|
|
|
@ -35,8 +35,6 @@ void AP_Mount_Servo::update()
@@ -35,8 +35,6 @@ void AP_Mount_Servo::update()
|
|
|
|
|
_last_check_servo_map_ms = now; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
uint8_t relative_pan = _state._options & AP_MOUNT_OPTION_RELATIVE_PAN; |
|
|
|
|
|
|
|
|
|
switch(get_mode()) { |
|
|
|
|
// move mount to a "retracted position" or to a position where a fourth servo can retract the entire mount into the fuselage
|
|
|
|
|
case MAV_MOUNT_MODE_RETRACT: |
|
|
|
@ -72,7 +70,7 @@ void AP_Mount_Servo::update()
@@ -72,7 +70,7 @@ void AP_Mount_Servo::update()
|
|
|
|
|
// point mount to a GPS point given by the mission planner
|
|
|
|
|
case MAV_MOUNT_MODE_GPS_POINT: |
|
|
|
|
{ |
|
|
|
|
if (calc_angle_to_roi_target(_angle_ef_target_rad, _flags.tilt_control, _flags.pan_control, relative_pan)) { |
|
|
|
|
if (calc_angle_to_roi_target(_angle_ef_target_rad, _flags.tilt_control, _flags.pan_control, true)) { |
|
|
|
|
stabilize(); |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
@ -85,7 +83,7 @@ void AP_Mount_Servo::update()
@@ -85,7 +83,7 @@ void AP_Mount_Servo::update()
|
|
|
|
|
} |
|
|
|
|
_state._roi_target = AP::ahrs().get_home(); |
|
|
|
|
_state._roi_target_set = true; |
|
|
|
|
if (calc_angle_to_roi_target(_angle_ef_target_rad, _flags.tilt_control, _flags.pan_control, relative_pan)) { |
|
|
|
|
if (calc_angle_to_roi_target(_angle_ef_target_rad, _flags.tilt_control, _flags.pan_control, true)) { |
|
|
|
|
stabilize(); |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
@ -94,7 +92,7 @@ void AP_Mount_Servo::update()
@@ -94,7 +92,7 @@ void AP_Mount_Servo::update()
|
|
|
|
|
if (calc_angle_to_sysid_target(_angle_ef_target_rad, |
|
|
|
|
_flags.tilt_control, |
|
|
|
|
_flags.pan_control, |
|
|
|
|
relative_pan)) { |
|
|
|
|
true)) { |
|
|
|
|
stabilize(); |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|