mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-31 18:47:21 +08:00
Enabled additional drivers on v2, kill misplaced code in mkblctrl
This commit is contained in:
@@ -21,7 +21,6 @@ MODULES += drivers/boards/px4fmuv2
|
|||||||
MODULES += drivers/rgbled
|
MODULES += drivers/rgbled
|
||||||
MODULES += drivers/lsm303d
|
MODULES += drivers/lsm303d
|
||||||
MODULES += drivers/l3gd20
|
MODULES += drivers/l3gd20
|
||||||
#MODULES += drivers/mpu6000
|
|
||||||
MODULES += drivers/hmc5883
|
MODULES += drivers/hmc5883
|
||||||
MODULES += drivers/ms5611
|
MODULES += drivers/ms5611
|
||||||
MODULES += drivers/mb12xx
|
MODULES += drivers/mb12xx
|
||||||
@@ -30,6 +29,10 @@ MODULES += drivers/hil
|
|||||||
MODULES += drivers/hott/hott_telemetry
|
MODULES += drivers/hott/hott_telemetry
|
||||||
MODULES += drivers/hott/hott_sensors
|
MODULES += drivers/hott/hott_sensors
|
||||||
MODULES += drivers/blinkm
|
MODULES += drivers/blinkm
|
||||||
|
MODULES += drivers/mkblctrl
|
||||||
|
MODULES += drivers/airspeed
|
||||||
|
MODULES += drivers/ets_airspeed
|
||||||
|
MODULES += drivers/meas_airspeed
|
||||||
MODULES += modules/sensors
|
MODULES += modules/sensors
|
||||||
|
|
||||||
#
|
#
|
||||||
|
|||||||
@@ -1345,44 +1345,6 @@ mk_new_mode(PortMode new_mode, int update_rate, int motorcount, bool motortest,
|
|||||||
gpio_bits = 0;
|
gpio_bits = 0;
|
||||||
servo_mode = MK::MODE_NONE;
|
servo_mode = MK::MODE_NONE;
|
||||||
|
|
||||||
switch (new_mode) {
|
|
||||||
case PORT_FULL_GPIO:
|
|
||||||
case PORT_MODE_UNSET:
|
|
||||||
/* nothing more to do here */
|
|
||||||
break;
|
|
||||||
|
|
||||||
case PORT_FULL_SERIAL:
|
|
||||||
/* set all multi-GPIOs to serial mode */
|
|
||||||
gpio_bits = GPIO_MULTI_1 | GPIO_MULTI_2 | GPIO_MULTI_3 | GPIO_MULTI_4;
|
|
||||||
break;
|
|
||||||
|
|
||||||
case PORT_FULL_PWM:
|
|
||||||
/* select 4-pin PWM mode */
|
|
||||||
servo_mode = MK::MODE_4PWM;
|
|
||||||
break;
|
|
||||||
|
|
||||||
case PORT_GPIO_AND_SERIAL:
|
|
||||||
/* set RX/TX multi-GPIOs to serial mode */
|
|
||||||
gpio_bits = GPIO_MULTI_3 | GPIO_MULTI_4;
|
|
||||||
break;
|
|
||||||
|
|
||||||
case PORT_PWM_AND_SERIAL:
|
|
||||||
/* select 2-pin PWM mode */
|
|
||||||
servo_mode = MK::MODE_2PWM;
|
|
||||||
/* set RX/TX multi-GPIOs to serial mode */
|
|
||||||
gpio_bits = GPIO_MULTI_3 | GPIO_MULTI_4;
|
|
||||||
break;
|
|
||||||
|
|
||||||
case PORT_PWM_AND_GPIO:
|
|
||||||
/* select 2-pin PWM mode */
|
|
||||||
servo_mode = MK::MODE_2PWM;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* adjust GPIO config for serial mode(s) */
|
|
||||||
if (gpio_bits != 0)
|
|
||||||
g_mk->ioctl(0, GPIO_SET_ALT_1, gpio_bits);
|
|
||||||
|
|
||||||
/* native PX4 addressing) */
|
/* native PX4 addressing) */
|
||||||
g_mk->set_px4mode(px4mode);
|
g_mk->set_px4mode(px4mode);
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user