int initialize_magnetic_sensor(struct ssp_data *data)
{
int ret;
ret = set_static_matrix(data);
if (ret < 0)
pr_err("[SSP]: %s - set_magnetic_static_matrix failed %d\n",
__func__, ret);
return ret;
}
int initialize_mcu(struct ssp_data *data)
{
int iRet = 0;
iRet = get_chipid(data);
pr_info("[SSP] MCU device ID = %d, reading ID = %d\n", DEVICE_ID, iRet);
if (iRet != DEVICE_ID) {
if (iRet < 0) {
pr_err("[SSP]: %s - MCU is not working : 0x%x\n",
__func__, iRet);
} else {
pr_err("[SSP]: %s - MCU identification failed\n",
__func__);
iRet = -ENODEV;
}
goto out;
}
iRet = set_sensor_position(data);
if (iRet < 0) {
pr_err("[SSP]: %s - set_sensor_position failed\n", __func__);
goto out;
}
data->uSensorState = get_sensor_scanning_info(data);
if (data->uSensorState == 0) {
pr_err("[SSP]: %s - get_sensor_scanning_info failed\n",
__func__);
iRet = ERROR;
goto out;
}
iRet = ssp_send_cmd(data, MSG2SSP_AP_MCU_SET_DUMPMODE,
sec_debug_is_enabled());
if (iRet < 0) {
pr_err("[SSP]: %s - set_mcu_dump_mode failed\n", __func__);
goto out;
}
#if defined (CONFIG_SENSORS_SSP_YAS532)
iRet = set_static_matrix(data);
if (iRet < 0)
pr_err("[SSP]: %s - yas set static matrix failed\n", __func__);
#endif
iRet = SUCCESS;
out:
return iRet;
}
int initialize_mcu(struct ssp_data *data)
{
int iRet = 0;
clean_pending_list(data);
iRet = get_chipid(data);
pr_info("[SSP] MCU device ID = %d, reading ID = %d\n", DEVICE_ID, iRet);
if (iRet != DEVICE_ID) {
if (iRet < 0) {
pr_err("[SSP]: %s - MCU is not working : 0x%x\n",
__func__, iRet);
} else {
pr_err("[SSP]: %s - MCU identification failed\n",
__func__);
iRet = -ENODEV;
}
goto out;
}
iRet = set_sensor_position(data);
if (iRet < 0) {
pr_err("[SSP]: %s - set_sensor_position failed\n", __func__);
goto out;
}
data->uSensorState = get_sensor_scanning_info(data);
if (data->uSensorState == 0) {
pr_err("[SSP]: %s - get_sensor_scanning_info failed\n",
__func__);
iRet = ERROR;
goto out;
}
#if defined (CONFIG_SENSORS_SSP_YAS532)
iRet = set_static_matrix(data);
if (iRet < 0)
pr_err("[SSP] %s - set_magnetic_static_matrix failed\n", __func__);
#endif
data->uCurFirmRev = get_firmware_rev(data);
pr_info("[SSP] MCU Firm Rev : New = %8u\n",
data->uCurFirmRev);
iRet = ssp_send_cmd(data, MSG2SSP_AP_MCU_DUMP_CHECK, 0);
out:
return iRet;
}
