mirror of https://github.com/ArduPilot/ardupilot
Fix manual values mapping
This commit is contained in:
parent
a78de771d4
commit
5bf21d5159
|
@ -124,31 +124,27 @@ void AP_Mount::update_mount()
|
||||||
yaw_angle=100*_roam_angles.z;
|
yaw_angle=100*_roam_angles.z;
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
case k_none:
|
|
||||||
{
|
|
||||||
//do nothing
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
case k_manual: // radio manual control
|
case k_manual: // radio manual control
|
||||||
if (g_rc_function[RC_Channel_aux::k_mount_roll])
|
if (g_rc_function[RC_Channel_aux::k_mount_roll])
|
||||||
roll_angle = map(g_rc_function[RC_Channel_aux::k_mount_roll]->radio_in,
|
roll_angle = map(g_rc_function[RC_Channel_aux::k_mount_roll]->radio_in,
|
||||||
g_rc_function[RC_Channel_aux::k_mount_roll]->radio_min,
|
g_rc_function[RC_Channel_aux::k_mount_roll]->radio_min,
|
||||||
g_rc_function[RC_Channel_aux::k_mount_roll]->radio_max,
|
g_rc_function[RC_Channel_aux::k_mount_roll]->radio_max,
|
||||||
g_rc_function[RC_Channel_aux::k_mount_roll]->angle_min,
|
g_rc_function[RC_Channel_aux::k_mount_roll]->angle_min,
|
||||||
g_rc_function[RC_Channel_aux::k_mount_roll]->radio_max);
|
g_rc_function[RC_Channel_aux::k_mount_roll]->angle_max);
|
||||||
if (g_rc_function[RC_Channel_aux::k_mount_pitch])
|
if (g_rc_function[RC_Channel_aux::k_mount_pitch])
|
||||||
pitch_angle = map(g_rc_function[RC_Channel_aux::k_mount_pitch]->radio_in,
|
pitch_angle = map(g_rc_function[RC_Channel_aux::k_mount_pitch]->radio_in,
|
||||||
g_rc_function[RC_Channel_aux::k_mount_pitch]->radio_min,
|
g_rc_function[RC_Channel_aux::k_mount_pitch]->radio_min,
|
||||||
g_rc_function[RC_Channel_aux::k_mount_pitch]->radio_max,
|
g_rc_function[RC_Channel_aux::k_mount_pitch]->radio_max,
|
||||||
g_rc_function[RC_Channel_aux::k_mount_pitch]->angle_min,
|
g_rc_function[RC_Channel_aux::k_mount_pitch]->angle_min,
|
||||||
g_rc_function[RC_Channel_aux::k_mount_pitch]->radio_max);
|
g_rc_function[RC_Channel_aux::k_mount_pitch]->angle_max);
|
||||||
if (g_rc_function[RC_Channel_aux::k_mount_yaw])
|
if (g_rc_function[RC_Channel_aux::k_mount_yaw])
|
||||||
yaw_angle = map(g_rc_function[RC_Channel_aux::k_mount_yaw]->radio_in,
|
yaw_angle = map(g_rc_function[RC_Channel_aux::k_mount_yaw]->radio_in,
|
||||||
g_rc_function[RC_Channel_aux::k_mount_yaw]->radio_min,
|
g_rc_function[RC_Channel_aux::k_mount_yaw]->radio_min,
|
||||||
g_rc_function[RC_Channel_aux::k_mount_yaw]->radio_max,
|
g_rc_function[RC_Channel_aux::k_mount_yaw]->radio_max,
|
||||||
g_rc_function[RC_Channel_aux::k_mount_yaw]->angle_min,
|
g_rc_function[RC_Channel_aux::k_mount_yaw]->angle_min,
|
||||||
g_rc_function[RC_Channel_aux::k_mount_yaw]->radio_max);
|
g_rc_function[RC_Channel_aux::k_mount_yaw]->angle_max);
|
||||||
break;
|
break;
|
||||||
|
case k_none:
|
||||||
default:
|
default:
|
||||||
{
|
{
|
||||||
//do nothing
|
//do nothing
|
||||||
|
|
Loading…
Reference in New Issue