| Message ID | 1418624603-19054-11-git-send-email-dudley.dulixin@gmail.com (mailing list archive) |
|---|---|
| State | New, archived |
| Headers | show |
Dudley, On Mon, Dec 15, 2014 at 02:23:21PM +0800, Dudley Du wrote: > Add read baseline function supported for gen5 trackpad device, > it can be used through sysfs baseline interface. > TEST=test on Chromebooks. > > Signed-off-by: Dudley Du <dudley.dulixin@gmail.com> > --- > drivers/input/mouse/cyapa.h | 2 + > drivers/input/mouse/cyapa_gen5.c | 621 +++++++++++++++++++++++++++++++++++++++ > 2 files changed, 623 insertions(+) > > diff --git a/drivers/input/mouse/cyapa.h b/drivers/input/mouse/cyapa.h > index bf0bbd9..4f1fc89 100644 > --- a/drivers/input/mouse/cyapa.h > +++ b/drivers/input/mouse/cyapa.h > @@ -285,6 +285,8 @@ struct cyapa { > u8 y_origin; /* Y Axis Origin: 0 = top; 1 = bottom. */ > int electrodes_x; /* Number of electrodes on the X Axis*/ > int electrodes_y; /* Number of electrodes on the Y Axis*/ > + int electrodes_rx; /* Number of Rx electrodes */ > + int algined_electrodes_rx; /* 4 aligned */ aligned > int max_z; > > /* > diff --git a/drivers/input/mouse/cyapa_gen5.c b/drivers/input/mouse/cyapa_gen5.c > index e89a952..3c87ad4 100644 > --- a/drivers/input/mouse/cyapa_gen5.c > +++ b/drivers/input/mouse/cyapa_gen5.c > @@ -1533,6 +1533,625 @@ static int cyapa_gen5_set_power_mode(struct cyapa *cyapa, > return 0; > } > > +static int cyapa_gen5_resume_scanning(struct cyapa *cyapa) > +{ > + u8 cmd[7] = { 0x04, 0x00, 0x05, 0x00, 0x2f, 0x00, 0x04 }; > + u8 resp_data[6]; > + int resp_len; > + int error; > + > + /* Try to dump all buffered data before doing command. */ > + cyapa_empty_pip_output_data(cyapa, NULL, NULL, NULL); > + > + resp_len = 6; > + error = cyapa_i2c_pip_cmd_irq_sync(cyapa, > + cmd, 7, > + resp_data, &resp_len, > + 500, cyapa_gen5_sort_tsg_pip_app_resp_data, true); > + if (error || !VALID_CMD_RESP_HEADER(resp_data, 0x04)) > + return -EINVAL; > + > + /* Try to dump all buffered data when resuming scanning. */ > + cyapa_empty_pip_output_data(cyapa, NULL, NULL, NULL); > + > + return 0; > +} > + > +static int cyapa_gen5_suspend_scanning(struct cyapa *cyapa) > +{ > + u8 cmd[7] = { 0x04, 0x00, 0x05, 0x00, 0x2f, 0x00, 0x03 }; > + u8 resp_data[6]; > + int resp_len; > + int error; > + > + /* Try to dump all buffered data before doing command. */ > + cyapa_empty_pip_output_data(cyapa, NULL, NULL, NULL); > + > + resp_len = 6; > + error = cyapa_i2c_pip_cmd_irq_sync(cyapa, > + cmd, 7, > + resp_data, &resp_len, > + 500, cyapa_gen5_sort_tsg_pip_app_resp_data, true); > + if (error || !VALID_CMD_RESP_HEADER(resp_data, 0x03)) > + return -EINVAL; > + > + /* Try to dump all buffered data when suspending scanning. */ > + cyapa_empty_pip_output_data(cyapa, NULL, NULL, NULL); > + > + return 0; > +} > + > +static s32 two_complement_to_s32(s32 value, int num_bits) twos_* might be a better prefix since it is "Two's compliment". > +{ > + if (value >> (num_bits - 1)) > + value |= -1 << num_bits; > + return value; > +} > + > +static s32 cyapa_parse_structure_data(u8 data_format, u8 *buf, int buf_len) > +{ > + int data_size; > + bool big_endian; > + bool unsigned_type; > + s32 value; > + > + data_size = (data_format & 0x07); > + big_endian = ((data_format & 0x10) == 0x00); > + unsigned_type = ((data_format & 0x20) == 0x00); > + > + if (buf_len < data_size) > + return 0; > + > + switch (data_size) { > + case 1: > + value = buf[0]; > + break; > + case 2: > + if (big_endian) > + value = get_unaligned_be16(buf); > + else > + value = get_unaligned_le16(buf); > + break; > + case 4: > + if (big_endian) > + value = get_unaligned_be32(buf); > + else > + value = get_unaligned_le32(buf); > + break; > + default: > + /* Should not happen, just as default case here. */ > + value = 0; > + break; > + } > + > + if (!unsigned_type) > + value = two_complement_to_s32(value, data_size * 8); > + > + return value; > +} > + > + > +/* > + * Read all the global mutual or self idac data or mutual or self local PWC > + * data based on the @idac_data_type. > + * If the input value of @data_size is 0, then means read global mutual or > + * self idac data. For read global mutual idac data, @idac_max, @idac_min and > + * @idac_ave are in order used to return the max value of global mutual idac > + * data, the min value of global mutual idac and the average value of the > + * global mutual idac data. For read global self idac data, @idac_max is used > + * to return the global self cap idac data in Rx direction, @idac_min is used > + * to return the global self cap idac data in Tx direction. @idac_ave is not > + * used. > + * If the input value of @data_size is not 0, than means read the mutual or > + * self local PWC data. The @idac_max, @idac_min and @idac_ave are used to > + * return the max, min and average value of the mutual or self local PWC data. > + * Note, in order to raed mutual local PWC data, must read invoke this function > + * to read the mutual global idac data firstly to set the correct Rx number > + * value, otherwise, the read mutual idac and PWC data may not correct. > + */ > +static int cyapa_gen5_read_idac_data(struct cyapa *cyapa, > + u8 cmd_code, u8 idac_data_type, int *data_size, > + int *idac_max, int *idac_min, int *idac_ave) > +{ > + int i; > + u8 cmd[12]; > + u8 resp_data[256]; > + int resp_len; > + int read_len; > + int value; > + u16 offset; > + int read_elements; > + bool read_global_idac; > + int sum, count, max_element_cnt; > + int tmp_max, tmp_min, tmp_ave, tmp_sum, tmp_count; > + int electrodes_rx, electrodes_tx; > + int error; > + > + if (cmd_code != GEN5_CMD_RETRIEVE_DATA_STRUCTURE || > + (idac_data_type != GEN5_RETRIEVE_MUTUAL_PWC_DATA && > + idac_data_type != GEN5_RETRIEVE_SELF_CAP_PWC_DATA) || > + !data_size || !idac_max || !idac_min || !idac_ave) > + return -EINVAL; > + > + *idac_max = INT_MIN; > + *idac_min = INT_MAX; > + sum = count = tmp_count = 0; > + electrodes_rx = electrodes_tx = 0; > + if (*data_size == 0) { > + /* > + * Read global idac values firstly. > + * Currently, no idac data exceed 4 bytes. > + */ > + read_global_idac = true; > + offset = 0; > + *data_size = 4; > + tmp_max = INT_MIN; > + tmp_min = INT_MAX; > + tmp_ave = tmp_sum = tmp_count = 0; > + > + if (idac_data_type == GEN5_RETRIEVE_MUTUAL_PWC_DATA) { > + if (cyapa->algined_electrodes_rx == 0) { s/algined/aligned/ > + if (cyapa->electrodes_rx != 0) { > + electrodes_rx = cyapa->electrodes_rx; > + electrodes_tx = (cyapa->electrodes_x == > + electrodes_rx) ? > + cyapa->electrodes_y : > + cyapa->electrodes_x; > + } else { > + electrodes_tx = min(cyapa->electrodes_x, > + cyapa->electrodes_y); > + electrodes_rx = max(cyapa->electrodes_x, > + cyapa->electrodes_y); > + } > + cyapa->algined_electrodes_rx = > + (electrodes_rx + 3) & ~3u; The right margin is really cramped, maybe it is time for a new function? > + } > + max_element_cnt = > + (cyapa->algined_electrodes_rx + 7) & ~7u; > + } else { > + max_element_cnt = 2; > + } > + } else { > + read_global_idac = false; > + if (*data_size > 4) > + *data_size = 4; > + /* Calculate the start offset in bytes of local PWC data. */ > + if (idac_data_type == GEN5_RETRIEVE_MUTUAL_PWC_DATA) { > + offset = cyapa->algined_electrodes_rx * (*data_size); > + electrodes_tx = > + (cyapa->electrodes_rx == cyapa->electrodes_x) ? > + cyapa->electrodes_y : cyapa->electrodes_x; > + max_element_cnt = ((cyapa->algined_electrodes_rx + 7) & > + ~7u) * electrodes_tx; > + } else if (idac_data_type == GEN5_RETRIEVE_SELF_CAP_PWC_DATA) { > + offset = 2; > + max_element_cnt = cyapa->electrodes_x + > + cyapa->electrodes_y; > + max_element_cnt = (max_element_cnt + 3) & ~3u; > + } > + } > + > + do { > + read_elements = (256 - 10) / (*data_size); > + read_elements = min(read_elements, max_element_cnt - count); > + read_len = read_elements * (*data_size); > + > + cmd[0] = 0x04; > + cmd[1] = 0x00; > + cmd[2] = 0x0a; > + cmd[3] = 0x00; > + cmd[4] = GEN5_APP_CMD_REPORT_ID; > + cmd[5] = 0x00; > + cmd[6] = cmd_code; > + put_unaligned_le16(offset, &cmd[7]); /* Read Offset[15:0] */ > + put_unaligned_le16(read_len, &cmd[9]); /* Read Length[15:0] */ > + cmd[11] = idac_data_type; > + resp_len = 10 + read_len; > + error = cyapa_i2c_pip_cmd_irq_sync(cyapa, > + cmd, 12, > + resp_data, &resp_len, > + 500, cyapa_gen5_sort_tsg_pip_app_resp_data, > + true); > + if (error || resp_len < 10 || > + !VALID_CMD_RESP_HEADER(resp_data, cmd_code) || > + !GEN5_CMD_COMPLETE_SUCCESS(resp_data[5]) || > + resp_data[6] != idac_data_type) > + return (error < 0) ? error : -EAGAIN; > + read_len = get_unaligned_le16(&resp_data[7]); > + if (read_len == 0) > + break; > + > + *data_size = (resp_data[9] & GEN5_PWC_DATA_ELEMENT_SIZE_MASK); > + if (read_len < *data_size) > + return -EINVAL; > + > + if (read_global_idac && > + idac_data_type == GEN5_RETRIEVE_SELF_CAP_PWC_DATA) { > + /* Rx's self global idac data. */ > + *idac_max = cyapa_parse_structure_data( > + resp_data[9], &resp_data[10], > + *data_size); > + /* Tx's self global idac data. */ > + *idac_min = cyapa_parse_structure_data( > + resp_data[9], > + &resp_data[10 + *data_size], > + *data_size); > + break; > + } > + > + /* Read mutual global idac or local mutual/self PWC data. */ > + offset += read_len; > + for (i = 10; i < (read_len + 10); i += *data_size) { > + value = cyapa_parse_structure_data(resp_data[9], > + &resp_data[i], *data_size); > + *idac_min = min(value, *idac_min); > + *idac_max = max(value, *idac_max); > + > + if (idac_data_type == GEN5_RETRIEVE_MUTUAL_PWC_DATA && > + tmp_count < cyapa->algined_electrodes_rx && > + read_global_idac) { > + /* > + * The value gap betwen global and local mutual > + * idac data must bigger than 50%. > + * Normally, global value bigger than 50, > + * local values less than 10. > + */ > + if (!tmp_ave || value > tmp_ave / 2) { > + tmp_min = min(value, tmp_min); > + tmp_max = max(value, tmp_max); > + tmp_sum += value; > + tmp_count++; > + > + tmp_ave = tmp_sum / tmp_count; > + } > + } > + > + sum += value; > + count++; > + > + if (count >= max_element_cnt) > + goto out; > + } > + } while (true); > + > +out: > + *idac_ave = count ? (sum / count) : 0; > + > + if (read_global_idac && > + idac_data_type == GEN5_RETRIEVE_MUTUAL_PWC_DATA) { > + if (tmp_count == 0) > + return 0; > + > + if (tmp_count == cyapa->algined_electrodes_rx) { > + cyapa->electrodes_rx = cyapa->electrodes_rx ? > + cyapa->electrodes_rx : electrodes_rx; > + } else if (tmp_count == electrodes_rx) { > + cyapa->electrodes_rx = cyapa->electrodes_rx ? > + cyapa->electrodes_rx : electrodes_rx; > + cyapa->algined_electrodes_rx = electrodes_rx; > + } else { > + cyapa->electrodes_rx = cyapa->electrodes_rx ? > + cyapa->electrodes_rx : electrodes_tx; > + cyapa->algined_electrodes_rx = tmp_count; > + } > + > + *idac_min = tmp_min; > + *idac_max = tmp_max; > + *idac_ave = tmp_ave; > + } > + > + return 0; > +} > + > +static int cyapa_gen5_read_mutual_idac_data(struct cyapa *cyapa, > + int *gidac_mutual_max, int *gidac_mutual_min, int *gidac_mutual_ave, > + int *lidac_mutual_max, int *lidac_mutual_min, int *lidac_mutual_ave) > +{ > + int error; > + int data_size; > + > + *gidac_mutual_max = *gidac_mutual_min = *gidac_mutual_ave = 0; > + *lidac_mutual_max = *lidac_mutual_min = *lidac_mutual_ave = 0; > + > + data_size = 0; > + error = cyapa_gen5_read_idac_data(cyapa, > + GEN5_CMD_RETRIEVE_DATA_STRUCTURE, > + GEN5_RETRIEVE_MUTUAL_PWC_DATA, > + &data_size, > + gidac_mutual_max, gidac_mutual_min, gidac_mutual_ave); > + if (error) > + return error; > + > + error = cyapa_gen5_read_idac_data(cyapa, > + GEN5_CMD_RETRIEVE_DATA_STRUCTURE, > + GEN5_RETRIEVE_MUTUAL_PWC_DATA, > + &data_size, > + lidac_mutual_max, lidac_mutual_min, lidac_mutual_ave); > + return error; > +} > + > +static int cyapa_gen5_read_self_idac_data(struct cyapa *cyapa, > + int *gidac_self_rx, int *gidac_self_tx, > + int *lidac_self_max, int *lidac_self_min, int *lidac_self_ave) > +{ > + int error; > + int data_size; > + > + *gidac_self_rx = *gidac_self_tx = 0; > + *lidac_self_max = *lidac_self_min = *lidac_self_ave = 0; > + > + data_size = 0; > + error = cyapa_gen5_read_idac_data(cyapa, > + GEN5_CMD_RETRIEVE_DATA_STRUCTURE, > + GEN5_RETRIEVE_SELF_CAP_PWC_DATA, > + &data_size, > + lidac_self_max, lidac_self_min, lidac_self_ave); > + if (error) > + return error; > + *gidac_self_rx = *lidac_self_max; > + *gidac_self_tx = *lidac_self_min; > + > + error = cyapa_gen5_read_idac_data(cyapa, > + GEN5_CMD_RETRIEVE_DATA_STRUCTURE, > + GEN5_RETRIEVE_SELF_CAP_PWC_DATA, > + &data_size, > + lidac_self_max, lidac_self_min, lidac_self_ave); > + return error; > +} > + > +static ssize_t cyapa_gen5_execute_panel_scan(struct cyapa *cyapa) > +{ > + int error; > + u8 cmd[7]; > + u8 resp_data[6]; > + int resp_len; > + > + cmd[0] = 0x04; > + cmd[1] = 0x00; > + cmd[2] = 0x05; > + cmd[3] = 0x00; > + cmd[4] = GEN5_APP_CMD_REPORT_ID; > + cmd[5] = 0x00; > + cmd[6] = GEN5_CMD_EXECUTE_PANEL_SCAN; /* Command code */ > + resp_len = 6; > + error = cyapa_i2c_pip_cmd_irq_sync(cyapa, > + cmd, 7, > + resp_data, &resp_len, > + 500, cyapa_gen5_sort_tsg_pip_app_resp_data, true); > + if (error || resp_len != 6 || > + !VALID_CMD_RESP_HEADER(resp_data, > + GEN5_CMD_EXECUTE_PANEL_SCAN) || > + !GEN5_CMD_COMPLETE_SUCCESS(resp_data[5])) > + return error ? error : -EAGAIN; > + > + return 0; > +} > + > +static int cyapa_gen5_read_panel_scan_raw_data(struct cyapa *cyapa, > + u8 cmd_code, u8 raw_data_type, int raw_data_max_num, > + int *raw_data_max, int *raw_data_min, int *raw_data_ave, > + u8 *buffer) > +{ > + int i; > + u8 cmd[12]; > + u8 resp_data[256]; /* Max bytes can transfer one time. */ > + int resp_len; > + int read_elements; > + int read_len; > + u16 offset; > + s32 value; > + int sum, count; > + int data_size; > + s32 *intp; > + int error; > + > + if (cmd_code != GEN5_CMD_RETRIEVE_PANEL_SCAN || > + (raw_data_type > GEN5_PANEL_SCAN_SELF_DIFFCOUNT) || > + !raw_data_max || !raw_data_min || !raw_data_ave) > + return -EINVAL; > + > + intp = (s32 *)buffer; > + *raw_data_max = INT_MIN; > + *raw_data_min = INT_MAX; > + sum = count = 0; > + offset = 0; > + read_elements = (256 - 10) / 4; /* Currently, max element size is 4. */ > + read_len = read_elements * 4; > + do { > + cmd[0] = 0x04; > + cmd[1] = 0x00; > + cmd[2] = 0x0a; > + cmd[3] = 0x00; > + cmd[4] = GEN5_APP_CMD_REPORT_ID; > + cmd[5] = 0x00; > + cmd[6] = cmd_code; /* Command code */ > + put_unaligned_le16(offset, &cmd[7]); > + put_unaligned_le16(read_elements, &cmd[9]); > + cmd[11] = raw_data_type; > + resp_len = 10 + read_len; > + > + error = cyapa_i2c_pip_cmd_irq_sync(cyapa, > + cmd, 12, > + resp_data, &resp_len, > + 500, cyapa_gen5_sort_tsg_pip_app_resp_data, true); > + if (error || resp_len < 10 || > + !VALID_CMD_RESP_HEADER(resp_data, cmd_code) || > + !GEN5_CMD_COMPLETE_SUCCESS(resp_data[5]) || > + resp_data[6] != raw_data_type) > + return error ? error : -EAGAIN; > + > + read_elements = get_unaligned_le16(&resp_data[7]); > + if (read_elements == 0) > + break; > + > + data_size = (resp_data[9] & GEN5_PWC_DATA_ELEMENT_SIZE_MASK); > + offset += read_elements; > + if (read_elements) { > + for (i = 10; > + i < (read_elements * data_size + 10); > + i += data_size) { > + value = cyapa_parse_structure_data(resp_data[9], > + &resp_data[i], data_size); > + *raw_data_min = min(value, *raw_data_min); > + *raw_data_max = max(value, *raw_data_max); > + > + if (intp) > + put_unaligned_le32(value, &intp[count]); > + > + sum += value; > + count++; > + > + } > + } > + > + if (count >= raw_data_max_num) > + break; > + > + read_elements = (sizeof(resp_data) - 10) / data_size; > + read_len = read_elements * data_size; > + } while (true); > + > + *raw_data_ave = count ? (sum / count) : 0; > + > + return 0; > +} > + > +static ssize_t cyapa_gen5_show_baseline(struct device *dev, > + struct device_attribute *attr, char *buf) > +{ > + struct cyapa *cyapa = dev_get_drvdata(dev); > + int gidac_mutual_max, gidac_mutual_min, gidac_mutual_ave; > + int lidac_mutual_max, lidac_mutual_min, lidac_mutual_ave; > + int gidac_self_rx, gidac_self_tx; > + int lidac_self_max, lidac_self_min, lidac_self_ave; > + int raw_cap_mutual_max, raw_cap_mutual_min, raw_cap_mutual_ave; > + int raw_cap_self_max, raw_cap_self_min, raw_cap_self_ave; > + int mutual_diffdata_max, mutual_diffdata_min, mutual_diffdata_ave; > + int self_diffdata_max, self_diffdata_min, self_diffdata_ave; > + int mutual_baseline_max, mutual_baseline_min, mutual_baseline_ave; > + int self_baseline_max, self_baseline_min, self_baseline_ave; > + int error, resume_error; > + int size; > + > + if (cyapa->state != CYAPA_STATE_GEN5_APP) > + return -EBUSY; > + > + /* 1. Suspend Scanning*/ > + error = cyapa_gen5_suspend_scanning(cyapa); > + if (error) > + return error; > + > + /* 2. Read global and local mutual IDAC data. */ > + gidac_self_rx = gidac_self_tx = 0; > + error = cyapa_gen5_read_mutual_idac_data(cyapa, > + &gidac_mutual_max, &gidac_mutual_min, > + &gidac_mutual_ave, &lidac_mutual_max, > + &lidac_mutual_min, &lidac_mutual_ave); > + if (error) > + goto resume_scanning; > + > + /* 3. Read global and local self IDAC data. */ > + error = cyapa_gen5_read_self_idac_data(cyapa, > + &gidac_self_rx, &gidac_self_tx, > + &lidac_self_max, &lidac_self_min, > + &lidac_self_ave); > + if (error) > + goto resume_scanning; > + > + /* 4. Execuate panel scan. It must be executed before read data. */ > + error = cyapa_gen5_execute_panel_scan(cyapa); > + if (error) > + goto resume_scanning; > + > + /* 5. Retrieve panel scan, mutual cap raw data. */ > + error = cyapa_gen5_read_panel_scan_raw_data(cyapa, > + GEN5_CMD_RETRIEVE_PANEL_SCAN, > + GEN5_PANEL_SCAN_MUTUAL_RAW_DATA, > + cyapa->electrodes_x * cyapa->electrodes_y, > + &raw_cap_mutual_max, &raw_cap_mutual_min, > + &raw_cap_mutual_ave, > + NULL); > + if (error) > + goto resume_scanning; > + > + /* 6. Retrieve panel scan, self cap raw data. */ > + error = cyapa_gen5_read_panel_scan_raw_data(cyapa, > + GEN5_CMD_RETRIEVE_PANEL_SCAN, > + GEN5_PANEL_SCAN_SELF_RAW_DATA, > + cyapa->electrodes_x + cyapa->electrodes_y, > + &raw_cap_self_max, &raw_cap_self_min, > + &raw_cap_self_ave, > + NULL); > + if (error) > + goto resume_scanning; > + > + /* 7. Retrieve panel scan, mutual cap diffcount raw data. */ > + error = cyapa_gen5_read_panel_scan_raw_data(cyapa, > + GEN5_CMD_RETRIEVE_PANEL_SCAN, > + GEN5_PANEL_SCAN_MUTUAL_DIFFCOUNT, > + cyapa->electrodes_x * cyapa->electrodes_y, > + &mutual_diffdata_max, &mutual_diffdata_min, > + &mutual_diffdata_ave, > + NULL); > + if (error) > + goto resume_scanning; > + > + /* 8. Retrieve panel scan, self cap diffcount raw data. */ > + error = cyapa_gen5_read_panel_scan_raw_data(cyapa, > + GEN5_CMD_RETRIEVE_PANEL_SCAN, > + GEN5_PANEL_SCAN_SELF_DIFFCOUNT, > + cyapa->electrodes_x + cyapa->electrodes_y, > + &self_diffdata_max, &self_diffdata_min, > + &self_diffdata_ave, > + NULL); > + if (error) > + goto resume_scanning; > + > + /* 9. Retrieve panel scan, mutual cap baseline raw data. */ > + error = cyapa_gen5_read_panel_scan_raw_data(cyapa, > + GEN5_CMD_RETRIEVE_PANEL_SCAN, > + GEN5_PANEL_SCAN_MUTUAL_BASELINE, > + cyapa->electrodes_x * cyapa->electrodes_y, > + &mutual_baseline_max, &mutual_baseline_min, > + &mutual_baseline_ave, > + NULL); > + if (error) > + goto resume_scanning; > + > + /* 10. Retrieve panel scan, self cap baseline raw data. */ > + error = cyapa_gen5_read_panel_scan_raw_data(cyapa, > + GEN5_CMD_RETRIEVE_PANEL_SCAN, > + GEN5_PANEL_SCAN_SELF_BASELINE, > + cyapa->electrodes_x + cyapa->electrodes_y, > + &self_baseline_max, &self_baseline_min, > + &self_baseline_ave, > + NULL); > + if (error) > + goto resume_scanning; > + > +resume_scanning: > + /* 11. Resume Scanning*/ > + resume_error = cyapa_gen5_resume_scanning(cyapa); > + if (resume_error || error) > + return resume_error ? resume_error : error; > + > + /* 12. Output data strings */ > + size = scnprintf(buf, PAGE_SIZE, "%d %d %d %d %d %d %d %d %d %d %d ", > + gidac_mutual_min, gidac_mutual_max, gidac_mutual_ave, > + lidac_mutual_min, lidac_mutual_max, lidac_mutual_ave, > + gidac_self_rx, gidac_self_tx, > + lidac_self_min, lidac_self_max, lidac_self_ave); > + size += scnprintf(buf + size, PAGE_SIZE - size, > + "%d %d %d %d %d %d %d %d %d %d %d %d %d %d %d %d %d %d\n", > + raw_cap_mutual_min, raw_cap_mutual_max, raw_cap_mutual_ave, > + raw_cap_self_min, raw_cap_self_max, raw_cap_self_ave, > + mutual_diffdata_min, mutual_diffdata_max, mutual_diffdata_ave, > + self_diffdata_min, self_diffdata_max, self_diffdata_ave, > + mutual_baseline_min, mutual_baseline_max, mutual_baseline_ave, > + self_baseline_min, self_baseline_max, self_baseline_ave); > + return size; > +} > + > static bool cyapa_gen5_sort_system_info_data(struct cyapa *cyapa, > u8 *buf, int len) > { > @@ -1938,6 +2557,8 @@ const struct cyapa_dev_ops cyapa_gen5_ops = { > .bl_initiate = cyapa_gen5_bl_initiate, > .update_fw = cyapa_gen5_do_fw_update, > > + .show_baseline = cyapa_gen5_show_baseline, > + > .initialize = cyapa_gen5_initialize, > > .state_parse = cyapa_gen5_state_parse, > -- > 1.9.1 > > -- > To unsubscribe from this list: send the line "unsubscribe linux-kernel" in > the body of a message to majordomo@vger.kernel.org > More majordomo info at http://vger.kernel.org/majordomo-info.html > Please read the FAQ at http://www.tux.org/lkml/
diff --git a/drivers/input/mouse/cyapa.h b/drivers/input/mouse/cyapa.h index bf0bbd9..4f1fc89 100644 --- a/drivers/input/mouse/cyapa.h +++ b/drivers/input/mouse/cyapa.h @@ -285,6 +285,8 @@ struct cyapa { u8 y_origin; /* Y Axis Origin: 0 = top; 1 = bottom. */ int electrodes_x; /* Number of electrodes on the X Axis*/ int electrodes_y; /* Number of electrodes on the Y Axis*/ + int electrodes_rx; /* Number of Rx electrodes */ + int algined_electrodes_rx; /* 4 aligned */ int max_z; /* diff --git a/drivers/input/mouse/cyapa_gen5.c b/drivers/input/mouse/cyapa_gen5.c index e89a952..3c87ad4 100644 --- a/drivers/input/mouse/cyapa_gen5.c +++ b/drivers/input/mouse/cyapa_gen5.c @@ -1533,6 +1533,625 @@ static int cyapa_gen5_set_power_mode(struct cyapa *cyapa, return 0; } +static int cyapa_gen5_resume_scanning(struct cyapa *cyapa) +{ + u8 cmd[7] = { 0x04, 0x00, 0x05, 0x00, 0x2f, 0x00, 0x04 }; + u8 resp_data[6]; + int resp_len; + int error; + + /* Try to dump all buffered data before doing command. */ + cyapa_empty_pip_output_data(cyapa, NULL, NULL, NULL); + + resp_len = 6; + error = cyapa_i2c_pip_cmd_irq_sync(cyapa, + cmd, 7, + resp_data, &resp_len, + 500, cyapa_gen5_sort_tsg_pip_app_resp_data, true); + if (error || !VALID_CMD_RESP_HEADER(resp_data, 0x04)) + return -EINVAL; + + /* Try to dump all buffered data when resuming scanning. */ + cyapa_empty_pip_output_data(cyapa, NULL, NULL, NULL); + + return 0; +} + +static int cyapa_gen5_suspend_scanning(struct cyapa *cyapa) +{ + u8 cmd[7] = { 0x04, 0x00, 0x05, 0x00, 0x2f, 0x00, 0x03 }; + u8 resp_data[6]; + int resp_len; + int error; + + /* Try to dump all buffered data before doing command. */ + cyapa_empty_pip_output_data(cyapa, NULL, NULL, NULL); + + resp_len = 6; + error = cyapa_i2c_pip_cmd_irq_sync(cyapa, + cmd, 7, + resp_data, &resp_len, + 500, cyapa_gen5_sort_tsg_pip_app_resp_data, true); + if (error || !VALID_CMD_RESP_HEADER(resp_data, 0x03)) + return -EINVAL; + + /* Try to dump all buffered data when suspending scanning. */ + cyapa_empty_pip_output_data(cyapa, NULL, NULL, NULL); + + return 0; +} + +static s32 two_complement_to_s32(s32 value, int num_bits) +{ + if (value >> (num_bits - 1)) + value |= -1 << num_bits; + return value; +} + +static s32 cyapa_parse_structure_data(u8 data_format, u8 *buf, int buf_len) +{ + int data_size; + bool big_endian; + bool unsigned_type; + s32 value; + + data_size = (data_format & 0x07); + big_endian = ((data_format & 0x10) == 0x00); + unsigned_type = ((data_format & 0x20) == 0x00); + + if (buf_len < data_size) + return 0; + + switch (data_size) { + case 1: + value = buf[0]; + break; + case 2: + if (big_endian) + value = get_unaligned_be16(buf); + else + value = get_unaligned_le16(buf); + break; + case 4: + if (big_endian) + value = get_unaligned_be32(buf); + else + value = get_unaligned_le32(buf); + break; + default: + /* Should not happen, just as default case here. */ + value = 0; + break; + } + + if (!unsigned_type) + value = two_complement_to_s32(value, data_size * 8); + + return value; +} + + +/* + * Read all the global mutual or self idac data or mutual or self local PWC + * data based on the @idac_data_type. + * If the input value of @data_size is 0, then means read global mutual or + * self idac data. For read global mutual idac data, @idac_max, @idac_min and + * @idac_ave are in order used to return the max value of global mutual idac + * data, the min value of global mutual idac and the average value of the + * global mutual idac data. For read global self idac data, @idac_max is used + * to return the global self cap idac data in Rx direction, @idac_min is used + * to return the global self cap idac data in Tx direction. @idac_ave is not + * used. + * If the input value of @data_size is not 0, than means read the mutual or + * self local PWC data. The @idac_max, @idac_min and @idac_ave are used to + * return the max, min and average value of the mutual or self local PWC data. + * Note, in order to raed mutual local PWC data, must read invoke this function + * to read the mutual global idac data firstly to set the correct Rx number + * value, otherwise, the read mutual idac and PWC data may not correct. + */ +static int cyapa_gen5_read_idac_data(struct cyapa *cyapa, + u8 cmd_code, u8 idac_data_type, int *data_size, + int *idac_max, int *idac_min, int *idac_ave) +{ + int i; + u8 cmd[12]; + u8 resp_data[256]; + int resp_len; + int read_len; + int value; + u16 offset; + int read_elements; + bool read_global_idac; + int sum, count, max_element_cnt; + int tmp_max, tmp_min, tmp_ave, tmp_sum, tmp_count; + int electrodes_rx, electrodes_tx; + int error; + + if (cmd_code != GEN5_CMD_RETRIEVE_DATA_STRUCTURE || + (idac_data_type != GEN5_RETRIEVE_MUTUAL_PWC_DATA && + idac_data_type != GEN5_RETRIEVE_SELF_CAP_PWC_DATA) || + !data_size || !idac_max || !idac_min || !idac_ave) + return -EINVAL; + + *idac_max = INT_MIN; + *idac_min = INT_MAX; + sum = count = tmp_count = 0; + electrodes_rx = electrodes_tx = 0; + if (*data_size == 0) { + /* + * Read global idac values firstly. + * Currently, no idac data exceed 4 bytes. + */ + read_global_idac = true; + offset = 0; + *data_size = 4; + tmp_max = INT_MIN; + tmp_min = INT_MAX; + tmp_ave = tmp_sum = tmp_count = 0; + + if (idac_data_type == GEN5_RETRIEVE_MUTUAL_PWC_DATA) { + if (cyapa->algined_electrodes_rx == 0) { + if (cyapa->electrodes_rx != 0) { + electrodes_rx = cyapa->electrodes_rx; + electrodes_tx = (cyapa->electrodes_x == + electrodes_rx) ? + cyapa->electrodes_y : + cyapa->electrodes_x; + } else { + electrodes_tx = min(cyapa->electrodes_x, + cyapa->electrodes_y); + electrodes_rx = max(cyapa->electrodes_x, + cyapa->electrodes_y); + } + cyapa->algined_electrodes_rx = + (electrodes_rx + 3) & ~3u; + } + max_element_cnt = + (cyapa->algined_electrodes_rx + 7) & ~7u; + } else { + max_element_cnt = 2; + } + } else { + read_global_idac = false; + if (*data_size > 4) + *data_size = 4; + /* Calculate the start offset in bytes of local PWC data. */ + if (idac_data_type == GEN5_RETRIEVE_MUTUAL_PWC_DATA) { + offset = cyapa->algined_electrodes_rx * (*data_size); + electrodes_tx = + (cyapa->electrodes_rx == cyapa->electrodes_x) ? + cyapa->electrodes_y : cyapa->electrodes_x; + max_element_cnt = ((cyapa->algined_electrodes_rx + 7) & + ~7u) * electrodes_tx; + } else if (idac_data_type == GEN5_RETRIEVE_SELF_CAP_PWC_DATA) { + offset = 2; + max_element_cnt = cyapa->electrodes_x + + cyapa->electrodes_y; + max_element_cnt = (max_element_cnt + 3) & ~3u; + } + } + + do { + read_elements = (256 - 10) / (*data_size); + read_elements = min(read_elements, max_element_cnt - count); + read_len = read_elements * (*data_size); + + cmd[0] = 0x04; + cmd[1] = 0x00; + cmd[2] = 0x0a; + cmd[3] = 0x00; + cmd[4] = GEN5_APP_CMD_REPORT_ID; + cmd[5] = 0x00; + cmd[6] = cmd_code; + put_unaligned_le16(offset, &cmd[7]); /* Read Offset[15:0] */ + put_unaligned_le16(read_len, &cmd[9]); /* Read Length[15:0] */ + cmd[11] = idac_data_type; + resp_len = 10 + read_len; + error = cyapa_i2c_pip_cmd_irq_sync(cyapa, + cmd, 12, + resp_data, &resp_len, + 500, cyapa_gen5_sort_tsg_pip_app_resp_data, + true); + if (error || resp_len < 10 || + !VALID_CMD_RESP_HEADER(resp_data, cmd_code) || + !GEN5_CMD_COMPLETE_SUCCESS(resp_data[5]) || + resp_data[6] != idac_data_type) + return (error < 0) ? error : -EAGAIN; + read_len = get_unaligned_le16(&resp_data[7]); + if (read_len == 0) + break; + + *data_size = (resp_data[9] & GEN5_PWC_DATA_ELEMENT_SIZE_MASK); + if (read_len < *data_size) + return -EINVAL; + + if (read_global_idac && + idac_data_type == GEN5_RETRIEVE_SELF_CAP_PWC_DATA) { + /* Rx's self global idac data. */ + *idac_max = cyapa_parse_structure_data( + resp_data[9], &resp_data[10], + *data_size); + /* Tx's self global idac data. */ + *idac_min = cyapa_parse_structure_data( + resp_data[9], + &resp_data[10 + *data_size], + *data_size); + break; + } + + /* Read mutual global idac or local mutual/self PWC data. */ + offset += read_len; + for (i = 10; i < (read_len + 10); i += *data_size) { + value = cyapa_parse_structure_data(resp_data[9], + &resp_data[i], *data_size); + *idac_min = min(value, *idac_min); + *idac_max = max(value, *idac_max); + + if (idac_data_type == GEN5_RETRIEVE_MUTUAL_PWC_DATA && + tmp_count < cyapa->algined_electrodes_rx && + read_global_idac) { + /* + * The value gap betwen global and local mutual + * idac data must bigger than 50%. + * Normally, global value bigger than 50, + * local values less than 10. + */ + if (!tmp_ave || value > tmp_ave / 2) { + tmp_min = min(value, tmp_min); + tmp_max = max(value, tmp_max); + tmp_sum += value; + tmp_count++; + + tmp_ave = tmp_sum / tmp_count; + } + } + + sum += value; + count++; + + if (count >= max_element_cnt) + goto out; + } + } while (true); + +out: + *idac_ave = count ? (sum / count) : 0; + + if (read_global_idac && + idac_data_type == GEN5_RETRIEVE_MUTUAL_PWC_DATA) { + if (tmp_count == 0) + return 0; + + if (tmp_count == cyapa->algined_electrodes_rx) { + cyapa->electrodes_rx = cyapa->electrodes_rx ? + cyapa->electrodes_rx : electrodes_rx; + } else if (tmp_count == electrodes_rx) { + cyapa->electrodes_rx = cyapa->electrodes_rx ? + cyapa->electrodes_rx : electrodes_rx; + cyapa->algined_electrodes_rx = electrodes_rx; + } else { + cyapa->electrodes_rx = cyapa->electrodes_rx ? + cyapa->electrodes_rx : electrodes_tx; + cyapa->algined_electrodes_rx = tmp_count; + } + + *idac_min = tmp_min; + *idac_max = tmp_max; + *idac_ave = tmp_ave; + } + + return 0; +} + +static int cyapa_gen5_read_mutual_idac_data(struct cyapa *cyapa, + int *gidac_mutual_max, int *gidac_mutual_min, int *gidac_mutual_ave, + int *lidac_mutual_max, int *lidac_mutual_min, int *lidac_mutual_ave) +{ + int error; + int data_size; + + *gidac_mutual_max = *gidac_mutual_min = *gidac_mutual_ave = 0; + *lidac_mutual_max = *lidac_mutual_min = *lidac_mutual_ave = 0; + + data_size = 0; + error = cyapa_gen5_read_idac_data(cyapa, + GEN5_CMD_RETRIEVE_DATA_STRUCTURE, + GEN5_RETRIEVE_MUTUAL_PWC_DATA, + &data_size, + gidac_mutual_max, gidac_mutual_min, gidac_mutual_ave); + if (error) + return error; + + error = cyapa_gen5_read_idac_data(cyapa, + GEN5_CMD_RETRIEVE_DATA_STRUCTURE, + GEN5_RETRIEVE_MUTUAL_PWC_DATA, + &data_size, + lidac_mutual_max, lidac_mutual_min, lidac_mutual_ave); + return error; +} + +static int cyapa_gen5_read_self_idac_data(struct cyapa *cyapa, + int *gidac_self_rx, int *gidac_self_tx, + int *lidac_self_max, int *lidac_self_min, int *lidac_self_ave) +{ + int error; + int data_size; + + *gidac_self_rx = *gidac_self_tx = 0; + *lidac_self_max = *lidac_self_min = *lidac_self_ave = 0; + + data_size = 0; + error = cyapa_gen5_read_idac_data(cyapa, + GEN5_CMD_RETRIEVE_DATA_STRUCTURE, + GEN5_RETRIEVE_SELF_CAP_PWC_DATA, + &data_size, + lidac_self_max, lidac_self_min, lidac_self_ave); + if (error) + return error; + *gidac_self_rx = *lidac_self_max; + *gidac_self_tx = *lidac_self_min; + + error = cyapa_gen5_read_idac_data(cyapa, + GEN5_CMD_RETRIEVE_DATA_STRUCTURE, + GEN5_RETRIEVE_SELF_CAP_PWC_DATA, + &data_size, + lidac_self_max, lidac_self_min, lidac_self_ave); + return error; +} + +static ssize_t cyapa_gen5_execute_panel_scan(struct cyapa *cyapa) +{ + int error; + u8 cmd[7]; + u8 resp_data[6]; + int resp_len; + + cmd[0] = 0x04; + cmd[1] = 0x00; + cmd[2] = 0x05; + cmd[3] = 0x00; + cmd[4] = GEN5_APP_CMD_REPORT_ID; + cmd[5] = 0x00; + cmd[6] = GEN5_CMD_EXECUTE_PANEL_SCAN; /* Command code */ + resp_len = 6; + error = cyapa_i2c_pip_cmd_irq_sync(cyapa, + cmd, 7, + resp_data, &resp_len, + 500, cyapa_gen5_sort_tsg_pip_app_resp_data, true); + if (error || resp_len != 6 || + !VALID_CMD_RESP_HEADER(resp_data, + GEN5_CMD_EXECUTE_PANEL_SCAN) || + !GEN5_CMD_COMPLETE_SUCCESS(resp_data[5])) + return error ? error : -EAGAIN; + + return 0; +} + +static int cyapa_gen5_read_panel_scan_raw_data(struct cyapa *cyapa, + u8 cmd_code, u8 raw_data_type, int raw_data_max_num, + int *raw_data_max, int *raw_data_min, int *raw_data_ave, + u8 *buffer) +{ + int i; + u8 cmd[12]; + u8 resp_data[256]; /* Max bytes can transfer one time. */ + int resp_len; + int read_elements; + int read_len; + u16 offset; + s32 value; + int sum, count; + int data_size; + s32 *intp; + int error; + + if (cmd_code != GEN5_CMD_RETRIEVE_PANEL_SCAN || + (raw_data_type > GEN5_PANEL_SCAN_SELF_DIFFCOUNT) || + !raw_data_max || !raw_data_min || !raw_data_ave) + return -EINVAL; + + intp = (s32 *)buffer; + *raw_data_max = INT_MIN; + *raw_data_min = INT_MAX; + sum = count = 0; + offset = 0; + read_elements = (256 - 10) / 4; /* Currently, max element size is 4. */ + read_len = read_elements * 4; + do { + cmd[0] = 0x04; + cmd[1] = 0x00; + cmd[2] = 0x0a; + cmd[3] = 0x00; + cmd[4] = GEN5_APP_CMD_REPORT_ID; + cmd[5] = 0x00; + cmd[6] = cmd_code; /* Command code */ + put_unaligned_le16(offset, &cmd[7]); + put_unaligned_le16(read_elements, &cmd[9]); + cmd[11] = raw_data_type; + resp_len = 10 + read_len; + + error = cyapa_i2c_pip_cmd_irq_sync(cyapa, + cmd, 12, + resp_data, &resp_len, + 500, cyapa_gen5_sort_tsg_pip_app_resp_data, true); + if (error || resp_len < 10 || + !VALID_CMD_RESP_HEADER(resp_data, cmd_code) || + !GEN5_CMD_COMPLETE_SUCCESS(resp_data[5]) || + resp_data[6] != raw_data_type) + return error ? error : -EAGAIN; + + read_elements = get_unaligned_le16(&resp_data[7]); + if (read_elements == 0) + break; + + data_size = (resp_data[9] & GEN5_PWC_DATA_ELEMENT_SIZE_MASK); + offset += read_elements; + if (read_elements) { + for (i = 10; + i < (read_elements * data_size + 10); + i += data_size) { + value = cyapa_parse_structure_data(resp_data[9], + &resp_data[i], data_size); + *raw_data_min = min(value, *raw_data_min); + *raw_data_max = max(value, *raw_data_max); + + if (intp) + put_unaligned_le32(value, &intp[count]); + + sum += value; + count++; + + } + } + + if (count >= raw_data_max_num) + break; + + read_elements = (sizeof(resp_data) - 10) / data_size; + read_len = read_elements * data_size; + } while (true); + + *raw_data_ave = count ? (sum / count) : 0; + + return 0; +} + +static ssize_t cyapa_gen5_show_baseline(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct cyapa *cyapa = dev_get_drvdata(dev); + int gidac_mutual_max, gidac_mutual_min, gidac_mutual_ave; + int lidac_mutual_max, lidac_mutual_min, lidac_mutual_ave; + int gidac_self_rx, gidac_self_tx; + int lidac_self_max, lidac_self_min, lidac_self_ave; + int raw_cap_mutual_max, raw_cap_mutual_min, raw_cap_mutual_ave; + int raw_cap_self_max, raw_cap_self_min, raw_cap_self_ave; + int mutual_diffdata_max, mutual_diffdata_min, mutual_diffdata_ave; + int self_diffdata_max, self_diffdata_min, self_diffdata_ave; + int mutual_baseline_max, mutual_baseline_min, mutual_baseline_ave; + int self_baseline_max, self_baseline_min, self_baseline_ave; + int error, resume_error; + int size; + + if (cyapa->state != CYAPA_STATE_GEN5_APP) + return -EBUSY; + + /* 1. Suspend Scanning*/ + error = cyapa_gen5_suspend_scanning(cyapa); + if (error) + return error; + + /* 2. Read global and local mutual IDAC data. */ + gidac_self_rx = gidac_self_tx = 0; + error = cyapa_gen5_read_mutual_idac_data(cyapa, + &gidac_mutual_max, &gidac_mutual_min, + &gidac_mutual_ave, &lidac_mutual_max, + &lidac_mutual_min, &lidac_mutual_ave); + if (error) + goto resume_scanning; + + /* 3. Read global and local self IDAC data. */ + error = cyapa_gen5_read_self_idac_data(cyapa, + &gidac_self_rx, &gidac_self_tx, + &lidac_self_max, &lidac_self_min, + &lidac_self_ave); + if (error) + goto resume_scanning; + + /* 4. Execuate panel scan. It must be executed before read data. */ + error = cyapa_gen5_execute_panel_scan(cyapa); + if (error) + goto resume_scanning; + + /* 5. Retrieve panel scan, mutual cap raw data. */ + error = cyapa_gen5_read_panel_scan_raw_data(cyapa, + GEN5_CMD_RETRIEVE_PANEL_SCAN, + GEN5_PANEL_SCAN_MUTUAL_RAW_DATA, + cyapa->electrodes_x * cyapa->electrodes_y, + &raw_cap_mutual_max, &raw_cap_mutual_min, + &raw_cap_mutual_ave, + NULL); + if (error) + goto resume_scanning; + + /* 6. Retrieve panel scan, self cap raw data. */ + error = cyapa_gen5_read_panel_scan_raw_data(cyapa, + GEN5_CMD_RETRIEVE_PANEL_SCAN, + GEN5_PANEL_SCAN_SELF_RAW_DATA, + cyapa->electrodes_x + cyapa->electrodes_y, + &raw_cap_self_max, &raw_cap_self_min, + &raw_cap_self_ave, + NULL); + if (error) + goto resume_scanning; + + /* 7. Retrieve panel scan, mutual cap diffcount raw data. */ + error = cyapa_gen5_read_panel_scan_raw_data(cyapa, + GEN5_CMD_RETRIEVE_PANEL_SCAN, + GEN5_PANEL_SCAN_MUTUAL_DIFFCOUNT, + cyapa->electrodes_x * cyapa->electrodes_y, + &mutual_diffdata_max, &mutual_diffdata_min, + &mutual_diffdata_ave, + NULL); + if (error) + goto resume_scanning; + + /* 8. Retrieve panel scan, self cap diffcount raw data. */ + error = cyapa_gen5_read_panel_scan_raw_data(cyapa, + GEN5_CMD_RETRIEVE_PANEL_SCAN, + GEN5_PANEL_SCAN_SELF_DIFFCOUNT, + cyapa->electrodes_x + cyapa->electrodes_y, + &self_diffdata_max, &self_diffdata_min, + &self_diffdata_ave, + NULL); + if (error) + goto resume_scanning; + + /* 9. Retrieve panel scan, mutual cap baseline raw data. */ + error = cyapa_gen5_read_panel_scan_raw_data(cyapa, + GEN5_CMD_RETRIEVE_PANEL_SCAN, + GEN5_PANEL_SCAN_MUTUAL_BASELINE, + cyapa->electrodes_x * cyapa->electrodes_y, + &mutual_baseline_max, &mutual_baseline_min, + &mutual_baseline_ave, + NULL); + if (error) + goto resume_scanning; + + /* 10. Retrieve panel scan, self cap baseline raw data. */ + error = cyapa_gen5_read_panel_scan_raw_data(cyapa, + GEN5_CMD_RETRIEVE_PANEL_SCAN, + GEN5_PANEL_SCAN_SELF_BASELINE, + cyapa->electrodes_x + cyapa->electrodes_y, + &self_baseline_max, &self_baseline_min, + &self_baseline_ave, + NULL); + if (error) + goto resume_scanning; + +resume_scanning: + /* 11. Resume Scanning*/ + resume_error = cyapa_gen5_resume_scanning(cyapa); + if (resume_error || error) + return resume_error ? resume_error : error; + + /* 12. Output data strings */ + size = scnprintf(buf, PAGE_SIZE, "%d %d %d %d %d %d %d %d %d %d %d ", + gidac_mutual_min, gidac_mutual_max, gidac_mutual_ave, + lidac_mutual_min, lidac_mutual_max, lidac_mutual_ave, + gidac_self_rx, gidac_self_tx, + lidac_self_min, lidac_self_max, lidac_self_ave); + size += scnprintf(buf + size, PAGE_SIZE - size, + "%d %d %d %d %d %d %d %d %d %d %d %d %d %d %d %d %d %d\n", + raw_cap_mutual_min, raw_cap_mutual_max, raw_cap_mutual_ave, + raw_cap_self_min, raw_cap_self_max, raw_cap_self_ave, + mutual_diffdata_min, mutual_diffdata_max, mutual_diffdata_ave, + self_diffdata_min, self_diffdata_max, self_diffdata_ave, + mutual_baseline_min, mutual_baseline_max, mutual_baseline_ave, + self_baseline_min, self_baseline_max, self_baseline_ave); + return size; +} + static bool cyapa_gen5_sort_system_info_data(struct cyapa *cyapa, u8 *buf, int len) { @@ -1938,6 +2557,8 @@ const struct cyapa_dev_ops cyapa_gen5_ops = { .bl_initiate = cyapa_gen5_bl_initiate, .update_fw = cyapa_gen5_do_fw_update, + .show_baseline = cyapa_gen5_show_baseline, + .initialize = cyapa_gen5_initialize, .state_parse = cyapa_gen5_state_parse,
Add read baseline function supported for gen5 trackpad device, it can be used through sysfs baseline interface. TEST=test on Chromebooks. Signed-off-by: Dudley Du <dudley.dulixin@gmail.com> --- drivers/input/mouse/cyapa.h | 2 + drivers/input/mouse/cyapa_gen5.c | 621 +++++++++++++++++++++++++++++++++++++++ 2 files changed, 623 insertions(+)