forked from Minki/linux
Merge branches 'for-3.11/wacom-fixed' and 'for-3.11/wiimote' into for-linus
This commit is contained in:
commit
21796b39c9
@ -12,7 +12,7 @@ Description: Make it possible to set/get current led state. Reading from it
|
||||
What: /sys/bus/hid/drivers/wiimote/<dev>/extension
|
||||
Date: August 2011
|
||||
KernelVersion: 3.2
|
||||
Contact: David Herrmann <dh.herrmann@googlemail.com>
|
||||
Contact: David Herrmann <dh.herrmann@gmail.com>
|
||||
Description: This file contains the currently connected and initialized
|
||||
extensions. It can be one of: none, motionp, nunchuck, classic,
|
||||
motionp+nunchuck, motionp+classic
|
||||
@ -20,3 +20,40 @@ Description: This file contains the currently connected and initialized
|
||||
the official Nintendo Nunchuck extension and classic is the
|
||||
Nintendo Classic Controller extension. The motionp extension can
|
||||
be combined with the other two.
|
||||
Starting with kernel-version 3.11 Motion Plus hotplugging is
|
||||
supported and if detected, it's no longer reported as static
|
||||
extension. You will get uevent notifications for the motion-plus
|
||||
device then.
|
||||
|
||||
What: /sys/bus/hid/drivers/wiimote/<dev>/devtype
|
||||
Date: May 2013
|
||||
KernelVersion: 3.11
|
||||
Contact: David Herrmann <dh.herrmann@gmail.com>
|
||||
Description: While a device is initialized by the wiimote driver, we perform
|
||||
a device detection and signal a "change" uevent after it is
|
||||
done. This file shows the detected device type. "pending" means
|
||||
that the detection is still ongoing, "unknown" means, that the
|
||||
device couldn't be detected or loaded. "generic" means, that the
|
||||
device couldn't be detected but supports basic Wii Remote
|
||||
features and can be used.
|
||||
Other strings for each device-type are available and may be
|
||||
added if new device-specific detections are added.
|
||||
Currently supported are:
|
||||
gen10: First Wii Remote generation
|
||||
gen20: Second Wii Remote Plus generation (builtin MP)
|
||||
balanceboard: Wii Balance Board
|
||||
|
||||
What: /sys/bus/hid/drivers/wiimote/<dev>/bboard_calib
|
||||
Date: May 2013
|
||||
KernelVersion: 3.11
|
||||
Contact: David Herrmann <dh.herrmann@gmail.com>
|
||||
Description: This attribute is only provided if the device was detected as a
|
||||
balance board. It provides a single line with 3 calibration
|
||||
values for all 4 sensors. The values are separated by colons and
|
||||
are each 2 bytes long (encoded as 4 digit hexadecimal value).
|
||||
First, 0kg values for all 4 sensors are written, followed by the
|
||||
17kg values for all 4 sensors and last the 34kg values for all 4
|
||||
sensors.
|
||||
Calibration data is already applied by the kernel to all input
|
||||
values but may be used by user-space to perform other
|
||||
transformations.
|
||||
|
@ -719,22 +719,29 @@ config HID_WACOM
|
||||
Support for Wacom Graphire Bluetooth and Intuos4 WL tablets.
|
||||
|
||||
config HID_WIIMOTE
|
||||
tristate "Nintendo Wii Remote support"
|
||||
tristate "Nintendo Wii / Wii U peripherals"
|
||||
depends on HID
|
||||
depends on LEDS_CLASS
|
||||
select POWER_SUPPLY
|
||||
select INPUT_FF_MEMLESS
|
||||
---help---
|
||||
Support for the Nintendo Wii Remote bluetooth device.
|
||||
Support for Nintendo Wii and Wii U Bluetooth peripherals. Supported
|
||||
devices are the Wii Remote and its extension devices, but also devices
|
||||
based on the Wii Remote like the Wii U Pro Controller or the
|
||||
Wii Balance Board.
|
||||
|
||||
config HID_WIIMOTE_EXT
|
||||
bool "Nintendo Wii Remote Extension support"
|
||||
depends on HID_WIIMOTE
|
||||
default HID_WIIMOTE
|
||||
---help---
|
||||
Support for extension controllers of the Nintendo Wii Remote. Say yes
|
||||
here if you want to use the Nintendo Motion+, Nunchuck or Classic
|
||||
extension controllers with your Wii Remote.
|
||||
Support for all official Nintendo extensions is available, however, 3rd
|
||||
party extensions might not be supported. Please report these devices to:
|
||||
http://github.com/dvdhrm/xwiimote/issues
|
||||
|
||||
Other Nintendo Wii U peripherals that are IEEE 802.11 based (including
|
||||
the Wii U Gamepad) might be supported in the future. But currently
|
||||
support is limited to Bluetooth based devices.
|
||||
|
||||
If unsure, say N.
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called hid-wiimote.
|
||||
|
||||
config HID_ZEROPLUS
|
||||
tristate "Zeroplus based game controller support"
|
||||
|
@ -28,10 +28,7 @@ ifdef CONFIG_LOGIWHEELS_FF
|
||||
hid-logitech-y += hid-lg4ff.o
|
||||
endif
|
||||
|
||||
hid-wiimote-y := hid-wiimote-core.o
|
||||
ifdef CONFIG_HID_WIIMOTE_EXT
|
||||
hid-wiimote-y += hid-wiimote-ext.o
|
||||
endif
|
||||
hid-wiimote-y := hid-wiimote-core.o hid-wiimote-modules.o
|
||||
ifdef CONFIG_DEBUG_FS
|
||||
hid-wiimote-y += hid-wiimote-debug.o
|
||||
endif
|
||||
|
@ -46,6 +46,7 @@ struct wacom_data {
|
||||
__u8 battery_capacity;
|
||||
__u8 power_raw;
|
||||
__u8 ps_connected;
|
||||
__u8 bat_charging;
|
||||
struct power_supply battery;
|
||||
struct power_supply ac;
|
||||
__u8 led_selector;
|
||||
@ -62,6 +63,7 @@ static enum power_supply_property wacom_battery_props[] = {
|
||||
POWER_SUPPLY_PROP_PRESENT,
|
||||
POWER_SUPPLY_PROP_CAPACITY,
|
||||
POWER_SUPPLY_PROP_SCOPE,
|
||||
POWER_SUPPLY_PROP_STATUS,
|
||||
};
|
||||
|
||||
static enum power_supply_property wacom_ac_props[] = {
|
||||
@ -287,6 +289,15 @@ static int wacom_battery_get_property(struct power_supply *psy,
|
||||
case POWER_SUPPLY_PROP_CAPACITY:
|
||||
val->intval = wdata->battery_capacity;
|
||||
break;
|
||||
case POWER_SUPPLY_PROP_STATUS:
|
||||
if (wdata->bat_charging)
|
||||
val->intval = POWER_SUPPLY_STATUS_CHARGING;
|
||||
else
|
||||
if (wdata->battery_capacity == 100 && wdata->ps_connected)
|
||||
val->intval = POWER_SUPPLY_STATUS_FULL;
|
||||
else
|
||||
val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
|
||||
break;
|
||||
default:
|
||||
ret = -EINVAL;
|
||||
break;
|
||||
@ -727,7 +738,8 @@ static int wacom_raw_event(struct hid_device *hdev, struct hid_report *report,
|
||||
if (power_raw != wdata->power_raw) {
|
||||
wdata->power_raw = power_raw;
|
||||
wdata->battery_capacity = batcap_i4[power_raw & 0x07];
|
||||
wdata->ps_connected = power_raw & 0x08;
|
||||
wdata->bat_charging = (power_raw & 0x08) ? 1 : 0;
|
||||
wdata->ps_connected = (power_raw & 0x10) ? 1 : 0;
|
||||
}
|
||||
|
||||
break;
|
||||
|
File diff suppressed because it is too large
Load Diff
@ -1,6 +1,6 @@
|
||||
/*
|
||||
* Debug support for HID Nintendo Wiimote devices
|
||||
* Copyright (c) 2011 David Herrmann
|
||||
* Debug support for HID Nintendo Wii / Wii U peripherals
|
||||
* Copyright (c) 2011-2013 David Herrmann <dh.herrmann@gmail.com>
|
||||
*/
|
||||
|
||||
/*
|
||||
@ -127,7 +127,8 @@ static int wiidebug_drm_open(struct inode *i, struct file *f)
|
||||
static ssize_t wiidebug_drm_write(struct file *f, const char __user *u,
|
||||
size_t s, loff_t *off)
|
||||
{
|
||||
struct wiimote_debug *dbg = f->private_data;
|
||||
struct seq_file *sf = f->private_data;
|
||||
struct wiimote_debug *dbg = sf->private;
|
||||
unsigned long flags;
|
||||
char buf[16];
|
||||
ssize_t len;
|
||||
@ -140,7 +141,7 @@ static ssize_t wiidebug_drm_write(struct file *f, const char __user *u,
|
||||
if (copy_from_user(buf, u, len))
|
||||
return -EFAULT;
|
||||
|
||||
buf[15] = 0;
|
||||
buf[len] = 0;
|
||||
|
||||
for (i = 0; i < WIIPROTO_REQ_MAX; ++i) {
|
||||
if (!wiidebug_drmmap[i])
|
||||
@ -150,10 +151,13 @@ static ssize_t wiidebug_drm_write(struct file *f, const char __user *u,
|
||||
}
|
||||
|
||||
if (i == WIIPROTO_REQ_MAX)
|
||||
i = simple_strtoul(buf, NULL, 10);
|
||||
i = simple_strtoul(buf, NULL, 16);
|
||||
|
||||
spin_lock_irqsave(&dbg->wdata->state.lock, flags);
|
||||
dbg->wdata->state.flags &= ~WIIPROTO_FLAG_DRM_LOCKED;
|
||||
wiiproto_req_drm(dbg->wdata, (__u8) i);
|
||||
if (i != WIIPROTO_REQ_NULL)
|
||||
dbg->wdata->state.flags |= WIIPROTO_FLAG_DRM_LOCKED;
|
||||
spin_unlock_irqrestore(&dbg->wdata->state.lock, flags);
|
||||
|
||||
return len;
|
||||
|
@ -1,849 +0,0 @@
|
||||
/*
|
||||
* HID driver for Nintendo Wiimote extension devices
|
||||
* Copyright (c) 2011 David Herrmann
|
||||
*/
|
||||
|
||||
/*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the Free
|
||||
* Software Foundation; either version 2 of the License, or (at your option)
|
||||
* any later version.
|
||||
*/
|
||||
|
||||
#include <linux/atomic.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/spinlock.h>
|
||||
#include <linux/workqueue.h>
|
||||
#include "hid-wiimote.h"
|
||||
|
||||
struct wiimote_ext {
|
||||
struct wiimote_data *wdata;
|
||||
struct work_struct worker;
|
||||
struct input_dev *input;
|
||||
struct input_dev *mp_input;
|
||||
|
||||
atomic_t opened;
|
||||
atomic_t mp_opened;
|
||||
bool plugged;
|
||||
bool mp_plugged;
|
||||
bool motionp;
|
||||
__u8 ext_type;
|
||||
__u16 calib[4][3];
|
||||
};
|
||||
|
||||
enum wiiext_type {
|
||||
WIIEXT_NONE, /* placeholder */
|
||||
WIIEXT_CLASSIC, /* Nintendo classic controller */
|
||||
WIIEXT_NUNCHUCK, /* Nintendo nunchuck controller */
|
||||
WIIEXT_BALANCE_BOARD, /* Nintendo balance board controller */
|
||||
};
|
||||
|
||||
enum wiiext_keys {
|
||||
WIIEXT_KEY_C,
|
||||
WIIEXT_KEY_Z,
|
||||
WIIEXT_KEY_A,
|
||||
WIIEXT_KEY_B,
|
||||
WIIEXT_KEY_X,
|
||||
WIIEXT_KEY_Y,
|
||||
WIIEXT_KEY_ZL,
|
||||
WIIEXT_KEY_ZR,
|
||||
WIIEXT_KEY_PLUS,
|
||||
WIIEXT_KEY_MINUS,
|
||||
WIIEXT_KEY_HOME,
|
||||
WIIEXT_KEY_LEFT,
|
||||
WIIEXT_KEY_RIGHT,
|
||||
WIIEXT_KEY_UP,
|
||||
WIIEXT_KEY_DOWN,
|
||||
WIIEXT_KEY_LT,
|
||||
WIIEXT_KEY_RT,
|
||||
WIIEXT_KEY_COUNT
|
||||
};
|
||||
|
||||
static __u16 wiiext_keymap[] = {
|
||||
BTN_C, /* WIIEXT_KEY_C */
|
||||
BTN_Z, /* WIIEXT_KEY_Z */
|
||||
BTN_A, /* WIIEXT_KEY_A */
|
||||
BTN_B, /* WIIEXT_KEY_B */
|
||||
BTN_X, /* WIIEXT_KEY_X */
|
||||
BTN_Y, /* WIIEXT_KEY_Y */
|
||||
BTN_TL2, /* WIIEXT_KEY_ZL */
|
||||
BTN_TR2, /* WIIEXT_KEY_ZR */
|
||||
KEY_NEXT, /* WIIEXT_KEY_PLUS */
|
||||
KEY_PREVIOUS, /* WIIEXT_KEY_MINUS */
|
||||
BTN_MODE, /* WIIEXT_KEY_HOME */
|
||||
KEY_LEFT, /* WIIEXT_KEY_LEFT */
|
||||
KEY_RIGHT, /* WIIEXT_KEY_RIGHT */
|
||||
KEY_UP, /* WIIEXT_KEY_UP */
|
||||
KEY_DOWN, /* WIIEXT_KEY_DOWN */
|
||||
BTN_TL, /* WIIEXT_KEY_LT */
|
||||
BTN_TR, /* WIIEXT_KEY_RT */
|
||||
};
|
||||
|
||||
/* disable all extensions */
|
||||
static void ext_disable(struct wiimote_ext *ext)
|
||||
{
|
||||
unsigned long flags;
|
||||
__u8 wmem = 0x55;
|
||||
|
||||
if (!wiimote_cmd_acquire(ext->wdata)) {
|
||||
wiimote_cmd_write(ext->wdata, 0xa400f0, &wmem, sizeof(wmem));
|
||||
wiimote_cmd_release(ext->wdata);
|
||||
}
|
||||
|
||||
spin_lock_irqsave(&ext->wdata->state.lock, flags);
|
||||
ext->motionp = false;
|
||||
ext->ext_type = WIIEXT_NONE;
|
||||
wiiproto_req_drm(ext->wdata, WIIPROTO_REQ_NULL);
|
||||
spin_unlock_irqrestore(&ext->wdata->state.lock, flags);
|
||||
}
|
||||
|
||||
static bool motionp_read(struct wiimote_ext *ext)
|
||||
{
|
||||
__u8 rmem[2], wmem;
|
||||
ssize_t ret;
|
||||
bool avail = false;
|
||||
|
||||
if (!atomic_read(&ext->mp_opened))
|
||||
return false;
|
||||
|
||||
if (wiimote_cmd_acquire(ext->wdata))
|
||||
return false;
|
||||
|
||||
/* initialize motion plus */
|
||||
wmem = 0x55;
|
||||
ret = wiimote_cmd_write(ext->wdata, 0xa600f0, &wmem, sizeof(wmem));
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
/* read motion plus ID */
|
||||
ret = wiimote_cmd_read(ext->wdata, 0xa600fe, rmem, 2);
|
||||
if (ret == 2 || rmem[1] == 0x5)
|
||||
avail = true;
|
||||
|
||||
error:
|
||||
wiimote_cmd_release(ext->wdata);
|
||||
return avail;
|
||||
}
|
||||
|
||||
static __u8 ext_read(struct wiimote_ext *ext)
|
||||
{
|
||||
ssize_t ret;
|
||||
__u8 buf[24], i, j, offs = 0;
|
||||
__u8 rmem[2], wmem;
|
||||
__u8 type = WIIEXT_NONE;
|
||||
|
||||
if (!ext->plugged || !atomic_read(&ext->opened))
|
||||
return WIIEXT_NONE;
|
||||
|
||||
if (wiimote_cmd_acquire(ext->wdata))
|
||||
return WIIEXT_NONE;
|
||||
|
||||
/* initialize extension */
|
||||
wmem = 0x55;
|
||||
ret = wiimote_cmd_write(ext->wdata, 0xa400f0, &wmem, sizeof(wmem));
|
||||
if (!ret) {
|
||||
/* disable encryption */
|
||||
wmem = 0x0;
|
||||
wiimote_cmd_write(ext->wdata, 0xa400fb, &wmem, sizeof(wmem));
|
||||
}
|
||||
|
||||
/* read extension ID */
|
||||
ret = wiimote_cmd_read(ext->wdata, 0xa400fe, rmem, 2);
|
||||
if (ret == 2) {
|
||||
if (rmem[0] == 0 && rmem[1] == 0)
|
||||
type = WIIEXT_NUNCHUCK;
|
||||
else if (rmem[0] == 0x01 && rmem[1] == 0x01)
|
||||
type = WIIEXT_CLASSIC;
|
||||
else if (rmem[0] == 0x04 && rmem[1] == 0x02)
|
||||
type = WIIEXT_BALANCE_BOARD;
|
||||
}
|
||||
|
||||
/* get balance board calibration data */
|
||||
if (type == WIIEXT_BALANCE_BOARD) {
|
||||
ret = wiimote_cmd_read(ext->wdata, 0xa40024, buf, 12);
|
||||
ret += wiimote_cmd_read(ext->wdata, 0xa40024 + 12,
|
||||
buf + 12, 12);
|
||||
|
||||
if (ret != 24) {
|
||||
type = WIIEXT_NONE;
|
||||
} else {
|
||||
for (i = 0; i < 3; i++) {
|
||||
for (j = 0; j < 4; j++) {
|
||||
ext->calib[j][i] = buf[offs];
|
||||
ext->calib[j][i] <<= 8;
|
||||
ext->calib[j][i] |= buf[offs + 1];
|
||||
offs += 2;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
wiimote_cmd_release(ext->wdata);
|
||||
|
||||
return type;
|
||||
}
|
||||
|
||||
static void ext_enable(struct wiimote_ext *ext, bool motionp, __u8 ext_type)
|
||||
{
|
||||
unsigned long flags;
|
||||
__u8 wmem;
|
||||
int ret;
|
||||
|
||||
if (motionp) {
|
||||
if (wiimote_cmd_acquire(ext->wdata))
|
||||
return;
|
||||
|
||||
if (ext_type == WIIEXT_CLASSIC)
|
||||
wmem = 0x07;
|
||||
else if (ext_type == WIIEXT_NUNCHUCK)
|
||||
wmem = 0x05;
|
||||
else
|
||||
wmem = 0x04;
|
||||
|
||||
ret = wiimote_cmd_write(ext->wdata, 0xa600fe, &wmem, sizeof(wmem));
|
||||
wiimote_cmd_release(ext->wdata);
|
||||
if (ret)
|
||||
return;
|
||||
}
|
||||
|
||||
spin_lock_irqsave(&ext->wdata->state.lock, flags);
|
||||
ext->motionp = motionp;
|
||||
ext->ext_type = ext_type;
|
||||
wiiproto_req_drm(ext->wdata, WIIPROTO_REQ_NULL);
|
||||
spin_unlock_irqrestore(&ext->wdata->state.lock, flags);
|
||||
}
|
||||
|
||||
static void wiiext_worker(struct work_struct *work)
|
||||
{
|
||||
struct wiimote_ext *ext = container_of(work, struct wiimote_ext,
|
||||
worker);
|
||||
bool motionp;
|
||||
__u8 ext_type;
|
||||
|
||||
ext_disable(ext);
|
||||
motionp = motionp_read(ext);
|
||||
ext_type = ext_read(ext);
|
||||
ext_enable(ext, motionp, ext_type);
|
||||
}
|
||||
|
||||
/* schedule work only once, otherwise mark for reschedule */
|
||||
static void wiiext_schedule(struct wiimote_ext *ext)
|
||||
{
|
||||
schedule_work(&ext->worker);
|
||||
}
|
||||
|
||||
/*
|
||||
* Reacts on extension port events
|
||||
* Whenever the driver gets an event from the wiimote that an extension has been
|
||||
* plugged or unplugged, this funtion shall be called. It checks what extensions
|
||||
* are connected and initializes and activates them.
|
||||
* This can be called in atomic context. The initialization is done in a
|
||||
* separate worker thread. The state.lock spinlock must be held by the caller.
|
||||
*/
|
||||
void wiiext_event(struct wiimote_data *wdata, bool plugged)
|
||||
{
|
||||
if (!wdata->ext)
|
||||
return;
|
||||
|
||||
if (wdata->ext->plugged == plugged)
|
||||
return;
|
||||
|
||||
wdata->ext->plugged = plugged;
|
||||
|
||||
if (!plugged)
|
||||
wdata->ext->mp_plugged = false;
|
||||
|
||||
/*
|
||||
* We need to call wiiext_schedule(wdata->ext) here, however, the
|
||||
* extension initialization logic is not fully understood and so
|
||||
* automatic initialization is not supported, yet.
|
||||
*/
|
||||
}
|
||||
|
||||
/*
|
||||
* Returns true if the current DRM mode should contain extension data and false
|
||||
* if there is no interest in extension data.
|
||||
* All supported extensions send 6 byte extension data so any DRM that contains
|
||||
* extension bytes is fine.
|
||||
* The caller must hold the state.lock spinlock.
|
||||
*/
|
||||
bool wiiext_active(struct wiimote_data *wdata)
|
||||
{
|
||||
if (!wdata->ext)
|
||||
return false;
|
||||
|
||||
return wdata->ext->motionp || wdata->ext->ext_type;
|
||||
}
|
||||
|
||||
static void handler_motionp(struct wiimote_ext *ext, const __u8 *payload)
|
||||
{
|
||||
__s32 x, y, z;
|
||||
bool plugged;
|
||||
|
||||
/* | 8 7 6 5 4 3 | 2 | 1 |
|
||||
* -----+------------------------------+-----+-----+
|
||||
* 1 | Yaw Speed <7:0> |
|
||||
* 2 | Roll Speed <7:0> |
|
||||
* 3 | Pitch Speed <7:0> |
|
||||
* -----+------------------------------+-----+-----+
|
||||
* 4 | Yaw Speed <13:8> | Yaw |Pitch|
|
||||
* -----+------------------------------+-----+-----+
|
||||
* 5 | Roll Speed <13:8> |Roll | Ext |
|
||||
* -----+------------------------------+-----+-----+
|
||||
* 6 | Pitch Speed <13:8> | 1 | 0 |
|
||||
* -----+------------------------------+-----+-----+
|
||||
* The single bits Yaw, Roll, Pitch in the lower right corner specify
|
||||
* whether the wiimote is rotating fast (0) or slow (1). Speed for slow
|
||||
* roation is 440 deg/s and for fast rotation 2000 deg/s. To get a
|
||||
* linear scale we multiply by 2000/440 = ~4.5454 which is 18 for fast
|
||||
* and 9 for slow.
|
||||
* If the wiimote is not rotating the sensor reports 2^13 = 8192.
|
||||
* Ext specifies whether an extension is connected to the motionp.
|
||||
*/
|
||||
|
||||
x = payload[0];
|
||||
y = payload[1];
|
||||
z = payload[2];
|
||||
|
||||
x |= (((__u16)payload[3]) << 6) & 0xff00;
|
||||
y |= (((__u16)payload[4]) << 6) & 0xff00;
|
||||
z |= (((__u16)payload[5]) << 6) & 0xff00;
|
||||
|
||||
x -= 8192;
|
||||
y -= 8192;
|
||||
z -= 8192;
|
||||
|
||||
if (!(payload[3] & 0x02))
|
||||
x *= 18;
|
||||
else
|
||||
x *= 9;
|
||||
if (!(payload[4] & 0x02))
|
||||
y *= 18;
|
||||
else
|
||||
y *= 9;
|
||||
if (!(payload[3] & 0x01))
|
||||
z *= 18;
|
||||
else
|
||||
z *= 9;
|
||||
|
||||
input_report_abs(ext->mp_input, ABS_RX, x);
|
||||
input_report_abs(ext->mp_input, ABS_RY, y);
|
||||
input_report_abs(ext->mp_input, ABS_RZ, z);
|
||||
input_sync(ext->mp_input);
|
||||
|
||||
plugged = payload[5] & 0x01;
|
||||
if (plugged != ext->mp_plugged)
|
||||
ext->mp_plugged = plugged;
|
||||
}
|
||||
|
||||
static void handler_nunchuck(struct wiimote_ext *ext, const __u8 *payload)
|
||||
{
|
||||
__s16 x, y, z, bx, by;
|
||||
|
||||
/* Byte | 8 7 | 6 5 | 4 3 | 2 | 1 |
|
||||
* -----+----------+---------+---------+----+-----+
|
||||
* 1 | Button X <7:0> |
|
||||
* 2 | Button Y <7:0> |
|
||||
* -----+----------+---------+---------+----+-----+
|
||||
* 3 | Speed X <9:2> |
|
||||
* 4 | Speed Y <9:2> |
|
||||
* 5 | Speed Z <9:2> |
|
||||
* -----+----------+---------+---------+----+-----+
|
||||
* 6 | Z <1:0> | Y <1:0> | X <1:0> | BC | BZ |
|
||||
* -----+----------+---------+---------+----+-----+
|
||||
* Button X/Y is the analog stick. Speed X, Y and Z are the
|
||||
* accelerometer data in the same format as the wiimote's accelerometer.
|
||||
* The 6th byte contains the LSBs of the accelerometer data.
|
||||
* BC and BZ are the C and Z buttons: 0 means pressed
|
||||
*
|
||||
* If reported interleaved with motionp, then the layout changes. The
|
||||
* 5th and 6th byte changes to:
|
||||
* -----+-----------------------------------+-----+
|
||||
* 5 | Speed Z <9:3> | EXT |
|
||||
* -----+--------+-----+-----+----+----+----+-----+
|
||||
* 6 |Z <2:1> |Y <1>|X <1>| BC | BZ | 0 | 0 |
|
||||
* -----+--------+-----+-----+----+----+----+-----+
|
||||
* All three accelerometer values lose their LSB. The other data is
|
||||
* still available but slightly moved.
|
||||
*
|
||||
* Center data for button values is 128. Center value for accelerometer
|
||||
* values it 512 / 0x200
|
||||
*/
|
||||
|
||||
bx = payload[0];
|
||||
by = payload[1];
|
||||
bx -= 128;
|
||||
by -= 128;
|
||||
|
||||
x = payload[2] << 2;
|
||||
y = payload[3] << 2;
|
||||
z = payload[4] << 2;
|
||||
|
||||
if (ext->motionp) {
|
||||
x |= (payload[5] >> 3) & 0x02;
|
||||
y |= (payload[5] >> 4) & 0x02;
|
||||
z &= ~0x4;
|
||||
z |= (payload[5] >> 5) & 0x06;
|
||||
} else {
|
||||
x |= (payload[5] >> 2) & 0x03;
|
||||
y |= (payload[5] >> 4) & 0x03;
|
||||
z |= (payload[5] >> 6) & 0x03;
|
||||
}
|
||||
|
||||
x -= 0x200;
|
||||
y -= 0x200;
|
||||
z -= 0x200;
|
||||
|
||||
input_report_abs(ext->input, ABS_HAT0X, bx);
|
||||
input_report_abs(ext->input, ABS_HAT0Y, by);
|
||||
|
||||
input_report_abs(ext->input, ABS_RX, x);
|
||||
input_report_abs(ext->input, ABS_RY, y);
|
||||
input_report_abs(ext->input, ABS_RZ, z);
|
||||
|
||||
if (ext->motionp) {
|
||||
input_report_key(ext->input,
|
||||
wiiext_keymap[WIIEXT_KEY_Z], !(payload[5] & 0x04));
|
||||
input_report_key(ext->input,
|
||||
wiiext_keymap[WIIEXT_KEY_C], !(payload[5] & 0x08));
|
||||
} else {
|
||||
input_report_key(ext->input,
|
||||
wiiext_keymap[WIIEXT_KEY_Z], !(payload[5] & 0x01));
|
||||
input_report_key(ext->input,
|
||||
wiiext_keymap[WIIEXT_KEY_C], !(payload[5] & 0x02));
|
||||
}
|
||||
|
||||
input_sync(ext->input);
|
||||
}
|
||||
|
||||
static void handler_classic(struct wiimote_ext *ext, const __u8 *payload)
|
||||
{
|
||||
__s8 rx, ry, lx, ly, lt, rt;
|
||||
|
||||
/* Byte | 8 | 7 | 6 | 5 | 4 | 3 | 2 | 1 |
|
||||
* -----+-----+-----+-----+-----+-----+-----+-----+-----+
|
||||
* 1 | RX <5:4> | LX <5:0> |
|
||||
* 2 | RX <3:2> | LY <5:0> |
|
||||
* -----+-----+-----+-----+-----------------------------+
|
||||
* 3 |RX<1>| LT <5:4> | RY <5:1> |
|
||||
* -----+-----+-----------+-----------------------------+
|
||||
* 4 | LT <3:1> | RT <5:1> |
|
||||
* -----+-----+-----+-----+-----+-----+-----+-----+-----+
|
||||
* 5 | BDR | BDD | BLT | B- | BH | B+ | BRT | 1 |
|
||||
* -----+-----+-----+-----+-----+-----+-----+-----+-----+
|
||||
* 6 | BZL | BB | BY | BA | BX | BZR | BDL | BDU |
|
||||
* -----+-----+-----+-----+-----+-----+-----+-----+-----+
|
||||
* All buttons are 0 if pressed
|
||||
* RX and RY are right analog stick
|
||||
* LX and LY are left analog stick
|
||||
* LT is left trigger, RT is right trigger
|
||||
* BLT is 0 if left trigger is fully pressed
|
||||
* BRT is 0 if right trigger is fully pressed
|
||||
* BDR, BDD, BDL, BDU form the D-Pad with right, down, left, up buttons
|
||||
* BZL is left Z button and BZR is right Z button
|
||||
* B-, BH, B+ are +, HOME and - buttons
|
||||
* BB, BY, BA, BX are A, B, X, Y buttons
|
||||
* LSB of RX, RY, LT, and RT are not transmitted and always 0.
|
||||
*
|
||||
* With motionp enabled it changes slightly to this:
|
||||
* Byte | 8 | 7 | 6 | 5 | 4 | 3 | 2 | 1 |
|
||||
* -----+-----+-----+-----+-----+-----+-----+-----+-----+
|
||||
* 1 | RX <4:3> | LX <5:1> | BDU |
|
||||
* 2 | RX <2:1> | LY <5:1> | BDL |
|
||||
* -----+-----+-----+-----+-----------------------+-----+
|
||||
* 3 |RX<0>| LT <4:3> | RY <4:0> |
|
||||
* -----+-----+-----------+-----------------------------+
|
||||
* 4 | LT <2:0> | RT <4:0> |
|
||||
* -----+-----+-----+-----+-----+-----+-----+-----+-----+
|
||||
* 5 | BDR | BDD | BLT | B- | BH | B+ | BRT | EXT |
|
||||
* -----+-----+-----+-----+-----+-----+-----+-----+-----+
|
||||
* 6 | BZL | BB | BY | BA | BX | BZR | 0 | 0 |
|
||||
* -----+-----+-----+-----+-----+-----+-----+-----+-----+
|
||||
* Only the LSBs of LX and LY are lost. BDU and BDL are moved, the rest
|
||||
* is the same as before.
|
||||
*/
|
||||
|
||||
if (ext->motionp) {
|
||||
lx = payload[0] & 0x3e;
|
||||
ly = payload[0] & 0x3e;
|
||||
} else {
|
||||
lx = payload[0] & 0x3f;
|
||||
ly = payload[0] & 0x3f;
|
||||
}
|
||||
|
||||
rx = (payload[0] >> 3) & 0x14;
|
||||
rx |= (payload[1] >> 5) & 0x06;
|
||||
rx |= (payload[2] >> 7) & 0x01;
|
||||
ry = payload[2] & 0x1f;
|
||||
|
||||
rt = payload[3] & 0x1f;
|
||||
lt = (payload[2] >> 2) & 0x18;
|
||||
lt |= (payload[3] >> 5) & 0x07;
|
||||
|
||||
rx <<= 1;
|
||||
ry <<= 1;
|
||||
rt <<= 1;
|
||||
lt <<= 1;
|
||||
|
||||
input_report_abs(ext->input, ABS_HAT1X, lx - 0x20);
|
||||
input_report_abs(ext->input, ABS_HAT1Y, ly - 0x20);
|
||||
input_report_abs(ext->input, ABS_HAT2X, rx - 0x20);
|
||||
input_report_abs(ext->input, ABS_HAT2Y, ry - 0x20);
|
||||
input_report_abs(ext->input, ABS_HAT3X, rt - 0x20);
|
||||
input_report_abs(ext->input, ABS_HAT3Y, lt - 0x20);
|
||||
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_RIGHT],
|
||||
!!(payload[4] & 0x80));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_DOWN],
|
||||
!!(payload[4] & 0x40));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_LT],
|
||||
!!(payload[4] & 0x20));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_MINUS],
|
||||
!!(payload[4] & 0x10));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_HOME],
|
||||
!!(payload[4] & 0x08));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_PLUS],
|
||||
!!(payload[4] & 0x04));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_RT],
|
||||
!!(payload[4] & 0x02));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_ZL],
|
||||
!!(payload[5] & 0x80));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_B],
|
||||
!!(payload[5] & 0x40));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_Y],
|
||||
!!(payload[5] & 0x20));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_A],
|
||||
!!(payload[5] & 0x10));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_X],
|
||||
!!(payload[5] & 0x08));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_ZR],
|
||||
!!(payload[5] & 0x04));
|
||||
|
||||
if (ext->motionp) {
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_UP],
|
||||
!!(payload[0] & 0x01));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_LEFT],
|
||||
!!(payload[1] & 0x01));
|
||||
} else {
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_UP],
|
||||
!!(payload[5] & 0x01));
|
||||
input_report_key(ext->input, wiiext_keymap[WIIEXT_KEY_LEFT],
|
||||
!!(payload[5] & 0x02));
|
||||
}
|
||||
|
||||
input_sync(ext->input);
|
||||
}
|
||||
|
||||
static void handler_balance_board(struct wiimote_ext *ext, const __u8 *payload)
|
||||
{
|
||||
__s32 val[4], tmp;
|
||||
unsigned int i;
|
||||
|
||||
/* Byte | 8 7 6 5 4 3 2 1 |
|
||||
* -----+--------------------------+
|
||||
* 1 | Top Right <15:8> |
|
||||
* 2 | Top Right <7:0> |
|
||||
* -----+--------------------------+
|
||||
* 3 | Bottom Right <15:8> |
|
||||
* 4 | Bottom Right <7:0> |
|
||||
* -----+--------------------------+
|
||||
* 5 | Top Left <15:8> |
|
||||
* 6 | Top Left <7:0> |
|
||||
* -----+--------------------------+
|
||||
* 7 | Bottom Left <15:8> |
|
||||
* 8 | Bottom Left <7:0> |
|
||||
* -----+--------------------------+
|
||||
*
|
||||
* These values represent the weight-measurements of the Wii-balance
|
||||
* board with 16bit precision.
|
||||
*
|
||||
* The balance-board is never reported interleaved with motionp.
|
||||
*/
|
||||
|
||||
val[0] = payload[0];
|
||||
val[0] <<= 8;
|
||||
val[0] |= payload[1];
|
||||
|
||||
val[1] = payload[2];
|
||||
val[1] <<= 8;
|
||||
val[1] |= payload[3];
|
||||
|
||||
val[2] = payload[4];
|
||||
val[2] <<= 8;
|
||||
val[2] |= payload[5];
|
||||
|
||||
val[3] = payload[6];
|
||||
val[3] <<= 8;
|
||||
val[3] |= payload[7];
|
||||
|
||||
/* apply calibration data */
|
||||
for (i = 0; i < 4; i++) {
|
||||
if (val[i] < ext->calib[i][1]) {
|
||||
tmp = val[i] - ext->calib[i][0];
|
||||
tmp *= 1700;
|
||||
tmp /= ext->calib[i][1] - ext->calib[i][0];
|
||||
} else {
|
||||
tmp = val[i] - ext->calib[i][1];
|
||||
tmp *= 1700;
|
||||
tmp /= ext->calib[i][2] - ext->calib[i][1];
|
||||
tmp += 1700;
|
||||
}
|
||||
val[i] = tmp;
|
||||
}
|
||||
|
||||
input_report_abs(ext->input, ABS_HAT0X, val[0]);
|
||||
input_report_abs(ext->input, ABS_HAT0Y, val[1]);
|
||||
input_report_abs(ext->input, ABS_HAT1X, val[2]);
|
||||
input_report_abs(ext->input, ABS_HAT1Y, val[3]);
|
||||
|
||||
input_sync(ext->input);
|
||||
}
|
||||
|
||||
/* call this with state.lock spinlock held */
|
||||
void wiiext_handle(struct wiimote_data *wdata, const __u8 *payload)
|
||||
{
|
||||
struct wiimote_ext *ext = wdata->ext;
|
||||
|
||||
if (!ext)
|
||||
return;
|
||||
|
||||
if (ext->motionp && (payload[5] & 0x02)) {
|
||||
handler_motionp(ext, payload);
|
||||
} else if (ext->ext_type == WIIEXT_NUNCHUCK) {
|
||||
handler_nunchuck(ext, payload);
|
||||
} else if (ext->ext_type == WIIEXT_CLASSIC) {
|
||||
handler_classic(ext, payload);
|
||||
} else if (ext->ext_type == WIIEXT_BALANCE_BOARD) {
|
||||
handler_balance_board(ext, payload);
|
||||
}
|
||||
}
|
||||
|
||||
static ssize_t wiiext_show(struct device *dev, struct device_attribute *attr,
|
||||
char *buf)
|
||||
{
|
||||
struct wiimote_data *wdata = dev_to_wii(dev);
|
||||
__u8 type = WIIEXT_NONE;
|
||||
bool motionp = false;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&wdata->state.lock, flags);
|
||||
if (wdata->ext) {
|
||||
motionp = wdata->ext->motionp;
|
||||
type = wdata->ext->ext_type;
|
||||
}
|
||||
spin_unlock_irqrestore(&wdata->state.lock, flags);
|
||||
|
||||
if (type == WIIEXT_NUNCHUCK) {
|
||||
if (motionp)
|
||||
return sprintf(buf, "motionp+nunchuck\n");
|
||||
else
|
||||
return sprintf(buf, "nunchuck\n");
|
||||
} else if (type == WIIEXT_CLASSIC) {
|
||||
if (motionp)
|
||||
return sprintf(buf, "motionp+classic\n");
|
||||
else
|
||||
return sprintf(buf, "classic\n");
|
||||
} else if (type == WIIEXT_BALANCE_BOARD) {
|
||||
if (motionp)
|
||||
return sprintf(buf, "motionp+balanceboard\n");
|
||||
else
|
||||
return sprintf(buf, "balanceboard\n");
|
||||
} else {
|
||||
if (motionp)
|
||||
return sprintf(buf, "motionp\n");
|
||||
else
|
||||
return sprintf(buf, "none\n");
|
||||
}
|
||||
}
|
||||
|
||||
static DEVICE_ATTR(extension, S_IRUGO, wiiext_show, NULL);
|
||||
|
||||
static int wiiext_input_open(struct input_dev *dev)
|
||||
{
|
||||
struct wiimote_ext *ext = input_get_drvdata(dev);
|
||||
int ret;
|
||||
|
||||
ret = hid_hw_open(ext->wdata->hdev);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
atomic_inc(&ext->opened);
|
||||
wiiext_schedule(ext);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void wiiext_input_close(struct input_dev *dev)
|
||||
{
|
||||
struct wiimote_ext *ext = input_get_drvdata(dev);
|
||||
|
||||
atomic_dec(&ext->opened);
|
||||
wiiext_schedule(ext);
|
||||
hid_hw_close(ext->wdata->hdev);
|
||||
}
|
||||
|
||||
static int wiiext_mp_open(struct input_dev *dev)
|
||||
{
|
||||
struct wiimote_ext *ext = input_get_drvdata(dev);
|
||||
int ret;
|
||||
|
||||
ret = hid_hw_open(ext->wdata->hdev);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
atomic_inc(&ext->mp_opened);
|
||||
wiiext_schedule(ext);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void wiiext_mp_close(struct input_dev *dev)
|
||||
{
|
||||
struct wiimote_ext *ext = input_get_drvdata(dev);
|
||||
|
||||
atomic_dec(&ext->mp_opened);
|
||||
wiiext_schedule(ext);
|
||||
hid_hw_close(ext->wdata->hdev);
|
||||
}
|
||||
|
||||
/* Initializes the extension driver of a wiimote */
|
||||
int wiiext_init(struct wiimote_data *wdata)
|
||||
{
|
||||
struct wiimote_ext *ext;
|
||||
unsigned long flags;
|
||||
int ret, i;
|
||||
|
||||
ext = kzalloc(sizeof(*ext), GFP_KERNEL);
|
||||
if (!ext)
|
||||
return -ENOMEM;
|
||||
|
||||
ext->wdata = wdata;
|
||||
INIT_WORK(&ext->worker, wiiext_worker);
|
||||
|
||||
ext->input = input_allocate_device();
|
||||
if (!ext->input) {
|
||||
ret = -ENOMEM;
|
||||
goto err_input;
|
||||
}
|
||||
|
||||
input_set_drvdata(ext->input, ext);
|
||||
ext->input->open = wiiext_input_open;
|
||||
ext->input->close = wiiext_input_close;
|
||||
ext->input->dev.parent = &wdata->hdev->dev;
|
||||
ext->input->id.bustype = wdata->hdev->bus;
|
||||
ext->input->id.vendor = wdata->hdev->vendor;
|
||||
ext->input->id.product = wdata->hdev->product;
|
||||
ext->input->id.version = wdata->hdev->version;
|
||||
ext->input->name = WIIMOTE_NAME " Extension";
|
||||
|
||||
set_bit(EV_KEY, ext->input->evbit);
|
||||
for (i = 0; i < WIIEXT_KEY_COUNT; ++i)
|
||||
set_bit(wiiext_keymap[i], ext->input->keybit);
|
||||
|
||||
set_bit(EV_ABS, ext->input->evbit);
|
||||
set_bit(ABS_HAT0X, ext->input->absbit);
|
||||
set_bit(ABS_HAT0Y, ext->input->absbit);
|
||||
set_bit(ABS_HAT1X, ext->input->absbit);
|
||||
set_bit(ABS_HAT1Y, ext->input->absbit);
|
||||
set_bit(ABS_HAT2X, ext->input->absbit);
|
||||
set_bit(ABS_HAT2Y, ext->input->absbit);
|
||||
set_bit(ABS_HAT3X, ext->input->absbit);
|
||||
set_bit(ABS_HAT3Y, ext->input->absbit);
|
||||
input_set_abs_params(ext->input, ABS_HAT0X, -120, 120, 2, 4);
|
||||
input_set_abs_params(ext->input, ABS_HAT0Y, -120, 120, 2, 4);
|
||||
input_set_abs_params(ext->input, ABS_HAT1X, -30, 30, 1, 1);
|
||||
input_set_abs_params(ext->input, ABS_HAT1Y, -30, 30, 1, 1);
|
||||
input_set_abs_params(ext->input, ABS_HAT2X, -30, 30, 1, 1);
|
||||
input_set_abs_params(ext->input, ABS_HAT2Y, -30, 30, 1, 1);
|
||||
input_set_abs_params(ext->input, ABS_HAT3X, -30, 30, 1, 1);
|
||||
input_set_abs_params(ext->input, ABS_HAT3Y, -30, 30, 1, 1);
|
||||
set_bit(ABS_RX, ext->input->absbit);
|
||||
set_bit(ABS_RY, ext->input->absbit);
|
||||
set_bit(ABS_RZ, ext->input->absbit);
|
||||
input_set_abs_params(ext->input, ABS_RX, -500, 500, 2, 4);
|
||||
input_set_abs_params(ext->input, ABS_RY, -500, 500, 2, 4);
|
||||
input_set_abs_params(ext->input, ABS_RZ, -500, 500, 2, 4);
|
||||
|
||||
ret = input_register_device(ext->input);
|
||||
if (ret) {
|
||||
input_free_device(ext->input);
|
||||
goto err_input;
|
||||
}
|
||||
|
||||
ext->mp_input = input_allocate_device();
|
||||
if (!ext->mp_input) {
|
||||
ret = -ENOMEM;
|
||||
goto err_mp;
|
||||
}
|
||||
|
||||
input_set_drvdata(ext->mp_input, ext);
|
||||
ext->mp_input->open = wiiext_mp_open;
|
||||
ext->mp_input->close = wiiext_mp_close;
|
||||
ext->mp_input->dev.parent = &wdata->hdev->dev;
|
||||
ext->mp_input->id.bustype = wdata->hdev->bus;
|
||||
ext->mp_input->id.vendor = wdata->hdev->vendor;
|
||||
ext->mp_input->id.product = wdata->hdev->product;
|
||||
ext->mp_input->id.version = wdata->hdev->version;
|
||||
ext->mp_input->name = WIIMOTE_NAME " Motion+";
|
||||
|
||||
set_bit(EV_ABS, ext->mp_input->evbit);
|
||||
set_bit(ABS_RX, ext->mp_input->absbit);
|
||||
set_bit(ABS_RY, ext->mp_input->absbit);
|
||||
set_bit(ABS_RZ, ext->mp_input->absbit);
|
||||
input_set_abs_params(ext->mp_input, ABS_RX, -160000, 160000, 4, 8);
|
||||
input_set_abs_params(ext->mp_input, ABS_RY, -160000, 160000, 4, 8);
|
||||
input_set_abs_params(ext->mp_input, ABS_RZ, -160000, 160000, 4, 8);
|
||||
|
||||
ret = input_register_device(ext->mp_input);
|
||||
if (ret) {
|
||||
input_free_device(ext->mp_input);
|
||||
goto err_mp;
|
||||
}
|
||||
|
||||
ret = device_create_file(&wdata->hdev->dev, &dev_attr_extension);
|
||||
if (ret)
|
||||
goto err_dev;
|
||||
|
||||
spin_lock_irqsave(&wdata->state.lock, flags);
|
||||
wdata->ext = ext;
|
||||
spin_unlock_irqrestore(&wdata->state.lock, flags);
|
||||
|
||||
return 0;
|
||||
|
||||
err_dev:
|
||||
input_unregister_device(ext->mp_input);
|
||||
err_mp:
|
||||
input_unregister_device(ext->input);
|
||||
err_input:
|
||||
kfree(ext);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Deinitializes the extension driver of a wiimote */
|
||||
void wiiext_deinit(struct wiimote_data *wdata)
|
||||
{
|
||||
struct wiimote_ext *ext = wdata->ext;
|
||||
unsigned long flags;
|
||||
|
||||
if (!ext)
|
||||
return;
|
||||
|
||||
/*
|
||||
* We first unset wdata->ext to avoid further input from the wiimote
|
||||
* core. The worker thread does not access this pointer so it is not
|
||||
* affected by this.
|
||||
* We kill the worker after this so it does not get respawned during
|
||||
* deinitialization.
|
||||
*/
|
||||
|
||||
spin_lock_irqsave(&wdata->state.lock, flags);
|
||||
wdata->ext = NULL;
|
||||
spin_unlock_irqrestore(&wdata->state.lock, flags);
|
||||
|
||||
device_remove_file(&wdata->hdev->dev, &dev_attr_extension);
|
||||
input_unregister_device(ext->mp_input);
|
||||
input_unregister_device(ext->input);
|
||||
|
||||
cancel_work_sync(&ext->worker);
|
||||
kfree(ext);
|
||||
}
|
2086
drivers/hid/hid-wiimote-modules.c
Normal file
2086
drivers/hid/hid-wiimote-modules.c
Normal file
File diff suppressed because it is too large
Load Diff
@ -2,8 +2,8 @@
|
||||
#define __HID_WIIMOTE_H
|
||||
|
||||
/*
|
||||
* HID driver for Nintendo Wiimote devices
|
||||
* Copyright (c) 2011 David Herrmann
|
||||
* HID driver for Nintendo Wii / Wii U peripherals
|
||||
* Copyright (c) 2011-2013 David Herrmann <dh.herrmann@gmail.com>
|
||||
*/
|
||||
|
||||
/*
|
||||
@ -22,6 +22,7 @@
|
||||
#include <linux/mutex.h>
|
||||
#include <linux/power_supply.h>
|
||||
#include <linux/spinlock.h>
|
||||
#include <linux/timer.h>
|
||||
|
||||
#define WIIMOTE_NAME "Nintendo Wii Remote"
|
||||
#define WIIMOTE_BUFSIZE 32
|
||||
@ -35,6 +36,17 @@
|
||||
#define WIIPROTO_FLAG_IR_BASIC 0x40
|
||||
#define WIIPROTO_FLAG_IR_EXT 0x80
|
||||
#define WIIPROTO_FLAG_IR_FULL 0xc0 /* IR_BASIC | IR_EXT */
|
||||
#define WIIPROTO_FLAG_EXT_PLUGGED 0x0100
|
||||
#define WIIPROTO_FLAG_EXT_USED 0x0200
|
||||
#define WIIPROTO_FLAG_EXT_ACTIVE 0x0400
|
||||
#define WIIPROTO_FLAG_MP_PLUGGED 0x0800
|
||||
#define WIIPROTO_FLAG_MP_USED 0x1000
|
||||
#define WIIPROTO_FLAG_MP_ACTIVE 0x2000
|
||||
#define WIIPROTO_FLAG_EXITING 0x4000
|
||||
#define WIIPROTO_FLAG_DRM_LOCKED 0x8000
|
||||
#define WIIPROTO_FLAG_BUILTIN_MP 0x010000
|
||||
#define WIIPROTO_FLAG_NO_MP 0x020000
|
||||
|
||||
#define WIIPROTO_FLAGS_LEDS (WIIPROTO_FLAG_LED1 | WIIPROTO_FLAG_LED2 | \
|
||||
WIIPROTO_FLAG_LED3 | WIIPROTO_FLAG_LED4)
|
||||
#define WIIPROTO_FLAGS_IR (WIIPROTO_FLAG_IR_BASIC | WIIPROTO_FLAG_IR_EXT | \
|
||||
@ -43,16 +55,71 @@
|
||||
/* return flag for led \num */
|
||||
#define WIIPROTO_FLAG_LED(num) (WIIPROTO_FLAG_LED1 << (num - 1))
|
||||
|
||||
enum wiiproto_keys {
|
||||
WIIPROTO_KEY_LEFT,
|
||||
WIIPROTO_KEY_RIGHT,
|
||||
WIIPROTO_KEY_UP,
|
||||
WIIPROTO_KEY_DOWN,
|
||||
WIIPROTO_KEY_PLUS,
|
||||
WIIPROTO_KEY_MINUS,
|
||||
WIIPROTO_KEY_ONE,
|
||||
WIIPROTO_KEY_TWO,
|
||||
WIIPROTO_KEY_A,
|
||||
WIIPROTO_KEY_B,
|
||||
WIIPROTO_KEY_HOME,
|
||||
WIIPROTO_KEY_COUNT
|
||||
};
|
||||
|
||||
enum wiimote_devtype {
|
||||
WIIMOTE_DEV_PENDING,
|
||||
WIIMOTE_DEV_UNKNOWN,
|
||||
WIIMOTE_DEV_GENERIC,
|
||||
WIIMOTE_DEV_GEN10,
|
||||
WIIMOTE_DEV_GEN20,
|
||||
WIIMOTE_DEV_BALANCE_BOARD,
|
||||
WIIMOTE_DEV_PRO_CONTROLLER,
|
||||
WIIMOTE_DEV_NUM,
|
||||
};
|
||||
|
||||
enum wiimote_exttype {
|
||||
WIIMOTE_EXT_NONE,
|
||||
WIIMOTE_EXT_UNKNOWN,
|
||||
WIIMOTE_EXT_NUNCHUK,
|
||||
WIIMOTE_EXT_CLASSIC_CONTROLLER,
|
||||
WIIMOTE_EXT_BALANCE_BOARD,
|
||||
WIIMOTE_EXT_PRO_CONTROLLER,
|
||||
WIIMOTE_EXT_NUM,
|
||||
};
|
||||
|
||||
enum wiimote_mptype {
|
||||
WIIMOTE_MP_NONE,
|
||||
WIIMOTE_MP_UNKNOWN,
|
||||
WIIMOTE_MP_SINGLE,
|
||||
WIIMOTE_MP_PASSTHROUGH_NUNCHUK,
|
||||
WIIMOTE_MP_PASSTHROUGH_CLASSIC,
|
||||
};
|
||||
|
||||
struct wiimote_buf {
|
||||
__u8 data[HID_MAX_BUFFER_SIZE];
|
||||
size_t size;
|
||||
};
|
||||
|
||||
struct wiimote_queue {
|
||||
spinlock_t lock;
|
||||
struct work_struct worker;
|
||||
__u8 head;
|
||||
__u8 tail;
|
||||
struct wiimote_buf outq[WIIMOTE_BUFSIZE];
|
||||
};
|
||||
|
||||
struct wiimote_state {
|
||||
spinlock_t lock;
|
||||
__u8 flags;
|
||||
__u32 flags;
|
||||
__u8 accel_split[2];
|
||||
__u8 drm;
|
||||
__u8 devtype;
|
||||
__u8 exttype;
|
||||
__u8 mp;
|
||||
|
||||
/* synchronous cmd requests */
|
||||
struct mutex sync;
|
||||
@ -65,6 +132,9 @@ struct wiimote_state {
|
||||
__u8 cmd_err;
|
||||
__u8 *cmd_read_buf;
|
||||
__u8 cmd_read_size;
|
||||
|
||||
/* calibration data */
|
||||
__u16 calib_bboard[4][3];
|
||||
};
|
||||
|
||||
struct wiimote_data {
|
||||
@ -74,18 +144,63 @@ struct wiimote_data {
|
||||
struct input_dev *accel;
|
||||
struct input_dev *ir;
|
||||
struct power_supply battery;
|
||||
struct wiimote_ext *ext;
|
||||
struct input_dev *mp;
|
||||
struct timer_list timer;
|
||||
struct wiimote_debug *debug;
|
||||
|
||||
spinlock_t qlock;
|
||||
__u8 head;
|
||||
__u8 tail;
|
||||
struct wiimote_buf outq[WIIMOTE_BUFSIZE];
|
||||
struct work_struct worker;
|
||||
union {
|
||||
struct input_dev *input;
|
||||
} extension;
|
||||
|
||||
struct wiimote_queue queue;
|
||||
struct wiimote_state state;
|
||||
struct work_struct init_worker;
|
||||
};
|
||||
|
||||
/* wiimote modules */
|
||||
|
||||
enum wiimod_module {
|
||||
WIIMOD_KEYS,
|
||||
WIIMOD_RUMBLE,
|
||||
WIIMOD_BATTERY,
|
||||
WIIMOD_LED1,
|
||||
WIIMOD_LED2,
|
||||
WIIMOD_LED3,
|
||||
WIIMOD_LED4,
|
||||
WIIMOD_ACCEL,
|
||||
WIIMOD_IR,
|
||||
WIIMOD_BUILTIN_MP,
|
||||
WIIMOD_NO_MP,
|
||||
WIIMOD_NUM,
|
||||
WIIMOD_NULL = WIIMOD_NUM,
|
||||
};
|
||||
|
||||
#define WIIMOD_FLAG_INPUT 0x0001
|
||||
#define WIIMOD_FLAG_EXT8 0x0002
|
||||
#define WIIMOD_FLAG_EXT16 0x0004
|
||||
|
||||
struct wiimod_ops {
|
||||
__u16 flags;
|
||||
unsigned long arg;
|
||||
int (*probe) (const struct wiimod_ops *ops,
|
||||
struct wiimote_data *wdata);
|
||||
void (*remove) (const struct wiimod_ops *ops,
|
||||
struct wiimote_data *wdata);
|
||||
|
||||
void (*in_keys) (struct wiimote_data *wdata, const __u8 *keys);
|
||||
void (*in_accel) (struct wiimote_data *wdata, const __u8 *accel);
|
||||
void (*in_ir) (struct wiimote_data *wdata, const __u8 *ir, bool packed,
|
||||
unsigned int id);
|
||||
void (*in_mp) (struct wiimote_data *wdata, const __u8 *mp);
|
||||
void (*in_ext) (struct wiimote_data *wdata, const __u8 *ext);
|
||||
};
|
||||
|
||||
extern const struct wiimod_ops *wiimod_table[WIIMOD_NUM];
|
||||
extern const struct wiimod_ops *wiimod_ext_table[WIIMOTE_EXT_NUM];
|
||||
extern const struct wiimod_ops wiimod_mp;
|
||||
|
||||
/* wiimote requests */
|
||||
|
||||
enum wiiproto_reqs {
|
||||
WIIPROTO_REQ_NULL = 0x0,
|
||||
WIIPROTO_REQ_RUMBLE = 0x10,
|
||||
@ -99,24 +214,55 @@ enum wiiproto_reqs {
|
||||
WIIPROTO_REQ_STATUS = 0x20,
|
||||
WIIPROTO_REQ_DATA = 0x21,
|
||||
WIIPROTO_REQ_RETURN = 0x22,
|
||||
|
||||
/* DRM_K: BB*2 */
|
||||
WIIPROTO_REQ_DRM_K = 0x30,
|
||||
|
||||
/* DRM_KA: BB*2 AA*3 */
|
||||
WIIPROTO_REQ_DRM_KA = 0x31,
|
||||
|
||||
/* DRM_KE: BB*2 EE*8 */
|
||||
WIIPROTO_REQ_DRM_KE = 0x32,
|
||||
|
||||
/* DRM_KAI: BB*2 AA*3 II*12 */
|
||||
WIIPROTO_REQ_DRM_KAI = 0x33,
|
||||
|
||||
/* DRM_KEE: BB*2 EE*19 */
|
||||
WIIPROTO_REQ_DRM_KEE = 0x34,
|
||||
|
||||
/* DRM_KAE: BB*2 AA*3 EE*16 */
|
||||
WIIPROTO_REQ_DRM_KAE = 0x35,
|
||||
|
||||
/* DRM_KIE: BB*2 II*10 EE*9 */
|
||||
WIIPROTO_REQ_DRM_KIE = 0x36,
|
||||
|
||||
/* DRM_KAIE: BB*2 AA*3 II*10 EE*6 */
|
||||
WIIPROTO_REQ_DRM_KAIE = 0x37,
|
||||
|
||||
/* DRM_E: EE*21 */
|
||||
WIIPROTO_REQ_DRM_E = 0x3d,
|
||||
|
||||
/* DRM_SKAI1: BB*2 AA*1 II*18 */
|
||||
WIIPROTO_REQ_DRM_SKAI1 = 0x3e,
|
||||
|
||||
/* DRM_SKAI2: BB*2 AA*1 II*18 */
|
||||
WIIPROTO_REQ_DRM_SKAI2 = 0x3f,
|
||||
|
||||
WIIPROTO_REQ_MAX
|
||||
};
|
||||
|
||||
#define dev_to_wii(pdev) hid_get_drvdata(container_of(pdev, struct hid_device, \
|
||||
dev))
|
||||
|
||||
void __wiimote_schedule(struct wiimote_data *wdata);
|
||||
|
||||
extern void wiiproto_req_drm(struct wiimote_data *wdata, __u8 drm);
|
||||
extern void wiiproto_req_rumble(struct wiimote_data *wdata, __u8 rumble);
|
||||
extern void wiiproto_req_leds(struct wiimote_data *wdata, int leds);
|
||||
extern void wiiproto_req_status(struct wiimote_data *wdata);
|
||||
extern void wiiproto_req_accel(struct wiimote_data *wdata, __u8 accel);
|
||||
extern void wiiproto_req_ir1(struct wiimote_data *wdata, __u8 flags);
|
||||
extern void wiiproto_req_ir2(struct wiimote_data *wdata, __u8 flags);
|
||||
extern int wiimote_cmd_write(struct wiimote_data *wdata, __u32 offset,
|
||||
const __u8 *wmem, __u8 size);
|
||||
extern ssize_t wiimote_cmd_read(struct wiimote_data *wdata, __u32 offset,
|
||||
@ -129,24 +275,6 @@ extern ssize_t wiimote_cmd_read(struct wiimote_data *wdata, __u32 offset,
|
||||
extern void wiiproto_req_rmem(struct wiimote_data *wdata, bool eeprom,
|
||||
__u32 offset, __u16 size);
|
||||
|
||||
#ifdef CONFIG_HID_WIIMOTE_EXT
|
||||
|
||||
extern int wiiext_init(struct wiimote_data *wdata);
|
||||
extern void wiiext_deinit(struct wiimote_data *wdata);
|
||||
extern void wiiext_event(struct wiimote_data *wdata, bool plugged);
|
||||
extern bool wiiext_active(struct wiimote_data *wdata);
|
||||
extern void wiiext_handle(struct wiimote_data *wdata, const __u8 *payload);
|
||||
|
||||
#else
|
||||
|
||||
static inline int wiiext_init(void *u) { return 0; }
|
||||
static inline void wiiext_deinit(void *u) { }
|
||||
static inline void wiiext_event(void *u, bool p) { }
|
||||
static inline bool wiiext_active(void *u) { return false; }
|
||||
static inline void wiiext_handle(void *u, const __u8 *p) { }
|
||||
|
||||
#endif
|
||||
|
||||
#ifdef CONFIG_DEBUG_FS
|
||||
|
||||
extern int wiidebug_init(struct wiimote_data *wdata);
|
||||
@ -173,11 +301,26 @@ static inline void wiimote_cmd_complete(struct wiimote_data *wdata)
|
||||
complete(&wdata->state.ready);
|
||||
}
|
||||
|
||||
/* requires the state.lock spinlock to be held */
|
||||
static inline void wiimote_cmd_abort(struct wiimote_data *wdata)
|
||||
{
|
||||
/* Abort synchronous request by waking up the sleeping caller. But
|
||||
* reset the state.cmd field to an invalid value so no further event
|
||||
* handlers will work with it. */
|
||||
wdata->state.cmd = WIIPROTO_REQ_MAX;
|
||||
complete(&wdata->state.ready);
|
||||
}
|
||||
|
||||
static inline int wiimote_cmd_acquire(struct wiimote_data *wdata)
|
||||
{
|
||||
return mutex_lock_interruptible(&wdata->state.sync) ? -ERESTARTSYS : 0;
|
||||
}
|
||||
|
||||
static inline void wiimote_cmd_acquire_noint(struct wiimote_data *wdata)
|
||||
{
|
||||
mutex_lock(&wdata->state.sync);
|
||||
}
|
||||
|
||||
/* requires the state.lock spinlock to be held */
|
||||
static inline void wiimote_cmd_set(struct wiimote_data *wdata, int cmd,
|
||||
__u32 opt)
|
||||
@ -196,11 +339,31 @@ static inline int wiimote_cmd_wait(struct wiimote_data *wdata)
|
||||
{
|
||||
int ret;
|
||||
|
||||
/* The completion acts as implicit memory barrier so we can safely
|
||||
* assume that state.cmd is set on success/failure and isn't accessed
|
||||
* by any other thread, anymore. */
|
||||
|
||||
ret = wait_for_completion_interruptible_timeout(&wdata->state.ready, HZ);
|
||||
if (ret < 0)
|
||||
return -ERESTARTSYS;
|
||||
else if (ret == 0)
|
||||
return -EIO;
|
||||
else if (wdata->state.cmd != WIIPROTO_REQ_NULL)
|
||||
return -EIO;
|
||||
else
|
||||
return 0;
|
||||
}
|
||||
|
||||
static inline int wiimote_cmd_wait_noint(struct wiimote_data *wdata)
|
||||
{
|
||||
unsigned long ret;
|
||||
|
||||
/* no locking needed; see wiimote_cmd_wait() */
|
||||
ret = wait_for_completion_timeout(&wdata->state.ready, HZ);
|
||||
if (!ret)
|
||||
return -EIO;
|
||||
else if (wdata->state.cmd != WIIPROTO_REQ_NULL)
|
||||
return -EIO;
|
||||
else
|
||||
return 0;
|
||||
}
|
||||
|
@ -506,11 +506,15 @@ struct input_keymap_entry {
|
||||
#define BTN_DEAD 0x12f
|
||||
|
||||
#define BTN_GAMEPAD 0x130
|
||||
#define BTN_A 0x130
|
||||
#define BTN_B 0x131
|
||||
#define BTN_SOUTH 0x130
|
||||
#define BTN_A BTN_SOUTH
|
||||
#define BTN_EAST 0x131
|
||||
#define BTN_B BTN_EAST
|
||||
#define BTN_C 0x132
|
||||
#define BTN_X 0x133
|
||||
#define BTN_Y 0x134
|
||||
#define BTN_NORTH 0x133
|
||||
#define BTN_X BTN_NORTH
|
||||
#define BTN_WEST 0x134
|
||||
#define BTN_Y BTN_WEST
|
||||
#define BTN_Z 0x135
|
||||
#define BTN_TL 0x136
|
||||
#define BTN_TR 0x137
|
||||
@ -707,6 +711,11 @@ struct input_keymap_entry {
|
||||
#define KEY_ATTENDANT_TOGGLE 0x21d /* Attendant call on or off */
|
||||
#define KEY_LIGHTS_TOGGLE 0x21e /* Reading light on or off */
|
||||
|
||||
#define BTN_DPAD_UP 0x220
|
||||
#define BTN_DPAD_DOWN 0x221
|
||||
#define BTN_DPAD_LEFT 0x222
|
||||
#define BTN_DPAD_RIGHT 0x223
|
||||
|
||||
#define BTN_TRIGGER_HAPPY 0x2c0
|
||||
#define BTN_TRIGGER_HAPPY1 0x2c0
|
||||
#define BTN_TRIGGER_HAPPY2 0x2c1
|
||||
|
Loading…
Reference in New Issue
Block a user