Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-26 09:43:57 -04:00
Code Issues Packages Projects Releases Wiki Activity

ArduCopter: added DMP_ENABLE #define and CH6 tuning value for AHRS_KP

Browse Source
This commit is contained in:
rmackay9 2012-07-28 14:21:07 +09:00
parent f97257830b
commit 014f5aae99
3 changed files with 16 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
ArduCopter/ArduCopter.pde
View File

@ -262,7 +262,11 @@ static GPS *g_gps_null;
#if QUATERNION_ENABLE == ENABLED
AP_AHRS_Quaternion ahrs(&imu, g_gps_null);
#else
#if DMP_ENABLED == ENABLED && CONFIG_APM_HARDWARE == APM_HARDWARE_APM2
AP_AHRS_MPU6000 ahrs(&imu, g_gps, &ins); // only works with APM2
#else
AP_AHRS_DCM ahrs(&imu, g_gps);
#endif
#endif
AP_TimerProcess timer_scheduler;
@ -2368,6 +2372,11 @@ static void tuning(){
case CH6_AHRS_YAW_KP:
ahrs._kp_yaw.set(tuning_value);
break;
case CH6_AHRS_KP:
ahrs._kp.set(tuning_value);
//ahrs.push_gains_to_dmp();
break;
}
}

4
ArduCopter/config.h
View File

@ -1025,6 +1025,10 @@
# define QUATERNION_ENABLE DISABLED
#endif
// experimental mpu6000 DMP code
#ifndef DMP_ENABLED
# define DMP_ENABLED DISABLED
#endif
#ifndef ALTERNATIVE_YAW_MODE
# define ALTERNATIVE_YAW_MODE DISABLED

1
ArduCopter/defines.h
View File

@ -180,6 +180,7 @@
#define CH6_LOITER_RATE_KD 23
#define CH6_AHRS_YAW_KP 30
#define CH6_AHRS_KP 31
// nav byte mask