mirror of
https://gitee.com/xiaohuolufeihua/bizhang_-obav.git
synced 2026-05-22 09:28:58 +00:00
Fix cut and paste so that we send direct PWM and read back servo values from the right pages.
This commit is contained in:
@@ -985,7 +985,7 @@ PX4IO::ioctl(file *filep, int cmd, unsigned long arg)
|
||||
ret = -EINVAL;
|
||||
} else {
|
||||
/* send a direct PWM value */
|
||||
ret = io_reg_set(PX4IO_PAGE_SERVOS, channel, arg);
|
||||
ret = io_reg_set(PX4IO_PAGE_DIRECT_PWM, channel, arg);
|
||||
}
|
||||
|
||||
break;
|
||||
@@ -999,7 +999,7 @@ PX4IO::ioctl(file *filep, int cmd, unsigned long arg)
|
||||
ret = -EINVAL;
|
||||
} else {
|
||||
/* fetch a current PWM value */
|
||||
uint32_t value = io_reg_get(PX4IO_PAGE_DIRECT_PWM, channel);
|
||||
uint32_t value = io_reg_get(PX4IO_PAGE_SERVOS, channel);
|
||||
if (value == _io_reg_get_error) {
|
||||
ret = -EIO;
|
||||
} else {
|
||||
|
||||
Reference in New Issue
Block a user