yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-22 01:12:31 +00:00
Code Issues Packages Projects Releases Wiki Activity

Tidy up the write path.

Browse Source
This commit is contained in:
px4dev
2013-01-26 13:15:27 -08:00
parent 899fbcc7cf
commit 72fcc8aad3
1 changed files with 5 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
apps/drivers/px4io/px4io.cpp
View File

@@ -1085,18 +1085,16 @@ ssize_t
PX4IO::write(file *filp, const char *buffer, size_t len) PX4IO::write(file *filp, const char *buffer, size_t len)
{ {
unsigned count = len / 2; unsigned count = len / 2;
int ret;
if (count > 0) {
if (count > _max_actuators) if (count > _max_actuators)
count = _max_actuators; count = _max_actuators;
ret = io_reg_set(PX4IO_PAGE_DIRECT_PWM, 0, (uint16_t *)buffer, count); if (count > 0) {
} else { int ret = io_reg_set(PX4IO_PAGE_DIRECT_PWM, 0, (uint16_t *)buffer, count);
ret = -EINVAL; if (ret != OK)
}
return ret; return ret;
} }
return count * 2;
}
extern "C" __EXPORT int px4io_main(int argc, char *argv[]); extern "C" __EXPORT int px4io_main(int argc, char *argv[]);