static ssize_t mpu6050_input_gyro_enable_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t count)
{
struct input_dev *input_data = to_input_dev(dev);
struct mpu6050_input_data *data = input_get_drvdata(input_data);
unsigned long value = 0;
if (strict_strtoul(buf, 10, &value))
return -EINVAL;
gyro_open_calibration();
mutex_lock(&data->mutex);
pr_info("%s : enable = %ld\n", __func__, value);
mpu6050_input_activate_devices(data, MPU6050_SENSOR_GYRO,
(value == 1) ? true : false);
#ifdef CONFIG_INPUT_MPU6050_POLLING
if ((atomic_read(&data->gyro_enable)) && !value)
cancel_delayed_work_sync(&data->gyro_work);
if (!(atomic_read(&data->gyro_enable)) && value)
schedule_delayed_work(&data->gyro_work, 0);
#endif
atomic_set(&data->gyro_enable, value);
mutex_unlock(&data->mutex);
return count;
}
static int ssp_remove_sensor(struct ssp_data *data,
unsigned int uChangedSensor, unsigned int uNewEnable)
{
u8 uBuf[2];
int64_t dSensorDelay = data->adDelayBuf[uChangedSensor];
ssp_dbg("[SSP]: %s - remove sensor = %d, current state = %d\n",
__func__, (1 << uChangedSensor), uNewEnable);
data->adDelayBuf[uChangedSensor] = DEFUALT_POLLING_DELAY;
if (data->aiCheckStatus[uChangedSensor] == INITIALIZATION_STATE) {
data->aiCheckStatus[uChangedSensor] = NO_SENSOR_STATE;
if (uChangedSensor == ACCELEROMETER_SENSOR)
accel_open_calibration(data);
else if (uChangedSensor == GYROSCOPE_SENSOR)
gyro_open_calibration(data);
else if (uChangedSensor == PRESSURE_SENSOR)
pressure_open_calibration(data);
else if (uChangedSensor == PROXIMITY_SENSOR)
proximity_open_calibration(data);
return 0;
} else if (uChangedSensor == ORIENTATION_SENSOR) {
if (!(atomic_read(&data->aSensorEnable)
& (1 << ACCELEROMETER_SENSOR)))
uChangedSensor = ACCELEROMETER_SENSOR;
else {
change_sensor_delay(data, ACCELEROMETER_SENSOR,
data->adDelayBuf[ACCELEROMETER_SENSOR]);
return 0;
}
} else if (uChangedSensor == ACCELEROMETER_SENSOR) {
if (atomic_read(&data->aSensorEnable)
& (1 << ORIENTATION_SENSOR)) {
change_sensor_delay(data, ORIENTATION_SENSOR,
data->adDelayBuf[ORIENTATION_SENSOR]);
return 0;
}
}
if (!uNewEnable) {
if (data->bCheckSuspend == false) {
disable_debug_timer(data);
data->bDebugEnabled = false;
}
}
uBuf[1] = (u8)get_msdelay(dSensorDelay);
uBuf[0] = (u8)get_delay_cmd(uBuf[1]);
send_instruction(data, REMOVE_SENSOR, uChangedSensor, uBuf, 2);
data->aiCheckStatus[uChangedSensor] = NO_SENSOR_STATE;
return 0;
}
int forced_to_download_binary(struct ssp_data *data, int iBinType)
{
int iRet = 0;
int retry = 3;
ssp_dbg("[SSP] %s, mcu binany update!\n", __func__);
ssp_enable(data, false);
#if SSP_STATUS_MONITOR
cancel_delayed_work_sync(&data->polling_work);
#endif
data->fw_dl_state = FW_DL_STATE_DOWNLOADING;
pr_info("[SSP] %s, DL state = %d\n", __func__, data->fw_dl_state);
data->spi->max_speed_hz = BOOT_SPI_HZ;
if (spi_setup(data->spi))
pr_err("failed to setup spi for ssp_boot\n");
do {
pr_info("[SSP] %d try\n", 3 - retry);
iRet = update_mcu_bin(data, iBinType);
} while (retry -- > 0 && iRet < 0);
data->spi->max_speed_hz = NORM_SPI_HZ;
if (spi_setup(data->spi))
pr_err("failed to setup spi for ssp_norm\n");
if (iRet < 0) {
ssp_dbg("[SSP] %s, update_mcu_bin failed!\n", __func__);
goto out;
}
data->fw_dl_state = FW_DL_STATE_SYNC;
pr_info("[SSP] %s, DL state = %d\n", __func__, data->fw_dl_state);
ssp_enable(data, true);
get_proximity_threshold(data);
proximity_open_calibration(data);
accel_open_calibration(data);
gyro_open_calibration(data);
pressure_open_calibration(data);
data->fw_dl_state = FW_DL_STATE_DONE;
pr_info("[SSP] %s, DL state = %d\n", __func__, data->fw_dl_state);
#if SSP_STATUS_MONITOR
schedule_delayed_work(&data->polling_work, msecs_to_jiffies(7000));
#endif
iRet = SUCCESS;
out:
return iRet;
}
int forced_to_download_binary(struct ssp_data *data, int iBinType)
{
int iRet = 0;
int retry = 3;
ssp_dbg("[SSP] %s, mcu binany update!\n", __func__);
ssp_enable(data, false);
data->fw_dl_state = FW_DL_STATE_DOWNLOADING;
data->spi->mode = SPI_MODE_0;
pr_info("[SSP] %s, DL state = %d\n", __func__, data->fw_dl_state);
data->spi->max_speed_hz = BOOT_SPI_HZ;
if (spi_setup(data->spi))
pr_err("failed to setup spi for ssp_boot\n");
do {
pr_info("[SSP] %d try\n", 3 - retry);
iRet = update_mcu_bin(data, iBinType);
pr_info("======[SSP] SCHEDULE!!!!!\n");
schedule(); /*Defence for cpu schedule blocking watchdog*/
msleep(3);
} while (retry -- > 0 && iRet < 0);
data->spi->max_speed_hz = NORM_SPI_HZ;
data->spi->mode = SPI_MODE_1;
if (spi_setup(data->spi))
pr_err("failed to setup spi for ssp_norm\n");
if (iRet < 0) {
ssp_dbg("[SSP] %s, update_mcu_bin failed!\n", __func__);
goto out;
}
data->fw_dl_state = FW_DL_STATE_SYNC;
pr_info("[SSP] %s, DL state = %d\n", __func__, data->fw_dl_state);
ssp_enable(data, true);
proximity_open_lcd_ldi(data);
proximity_open_calibration(data);
accel_open_calibration(data);
gyro_open_calibration(data);
pressure_open_calibration(data);
data->fw_dl_state = FW_DL_STATE_DONE;
pr_info("[SSP] %s, DL state = %d\n", __func__, data->fw_dl_state);
iRet = SUCCESS;
out:
return iRet;
}
int forced_to_download_binary(struct ssp_data *data, int iBinType)
{
int iRet = 0;
int retry = 3;
ssp_dbg("[SSP]: %s - mcu binany update!\n", __func__);
ssp_enable(data, false);
data->fw_dl_state = FW_DL_STATE_DOWNLOADING;
pr_info("[SSP] %s, DL state = %d\n", __func__,
data->fw_dl_state);
data->spi->max_speed_hz = BOOT_SPI_HZ;
if (spi_setup(data->spi))
pr_err("failed to setup spi for ssp_boot\n");
do {
pr_info("[SSP] %d try\n", 3 - retry);
iRet = update_mcu_bin(data, iBinType);
} while (retry -- > 0 && iRet < 0);
data->spi->max_speed_hz = NORM_SPI_HZ;
if (spi_setup(data->spi))
pr_err("failed to setup spi for ssp_norm\n");
if (iRet < 0) {
ssp_dbg("[SSP]: %s - update_mcu_bin failed!\n", __func__);
goto out;
}
data->fw_dl_state = FW_DL_STATE_SYNC;
pr_info("[SSP] %s, DL state = %d\n", __func__, data->fw_dl_state);
ssp_enable(data, true);
proximity_open_lcd_ldi(data);
proximity_open_calibration(data);
accel_open_calibration(data);
gyro_open_calibration(data);
#ifdef CONFIG_SENSORS_SSP_BMP182
pressure_open_calibration(data);
#endif
data->fw_dl_state = FW_DL_STATE_DONE;
pr_info("[SSP] %s, DL state = %d\n", __func__, data->fw_dl_state);
iRet = SUCCESS;
out:
return iRet;
}
static ssize_t set_sensors_enable(struct device *dev,
struct device_attribute *attr, const char *buf, size_t size)
{
int64_t dTemp;
unsigned int uNewEnable = 0, uChangedSensor = 0;
struct ssp_data *data = dev_get_drvdata(dev);
int iRet;
if (strict_strtoll(buf, 10, &dTemp) < 0)
return -1;
uNewEnable = (unsigned int)dTemp;
ssp_dbg("[SSP]: %s - new_enable = %u, old_enable = %u\n", __func__,
uNewEnable, atomic_read(&data->aSensorEnable));
if (uNewEnable == atomic_read(&data->aSensorEnable))
return 0;
for (uChangedSensor = 0; uChangedSensor < SENSOR_MAX; uChangedSensor++)
if ((atomic_read(&data->aSensorEnable) & (1 << uChangedSensor))
!= (uNewEnable & (1 << uChangedSensor))) {
if (!(uNewEnable & (1 << uChangedSensor)))
ssp_remove_sensor(data, uChangedSensor,
uNewEnable); /* disable */
else { /* Change to ADD_SENSOR_STATE from KitKat */
if (data->aiCheckStatus[uChangedSensor] == INITIALIZATION_STATE) {
if (uChangedSensor == ACCELEROMETER_SENSOR)
accel_open_calibration(data);
else if (uChangedSensor == GYROSCOPE_SENSOR)
gyro_open_calibration(data);
else if (uChangedSensor == PRESSURE_SENSOR)
pressure_open_calibration(data);
else if (uChangedSensor == PROXIMITY_SENSOR) {
proximity_open_lcd_ldi(data);
proximity_open_calibration(data);
}
}
data->aiCheckStatus[uChangedSensor] = ADD_SENSOR_STATE;
}
break;
}
atomic_set(&data->aSensorEnable, uNewEnable);
return size;
}
int forced_to_download_binary(struct ssp_data *data, int iBinType)
{
int iRet = 0;
int retry = 3;
ssp_infof("mcu binany update!");
ssp_enable(data, false);
data->fw_dl_state = FW_DL_STATE_DOWNLOADING;
ssp_infof("DL state = %d", data->fw_dl_state);
data->spi->max_speed_hz = BOOT_SPI_HZ;
if (spi_setup(data->spi))
ssp_err("failed to setup spi for ssp_boot");
do {
ssp_info("%d try", 3 - retry);
iRet = update_mcu_bin(data, iBinType);
} while (retry-- > 0 && iRet < 0);
data->spi->max_speed_hz = NORM_SPI_HZ;
if (spi_setup(data->spi))
ssp_err("failed to setup spi for ssp_norm");
if (iRet < 0) {
ssp_infof("update_mcu_bin failed!");
goto out;
}
data->fw_dl_state = FW_DL_STATE_SYNC;
ssp_infof("DL state = %d", data->fw_dl_state);
ssp_enable(data, true);
get_proximity_threshold(data);
proximity_open_calibration(data);
accel_open_calibration(data);
gyro_open_calibration(data);
pressure_open_calibration(data);
data->fw_dl_state = FW_DL_STATE_DONE;
ssp_infof("DL state = %d", data->fw_dl_state);
iRet = SUCCESS;
out:
return iRet;
}
int forced_to_download_binary(struct ssp_data *data, int iBinType)
{
int iRet = 0;
int retry = 3;
ssp_dbg("[SSP]: %s - mcu binany update!\n", __func__);
ssp_enable(data, false);
data->fw_dl_state = FW_DL_STATE_DOWNLOADING;
pr_info("[SSP] %s, DL state = %d\n", __func__,
data->fw_dl_state);
data->spi->max_speed_hz = BOOT_SPI_HZ;
if (spi_setup(data->spi))
pr_err("failed to setup spi for ssp_boot\n");
do {
pr_info("[SSP] %d try\n", 3 - retry);
iRet = update_mcu_bin(data, iBinType);
} while (retry -- > 0 && iRet < 0);
data->spi->max_speed_hz = NORM_SPI_HZ;
if (spi_setup(data->spi))
pr_err("failed to setup spi for ssp_norm\n");
if (iRet < 0) {
ssp_dbg("[SSP]: %s - update_mcu_bin failed!\n", __func__);
goto out;
}
data->fw_dl_state = FW_DL_STATE_SYNC;
pr_info("[SSP] %s, DL state = %d\n", __func__, data->fw_dl_state);
clean_pending_list(data);
ssp_enable(data, true);
iRet = initialize_mcu(data);
if (iRet < 0) {
iRet = ERROR;
ssp_dbg("[SSP]: %s - initialize_mcu failed!\n", __func__);
goto out;
}
proximity_open_lcd_ldi(data);
proximity_open_calibration(data);
accel_open_calibration(data);
gyro_open_calibration(data);
pressure_open_calibration(data);
if (mag_open_hwoffset(data) < 0)
pr_info("[SSP]: %s - mag_open_hw_offset"
" failed, %d\n", __func__, iRet);
sync_sensor_state(data);
#ifdef CONFIG_SENSORS_SSP_SENSORHUB
ssp_sensorhub_report_notice(data, MSG2SSP_AP_STATUS_RESET);
#endif
data->fw_dl_state = FW_DL_STATE_DONE;
pr_info("[SSP] %s, DL state = %d\n", __func__, data->fw_dl_state);
iRet = SUCCESS;
out:
return iRet;
}
static int ssp_remove_sensor(struct ssp_data *data,
unsigned int uChangedSensor, unsigned int uNewEnable)
{
u8 uBuf[2];
int iRet = 0;
int64_t dSensorDelay = data->adDelayBuf[uChangedSensor];
ssp_dbg("[SSP]: %s - remove sensor = %d, current state = %d\n",
__func__, (1 << uChangedSensor), uNewEnable);
data->adDelayBuf[uChangedSensor] = DEFUALT_POLLING_DELAY;
if (data->aiCheckStatus[uChangedSensor] == INITIALIZATION_STATE) {
data->aiCheckStatus[uChangedSensor] = NO_SENSOR_STATE;
if (uChangedSensor == ACCELEROMETER_SENSOR)
accel_open_calibration(data);
else if (uChangedSensor == GYROSCOPE_SENSOR)
gyro_open_calibration(data);
else if (uChangedSensor == PRESSURE_SENSOR)
pressure_open_calibration(data);
else if (uChangedSensor == PROXIMITY_SENSOR) {
proximity_open_lcd_ldi(data);
proximity_open_calibration(data);
} else if (uChangedSensor == GEOMAGNETIC_SENSOR) {
iRet = mag_open_hwoffset(data);
if (iRet < 0)
pr_err("[SSP]: %s - mag_open_hw_offset"
" failed, %d\n", __func__, iRet);
iRet = set_hw_offset(data);
if (iRet < 0) {
pr_err("[SSP]: %s - set_hw_offset failed\n",
__func__);
}
}
return 0;
} else if (uChangedSensor == ORIENTATION_SENSOR) {
if (!(atomic_read(&data->aSensorEnable)
& (1 << ACCELEROMETER_SENSOR))) {
uChangedSensor = ACCELEROMETER_SENSOR;
} else {
change_sensor_delay(data, ACCELEROMETER_SENSOR,
data->adDelayBuf[ACCELEROMETER_SENSOR]);
return 0;
}
} else if (uChangedSensor == ACCELEROMETER_SENSOR) {
if (atomic_read(&data->aSensorEnable)
& (1 << ORIENTATION_SENSOR)) {
change_sensor_delay(data, ORIENTATION_SENSOR,
data->adDelayBuf[ORIENTATION_SENSOR]);
return 0;
}
} else if (uChangedSensor == GEOMAGNETIC_SENSOR) {
if (mag_store_hwoffset(data))
pr_err("mag_store_hwoffset success\n");
}
if (atomic_read(&data->aSensorEnable) & (1 << uChangedSensor)) {
uBuf[1] = (u8)get_msdelay(dSensorDelay);
uBuf[0] = (u8)get_delay_cmd(uBuf[1]);
send_instruction(data, REMOVE_SENSOR, uChangedSensor, uBuf, 2);
}
data->aiCheckStatus[uChangedSensor] = NO_SENSOR_STATE;
return 0;
}