|
|
|
@ -260,7 +260,7 @@ PWMSim::init()
@@ -260,7 +260,7 @@ PWMSim::init()
|
|
|
|
|
nullptr); |
|
|
|
|
|
|
|
|
|
if (_task < 0) { |
|
|
|
|
DEVICE_DEBUG("task start failed: %d", errno); |
|
|
|
|
PX4_INFO("task start failed: %d", errno); |
|
|
|
|
return -errno; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -285,42 +285,42 @@ PWMSim::set_mode(Mode mode)
@@ -285,42 +285,42 @@ PWMSim::set_mode(Mode mode)
|
|
|
|
|
*/ |
|
|
|
|
switch (mode) { |
|
|
|
|
case MODE_2PWM: |
|
|
|
|
DEVICE_DEBUG("MODE_2PWM"); |
|
|
|
|
PX4_INFO("MODE_2PWM"); |
|
|
|
|
/* multi-port with flow control lines as PWM */ |
|
|
|
|
_update_rate = 50; /* default output rate */ |
|
|
|
|
_num_outputs = 2; |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case MODE_4PWM: |
|
|
|
|
DEVICE_DEBUG("MODE_4PWM"); |
|
|
|
|
PX4_INFO("MODE_4PWM"); |
|
|
|
|
/* multi-port as 4 PWM outs */ |
|
|
|
|
_update_rate = 50; /* default output rate */ |
|
|
|
|
_num_outputs = 4; |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case MODE_8PWM: |
|
|
|
|
DEVICE_DEBUG("MODE_8PWM"); |
|
|
|
|
PX4_INFO("MODE_8PWM"); |
|
|
|
|
/* multi-port as 8 PWM outs */ |
|
|
|
|
_update_rate = 50; /* default output rate */ |
|
|
|
|
_num_outputs = 8; |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case MODE_12PWM: |
|
|
|
|
DEVICE_DEBUG("MODE_12PWM"); |
|
|
|
|
PX4_INFO("MODE_12PWM"); |
|
|
|
|
/* multi-port as 12 PWM outs */ |
|
|
|
|
_update_rate = 50; /* default output rate */ |
|
|
|
|
_num_outputs = 12; |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case MODE_16PWM: |
|
|
|
|
DEVICE_DEBUG("MODE_16PWM"); |
|
|
|
|
PX4_INFO("MODE_16PWM"); |
|
|
|
|
/* multi-port as 16 PWM outs */ |
|
|
|
|
_update_rate = 50; /* default output rate */ |
|
|
|
|
_num_outputs = 16; |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case MODE_NONE: |
|
|
|
|
DEVICE_DEBUG("MODE_NONE"); |
|
|
|
|
PX4_INFO("MODE_NONE"); |
|
|
|
|
/* disable servo outputs and set a very low update rate */ |
|
|
|
|
_update_rate = 10; |
|
|
|
|
_num_outputs = 0; |
|
|
|
@ -575,7 +575,7 @@ PWMSim::ioctl(device::file_t *filp, int cmd, unsigned long arg)
@@ -575,7 +575,7 @@ PWMSim::ioctl(device::file_t *filp, int cmd, unsigned long arg)
|
|
|
|
|
|
|
|
|
|
default: |
|
|
|
|
ret = -ENOTTY; |
|
|
|
|
DEVICE_DEBUG("not in a PWM mode"); |
|
|
|
|
PX4_INFO("not in a PWM mode"); |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -789,7 +789,7 @@ PWMSim::pwm_ioctl(device::file_t *filp, int cmd, unsigned long arg)
@@ -789,7 +789,7 @@ PWMSim::pwm_ioctl(device::file_t *filp, int cmd, unsigned long arg)
|
|
|
|
|
ret = _mixers->load_from_buf(buf, buflen); |
|
|
|
|
|
|
|
|
|
if (ret != 0) { |
|
|
|
|
DEVICE_DEBUG("mixer load failed with %d", ret); |
|
|
|
|
PX4_ERR("mixer load failed with %d", ret); |
|
|
|
|
delete _mixers; |
|
|
|
|
_mixers = nullptr; |
|
|
|
|
_groups_required = 0; |
|
|
|
@ -949,7 +949,7 @@ extern "C" __EXPORT int pwm_out_sim_main(int argc, char *argv[]);
@@ -949,7 +949,7 @@ extern "C" __EXPORT int pwm_out_sim_main(int argc, char *argv[]);
|
|
|
|
|
static void |
|
|
|
|
usage() |
|
|
|
|
{ |
|
|
|
|
PX4_WARN("pwm_out_sim: unrecognized command, try:"); |
|
|
|
|
PX4_WARN("unrecognized command, try:"); |
|
|
|
|
PX4_WARN(" mode_pwm, mode_gpio_serial, mode_pwm_serial, mode_pwm_gpio, mode_port2_pwm8, mode_port2_pwm12, mode_port2_pwm16"); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|