static void mxt_treat_dbg_data(struct mxt_data *data,
struct mxt_object *dbg_object, u8 dbg_mode, u8 read_point, u16 num)
{
struct i2c_client *client = data->client;
struct mxt_data_sysfs *sysfs_data = data->sysfs_data;
u8 data_buffer[DATA_PER_NODE] = { 0 };
if (dbg_mode == MXT_DIAG_DELTA_MODE) {
/* read delta data */
mxt_read_mem(data, dbg_object->start_address + read_point,
DATA_PER_NODE, data_buffer);
sysfs_data->delta[num] =
((u16)data_buffer[1] << 8) + (u16)data_buffer[0];
dev_dbg(&client->dev, "delta[%d] = %d\n",
num, sysfs_data->delta[num]);
if (abs(sysfs_data->delta[num])
> abs(sysfs_data->delta_max_data)) {
sysfs_data->delta_max_node = num;
sysfs_data->delta_max_data = sysfs_data->delta[num];
}
} else if (dbg_mode == MXT_DIAG_REFERENCE_MODE) {
/* read reference data */
mxt_read_mem(data, dbg_object->start_address + read_point,
DATA_PER_NODE, data_buffer);
sysfs_data->reference[num] =
((u16)data_buffer[1] << 8) + (u16)data_buffer[0]
- REF_OFFSET_VALUE;
if (mxt_check_last_line(data, num))
sysfs_data->reference[num] *= 2;
/* check that reference is in spec or not */
if (sysfs_data->reference[num] < REF_MIN_VALUE
|| sysfs_data->reference[num] > REF_MAX_VALUE) {
dev_err(&client->dev, "reference[%d] is out of range ="
" %d(%d,%d)\n", num, sysfs_data->reference[num],
num / data->y_num, num % data->y_num);
}
if (sysfs_data->reference[num] > sysfs_data->ref_max_data)
sysfs_data->ref_max_data =
sysfs_data->reference[num];
if (sysfs_data->reference[num] < sysfs_data->ref_min_data)
sysfs_data->ref_min_data =
sysfs_data->reference[num];
dev_dbg(&client->dev, "reference[%d] = %d\n",
num, sysfs_data->reference[num]);
}
}
static void get_config_ver(void *device_data)
{
struct mxt_data *data = (struct mxt_data *)device_data;
struct i2c_client *client = data->client;
struct mxt_fac_data *fdata = data->fdata;
struct mxt_object *user_object;
char buff[50] = {0};
char date[10] = {0};
int error = 0;
u32 current_crc = 0;
set_default_result(fdata);
/* Get the config version from userdata */
user_object = mxt_get_object(data, MXT_SPT_USERDATA_T38);
if (!user_object) {
dev_err(&client->dev, "fail to get object_info\n");
snprintf(buff, sizeof(buff), "%s", "NG");
set_cmd_result(fdata, buff, strnlen(buff, sizeof(buff)));
fdata->cmd_state = CMD_STATUS_FAIL;
return;
}
mxt_read_mem(data, user_object->start_address,
MXT_CONFIG_VERSION_LENGTH, date);
disable_irq(data->client->irq);
/* Get config CRC from device */
error = mxt_read_config_crc(data, ¤t_crc);
if (error)
dev_err(&client->dev, "%s Error getting configuration CRC:%d\n",
__func__, error);
enable_irq(data->client->irq);
/* Model number_vendor_date_CRC value */
/* Need to be removed hard cording in date */
snprintf(buff, sizeof(buff), "%s_AT_%s_0x%06X",
data->pdata->project_name, date, current_crc);
set_cmd_result(fdata, buff, strnlen(buff, sizeof(buff)));
fdata->cmd_state = CMD_STATUS_OK;
dev_info(&client->dev, "%s: %s(%d)\n",
__func__, buff, strnlen(buff, sizeof(buff)));
}
static int mxt_read_all_diagnostic_data(struct mxt_data *data, u8 dbg_mode)
{
struct i2c_client *client = data->client;
struct mxt_data_sysfs *sysfs_data = data->sysfs_data;
struct mxt_object *dbg_object;
u8 read_page, cur_page, end_page, read_point;
u16 node = 0, num = 0, cnt = 0;
int ret = 0;
/* to make the Page Num to 0 */
ret = mxt_set_diagnostic_mode(data, MXT_DIAG_CTE_MODE);
if (ret)
goto out;
/* change the debug mode */
ret = mxt_set_diagnostic_mode(data, dbg_mode);
if (ret)
goto out;
/* get object info for diagnostic */
dbg_object = mxt_get_object_info(data, DEBUG_DIAGNOSTIC_T37);
if (!dbg_object) {
dev_err(&client->dev, "fail to get object_info\n");
ret = -EINVAL;
goto out;
}
/* calculate end page of IC */
sysfs_data->ref_min_data = REF_MAX_VALUE;
sysfs_data->ref_max_data = REF_MIN_VALUE;
sysfs_data->delta_max_data = 0;
sysfs_data->delta_max_node = 0;
end_page = (data->info.matrix_xsize * data->info.matrix_ysize)
/ NODE_PER_PAGE;
/* read the dbg data */
for (read_page = 0 ; read_page < end_page; read_page++) {
for (node = 0; node < NODE_PER_PAGE; node++) {
read_point = (node * DATA_PER_NODE) + 2;
if (check_xy_range(data, cnt)) {
mxt_treat_dbg_data(data, dbg_object, dbg_mode,
read_point, num);
num++;
}
cnt++;
}
ret = mxt_set_diagnostic_mode(data, MXT_DIAG_PAGE_UP);
if (ret)
goto out;
do {
msleep(20);
ret = mxt_read_mem(data,
dbg_object->start_address + MXT_DIAGNOSTIC_PAGE,
1, &cur_page);
if (ret) {
dev_err(&client->dev,
"%s Read fail page\n", __func__);
goto out;
}
} while (cur_page != read_page + 1);
}
if (dbg_mode == MXT_DIAG_REFERENCE_MODE) {
dev_info(&client->dev, "min/max reference is [%d/%d]\n",
sysfs_data->ref_min_data, sysfs_data->ref_max_data);
} else if (dbg_mode == MXT_DIAG_DELTA_MODE) {
dev_info(&client->dev, "max delta node %d=[%d]\n",
sysfs_data->delta_max_node, sysfs_data->delta_max_data);
}
out:
return ret;
}
static int mxt_read_diagnostic_data(struct mxt_data *data,
u8 dbg_mode, u16 node, u16 *dbg_data)
{
struct i2c_client *client = data->client;
struct mxt_object *dbg_object;
u8 read_page, read_point;
u8 cur_page, cnt_page;
u8 data_buf[DATA_PER_NODE] = { 0 };
int ret = 0;
/* calculate the read page and point */
read_page = node / NODE_PER_PAGE;
node %= NODE_PER_PAGE;
read_point = (node * DATA_PER_NODE) + 2;
/* to make the Page Num to 0 */
ret = mxt_set_diagnostic_mode(data, MXT_DIAG_CTE_MODE);
if (ret)
goto out;
/* change the debug mode */
ret = mxt_set_diagnostic_mode(data, dbg_mode);
if (ret)
goto out;
/* get object info for diagnostic */
dbg_object = mxt_get_object_info(data, DEBUG_DIAGNOSTIC_T37);
if (!dbg_object) {
dev_err(&client->dev, "fail to get object_info\n");
ret = -EINVAL;
goto out;
}
/* move to the proper page */
for (cnt_page = 1; cnt_page <= read_page; cnt_page++) {
ret = mxt_set_diagnostic_mode(data, MXT_DIAG_PAGE_UP);
if (ret)
goto out;
do {
msleep(20);
ret = mxt_read_mem(data,
dbg_object->start_address + MXT_DIAGNOSTIC_PAGE,
1, &cur_page);
if (ret) {
dev_err(&client->dev,
"%s Read fail page\n", __func__);
goto out;
}
} while (cur_page != cnt_page);
}
/* read the dbg data */
ret = mxt_read_mem(data, dbg_object->start_address + read_point,
DATA_PER_NODE, data_buf);
if (ret)
goto out;
*dbg_data = ((u16)data_buf[1] << 8) + (u16)data_buf[0];
dev_info(&client->dev, "dbg_mode[%d]: dbg data[%d] = %d\n",
dbg_mode, (read_page * NODE_PER_PAGE) + node,
dbg_mode == MXT_DIAG_DELTA_MODE ? (s16)(*dbg_data) : *dbg_data);
out:
return ret;
}
