From patchwork Wed Aug 19 07:29:58 2015 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: John Sung X-Patchwork-Id: 7035961 X-Patchwork-Delegate: jikos@jikos.cz 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.29.136]) by patchwork2.web.kernel.org (Postfix) with ESMTP id 39EA0C05AD for ; Wed, 19 Aug 2015 07:31:22 +0000 (UTC) Received: from mail.kernel.org (localhost [127.0.0.1]) by mail.kernel.org (Postfix) with ESMTP id 4D5AB203F1 for ; Wed, 19 Aug 2015 07:31:21 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.kernel.org (Postfix) with ESMTP id 5982F20872 for ; Wed, 19 Aug 2015 07:31:20 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1753163AbbHSHar (ORCPT ); Wed, 19 Aug 2015 03:30:47 -0400 Received: from mail-pd0-f169.google.com ([209.85.192.169]:35671 "EHLO mail-pd0-f169.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1753043AbbHSHan (ORCPT ); Wed, 19 Aug 2015 03:30:43 -0400 Received: by pdob1 with SMTP id b1so22223025pdo.2; Wed, 19 Aug 2015 00:30:42 -0700 (PDT) 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=lPuEF67HVf1gz74WuFtebBYR34fd3Zds/08NfGHyBf8=; b=wmtZa5otUqfocUrWqMVX/FefmhQWOg43PhuZgoloM/fAz/I8v0q1OGXPGg6IsH3MNt 9olHQIIQk9bI6TGtzSZ1SdAZp6Y/PmwJipF+6tFD0Vz4r4qwT7zM9lSLZB/+nvVHluon Ua2uBRJAJ7+VtqeGJ6EJlmhcwuC4qAeo/wv6H4FSPHanRtHUqMml5akJzEsu7qJ0HCjW JfW2ztNkapbSbchUaCQ0P9lfagRjTO9QzGqeLCjpx44ljC7mN/afouf28DaAbLDyZWvF GdBtPEtAyKEVb/KVjildw5VT+z4+OhAQTQQxhSojwLwBU/Ixfj2ws5xI5fYstUzlEd7J tEYQ== X-Received: by 10.70.41.233 with SMTP id i9mr22154446pdl.93.1439969442824; Wed, 19 Aug 2015 00:30:42 -0700 (PDT) Received: from localhost.localdomain ([210.68.37.194]) by smtp.gmail.com with ESMTPSA id d5sm20489608pdn.74.2015.08.19.00.30.41 (version=TLSv1.1 cipher=ECDHE-RSA-RC4-SHA bits=128/128); Wed, 19 Aug 2015 00:30:42 -0700 (PDT) From: John Sung To: Dmitry Torokhov , Jiri Kosina , linux-input@vger.kernel.org, linux-kernel@vger.kernel.org Cc: penmount.touch@gmail.com Subject: [PATCH 2/3] HID: hid-penmount shows device version Date: Wed, 19 Aug 2015 15:29:58 +0800 Message-Id: <1439969399-11469-2-git-send-email-penmount.touch@gmail.com> X-Mailer: git-send-email 1.7.9.5 In-Reply-To: <1439969399-11469-1-git-send-email-penmount.touch@gmail.com> References: <1439969399-11469-1-git-send-email-penmount.touch@gmail.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=-7.3 required=5.0 tests=BAYES_00, DKIM_ADSP_CUSTOM_MED, DKIM_SIGNED, FREEMAIL_FROM, RCVD_IN_DNSWL_HI, RP_MATCHES_RCVD, T_DKIM_INVALID, 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 Let hid-penmount retrieve the device version using feature report. Signed-off-by: John Sung --- drivers/hid/hid-penmount.c | 112 ++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 112 insertions(+) diff --git a/drivers/hid/hid-penmount.c b/drivers/hid/hid-penmount.c index 68c5721..4fd14c8 100644 --- a/drivers/hid/hid-penmount.c +++ b/drivers/hid/hid-penmount.c @@ -24,6 +24,8 @@ #define PM_MAX_CONTACT 10 #define PM_DEF_CONTACT_PCI 5 #define PM_DEF_CONTACT_6000 1 +#define PM_HID_REPORT_SIZE 5 +#define PM_HID_REPORT_ID 0x00 struct mt_slot { unsigned char id; @@ -39,8 +41,117 @@ struct penmount { unsigned char maxcontacts; struct mt_slot slots[PM_MAX_CONTACT]; struct mt_slot curdata; + char version[32]; }; +static int penmount_hid_setreport(struct penmount *pm, unsigned char *cmd) +{ + + int ret = 0; + unsigned char report[PM_HID_REPORT_SIZE+1] = { PM_HID_REPORT_ID, + cmd[0], cmd[1], cmd[2], cmd[3], cmd[4] }; + + ret = hid_hw_raw_request(pm->hid, PM_HID_REPORT_ID, report, + PM_HID_REPORT_SIZE+1, HID_FEATURE_REPORT, HID_REQ_SET_REPORT); + if (ret < 0) + hid_err(pm->hid, "Failed to set feature report !\n"); + + return ret; +} + +static int penmount_hid_getreport(struct penmount *pm, unsigned char *ack) +{ + int ret = 0; + int i = 0; + unsigned char report[PM_HID_REPORT_SIZE+1] = { PM_HID_REPORT_ID, + 0, 0, 0, 0, 0 }; + + ret = hid_hw_raw_request(pm->hid, PM_HID_REPORT_ID, report, + PM_HID_REPORT_SIZE+1, HID_FEATURE_REPORT, HID_REQ_GET_REPORT); + if (ret < 0) { + hid_err(pm->hid, "Failed to get feature report !\n"); + return ret; + } + + for (i = 0; i < PM_HID_REPORT_SIZE; i++) + ack[i] = report[i+1]; + + return ret; +} + +static int penmount_get_version(struct penmount *pm) +{ + int ret = 0; + unsigned short product_version = 0; + unsigned char major_version = 0; + unsigned char minor_version = 0; + unsigned char build_version = 0; + unsigned char odm_version = 0; + unsigned char cmd[PM_HID_REPORT_SIZE] = { 0xEE, 0, 0, 0, 0 }; + unsigned char ack[PM_HID_REPORT_SIZE] = { 0, 0, 0, 0, 0 }; + + ret = penmount_hid_setreport(pm, cmd); + if (ret < 0) { + hid_warn(pm->hid, "Failed to get firmware version !"); + return ret; + } + + ret = penmount_hid_getreport(pm, ack); + if (ret < 0) { + hid_warn(pm->hid, "Failed to get firmware version !"); + return ret; + } + + switch (pm->model) { + case USB_DEVICE_ID_PENMOUNT_PCI: + product_version = (ack[2] * 256 + ack[1]) & 0x7FFF; + major_version = ack[3]; + break; + case USB_DEVICE_ID_PENMOUNT_6000: + product_version = ack[1] * 256 + ack[2]; + major_version = ack[4]; + break; + } + + cmd[0] = 0xED; + ret = penmount_hid_setreport(pm, cmd); + if (ret < 0) { + hid_warn(pm->hid, "Failed to get firmware version !"); + return ret; + } + + ret = penmount_hid_getreport(pm, ack); + if (ret < 0) { + hid_warn(pm->hid, "Failed to get firmware version !"); + return ret; + } + + switch (pm->model) { + case USB_DEVICE_ID_PENMOUNT_PCI: + minor_version = ack[1]; + odm_version = ack[2]; + build_version = ack[3]; + break; + case USB_DEVICE_ID_PENMOUNT_6000: + minor_version = ack[2]; + build_version = ack[4]; + break; + } + + if (!odm_version) { + sprintf(pm->version, "%d.%d.%d.%d", product_version, + major_version, minor_version, build_version); + } else { + sprintf(pm->version, "%d.D%02X.%d.%d.%d", product_version, + odm_version, major_version, minor_version, + build_version); + } + + hid_info(pm->hid, "Firmware version %s\n", pm->version); + + return ret; +} + static void penmount_send_event(struct penmount *pm) { int i; @@ -245,6 +356,7 @@ static int penmount_probe(struct hid_device *hdev, set_bit(INPUT_PROP_DIRECT, hidinput->input->propbit); } + penmount_get_version(pm); hid_info(hdev, "Device supports %d touch contacts !\n", pm->maxcontacts); return ret;