CompassSensor::CompassSensor()
: SensorBase(NULL, NULL),
compass_fd(-1),
mCompassTimestamp(0),
mCompassInputReader(8)
{
VFUNC_LOG;
if(!strcmp(COMPASS_NAME, "USE_SYSFS")) {
int result = find_name_by_sensor_type("in_magn_scale", "iio:device",
sensor_name);
if(result) {
LOGE("HAL:Cannot read secondary device name - (%d)", result);
}
dev_name = sensor_name;
}
LOGI_IF(PROCESS_VERBOSE, "HAL:Secondary Chip Id: %s", dev_name);
if(inv_init_sysfs_attributes()) {
LOGE("Error Instantiating Compass\n");
return;
}
memset(mCachedCompassData, 0, sizeof(mCachedCompassData));
LOGV_IF(SYSFS_VERBOSE, "HAL:sysfs:cat %s (%lld)",
compassSysFs.compass_orient, getTimestamp());
FILE *fptr;
fptr = fopen(compassSysFs.compass_orient, "r");
if (fptr != NULL) {
int om[9];
if (fscanf(fptr, "%d,%d,%d,%d,%d,%d,%d,%d,%d",
&om[0], &om[1], &om[2], &om[3], &om[4], &om[5],
&om[6], &om[7], &om[8]) < 0 || fclose(fptr) < 0) {
LOGE("HAL:Could not read compass mounting matrix");
} else {
LOGV_IF(EXTRA_VERBOSE, "HAL:compass mounting matrix: "
"%+d %+d %+d %+d %+d %+d %+d %+d %+d", om[0], om[1], om[2],
om[3], om[4], om[5], om[6], om[7], om[8]);
mCompassOrientation[0] = om[0];
mCompassOrientation[1] = om[1];
mCompassOrientation[2] = om[2];
mCompassOrientation[3] = om[3];
mCompassOrientation[4] = om[4];
mCompassOrientation[5] = om[5];
mCompassOrientation[6] = om[6];
mCompassOrientation[7] = om[7];
mCompassOrientation[8] = om[8];
}
}
if (!isIntegrated()) {
enable(ID_M, 0);
}
}
CompassSensor::CompassSensor()
: SensorBase(NULL, NULL),
compass_fd(-1),
mCompassTimestamp(0),
mCompassInputReader(8)
{
VFUNC_LOG;
if(inv_init_sysfs_attributes()) {
LOGE("Error Instantiating Compass\n");
return;
}
if (!strcmp(COMPASS_NAME, "INV_COMPASS")) {
mI2CBus = COMPASS_BUS_SECONDARY;
} else {
mI2CBus = COMPASS_BUS_PRIMARY;
}
memset(mCachedCompassData, 0, sizeof(mCachedCompassData));
LOGV_IF(SYSFS_VERBOSE, "HAL:sysfs:cat %s (%lld)",
compassSysFs.compass_orient, getTimestamp());
FILE *fptr;
fptr = fopen(compassSysFs.compass_orient, "r");
if (fptr != NULL) {
int om[9];
fscanf(fptr, "%d,%d,%d,%d,%d,%d,%d,%d,%d",
&om[0], &om[1], &om[2], &om[3], &om[4], &om[5],
&om[6], &om[7], &om[8]);
fclose(fptr);
LOGV_IF(EXTRA_VERBOSE,
"HAL:compass mounting matrix: "
"%+d %+d %+d %+d %+d %+d %+d %+d %+d",
om[0], om[1], om[2], om[3], om[4], om[5], om[6], om[7], om[8]);
mCompassOrientation[0] = om[0];
mCompassOrientation[1] = om[1];
mCompassOrientation[2] = om[2];
mCompassOrientation[3] = om[3];
mCompassOrientation[4] = om[4];
mCompassOrientation[5] = om[5];
mCompassOrientation[6] = om[6];
mCompassOrientation[7] = om[7];
mCompassOrientation[8] = om[8];
} else {
LOGE("HAL:Couldn't read compass mounting matrix");
}
if (!isIntegrated()) {
enable(ID_M, 0);
}
}
CompassSensor::CompassSensor()
: SensorBase(COMPASS_NAME, NULL),
mCompassTimestamp(0),
mCompassInputReader(8),
mCoilsResetFd(0)
{
FILE *fptr;
VFUNC_LOG;
mYasCompass = false;
if(!strcmp(dev_name, "USE_SYSFS")) {
char sensor_name[20];
find_name_by_sensor_type("in_magn_x_raw", "iio:device", sensor_name);
strncpy(dev_full_name, sensor_name,
sizeof(dev_full_name) / sizeof(dev_full_name[0]));
if(!strncmp(dev_full_name, "yas", 3)) {
mYasCompass = true;
}
} else {
#ifdef COMPASS_YAS53x
/* for YAS53x compasses, dev_name is just a prefix,
we need to find the actual name */
if (fill_dev_full_name_by_prefix(dev_name,
dev_full_name, sizeof(dev_full_name) / sizeof(dev_full_name[0]))) {
LOGE("Cannot find Yamaha device with prefix name '%s' - "
"magnetometer will likely not work.", dev_name);
} else {
mYasCompass = true;
}
#else
strncpy(dev_full_name, dev_name,
sizeof(dev_full_name) / sizeof(dev_full_name[0]));
#endif
}
if (inv_init_sysfs_attributes()) {
LOGE("Error Instantiating Compass\n");
return;
}
if (!strcmp(dev_full_name, "INV_COMPASS")) {
mI2CBus = COMPASS_BUS_SECONDARY;
} else {
mI2CBus = COMPASS_BUS_PRIMARY;
}
memset(mCachedCompassData, 0, sizeof(mCachedCompassData));
if (!isIntegrated()) {
enable(ID_M, 0);
}
LOGV_IF(SYSFS_VERBOSE, "HAL:compass name: %s", dev_full_name);
enable_iio_sysfs();
LOGV_IF(SYSFS_VERBOSE, "HAL:sysfs:cat %s (%lld)",
compassSysFs.compass_orient, getTimestamp());
fptr = fopen(compassSysFs.compass_orient, "r");
if (fptr != NULL) {
int om[9];
if (fscanf(fptr, "%d,%d,%d,%d,%d,%d,%d,%d,%d",
&om[0], &om[1], &om[2], &om[3], &om[4], &om[5],
&om[6], &om[7], &om[8]) < 0 || fclose(fptr)) {
LOGE("HAL:could not read compass mounting matrix");
} else {
LOGV_IF(EXTRA_VERBOSE,
"HAL:compass mounting matrix: "
"%+d %+d %+d %+d %+d %+d %+d %+d %+d",
om[0], om[1], om[2], om[3], om[4], om[5], om[6], om[7], om[8]);
mCompassOrientation[0] = om[0];
mCompassOrientation[1] = om[1];
mCompassOrientation[2] = om[2];
mCompassOrientation[3] = om[3];
mCompassOrientation[4] = om[4];
mCompassOrientation[5] = om[5];
mCompassOrientation[6] = om[6];
mCompassOrientation[7] = om[7];
mCompassOrientation[8] = om[8];
}
}
if(mYasCompass) {
mCoilsResetFd = fopen(compassSysFs.compass_attr_1, "r+");
if (fptr == NULL) {
LOGE("HAL:Could not open compass overunderflow");
}
}
}
