aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_Param: update AHRS for new constructor syntax

Browse Source
This commit is contained in:
Andrew Tridgell 2012-08-07 11:01:44 +10:00
parent 5e8fe8d93e
commit 898a5af692
4 changed files with 5 additions and 12 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
libraries/AP_AHRS/AP_AHRS_DCM.cpp
View File

@ -36,21 +36,21 @@ const AP_Param::GroupInfo AP_AHRS_DCM::var_info[] PROGMEM = {
// @Description: This controls the weight the compass has on the overall heading
// @Range: 0 .4
// @Increment: .01
AP_GROUPINFO("YAW_P", 0, AP_AHRS_DCM, _kp_yaw),
AP_GROUPINFO("YAW_P", 0, AP_AHRS_DCM, _kp_yaw, 0.4),
// @Param: RP_P
// @DisplayName: AHRS RP_P
// @Description: This controls how fast the accelerometers correct the attitude
// @Range: 0 .4
// @Increment: .01
AP_GROUPINFO("RP_P", 1, AP_AHRS_DCM, _kp),
AP_GROUPINFO("RP_P", 1, AP_AHRS_DCM, _kp, 0.4),
// @Param: GPS_GAIN
// @DisplayName: AHRS GPS gain
// @Description: This controls how how much to use the GPS to correct the attitude
// @Range: 0.0 1.0
// @Increment: .01
AP_GROUPINFO("GPS_GAIN", 2, AP_AHRS_DCM, gps_gain),
AP_GROUPINFO("GPS_GAIN", 2, AP_AHRS_DCM, gps_gain, 1.0),
AP_GROUPEND
};

4
libraries/AP_AHRS/AP_AHRS_DCM.h
View File

@ -22,10 +22,6 @@ public:
// with large drift levels
_ki = 0.0087;
_ki_yaw = 0.01;
_kp.set(0.4);
_kp_yaw.set(0.4);
gps_gain.set(1.0);
}
// return the smoothed gyro vector corrected for drift

4
libraries/AP_AHRS/AP_AHRS_MPU6000.cpp
View File

@ -34,14 +34,14 @@ const AP_Param::GroupInfo AP_AHRS_MPU6000::var_info[] PROGMEM = {
// @Description: This controls the weight the compass has on the overall heading
// @Range: 0 .4
// @Increment: .01
AP_GROUPINFO("YAW_P", 0, AP_AHRS_MPU6000, _kp_yaw),
AP_GROUPINFO("YAW_P", 0, AP_AHRS_MPU6000, _kp_yaw, 0.4),
// @Param: AHRS_RP_P
// @DisplayName: AHRS RP_P
// @Description: This controls how fast the accelerometers correct the attitude
// @Range: 0 .4
// @Increment: .01
AP_GROUPINFO("RP_P", 1, AP_AHRS_MPU6000, _kp),
AP_GROUPINFO("RP_P", 1, AP_AHRS_MPU6000, _kp, 0.4),
AP_GROUPEND
};

3
libraries/AP_AHRS/AP_AHRS_MPU6000.h
View File

@ -29,9 +29,6 @@ public:
_ki = 0.0087;
_ki_yaw = 0.01;
_kp.set(0.4);
_kp_yaw.set(0.4);
// dmp related variable initialisation
_gyro_bias_from_gravity_gain = 0.008;
_compass_bias_time = 0;