From patchwork Tue Jun 14 23:45:55 2011 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: David Herrmann X-Patchwork-Id: 880592 X-Patchwork-Delegate: jikos@jikos.cz Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by demeter1.kernel.org (8.14.4/8.14.4) with ESMTP id p5ENjw6R019029 for ; Tue, 14 Jun 2011 23:46:37 GMT Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1753614Ab1FNXq1 (ORCPT ); Tue, 14 Jun 2011 19:46:27 -0400 Received: from mail-fx0-f46.google.com ([209.85.161.46]:36667 "EHLO mail-fx0-f46.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1752089Ab1FNXq0 (ORCPT ); Tue, 14 Jun 2011 19:46:26 -0400 Received: by mail-fx0-f46.google.com with SMTP id 17so41764fxm.19 for ; Tue, 14 Jun 2011 16:46:26 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=googlemail.com; s=gamma; h=domainkey-signature:from:to:cc:subject:date:message-id:x-mailer :in-reply-to:references; bh=Sh3b/fmlndNxOT82fOAy0RNylQ0qBSNkzNJlgXUOrcQ=; b=cv2JyW/jnPbhLFCbXyb3A5K+zc1QpZaWJr0WGDAioKaWW73v1lf7e6gvfEcCGxs3Im mQePqv/ZPQ/+RiY5qXF9huPkPVZFPM5mbBc2IRD3g6/enKgvUcXTNOoy/oYk4gn7YyYN H7k0YYrJWNhepz6DUZKh61ypaB+/AF6V4Tf4M= DomainKey-Signature: a=rsa-sha1; c=nofws; d=googlemail.com; s=gamma; h=from:to:cc:subject:date:message-id:x-mailer:in-reply-to:references; b=Or77eD5WvVDUIeoPfZvGa9NBzQKFWm/af8bMzdyP+APygN7tQxlg6iEJTFoYg0wZBb rbMR6PRv+cGUV5LXSYVOFTvZU7xY3l/7rlKM30bjLIdcpMy9TCTgWA6uz9j1NMdm+5DW WsScuWl10w4YjWTh00IgfTUHtFd9ftvVHC7c4= Received: by 10.223.53.85 with SMTP id l21mr1919801fag.26.1308095186314; Tue, 14 Jun 2011 16:46:26 -0700 (PDT) Received: from localhost.localdomain (stgt-4d0383f8.pool.mediaWays.net [77.3.131.248]) by mx.google.com with ESMTPS id g7sm2963789fac.39.2011.06.14.16.46.25 (version=TLSv1/SSLv3 cipher=OTHER); Tue, 14 Jun 2011 16:46:25 -0700 (PDT) From: David Herrmann To: linux-input@vger.kernel.org Cc: jkosina@suse.cz, padovan@profusion.mobi, dh.herrmann@googlemail.com Subject: [RFC 10/12] HID: wiimote: Add wiimote led request Date: Wed, 15 Jun 2011 01:45:55 +0200 Message-Id: <1308095157-4699-11-git-send-email-dh.herrmann@googlemail.com> X-Mailer: git-send-email 1.7.5.2 In-Reply-To: <1308095157-4699-1-git-send-email-dh.herrmann@googlemail.com> References: <1308095157-4699-1-git-send-email-dh.herrmann@googlemail.com> Sender: linux-input-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-input@vger.kernel.org X-Greylist: IP, sender and recipient auto-whitelisted, not delayed by milter-greylist-4.2.6 (demeter1.kernel.org [140.211.167.41]); Tue, 14 Jun 2011 23:46:37 +0000 (UTC) Add new request that sets the leds on the target device. Also, per default, set led1 after initializing a device. Signed-off-by: David Herrmann --- drivers/hid/hid-wiimote.c | 26 ++++++++++++++++++++++++++ 1 files changed, 26 insertions(+), 0 deletions(-) diff --git a/drivers/hid/hid-wiimote.c b/drivers/hid/hid-wiimote.c index 4c3f5eb..fbdd7ef 100644 --- a/drivers/hid/hid-wiimote.c +++ b/drivers/hid/hid-wiimote.c @@ -39,7 +39,13 @@ struct wiimote_data { struct work_struct worker; }; +#define WIIPROTO_FLAG_LED1 0x01 +#define WIIPROTO_FLAG_LED2 0x02 +#define WIIPROTO_FLAG_LED3 0x04 +#define WIIPROTO_FLAG_LED4 0x08 + enum wiiproto_reqs { + WIIPROTO_REQ_LED = 0x11, WIIPROTO_REQ_DRM_K = 0x30, }; @@ -154,6 +160,25 @@ static void wiimote_queue(struct wiimote_data *wdata, const __u8 *buffer, spin_unlock_irqrestore(&wdata->qlock, flags); } +static void wiiproto_req_leds(struct wiimote_data *wdata, int leds) +{ + __u8 cmd[2]; + + cmd[0] = WIIPROTO_REQ_LED; + cmd[1] = 0; + + if (leds & WIIPROTO_FLAG_LED1) + cmd[1] |= 0x10; + if (leds & WIIPROTO_FLAG_LED2) + cmd[1] |= 0x20; + if (leds & WIIPROTO_FLAG_LED3) + cmd[1] |= 0x40; + if (leds & WIIPROTO_FLAG_LED4) + cmd[1] |= 0x80; + + wiimote_queue(wdata, cmd, sizeof(cmd)); +} + static int wiimote_input_event(struct input_dev *dev, unsigned int type, unsigned int code, int value) { @@ -294,6 +319,7 @@ static int wiimote_hid_probe(struct hid_device *hdev, atomic_set(&wdata->ready, 1); hid_info(hdev, "New device registered\n"); + wiiproto_req_leds(wdata, WIIPROTO_FLAG_LED1); return 0; err_stop: