fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-23 02:43:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

Make PX4IO driver obey HIL as it should

Browse Source
This commit is contained in:
Lorenz Meier
2014-03-17 14:32:27 +01:00
parent dbd467fe1f
commit 533e3172dc
1 changed files with 12 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/px4io/px4io.cpp
+12 -9
View File
@@ -1332,12 +1332,15 @@ PX4IO::io_handle_battery(uint16_t vbatt, uint16_t ibatt)
battery_status.discharged_mah = _battery_mamphour_total; battery_status.discharged_mah = _battery_mamphour_total;
_battery_last_timestamp = battery_status.timestamp; _battery_last_timestamp = battery_status.timestamp;
/* lazily publish the battery voltage */ /* the announced battery status would conflict with the simulated battery status in HIL */
if (_to_battery > 0) { if (!(_pub_blocked)) {
orb_publish(ORB_ID(battery_status), _to_battery, &battery_status); /* lazily publish the battery voltage */
if (_to_battery > 0) {
orb_publish(ORB_ID(battery_status), _to_battery, &battery_status);
} else { } else {
_to_battery = orb_advertise(ORB_ID(battery_status), &battery_status); _to_battery = orb_advertise(ORB_ID(battery_status), &battery_status);
}
} }
} }
@@ -1959,8 +1962,7 @@ PX4IO::print_status()
} }
int int
PX4IO::ioctl(file * /*filep*/, int cmd, unsigned long arg) PX4IO::ioctl(file * filep, int cmd, unsigned long arg)
/* Make it obvious that file * isn't used here */
{ {
int ret = OK; int ret = OK;
@@ -2372,8 +2374,9 @@ PX4IO::ioctl(file * /*filep*/, int cmd, unsigned long arg)
break; break;
default: default:
/* not a recognized value */ /* see if the parent class can make any use of it */
ret = -ENOTTY; ret = CDev::ioctl(filep, cmd, arg);
break;
} }
return ret; return ret;