Commit 566d533a authored by Nick Dyer's avatar Nick Dyer Committed by Mauro Carvalho Chehab

[media] Input: atmel_mxt_ts - add diagnostic data support for mXT1386

The mXT1386 family of chips have a different architecture which splits
the diagnostic data into 3 columns.
Signed-off-by: default avatarNick Dyer <nick@shmanahar.org>
Signed-off-by: default avatarHans Verkuil <hans.verkuil@cisco.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@s-opensource.com>
Acked-by: default avatarDmitry Torokhov <dmitry.torokhov@gmail.com>
parent de601f71
...@@ -137,6 +137,10 @@ struct t9_range { ...@@ -137,6 +137,10 @@ struct t9_range {
#define MXT_DIAGNOSTIC_DELTAS 0x10 #define MXT_DIAGNOSTIC_DELTAS 0x10
#define MXT_DIAGNOSTIC_SIZE 128 #define MXT_DIAGNOSTIC_SIZE 128
#define MXT_FAMILY_1386 160
#define MXT1386_COLUMNS 3
#define MXT1386_PAGES_PER_COLUMN 8
struct t37_debug { struct t37_debug {
#ifdef CONFIG_TOUCHSCREEN_ATMEL_MXT_T37 #ifdef CONFIG_TOUCHSCREEN_ATMEL_MXT_T37
u8 mode; u8 mode;
...@@ -2140,13 +2144,27 @@ static int mxt_init_t7_power_cfg(struct mxt_data *data) ...@@ -2140,13 +2144,27 @@ static int mxt_init_t7_power_cfg(struct mxt_data *data)
static u16 mxt_get_debug_value(struct mxt_data *data, unsigned int x, static u16 mxt_get_debug_value(struct mxt_data *data, unsigned int x,
unsigned int y) unsigned int y)
{ {
struct mxt_info *info = &data->info;
struct mxt_dbg *dbg = &data->dbg; struct mxt_dbg *dbg = &data->dbg;
unsigned int ofs, page; unsigned int ofs, page;
unsigned int col = 0;
unsigned int col_width;
if (info->family_id == MXT_FAMILY_1386) {
col_width = info->matrix_ysize / MXT1386_COLUMNS;
col = y / col_width;
y = y % col_width;
} else {
col_width = info->matrix_ysize;
}
ofs = (y + (x * data->info.matrix_ysize)) * sizeof(u16); ofs = (y + (x * col_width)) * sizeof(u16);
page = ofs / MXT_DIAGNOSTIC_SIZE; page = ofs / MXT_DIAGNOSTIC_SIZE;
ofs %= MXT_DIAGNOSTIC_SIZE; ofs %= MXT_DIAGNOSTIC_SIZE;
if (info->family_id == MXT_FAMILY_1386)
page += col * MXT1386_PAGES_PER_COLUMN;
return get_unaligned_le16(&dbg->t37_buf[page].data[ofs]); return get_unaligned_le16(&dbg->t37_buf[page].data[ofs]);
} }
...@@ -2416,6 +2434,7 @@ static const struct video_device mxt_video_device = { ...@@ -2416,6 +2434,7 @@ static const struct video_device mxt_video_device = {
static void mxt_debug_init(struct mxt_data *data) static void mxt_debug_init(struct mxt_data *data)
{ {
struct mxt_info *info = &data->info;
struct mxt_dbg *dbg = &data->dbg; struct mxt_dbg *dbg = &data->dbg;
struct mxt_object *object; struct mxt_object *object;
int error; int error;
...@@ -2439,8 +2458,14 @@ static void mxt_debug_init(struct mxt_data *data) ...@@ -2439,8 +2458,14 @@ static void mxt_debug_init(struct mxt_data *data)
/* Calculate size of data and allocate buffer */ /* Calculate size of data and allocate buffer */
dbg->t37_nodes = data->xsize * data->ysize; dbg->t37_nodes = data->xsize * data->ysize;
dbg->t37_pages = DIV_ROUND_UP(data->xsize * data->info.matrix_ysize *
sizeof(u16), sizeof(dbg->t37_buf->data)); if (info->family_id == MXT_FAMILY_1386)
dbg->t37_pages = MXT1386_COLUMNS * MXT1386_PAGES_PER_COLUMN;
else
dbg->t37_pages = DIV_ROUND_UP(data->xsize *
data->info.matrix_ysize *
sizeof(u16),
sizeof(dbg->t37_buf->data));
dbg->t37_buf = devm_kmalloc_array(&data->client->dev, dbg->t37_pages, dbg->t37_buf = devm_kmalloc_array(&data->client->dev, dbg->t37_pages,
sizeof(struct t37_debug), GFP_KERNEL); sizeof(struct t37_debug), GFP_KERNEL);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment