fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08: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
Show Stats 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)
{
unsigned count = len / 2;
int ret;
if (count > 0) {
if (count > _max_actuators)
count = _max_actuators;
ret = io_reg_set(PX4IO_PAGE_DIRECT_PWM, 0, (uint16_t *)buffer, count);
} else {
ret = -EINVAL;
}
if (count > 0) {
int ret = io_reg_set(PX4IO_PAGE_DIRECT_PWM, 0, (uint16_t *)buffer, count);
if (ret != OK)
return ret;
}
return count * 2;
}
extern "C" __EXPORT int px4io_main(int argc, char *argv[]);