From 070f1c1bbbf6631da2baea456b2d7b03b46fd96e Mon Sep 17 00:00:00 2001 From: Randy Mackay Date: Mon, 7 Jul 2014 21:30:37 +0900 Subject: [PATCH] Compass: add dev_id for VRBrain --- libraries/AP_Compass/AP_Compass_VRBRAIN.cpp | 4 ++++ 1 file changed, 4 insertions(+) diff --git a/libraries/AP_Compass/AP_Compass_VRBRAIN.cpp b/libraries/AP_Compass/AP_Compass_VRBRAIN.cpp index 6dbef5ba87..d760f91a34 100644 --- a/libraries/AP_Compass/AP_Compass_VRBRAIN.cpp +++ b/libraries/AP_Compass/AP_Compass_VRBRAIN.cpp @@ -30,6 +30,7 @@ #include #include +#include #include #include #include @@ -56,6 +57,9 @@ bool AP_Compass_VRBRAIN::init(void) } for (uint8_t i=0; i<_num_instances; i++) { + // get device id + _dev_id[i] = ioctl(_mag_fd[i], DEVIOCGDEVICEID, 0); + // average over up to 20 samples if (ioctl(_mag_fd[i], SENSORIOCSQUEUEDEPTH, 20) != 0) { hal.console->printf("Failed to setup compass queue\n");