|
|
|
@ -36,7 +36,9 @@ static void init_rc_in()
@@ -36,7 +36,9 @@ static void init_rc_in()
|
|
|
|
|
rc_ch[CH_8] = &g.rc_8; |
|
|
|
|
|
|
|
|
|
//set auxiliary ranges |
|
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_APM2 |
|
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_PX4 |
|
|
|
|
update_aux_servo_function(&g.rc_5, &g.rc_6, &g.rc_7, &g.rc_8, &g.rc_9, &g.rc_10, &g.rc_11, &g.rc_12); |
|
|
|
|
#elif CONFIG_HAL_BOARD == HAL_BOARD_APM2 |
|
|
|
|
update_aux_servo_function(&g.rc_5, &g.rc_6, &g.rc_7, &g.rc_8, &g.rc_9, &g.rc_10, &g.rc_11); |
|
|
|
|
#else |
|
|
|
|
update_aux_servo_function(&g.rc_5, &g.rc_6, &g.rc_7, &g.rc_8); |
|
|
|
@ -62,11 +64,14 @@ static void init_rc_out()
@@ -62,11 +64,14 @@ static void init_rc_out()
|
|
|
|
|
servo_write(CH_7, g.rc_7.radio_trim); |
|
|
|
|
servo_write(CH_8, g.rc_8.radio_trim); |
|
|
|
|
|
|
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_APM2 |
|
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_APM2 || CONFIG_HAL_BOARD == HAL_BOARD_PX4 |
|
|
|
|
servo_write(CH_9, g.rc_9.radio_trim); |
|
|
|
|
servo_write(CH_10, g.rc_10.radio_trim); |
|
|
|
|
servo_write(CH_11, g.rc_11.radio_trim); |
|
|
|
|
#endif |
|
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_PX4 |
|
|
|
|
servo_write(CH_12, g.rc_12.radio_trim); |
|
|
|
|
#endif |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static void read_radio() |
|
|
|
|