|
|
|
@ -1110,13 +1110,13 @@ start(enum Rotation rotation)
@@ -1110,13 +1110,13 @@ start(enum Rotation rotation)
|
|
|
|
|
DevMgr::getHandle(ACCELSIM_DEVICE_PATH_MAG, h_mag); |
|
|
|
|
|
|
|
|
|
/* don't fail if mag dev cannot be opened */ |
|
|
|
|
if (!h_mag.isValid()) { |
|
|
|
|
if (h.ioctl(SENSORIOCSPOLLRATE, (void *)SENSOR_POLLRATE_DEFAULT) < 0) { |
|
|
|
|
PX4_ERR("ioctl SENSORIOCSPOLLRATE %s failed", ACCELSIM_DEVICE_PATH_ACCEL); |
|
|
|
|
if (h_mag.isValid()) { |
|
|
|
|
if (h_mag.ioctl(SENSORIOCSPOLLRATE, (void *)SENSOR_POLLRATE_DEFAULT) < 0) { |
|
|
|
|
PX4_ERR("ioctl SENSORIOCSPOLLRATE %s failed", ACCELSIM_DEVICE_PATH_MAG); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
} else { |
|
|
|
|
PX4_ERR("ioctl SENSORIOCSPOLLRATE %s failed", ACCELSIM_DEVICE_PATH_ACCEL); |
|
|
|
|
PX4_ERR("ioctl SENSORIOCSPOLLRATE %s failed", ACCELSIM_DEVICE_PATH_MAG); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
DevMgr::releaseHandle(h); |
|
|
|
|