2b6a10d18b
AP_RangeFinder - changed example sketch to work with new Filter library
13 years ago
033347f8ee
Filter - updated example sketch to use modified library
13 years ago
645fda2fb2
Filter - added AverageFilter, removed SumFilter
...
added FilterWithBuffer to allow removal of malloc/free without losing ability to pass around filter objects
13 years ago
cb52b6c6d9
AP_Param: show numerical value in eeprom dump utility
13 years ago
a432232db9
AP_Param: fixed v.load() on a sub-element of a AP_Vector3f
...
this isn't actually used at the moment in APM, but we should get it
right in case someone does try to load a single element of a vector
13 years ago
39797c6f33
SITL: simulate noise on each ADC channel separately
...
scale the noise based on the period of the motors
13 years ago
efe5c0142c
SITL: raise the ADC noise level to 8 bits when flying
...
this is about the level of noise of a aircraft that has a lot of
vibration
13 years ago
cd4fcb694e
IMU: removed unused accel_filtered code
13 years ago
87a6d97f7b
AP_Param: fixed setting of CAM_P_G in ArduCopter
...
the variable CAM_P_G has the same prefix as the CAM_P group. We want
to allow for parameters having a common prefix with a group, so we
need to keep searching after we've found a group that matches the
prefix
13 years ago
fa443bd928
AP_Param: make the templating code a bit clearer
...
add comments on the arguments, and name them in a clearer way
13 years ago
eb35e0e8ac
DCM: fixed the sense of the compass GPS test in initial yaw
...
we were only disabling null offsets when we didn't have a compass,
which doesn't make much sense!
13 years ago
297d2ae457
ModeFilter - corrected shadowed variable compiler warning for drop_high_sample
13 years ago
b9b88ba237
Filter - added AverageFilter - this will be used in place of SumFilter because it removes the possibility of overflows
13 years ago
f53ff8de97
Filter - removed shadowing of variables in constructors for Filter, ModeFilter and SumFilter (sorry tridge!)
...
increased maximum sample buffer size from 6 to 10
13 years ago
74f7d7a1c0
ModeFilter - remove older ModeFilter library (new library is now in Filter directory)
13 years ago
f264e29814
AP_RangeFinder - cut over to use new ModeFilter from Filter library
13 years ago
c14d7768f7
Filter - first version of filter library include ModeFilter
13 years ago
952e5d7bbc
AP_Mount - #include FastSerial first to allow it to compile under Arduino 1.0
13 years ago
d0a6359b37
Compass: use constructor to set initial values for _learn and _use_for_yaw
...
this ensures they are set if you have MAG_ENABLE==0
13 years ago
900388a85a
DCM: disable compass null offsets when setting initial yaw
...
we need to ensure the compass null offsets code doesn't see a sudden
yaw change, or it will change the offsets by a large amount very
suddenly
13 years ago
f59297d7a7
Compass: catch the case of a user enabling a compass mid-flight
...
if a compass has not been initialised at startup we can't enable it
mid-flight, as we don't have the orientation
13 years ago
eb71b26d3f
DCM: use the new use_for_yaw() compass method
13 years ago
664622523d
Compass: added COMPASS_LEARN and COMPASS_USE parameters
...
these allow you to control if the compass should be used for yaw and
if it should learn its offsets. This is useful for locking in compass
offsets once they are confirmed to be good, and for learning offsets
without using them in flights.
The default is to behave the same as previously, which is
COMPASS_LEARN=1 and COMPASS_USE=1
13 years ago
f10097a6d5
AP_Param: added some comments on AP_Vector3f handling
13 years ago
5e2fbdb6cf
DCM: don't reset _have_initial_yaw for GPS heading unless very slow
...
wait till we reach 1m/s before we reset _have_initial_yaw. This
prevents us continually resetting the DCM matrix if our ground speed
is close to 3m/s.
13 years ago
2e9105c68a
AP_Param: added special handling for Vector3f
...
We would like to be able to use Vector3f as a parameter while exposing
the individual elements of the vector as MAVLink parameters. This
change to AP_Param makes that possible, by giving AP_Vector3f a dual
personality
13 years ago
d6bfceef7c
SITL: added -C option to desktop mode
...
this allows running APM to stdout, which is useful for test sketches
13 years ago
54aa8297af
libs: removed unused library GPS_IMU
13 years ago
185ab5aea9
libs: removed unusued library GCS_SIMPLE
13 years ago
55e33c3359
DCM: tidy up use of error_course and in_motion
...
in_motion is not a good name now it is also used for the compass
The error_course and heading component values don't need to be part of
the DCM object, they can be on the stack to reduce the memory usage a bit
13 years ago
ab8cc3d478
DCM: use rotation_matrix_from_euler() to calculate initial yaw
...
When we first get a compass reading or we first start motion we need
to setup the DCM matrix with the right yaw. This uses
rotation_matrix_from_euler() to get a DCM matrix corresponding to our
current roll/pitch, but with the correct yaw
13 years ago
ddeda1c367
DCM: use rotation_matrix_from_euler() in matrix reset
...
this makes the code a bit easier to read
13 years ago
06f37aad75
DCM: use calculate_euler_angles() to get eulers from DCM
...
this makes the code a bit easier to understand
13 years ago
16ed8bc8f6
AP_Math: added rotmat <-> euler functions
...
these will make the dcm matrix manipulation easier to understand
13 years ago
c354879f1f
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
13 years ago
17d16bc8c6
AP_Math: added safe_sqrt() function
...
this function will never return NAN. It will return zero for negative
numbers.
13 years ago
bad653f230
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.
13 years ago
c8e6d03c67
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
13 years ago
502fbf6e17
AP_Math: added a safe_asin() function
...
this adds range checking to asin()
13 years ago
17170da96e
AP_Math: added is_nan() methods to vector3f and matrix3f
13 years ago
b094f6ce52
added set integrator
13 years ago
ef90f336d3
DCM: changed the sense of floating point range comparison
...
This allows us to detect NaN, otherwise NaN values were considered
'in range'
13 years ago
57ffd00b69
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
13 years ago
2bb58db3f7
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
13 years ago
156d98cb9f
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
13 years ago
53b87229ff
AP_Param: added ParamToken type for variable list traversal
13 years ago
1e37a0ec17
added a limit to range output
13 years ago
33aa6fe13b
Optflow - added reference to FastSerial to resolve compile error on Arduino 1.0.
...
also removed reference to DCM (no longer required) and removed some old code.
13 years ago
9793d04ed1
SITL: increase the amount of noise in the simulated ADC
...
this increases the noise to 2 bits, which actually can have the effect
of improving accuracy, as it leads to better averaging
13 years ago
d52cb7e574
DCM: only add in centripetal accel if we have GPS lock
...
if we don't have a GPS or the GPS doesn't have a good lock then we
can't rely on the ground speed for adjusting the acceleration vector
13 years ago
rmackay9
Andrew Tridgell
Jason Short