dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

Gyrosim: More verbose output

This commit is contained in:
Lorenz Meier 2015-09-20 16:43:44 +02:00
parent d32f9f043b
commit b2a8dd18c0
1 changed files with 4 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
src/platforms/posix/drivers/gyrosim/gyrosim.cpp
View File

@ -52,7 +52,6 @@
#include <stdbool.h> #include <stdbool.h>
#include <stddef.h> #include <stddef.h>
#include <stdlib.h> #include <stdlib.h>
#include <semaphore.h>
#include <string.h> #include <string.h>
#include <fcntl.h> #include <fcntl.h>
#include <poll.h> #include <poll.h>
@ -513,6 +512,7 @@ GYROSIM::transfer(uint8_t *send, uint8_t *recv, unsigned len)
// Get data from the simulator // Get data from the simulator
Simulator *sim = Simulator::getInstance(); Simulator *sim = Simulator::getInstance();
if (sim == NULL) { if (sim == NULL) {
PX4_WARN("failed accessing simulator");
return ENODEV; return ENODEV;
} }
@ -531,6 +531,7 @@ GYROSIM::transfer(uint8_t *send, uint8_t *recv, unsigned len)
if (recv) if (recv)
memcpy(&recv[1], &_regdata[reg-MPUREG_PRODUCT_ID], len-1); memcpy(&recv[1], &_regdata[reg-MPUREG_PRODUCT_ID], len-1);
} }
return PX4_OK; return PX4_OK;
} }
@ -767,8 +768,9 @@ GYROSIM::ioctl(device::file_t *filp, int cmd, unsigned long arg)
bool want_start = (_call_interval == 0); bool want_start = (_call_interval == 0);
/* if we need to start the poll state machine, do it */ /* if we need to start the poll state machine, do it */
if (want_start) if (want_start) {
start(); start();
}
return OK; return OK;
} }