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

Add also default descriptor for alternate sensors

Browse Source
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
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/lsm303d/lsm303d.cpp
+21 -1
View File
@@ -552,11 +552,21 @@ LSM303D::init()
reset(); 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); ret = register_driver(ACCEL_DEVICE_PATH, &fops, 0666, (void *)this);
if (ret == OK) { if (ret == OK) {
log("default accel device"); 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 */ /* 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) { if (mag_ret == OK) {
log("default mag device"); 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 */ /* advertise mag topic */