Re: [PATCH v15 10/12] input: cyapa: add gen5 trackpad device read baseline function support

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



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@xxxxxxxxx>
> ---
>  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@xxxxxxxxxxxxxxx
> More majordomo info at  http://vger.kernel.org/majordomo-info.html
> Please read the FAQ at  http://www.tux.org/lkml/

-- 
- Jeremiah Mahler
--
To unsubscribe from this list: send the line "unsubscribe linux-input" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at  http://vger.kernel.org/majordomo-info.html




[Index of Archives]     [Linux Media Devel]     [Linux USB Devel]     [Video for Linux]     [Linux Audio Users]     [Yosemite News]     [Linux Kernel]     [Linux SCSI]     [Linux Wireless Networking]     [Linux Omap]

  Powered by Linux