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

Add also default descriptor for alternate sensors

This commit is contained in:
Lorenz Meier 2013-12-07 10:44:29 +01:00
parent 7becbcdbd5
commit c72162cc5a
1 changed files with 21 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

22
src/drivers/lsm303d/lsm303d.cpp
View File

@ -552,11 +552,21 @@ LSM303D::init()
reset();
/* try to claim the generic accel node as well - it's OK if we fail at this */
/* register the first instance as plain name, the 2nd as two and counting */
ret = register_driver(ACCEL_DEVICE_PATH, &fops, 0666, (void *)this);
if (ret == OK) {
log("default accel device");
} else {
unsigned instance = 1;
do {
char name[32];
sprintf(name, "%s%d", ACCEL_DEVICE_PATH, instance);
ret = register_driver(name, &fops, 0666, (void *)this);
instance++;
} while (ret);
}
/* try to claim the generic accel node as well - it's OK if we fail at this */
@ -564,6 +574,16 @@ LSM303D::init()
if (mag_ret == OK) {
log("default mag device");
} else {
unsigned instance = 1;
do {
char name[32];
sprintf(name, "%s%d", MAG_DEVICE_PATH, instance);
ret = register_driver(name, &fops, 0666, (void *)this);
instance++;
} while (ret);
}
/* advertise mag topic */