void sync_sensor_state(struct ssp_data *data)
{
unsigned char uBuf[9] = {0,};
unsigned int uSensorCnt;
int iRet = 0;
iRet = set_gyro_cal(data);
if (iRet < 0)
pr_err("[SSP]: %s - set_gyro_cal failed\n", __func__);
iRet = set_accel_cal(data);
if (iRet < 0)
pr_err("[SSP]: %s - set_accel_cal failed\n", __func__);
#ifdef CONFIG_SENSORS_SSP_SX9306
if (atomic_read(&data->aSensorEnable) & (1 << GRIP_SENSOR)) {
open_grip_caldata(data);
set_grip_calibration(data, true);
}
#endif
udelay(10);
for (uSensorCnt = 0; uSensorCnt < SENSOR_MAX; uSensorCnt++) {
mutex_lock(&data->enable_mutex);
if (atomic_read(&data->aSensorEnable) & (1 << uSensorCnt)) {
s32 dMsDelay =
get_msdelay(data->adDelayBuf[uSensorCnt]);
memcpy(&uBuf[0], &dMsDelay, 4);
memcpy(&uBuf[4], &data->batchLatencyBuf[uSensorCnt], 4);
uBuf[8] = data->batchOptBuf[uSensorCnt];
send_instruction(data, ADD_SENSOR, uSensorCnt, uBuf, 9);
udelay(10);
}
mutex_unlock(&data->enable_mutex);
}
if (data->bProximityRawEnabled == true) {
s32 dMsDelay = 20;
memcpy(&uBuf[0], &dMsDelay, 4);
send_instruction(data, ADD_SENSOR, PROXIMITY_RAW, uBuf, 4);
}
set_proximity_threshold(data, data->uProxHiThresh,data->uProxLoThresh);
data->bMcuDumpMode = ssp_check_sec_dump_mode();
iRet = ssp_send_cmd(data, MSG2SSP_AP_MCU_SET_DUMPMODE,
data->bMcuDumpMode);
if (iRet < 0)
pr_err("[SSP]: %s - MSG2SSP_AP_MCU_SET_DUMPMODE failed\n",
__func__);
}
static void initialize_variable(struct ssp_data *data)
{
int iSensorIndex;
for (iSensorIndex = 0; iSensorIndex < SENSOR_MAX; iSensorIndex++) {
data->adDelayBuf[iSensorIndex] = DEFUALT_POLLING_DELAY;
data->batchLatencyBuf[iSensorIndex] = 0;
data->batchOptBuf[iSensorIndex] = 0;
data->aiCheckStatus[iSensorIndex] = INITIALIZATION_STATE;
}
atomic_set(&data->aSensorEnable, 0);
data->iLibraryLength = 0;
data->uSensorState = NORMAL_SENSOR_STATE_K;
data->uFactoryProxAvg[0] = 0;
data->uMagCntlRegData = 1;
data->uResetCnt = 0;
data->uTimeOutCnt = 0;
data->uComFailCnt = 0;
data->uIrqCnt = 0;
data->bSspShutdown = true;
data->bProximityRawEnabled = false;
data->bGeomagneticRawEnabled = false;
data->bBarcodeEnabled = false;
data->bAccelAlert = false;
data->bTimeSyncing = true;
data->accelcal.x = 0;
data->accelcal.y = 0;
data->accelcal.z = 0;
data->gyrocal.x = 0;
data->gyrocal.y = 0;
data->gyrocal.z = 0;
data->magoffset.x = 0;
data->magoffset.y = 0;
data->magoffset.z = 0;
data->iPressureCal = 0;
data->uProxCanc = 0;
data->uProxHiThresh = 0;
data->uProxLoThresh = 0;
data->uGyroDps = GYROSCOPE_DPS500;
data->uIr_Current = DEFUALT_IR_CURRENT;
data->mcu_device = NULL;
data->acc_device = NULL;
data->gyro_device = NULL;
data->mag_device = NULL;
data->prs_device = NULL;
data->prox_device = NULL;
data->light_device = NULL;
data->ges_device = NULL;
data->voice_device = NULL;
data->bMcuDumpMode = ssp_check_sec_dump_mode();
INIT_LIST_HEAD(&data->pending_list);
data->sealevelpressure = 0;
data->step_count_total = 0;
initialize_function_pointer(data);
}
static void initialize_variable(struct ssp_data *data)
{
int iSensorIndex;
for (iSensorIndex = 0; iSensorIndex < SENSOR_MAX; iSensorIndex++) {
data->adDelayBuf[iSensorIndex] = DEFUALT_POLLING_DELAY;
data->batchLatencyBuf[iSensorIndex] = 0;
data->batchOptBuf[iSensorIndex] = 0;
data->aiCheckStatus[iSensorIndex] = INITIALIZATION_STATE;
data->lastTimestamp[iSensorIndex] = 0;
data->reportedData[iSensorIndex] = false;
}
atomic_set(&data->aSensorEnable, 0);
data->iLibraryLength = 0;
data->uSensorState = NORMAL_SENSOR_STATE_K;
data->uFactoryProxAvg[0] = 0;
data->uMagCntlRegData = 1;
data->uResetCnt = 0;
data->uTimeOutCnt = 0;
data->uComFailCnt = 0;
data->uIrqCnt = 0;
data->bSspShutdown = true;
data->bProximityRawEnabled = false;
data->bGeomagneticRawEnabled = false;
data->bBarcodeEnabled = false;
data->bAccelAlert = false;
data->bTimeSyncing = true;
data->bHandlingIrq = false;
data->accelcal.x = 0;
data->accelcal.y = 0;
data->accelcal.z = 0;
data->gyrocal.x = 0;
data->gyrocal.y = 0;
data->gyrocal.z = 0;
data->magoffset.x = 0;
data->magoffset.y = 0;
data->magoffset.z = 0;
data->iPressureCal = 0;
data->uProxCanc = 0;
data->uProxHiThresh = data->uProxHiThresh_default;
data->uProxLoThresh = data->uProxLoThresh_default;
data->uGyroDps = GYROSCOPE_DPS2000;
data->uIr_Current = DEFUALT_IR_CURRENT;
data->mcu_device = NULL;
data->acc_device = NULL;
data->gyro_device = NULL;
data->mag_device = NULL;
data->prs_device = NULL;
data->prox_device = NULL;
data->light_device = NULL;
data->ges_device = NULL;
data->voice_device = NULL;
data->bMcuDumpMode = ssp_check_sec_dump_mode();
INIT_LIST_HEAD(&data->pending_list);
data->bbd_on_packet_wq =
create_singlethread_workqueue("ssp_bbd_on_packet_wq");
INIT_WORK(&data->work_bbd_on_packet, bbd_on_packet_work_func);
data->bbd_mcu_ready_wq =
create_singlethread_workqueue("ssp_bbd_mcu_ready_wq");
INIT_WORK(&data->work_bbd_mcu_ready, bbd_mcu_ready_work_func);
#ifdef SSP_BBD_USE_SEND_WORK
data->bbd_send_packet_wq =
create_singlethread_workqueue("ssp_bbd_send_packet_wq");
INIT_WORK(&data->work_bbd_send_packet, bbd_send_packet_work_func);
#endif /* SSP_BBD_USE_SEND_WORK */
data->step_count_total = 0;
data->sealevelpressure = 0;
initialize_function_pointer(data);
}
static int ssp_probe(struct spi_device *spi)
{
struct ssp_data *data;
struct ssp_platform_data *pdata;
int iRet = 0;
pr_info("[SSP] %s, is called\n", __func__);
pdata = spi->dev.platform_data;
if (pdata == NULL) {
pr_err("[SSP] %s, platform_data is null\n", __func__);
iRet = -ENOMEM;
goto exit;
}
data = kzalloc(sizeof(*data), GFP_KERNEL);
if (data == NULL) {
pr_err("[SSP] %s, failed to allocate memory for data\n", __func__);
iRet = -ENOMEM;
goto exit;
}
data->set_mcu_reset = pdata->set_mcu_reset;
data->ap_int = pdata->ap_int;
data->mcu_int1 = pdata->mcu_int1;
data->mcu_int2 = pdata->mcu_int2;
/* AP system_rev */
if (pdata->check_ap_rev)
data->ap_rev = pdata->check_ap_rev();
else
data->ap_rev = 0;
/* Get sensor positions */
if (pdata->get_positions) {
pdata->get_positions(&data->accel_position,
&data->mag_position);
} else {
data->accel_position = 0;
data->mag_position = 0;
}
if (pdata->mag_matrix) {
data->mag_matrix_size = pdata->mag_matrix_size;
data->mag_matrix = pdata->mag_matrix;
}
#ifdef CONFIG_SENSORS_SSP_SHTC1
/* Get pdata for cp thermister */
if (pdata->cp_thm_adc_table) {
data->cp_thm_adc_channel = pdata->cp_thm_adc_channel;
data->cp_thm_adc_arr_size= pdata->cp_thm_adc_arr_size;
data->cp_thm_adc_table = pdata->cp_thm_adc_table;
}
/* Get pdata for batt thermister */
if (pdata->batt_thm_adc_table) {
data->batt_thm_adc_arr_size= pdata->batt_thm_adc_arr_size;
data->batt_thm_adc_table = pdata->batt_thm_adc_table;
}
/* Get pdata for chg thermister */
if (pdata->chg_thm_adc_table) {
data->chg_thm_adc_arr_size= pdata->chg_thm_adc_arr_size;
data->chg_thm_adc_table = pdata->chg_thm_adc_table;
}
#endif
spi->mode = SPI_MODE_1;
if (spi_setup(spi)) {
pr_err("[SSP] %s, failed to setup spi\n", __func__);
goto err_setup;
}
data->bProbeIsDone = false;
data->fw_dl_state = FW_DL_STATE_NONE;
data->spi = spi;
spi_set_drvdata(spi, data);
#ifdef CONFIG_SENSORS_SSP_SHTC1
mutex_init(&data->cp_temp_adc_lock);
mutex_init(&data->bulk_temp_read_lock);
#endif
#ifdef CONFIG_SENSORS_SSP_STM
mutex_init(&data->comm_mutex);
mutex_init(&data->pending_mutex);
#endif
if (data->set_mcu_reset == NULL) {
pr_err("[SSP] %s, function callback is null\n", __func__);
iRet = -EIO;
goto err_reset_null;
}
pr_info("\n#####################################################\n");
INIT_DELAYED_WORK(&data->work_firmware, work_function_firmware_update);
wake_lock_init(&data->ssp_wake_lock,
WAKE_LOCK_SUSPEND, "ssp_wake_lock");
iRet = initialize_input_dev(data);
if (iRet < 0) {
pr_err("[SSP]: %s - could not create input device\n", __func__);
goto err_input_register_device;
}
iRet = initialize_debug_timer(data);
if (iRet < 0) {
pr_err("[SSP]: %s - could not create workqueue\n", __func__);
goto err_create_workqueue;
}
iRet = initialize_irq(data);
if (iRet < 0) {
pr_err("[SSP]: %s - could not create irq\n", __func__);
goto err_setup_irq;
}
iRet = initialize_sysfs(data);
if (iRet < 0) {
pr_err("[SSP]: %s - could not create sysfs\n", __func__);
goto err_sysfs_create;
}
iRet = initialize_event_symlink(data);
if (iRet < 0) {
pr_err("[SSP]: %s - could not create symlink\n", __func__);
goto err_symlink_create;
}
initialize_variable(data);
ssp_enable(data, true);
/* check boot loader binary */
data->fw_dl_state = check_fwbl(data);
if (data->fw_dl_state == FW_DL_STATE_NONE) {
iRet = initialize_mcu(data);
if (iRet == ERROR) {
data->uResetCnt++;
toggle_mcu_reset(data);
msleep(SSP_SW_RESET_TIME);
initialize_mcu(data);
} else if (iRet < ERROR) {
pr_err("[SSP] %s, initialize_mcu failed\n", __func__);
goto err_read_reg;
}
}
#ifdef CONFIG_HAS_EARLYSUSPEND
data->early_suspend.suspend = ssp_early_suspend;
data->early_suspend.resume = ssp_late_resume;
register_early_suspend(&data->early_suspend);
#endif
#ifdef CONFIG_SENSORS_SSP_SENSORHUB
/* init sensorhub device */
iRet = ssp_sensorhub_initialize(data);
if (iRet < 0) {
pr_err("[SSP] %s, ssp_sensorhub_initialize err(%d)", __func__, iRet);
ssp_sensorhub_remove(data);
}
#endif
data->bMcuDumpMode = ssp_check_sec_dump_mode();
pr_info("[SSP]: %s - setup debuglevel %d!\n", __func__, data->bMcuDumpMode);
pr_info("[SSP]: %s - probe success!\n", __func__);
enable_debug_timer(data);
if (data->fw_dl_state == FW_DL_STATE_NEED_TO_SCHEDULE) {
pr_info("[SSP] Firmware update is scheduled\n");
schedule_delayed_work(&data->work_firmware,
msecs_to_jiffies(1000));
data->fw_dl_state = FW_DL_STATE_SCHEDULED;
} else if (data->fw_dl_state == FW_DL_STATE_FAIL) {
data->bSspShutdown = true;
}
data->bProbeIsDone = true;
iRet = 0;
goto exit;
err_read_reg:
err_symlink_create:
remove_sysfs(data);
err_sysfs_create:
free_irq(data->iIrq, data);
gpio_free(data->mcu_int1);
err_setup_irq:
destroy_workqueue(data->debug_wq);
err_create_workqueue:
remove_input_dev(data);
err_input_register_device:
wake_lock_destroy(&data->ssp_wake_lock);
err_reset_null:
#ifdef CONFIG_SENSORS_SSP_STM
mutex_destroy(&data->comm_mutex);
mutex_destroy(&data->pending_mutex);
#endif
#ifdef CONFIG_SENSORS_SSP_SHTC1
mutex_destroy(&data->bulk_temp_read_lock);
mutex_destroy(&data->cp_temp_adc_lock);
#endif
err_setup:
kfree(data);
pr_err("[SSP] %s, probe failed!\n", __func__);
exit:
pr_info("#####################################################\n\n");
return iRet;
}