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(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"); } } }