From patchwork Fri Nov 14 06:03:24 2014 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Dudley Du X-Patchwork-Id: 5303661 Return-Path: X-Original-To: patchwork-linux-input@patchwork.kernel.org Delivered-To: patchwork-parsemail@patchwork2.web.kernel.org Received: from mail.kernel.org (mail.kernel.org [198.145.19.201]) by patchwork2.web.kernel.org (Postfix) with ESMTP id 42F88C11AC for ; Fri, 14 Nov 2014 06:08:00 +0000 (UTC) Received: from mail.kernel.org (localhost [127.0.0.1]) by mail.kernel.org (Postfix) with ESMTP id 5BD7120149 for ; Fri, 14 Nov 2014 06:07:59 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.kernel.org (Postfix) with ESMTP id 5BD312013D for ; Fri, 14 Nov 2014 06:07:58 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S965068AbaKNGHl (ORCPT ); Fri, 14 Nov 2014 01:07:41 -0500 Received: from mail-pd0-f172.google.com ([209.85.192.172]:49687 "EHLO mail-pd0-f172.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S965067AbaKNGHi (ORCPT ); Fri, 14 Nov 2014 01:07:38 -0500 Received: by mail-pd0-f172.google.com with SMTP id r10so16155611pdi.3 for ; Thu, 13 Nov 2014 22:07:38 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20120113; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=IjrT4nXH/Lwfon3P0h4Leyn4OwsQ++ReJ8Yq92KSDxA=; b=PjtBP64mtm5rn3XkW1dR2V9ib5WV10ZCSp7POXQ6P9Dl0yPAgpW/ii15qJle+WgkA1 WH1oD4Z0cjlzc2A07hQP6KwLYhHbBFzjWVHUeQuLoww4SFbJOVmpWIohJtx2Xke5tFD2 pS+DA2i/XEcY/t06Rs7xT3dJYlGwqLm4zcUXHTJSk35xDYT3BtCmxXtRVXYVcO2nbmGY XtPfjprAKO2O/ZYNhSKi133c+p6vvb7DgD+7+u+OJ3A9W0s84+z3+4Lh6AqqdHGQgxYa 9diJG06a9vBKfI7EP+19YrPxy7BPDbG4s0teX2Vr4cdIZK18ZcyM9P+1UxTETuHLO+7e bI1w== X-Received: by 10.66.145.42 with SMTP id sr10mr7667342pab.73.1415945258202; Thu, 13 Nov 2014 22:07:38 -0800 (PST) Received: from localhost ([140.207.206.26]) by mx.google.com with ESMTPSA id cz4sm26517746pdb.8.2014.11.13.22.07.34 for (version=TLSv1.2 cipher=RC4-SHA bits=128/128); Thu, 13 Nov 2014 22:07:37 -0800 (PST) From: Dudley Du X-Google-Original-From: Dudley Du To: dmitry.torokhov@gmail.com, rydberg@euromail.se Cc: Dudley Du , bleung@google.com, linux-input@vger.kernel.org, linux-kernel@vger.kernel.org Subject: [PATCH v10 18/18] input: cyapa: add gen5 trackpad device read raw data function support Date: Fri, 14 Nov 2014 14:03:24 +0800 Message-Id: <1415945004-19868-19-git-send-email-dudl@cypress.com> X-Mailer: git-send-email 1.9.1 In-Reply-To: <1415945004-19868-1-git-send-email-dudl@cypress.com> References: <1415945004-19868-1-git-send-email-dudl@cypress.com> Sender: linux-input-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-input@vger.kernel.org X-Spam-Status: No, score=-6.8 required=5.0 tests=BAYES_00, DKIM_ADSP_CUSTOM_MED, DKIM_SIGNED, FREEMAIL_FROM, RCVD_IN_DNSWL_HI, T_DKIM_INVALID, T_RP_MATCHES_RCVD, UNPARSEABLE_RELAY autolearn=unavailable version=3.3.1 X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on mail.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP Add read raw data function supported for gen5 trackpad device, it can be used through debugfs raw_data interface. TEST=test on Chromebooks. Signed-off-by: Dudley Du --- drivers/input/mouse/cyapa_gen5.c | 138 +++++++++++++++++++++++++++++++++++++++ 1 file changed, 138 insertions(+) diff --git a/drivers/input/mouse/cyapa_gen5.c b/drivers/input/mouse/cyapa_gen5.c index aee3e57..52c915b 100644 --- a/drivers/input/mouse/cyapa_gen5.c +++ b/drivers/input/mouse/cyapa_gen5.c @@ -2363,6 +2363,143 @@ resume_scanning: return size; } +static int cyapa_gen5_read_electrodies_rx_tx(struct cyapa *cyapa) +{ + u8 cmd[7] = { 0x04, 0x00, 0x05, 0x00, 0x2f, 0x00, 0x71 }; + u8 resp_data[7]; + int resp_len; + int error; + + resp_len = sizeof(resp_data); + error = cyapa_i2c_pip_cmd_irq_sync(cyapa, + cmd, 7, + resp_data, &resp_len, + 150, cyapa_gen5_sort_tsg_pip_app_resp_data, true); + if (error || !VALID_CMD_RESP_HEADER(resp_data, 0x71) || + !resp_data[5] || !resp_data[6]) + return -EINVAL; + + cyapa->electrodes_rx = resp_data[6]; + + return 0; +} + +static int cyapa_gen5_read_raw_data(struct cyapa *cyapa) +{ + 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 offset; + int data_size, max, min, ave; + ktime_t time_mono; + int error, resume_error; + + offset = 0; + if (!cyapa->tp_raw_data) { + if (cyapa->state != CYAPA_STATE_GEN5_APP || + !cyapa->electrodes_x || !cyapa->electrodes_y) + return -EINVAL; + + cyapa->tp_raw_data_size = sizeof(s32) * (cyapa->electrodes_x * + cyapa->electrodes_y + cyapa->electrodes_x + + cyapa->electrodes_y) + GEN5_RAW_DATA_HEAD_SIZE; + /* + * This buffer will be hold after used until the driver is + * unloaded, the purpose of it is to improve the performace + * to avoid frequently allocate and release the buffer. + */ + cyapa->tp_raw_data = devm_kzalloc(&cyapa->client->dev, + cyapa->tp_raw_data_size, GFP_KERNEL); + if (!cyapa->tp_raw_data) + return -ENOMEM; + } + + /* + * 1. Suspend Scanning. + * + * After suspend scanning, the raw data will not be updated, + * so the time of the raw data is before scanning suspended. + */ + time_mono = ktime_get(); + error = cyapa_gen5_suspend_scanning(cyapa); + if (error) + return error; + + /* 2. Get the correct electrodes_rx number. */ + if (cyapa->electrodes_rx == 0) { + error = cyapa_gen5_read_electrodies_rx_tx(cyapa); + if (error || cyapa->electrodes_rx == 0) { + cyapa_empty_pip_output_data(cyapa, NULL, NULL, NULL); + + /* + * Since, old firmware doesn't support the command to + * read the electrodies' Rx and Tx values, so using + * the read global idac interface to get the Rx number, + * this value is useful to analyze and + * display the raw data map in userspace. + */ + data_size = 0; + error = cyapa_gen5_read_idac_data(cyapa, + GEN5_CMD_RETRIEVE_DATA_STRUCTURE, + GEN5_RETRIEVE_MUTUAL_PWC_DATA, + &data_size, &max, &min, &ave); + if (error || cyapa->electrodes_rx == 0) + goto resume_scanning; + } + } + + /* 3. Execuate panel scan. It must be executed before read data. */ + error = cyapa_gen5_execute_panel_scan(cyapa); + if (error) + goto resume_scanning; + + /* 4. Retrieve panel scan, mutual cap raw data. */ + offset = GEN5_RAW_DATA_HEAD_SIZE; + 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, + &raw_cap_mutual_max, &raw_cap_mutual_min, + &raw_cap_mutual_ave, + cyapa->tp_raw_data + offset); + if (error) + goto resume_scanning; + + offset += sizeof(s32) * cyapa->electrodes_x * cyapa->electrodes_y; + + /* 5. 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_DIFFCOUNT, + cyapa->electrodes_x + cyapa->electrodes_y, + &raw_cap_self_max, &raw_cap_self_min, + &raw_cap_self_ave, + cyapa->tp_raw_data + offset); + if (error) + goto resume_scanning; + + offset += sizeof(s32) * (cyapa->electrodes_x + cyapa->electrodes_y); + +resume_scanning: + /* 6. Resume Scanning*/ + resume_error = cyapa_gen5_resume_scanning(cyapa); + if (resume_error || error) + return resume_error ? resume_error : error; + + *((struct timeval *)&cyapa->tp_raw_data[0]) = + ktime_to_timeval(time_mono); + cyapa->tp_raw_data[16] = (u8)cyapa->electrodes_x; + cyapa->tp_raw_data[17] = (u8)cyapa->electrodes_y; + cyapa->tp_raw_data[18] = (u8)cyapa->x_origin; + cyapa->tp_raw_data[19] = (u8)cyapa->y_origin; + cyapa->tp_raw_data[20] = (u8)sizeof(s32); + cyapa->tp_raw_data[21] = (u8)sizeof(s32); + cyapa->tp_raw_data[22] = (u8)cyapa->electrodes_rx; + cyapa->tp_raw_data[23] = 0; /* Reserved. */ + + cyapa->tp_raw_data_size = offset; + return 0; +} + static bool cyapa_gen5_sort_system_info_data(struct cyapa *cyapa, u8 *buf, int len) { @@ -2776,6 +2913,7 @@ const struct cyapa_dev_ops cyapa_gen5_ops = { .calibrate_store = cyapa_gen5_do_calibrate, .read_fw = cyapa_gen5_read_fw, + .read_raw_data = cyapa_gen5_read_raw_data, .initialize = cyapa_gen5_initialize,