Browse Source

Add also default descriptor for alternate sensors

sbg
Lorenz Meier 11 years ago
parent
commit
1fb406ba09
  1. 22
      src/drivers/lsm303d/lsm303d.cpp

22
src/drivers/lsm303d/lsm303d.cpp

@ -586,11 +586,21 @@ LSM303D::init() @@ -586,11 +586,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 */
@ -598,6 +608,16 @@ LSM303D::init() @@ -598,6 +608,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 */

Loading…
Cancel
Save