Andrew Tridgell
8f74631882
DCM: don't use compass unless its healthy
13 years ago
Andrew Tridgell
0147c7b6c6
DCM: added matrix_reset() method
13 years ago
Andrew Tridgell
14866927e1
dcm: fixed an uninitialised variable
...
if no compass and not in motion the DCM we would multiply by an
uninitialised number
13 years ago
Wenyao Xie
2432ae130d
Fixed baro.
13 years ago
Jason Short
e37dffadf3
Added faster conversion from and to degrees*100 / rads
13 years ago
Doug Weibel
e3ab1b0353
Add an accessor for the DCM drift correction integrator to monitor performance
...
Also made the get_health accessor an inline function.
13 years ago
Doug Weibel
947950398c
Changed the DCM drift correction integrator limit to a vector magnitude of 30 degrees/second.
...
The drift correction integrator limit previously was near/at the gyro saturation limit. If we have that much drift there is a serious hardware problem. 30 degrees/second is arbitrary but should handle all temperature variation, etc.
13 years ago
Doug Weibel
c7077fa9e8
In case of DCM renorm "blow-up" reset the drift correction integrators
...
This should aid in recovery if we loose the AHRS solution and have to force to initial orientation. Also removed some old commented out code moved to the IMU object
13 years ago
Andrew Tridgell
9314dcaa89
DCM: re-work the DCM to use the new IMU/ADC features
...
this gives us higher resolution DCM calculations, with much more
accurate timing of the update delta time.
14 years ago
Jason Short
d50ed35077
Added a state machine intended to run at 250hz to the DCM. Spread load of DCM out to lower CPU.
14 years ago
jasonshort
5e163c6052
added ki_Yaw private variable and accessors.
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@2778 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
jasonshort
418a4b3903
removed redundant FP calcs for speed up.
...
added ability to alternate normalization and drift correction. Not fully implemented, needs further testing.
git-svn-id: https://arducopter.googlecode.com/svn/trunk@2691 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
tridge60@gmail.com
cb492ac00e
fixed warnings in AP_DCM
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@2559 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
jasonshort
edaf2b9641
Based on Doug's recommendation - increased Accel weighting to .66 – 1.33 Gs
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@2557 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
jasonshort
595266152b
Added dynamic setting of kp_rollpitch, ki_rollpitch, kp_yaw.
...
Added three constants for kp_rollpitch, (high, med -default, low)
Functionally equivalent to prior version.
git-svn-id: https://arducopter.googlecode.com/svn/trunk@2550 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
deweibel@gmail.com
195b695011
Fix imu_health metric
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1728 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
DrZiplok@gmail.com
cd341cef90
We should call imu.update() before asking for accel/gyro values so that we get timely, fresh numbers.
...
Most other consumers of the accel/gyro values should be asking us for them anyway. At that point, what they are getting are the values we sampled here.
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1376 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
jasonshort
ef160226cc
cosmetic
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1313 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
deweibel
1da23bc3c0
Fix bug in transposed DCM matrix accessor
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1134 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
jasonshort
7945937874
added ability to get the transpose of the DCM
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1116 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
jasonshort
2f2aaa88fd
Added dynamic setting of compass
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1010 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
jasonshort
a142d8ee7d
imu enhancements
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1007 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
jasonshort
b62c287f5e
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1002 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
james.goppert
110685f880
Updated DCM library.
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@996 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
jasonshort
93206020cb
Moved Health to DCM, Centripetal correct
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@988 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
jasonshort
275624358d
boolean to disable centrifugal correction.
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@987 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
jasonshort
d209f3d59e
update - See ArducopterMega in Branch for implementation details
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@986 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
DrZiplok@gmail.com
d159986be4
Use fabs() for floating point values, not abs(). The latter causes truncation (cast to int) and generates a lot more code.
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@956 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
james.goppert
da9ecf342c
Updated AP_DCM to use AP_ADC, fixes HIL bugs.
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@948 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
deweibel
607b86c9a2
Change roll, pitch, yaw to be public verus private/accessors per Jason's request.
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@945 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
james.goppert
0f9ac71e6a
HIL debugging AP_DCM
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@940 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
deweibel
0e32cb34c5
bug fix, enhancements
...
Now in a flyable state.
git-svn-id: https://arducopter.googlecode.com/svn/trunk@852 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
deweibel
52ed7fac8c
corrections to imu and dcm libs, addition of vector member to compass class for magnetic vector
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@844 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
deweibel
7b752babf0
checking in working copy to work on bad bug
...
DO NOT ATTEMPT TO FLY
git-svn-id: https://arducopter.googlecode.com/svn/trunk@762 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
deweibel
b49032d9ea
Changes to DCM and IMU libraries to put accel into m/s^2 units
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@757 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
deweibel
a80eb66e77
fix bugs from factoring imu object.
...
Tested & working - integration and roll/pitch drift correction
Untested - yaw drift correction and centrepetal comp
git-svn-id: https://arducopter.googlecode.com/svn/trunk@729 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago
deweibel
de51162e81
Correct file references for repository
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@727 f9c3cf11-9bcb-44bc-f272-b75c42450872
15 years ago
deweibel
3e30d2566d
Add DCM library
...
git-svn-id: https://arducopter.googlecode.com/svn/trunk@725 f9c3cf11-9bcb-44bc-f272-b75c42450872
15 years ago