Commit Graph

3473 Commits

Author SHA1 Message Date
Andrew Tridgell 4edf311865 ACM: ensure update_trig() doesn't cause NAN values for cos_roll/cos_pitch
the DCM matrix could have a value over 1.0 for c.x due to rounding
errors
2012-02-24 11:52:55 +11:00
Andrew Tridgell 50f85835bd Compass: ensure we don't produce NAN values for compass heading
this leaves the previous heading values alone if we are at a pitch of
exactly 90 or -90, at which point we can't compute a meaningful
heading
2012-02-24 11:52:55 +11:00
Andrew Tridgell 8190204287 AP_Math: added safe_sqrt() function
this function will never return NAN. It will return zero for negative
numbers.
2012-02-24 11:52:55 +11:00
Andrew Tridgell 0acea11152 DCM: tidy up the nan checking in DCM
use is_nan() on the matrix rather than just on c.x, and add
safe_asin() to the (unused) OUTPUTMODE==2 code.
2012-02-24 11:52:55 +11:00
Andrew Tridgell b4c8d6491a DCM: added matrix recovery on reset
when we get a bad DCM error we can recover a matrix corresponding to
the current attitude, making it more likely that the aircraft will be
able to recover
2012-02-24 11:52:55 +11:00
Andrew Tridgell 1a32ececb4 AP_Math: added a safe_asin() function
this adds range checking to asin()
2012-02-24 11:52:55 +11:00
Andrew Tridgell 7dd909a16b AP_Math: added is_nan() methods to vector3f and matrix3f 2012-02-24 11:52:55 +11:00
Jason Short 2a4b7facaa added set integrator 2012-02-23 09:38:08 -08:00
Jason Short b1340bbf80 added a constraint to D term 2012-02-23 09:14:44 -08:00
Hazy e88e6200b4 APM Planner
a little bit translate
2012-02-23 16:39:16 +08:00
Andrew Tridgell 8707965c15 DCM: changed the sense of floating point range comparison
This allows us to detect NaN, otherwise NaN values were considered 
'in range'
2012-02-23 11:41:26 +11:00
Andrew Tridgell 9caa4aeb44 DCM: range check the matrix before calculating pitch
The asin() in the pitch calculation can only take values between -1
and 1. This change ensures that the value is in range, and if it isn't
then we force a normalization. If that fails we reset the matrix
2012-02-23 08:16:08 +11:00
Andrew Tridgell 13693e1a04 DCM: reset more values on renorm blowup
when DCM blows up, we need to reset a lot more variables to ensure
that any NaN values don't persist
2012-02-23 08:16:08 +11:00
Andrew Tridgell b231112957 DCM: renorm_sqrt_count is now called renorm_range_count 2012-02-23 08:16:08 +11:00
Andrew Tridgell 5cfe1ad5dc DCM: remove the taylor expansion optimisation for renormalisation
The sqrt() costs about 44usec on a 2560, which is small enough for us
not to worry about the speed.

This also changes the range of values where we declare a blowup to
much less likely, which means we can cope with larger delta_t glitches
2012-02-23 08:16:08 +11:00
Jason Short 128f19cdf7 Emile's Fixes 2012-02-22 10:27:34 -08:00
Jason Short ac5a4830a1 Marco's Hexa Motors 2012-02-22 09:55:44 -08:00
Michael Oborne 6abd825a64 firmware build 2012-02-23 01:06:56 +08:00
Jason Short 92cfc8913a revved a version 2012-02-22 09:00:42 -08:00
Jason Short 207ffee856 made timer unsigned 2012-02-21 21:49:03 -08:00
Jason Short ac81ddef04 commented out control mode debug print 2012-02-21 21:48:07 -08:00
Michael Oborne 0eec6d462f ensure autoupdate works 2012-02-21 12:32:19 +08:00
Michael Oborne 63cb155fdd APM Planner 1.1.40 2012-02-21 12:04:45 +08:00
Michael Oborne 3259bc6c7a APM Planner - gps lat long bug fix. 2012-02-21 11:55:36 +08:00
Michael Oborne a5a7c012bd APM Planner 1.1.39
fix timeout issue.
2012-02-21 07:38:06 +08:00
Michael Oborne b00487513b APM Planner - fix timeout bug 2012-02-20 23:33:04 +08:00
Michael Oborne ce4437578a APM Planner 1.1.38
add ap param support
fix dtr
fix firmware screen on mono
misc mono fix's
mods from mandrolic - partial.
Add spanish - issue 515
new sitl images for attitude hil - issue 513
2012-02-20 19:30:47 +08:00
Michael Oborne 0aa5304dab firmware build 2012-02-20 13:24:12 +08:00
Michael Oborne e1be37b6d1 firmware build 2012-02-20 13:06:04 +08:00
Jason Short 9eea6a6c46 Better throttle for tests 2012-02-19 15:06:54 -08:00
Jason Short 7bfda28cdc removed old comments 2012-02-19 14:21:27 -08:00
Jason Short 7a60f33874 SIMPLE mode throttle fix 2012-02-19 14:21:27 -08:00
Andrew Tridgell 9f79455ecc autotest: fixed check of return code for build_all.sh 2012-02-20 09:17:08 +11:00
Andrew Tridgell aaab500fe3 autotest: fixed directory for build_all.sh 2012-02-20 08:41:40 +11:00
Jason Short 70d7a1f5d0 Added slow_wp default in AP mode 2012-02-19 13:15:40 -08:00
Jason Short 434b059586 reset slow_WP option at mode switch 2012-02-19 13:13:42 -08:00
Jason Short 151e710668 Added slow wp option in calc_desired_speed 2012-02-19 13:13:21 -08:00
Jason Short 4b52dde882 set Slow WP option for RTL in Auto mode 2012-02-19 13:12:23 -08:00
Jason Short 79a9665c9d Added "slow WP" option for RTL. 2012-02-19 13:11:59 -08:00
Jason Short ba2cfee2fb Updated manual throttle control during throttle hold 2012-02-19 12:40:51 -08:00
Jason Short a4b8119c24 added workaround for resetting alt. 2012-02-19 12:40:08 -08:00
Jason Short 2a5a7fa245 Added SW test for Manual Boost 2012-02-19 12:39:40 -08:00
Jason Short 9169fe2bfe AP TEST fixes for new throttle control 2012-02-19 12:38:57 -08:00
Randy Mackay b4ee111c49 TradHeli - change throttle range back to 0~1000 (was temporarily changed to be 1250~850 which limited the range of the swash plate's vertical movements) 2012-02-20 00:27:12 +09:00
ellissu ae885d4cfe Edit and Add some Traditional Chinese translation 2012-02-19 21:36:04 +08:00
Andrew Tridgell 982e6f22c3 autotest: lower throttle level for lowering altitude in loiter
we were not dropping altitude in the change_alt test
2012-02-19 23:21:09 +11:00
Andrew Tridgell 1e9f53cc44 autotest: fixed failsafe test
increased timeout, added check for home location, and fixed failure
testing on timeout
2012-02-19 22:52:09 +11:00
Randy Mackay 7c4ef140b9 ArduCopter - remove unnecessary block for next GPS value before saving home location 2012-02-19 15:38:40 +09:00
Andrew Tridgell 470ced9aad autotest: added build_all.sh to autotest 2012-02-19 17:05:28 +11:00
Andrew Tridgell 0a7c769fc6 scripts: added some more builds to build_all.sh 2012-02-19 17:05:28 +11:00