mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-05-31 20:38:27 +08:00
*** empty log message ***
This commit is contained in:
@@ -78,8 +78,8 @@
|
|||||||
<define name="ACCEL_Z_NEUTRAL" value="32768"/>
|
<define name="ACCEL_Z_NEUTRAL" value="32768"/>
|
||||||
|
|
||||||
<define name="ACCEL_X_SENS" value="( 1250.)"/>
|
<define name="ACCEL_X_SENS" value="( 1250.)"/>
|
||||||
<define name="ACCEL_Y_SENS" value="(-1250.)"/>
|
<define name="ACCEL_Y_SENS" value="( 1250.)"/>
|
||||||
<define name="ACCEL_Z_SENS" value="(-1250.)"/>
|
<define name="ACCEL_Z_SENS" value="( 1250.)"/>
|
||||||
|
|
||||||
|
|
||||||
<define name="MAG_X_CHAN" value="0"/>
|
<define name="MAG_X_CHAN" value="0"/>
|
||||||
|
|||||||
@@ -91,11 +91,11 @@ void booz_sensors_model_accel_run( double time, MAT* dcm ) {
|
|||||||
accel_body->ve[AXIS_X],
|
accel_body->ve[AXIS_X],
|
||||||
accel_body->ve[AXIS_Y],
|
accel_body->ve[AXIS_Y],
|
||||||
accel_body->ve[AXIS_Z]);
|
accel_body->ve[AXIS_Z]);
|
||||||
#endif
|
|
||||||
|
|
||||||
|
|
||||||
accel_body = mv_mlt(dcm, g_inert, accel_body);
|
accel_body = mv_mlt(dcm, g_inert, accel_body);
|
||||||
accel_body = sv_mlt(-1., accel_body, accel_body);
|
accel_body = sv_mlt(-1., accel_body, accel_body);
|
||||||
|
#endif
|
||||||
|
|
||||||
// printf(" accel_body ~ %f %f %f\n", accel_body->ve[AXIS_X], accel_body->ve[AXIS_Y], accel_body->ve[AXIS_Z]);
|
// printf(" accel_body ~ %f %f %f\n", accel_body->ve[AXIS_X], accel_body->ve[AXIS_Y], accel_body->ve[AXIS_Z]);
|
||||||
#endif
|
#endif
|
||||||
|
|||||||
@@ -31,15 +31,20 @@
|
|||||||
#define BSM_ACCEL_RESOLUTION (65536)
|
#define BSM_ACCEL_RESOLUTION (65536)
|
||||||
/* ms-2 */
|
/* ms-2 */
|
||||||
#define BSM_ACCEL_SENSITIVITY_XX 1250.
|
#define BSM_ACCEL_SENSITIVITY_XX 1250.
|
||||||
#define BSM_ACCEL_SENSITIVITY_YY -1250.
|
#define BSM_ACCEL_SENSITIVITY_YY 1250.
|
||||||
#define BSM_ACCEL_SENSITIVITY_ZZ -1250.
|
#define BSM_ACCEL_SENSITIVITY_ZZ 1250.
|
||||||
#define BSM_ACCEL_NEUTRAL_X 32768
|
#define BSM_ACCEL_NEUTRAL_X 32768
|
||||||
#define BSM_ACCEL_NEUTRAL_Y 32768
|
#define BSM_ACCEL_NEUTRAL_Y 32768
|
||||||
#define BSM_ACCEL_NEUTRAL_Z 32768
|
#define BSM_ACCEL_NEUTRAL_Z 32768
|
||||||
/* m2s-4 */
|
/* m2s-4 */
|
||||||
#define BSM_ACCEL_NOISE_STD_DEV_X 0
|
//#define BSM_ACCEL_NOISE_STD_DEV_X 0
|
||||||
#define BSM_ACCEL_NOISE_STD_DEV_Y 0
|
//#define BSM_ACCEL_NOISE_STD_DEV_Y 0
|
||||||
#define BSM_ACCEL_NOISE_STD_DEV_Z 0
|
//#define BSM_ACCEL_NOISE_STD_DEV_Z 0
|
||||||
|
|
||||||
|
#define BSM_ACCEL_NOISE_STD_DEV_X 5e-1
|
||||||
|
#define BSM_ACCEL_NOISE_STD_DEV_Y 5e-1
|
||||||
|
#define BSM_ACCEL_NOISE_STD_DEV_Z 5e-1
|
||||||
|
|
||||||
/* ms-2 */
|
/* ms-2 */
|
||||||
#define BSM_ACCEL_BIAS_X 0
|
#define BSM_ACCEL_BIAS_X 0
|
||||||
#define BSM_ACCEL_BIAS_Y 0
|
#define BSM_ACCEL_BIAS_Y 0
|
||||||
|
|||||||
Reference in New Issue
Block a user