8a49cfa9de
Validate that the values of the module parameters are within the supported range. Also print the values in hex since that seems like a better match for bitmasks than decimal. Signed-off-by: Ville Syrjala <syrjala@sci.fi> Signed-off-by: Dmitry Torokhov <dtor@mail.ru>
982 lines
23 KiB
C
982 lines
23 KiB
C
/*
|
|
* ati_remote2 - ATI/Philips USB RF remote driver
|
|
*
|
|
* Copyright (C) 2005-2008 Ville Syrjala <syrjala@sci.fi>
|
|
* Copyright (C) 2007-2008 Peter Stokes <linux@dadeos.co.uk>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2
|
|
* as published by the Free Software Foundation.
|
|
*/
|
|
|
|
#include <linux/usb/input.h>
|
|
|
|
#define DRIVER_DESC "ATI/Philips USB RF remote driver"
|
|
#define DRIVER_VERSION "0.3"
|
|
|
|
MODULE_DESCRIPTION(DRIVER_DESC);
|
|
MODULE_VERSION(DRIVER_VERSION);
|
|
MODULE_AUTHOR("Ville Syrjala <syrjala@sci.fi>");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
/*
|
|
* ATI Remote Wonder II Channel Configuration
|
|
*
|
|
* The remote control can by assigned one of sixteen "channels" in order to facilitate
|
|
* the use of multiple remote controls within range of each other.
|
|
* A remote's "channel" may be altered by pressing and holding the "PC" button for
|
|
* approximately 3 seconds, after which the button will slowly flash the count of the
|
|
* currently configured "channel", using the numeric keypad enter a number between 1 and
|
|
* 16 and then press the "PC" button again, the button will slowly flash the count of the
|
|
* newly configured "channel".
|
|
*/
|
|
|
|
enum {
|
|
ATI_REMOTE2_MAX_CHANNEL_MASK = 0xFFFF,
|
|
ATI_REMOTE2_MAX_MODE_MASK = 0x1F,
|
|
};
|
|
|
|
static int ati_remote2_set_mask(const char *val,
|
|
struct kernel_param *kp, unsigned int max)
|
|
{
|
|
unsigned long mask;
|
|
int ret;
|
|
|
|
if (!val)
|
|
return -EINVAL;
|
|
|
|
ret = strict_strtoul(val, 0, &mask);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (mask & ~max)
|
|
return -EINVAL;
|
|
|
|
*(unsigned int *)kp->arg = mask;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ati_remote2_set_channel_mask(const char *val,
|
|
struct kernel_param *kp)
|
|
{
|
|
pr_debug("%s()\n", __func__);
|
|
|
|
return ati_remote2_set_mask(val, kp, ATI_REMOTE2_MAX_CHANNEL_MASK);
|
|
}
|
|
|
|
static int ati_remote2_get_channel_mask(char *buffer, struct kernel_param *kp)
|
|
{
|
|
pr_debug("%s()\n", __func__);
|
|
|
|
return sprintf(buffer, "0x%04x", *(unsigned int *)kp->arg);
|
|
}
|
|
|
|
static int ati_remote2_set_mode_mask(const char *val, struct kernel_param *kp)
|
|
{
|
|
pr_debug("%s()\n", __func__);
|
|
|
|
return ati_remote2_set_mask(val, kp, ATI_REMOTE2_MAX_MODE_MASK);
|
|
}
|
|
|
|
static int ati_remote2_get_mode_mask(char *buffer, struct kernel_param *kp)
|
|
{
|
|
pr_debug("%s()\n", __func__);
|
|
|
|
return sprintf(buffer, "0x%02x", *(unsigned int *)kp->arg);
|
|
}
|
|
|
|
static unsigned int channel_mask = ATI_REMOTE2_MAX_CHANNEL_MASK;
|
|
#define param_check_channel_mask(name, p) __param_check(name, p, unsigned int)
|
|
#define param_set_channel_mask ati_remote2_set_channel_mask
|
|
#define param_get_channel_mask ati_remote2_get_channel_mask
|
|
module_param(channel_mask, channel_mask, 0644);
|
|
MODULE_PARM_DESC(channel_mask, "Bitmask of channels to accept <15:Channel16>...<1:Channel2><0:Channel1>");
|
|
|
|
static unsigned int mode_mask = ATI_REMOTE2_MAX_MODE_MASK;
|
|
#define param_check_mode_mask(name, p) __param_check(name, p, unsigned int)
|
|
#define param_set_mode_mask ati_remote2_set_mode_mask
|
|
#define param_get_mode_mask ati_remote2_get_mode_mask
|
|
module_param(mode_mask, mode_mask, 0644);
|
|
MODULE_PARM_DESC(mode_mask, "Bitmask of modes to accept <4:PC><3:AUX4><2:AUX3><1:AUX2><0:AUX1>");
|
|
|
|
static struct usb_device_id ati_remote2_id_table[] = {
|
|
{ USB_DEVICE(0x0471, 0x0602) }, /* ATI Remote Wonder II */
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(usb, ati_remote2_id_table);
|
|
|
|
static DEFINE_MUTEX(ati_remote2_mutex);
|
|
|
|
enum {
|
|
ATI_REMOTE2_OPENED = 0x1,
|
|
ATI_REMOTE2_SUSPENDED = 0x2,
|
|
};
|
|
|
|
enum {
|
|
ATI_REMOTE2_AUX1,
|
|
ATI_REMOTE2_AUX2,
|
|
ATI_REMOTE2_AUX3,
|
|
ATI_REMOTE2_AUX4,
|
|
ATI_REMOTE2_PC,
|
|
ATI_REMOTE2_MODES,
|
|
};
|
|
|
|
static const struct {
|
|
u8 hw_code;
|
|
u16 keycode;
|
|
} ati_remote2_key_table[] = {
|
|
{ 0x00, KEY_0 },
|
|
{ 0x01, KEY_1 },
|
|
{ 0x02, KEY_2 },
|
|
{ 0x03, KEY_3 },
|
|
{ 0x04, KEY_4 },
|
|
{ 0x05, KEY_5 },
|
|
{ 0x06, KEY_6 },
|
|
{ 0x07, KEY_7 },
|
|
{ 0x08, KEY_8 },
|
|
{ 0x09, KEY_9 },
|
|
{ 0x0c, KEY_POWER },
|
|
{ 0x0d, KEY_MUTE },
|
|
{ 0x10, KEY_VOLUMEUP },
|
|
{ 0x11, KEY_VOLUMEDOWN },
|
|
{ 0x20, KEY_CHANNELUP },
|
|
{ 0x21, KEY_CHANNELDOWN },
|
|
{ 0x28, KEY_FORWARD },
|
|
{ 0x29, KEY_REWIND },
|
|
{ 0x2c, KEY_PLAY },
|
|
{ 0x30, KEY_PAUSE },
|
|
{ 0x31, KEY_STOP },
|
|
{ 0x37, KEY_RECORD },
|
|
{ 0x38, KEY_DVD },
|
|
{ 0x39, KEY_TV },
|
|
{ 0x3f, KEY_PROG1 }, /* AUX1-AUX4 and PC */
|
|
{ 0x54, KEY_MENU },
|
|
{ 0x58, KEY_UP },
|
|
{ 0x59, KEY_DOWN },
|
|
{ 0x5a, KEY_LEFT },
|
|
{ 0x5b, KEY_RIGHT },
|
|
{ 0x5c, KEY_OK },
|
|
{ 0x78, KEY_A },
|
|
{ 0x79, KEY_B },
|
|
{ 0x7a, KEY_C },
|
|
{ 0x7b, KEY_D },
|
|
{ 0x7c, KEY_E },
|
|
{ 0x7d, KEY_F },
|
|
{ 0x82, KEY_ENTER },
|
|
{ 0x8e, KEY_VENDOR },
|
|
{ 0x96, KEY_COFFEE },
|
|
{ 0xa9, BTN_LEFT },
|
|
{ 0xaa, BTN_RIGHT },
|
|
{ 0xbe, KEY_QUESTION },
|
|
{ 0xd0, KEY_EDIT },
|
|
{ 0xd5, KEY_FRONT },
|
|
{ 0xf9, KEY_INFO },
|
|
};
|
|
|
|
struct ati_remote2 {
|
|
struct input_dev *idev;
|
|
struct usb_device *udev;
|
|
|
|
struct usb_interface *intf[2];
|
|
struct usb_endpoint_descriptor *ep[2];
|
|
struct urb *urb[2];
|
|
void *buf[2];
|
|
dma_addr_t buf_dma[2];
|
|
|
|
unsigned long jiffies;
|
|
int mode;
|
|
|
|
char name[64];
|
|
char phys[64];
|
|
|
|
/* Each mode (AUX1-AUX4 and PC) can have an independent keymap. */
|
|
u16 keycode[ATI_REMOTE2_MODES][ARRAY_SIZE(ati_remote2_key_table)];
|
|
|
|
unsigned int flags;
|
|
|
|
unsigned int channel_mask;
|
|
unsigned int mode_mask;
|
|
};
|
|
|
|
static int ati_remote2_probe(struct usb_interface *interface, const struct usb_device_id *id);
|
|
static void ati_remote2_disconnect(struct usb_interface *interface);
|
|
static int ati_remote2_suspend(struct usb_interface *interface, pm_message_t message);
|
|
static int ati_remote2_resume(struct usb_interface *interface);
|
|
static int ati_remote2_reset_resume(struct usb_interface *interface);
|
|
static int ati_remote2_pre_reset(struct usb_interface *interface);
|
|
static int ati_remote2_post_reset(struct usb_interface *interface);
|
|
|
|
static struct usb_driver ati_remote2_driver = {
|
|
.name = "ati_remote2",
|
|
.probe = ati_remote2_probe,
|
|
.disconnect = ati_remote2_disconnect,
|
|
.id_table = ati_remote2_id_table,
|
|
.suspend = ati_remote2_suspend,
|
|
.resume = ati_remote2_resume,
|
|
.reset_resume = ati_remote2_reset_resume,
|
|
.pre_reset = ati_remote2_pre_reset,
|
|
.post_reset = ati_remote2_post_reset,
|
|
.supports_autosuspend = 1,
|
|
};
|
|
|
|
static int ati_remote2_submit_urbs(struct ati_remote2 *ar2)
|
|
{
|
|
int r;
|
|
|
|
r = usb_submit_urb(ar2->urb[0], GFP_KERNEL);
|
|
if (r) {
|
|
dev_err(&ar2->intf[0]->dev,
|
|
"%s(): usb_submit_urb() = %d\n", __func__, r);
|
|
return r;
|
|
}
|
|
r = usb_submit_urb(ar2->urb[1], GFP_KERNEL);
|
|
if (r) {
|
|
usb_kill_urb(ar2->urb[0]);
|
|
dev_err(&ar2->intf[1]->dev,
|
|
"%s(): usb_submit_urb() = %d\n", __func__, r);
|
|
return r;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void ati_remote2_kill_urbs(struct ati_remote2 *ar2)
|
|
{
|
|
usb_kill_urb(ar2->urb[1]);
|
|
usb_kill_urb(ar2->urb[0]);
|
|
}
|
|
|
|
static int ati_remote2_open(struct input_dev *idev)
|
|
{
|
|
struct ati_remote2 *ar2 = input_get_drvdata(idev);
|
|
int r;
|
|
|
|
dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
|
|
|
|
r = usb_autopm_get_interface(ar2->intf[0]);
|
|
if (r) {
|
|
dev_err(&ar2->intf[0]->dev,
|
|
"%s(): usb_autopm_get_interface() = %d\n", __func__, r);
|
|
goto fail1;
|
|
}
|
|
|
|
mutex_lock(&ati_remote2_mutex);
|
|
|
|
if (!(ar2->flags & ATI_REMOTE2_SUSPENDED)) {
|
|
r = ati_remote2_submit_urbs(ar2);
|
|
if (r)
|
|
goto fail2;
|
|
}
|
|
|
|
ar2->flags |= ATI_REMOTE2_OPENED;
|
|
|
|
mutex_unlock(&ati_remote2_mutex);
|
|
|
|
usb_autopm_put_interface(ar2->intf[0]);
|
|
|
|
return 0;
|
|
|
|
fail2:
|
|
mutex_unlock(&ati_remote2_mutex);
|
|
usb_autopm_put_interface(ar2->intf[0]);
|
|
fail1:
|
|
return r;
|
|
}
|
|
|
|
static void ati_remote2_close(struct input_dev *idev)
|
|
{
|
|
struct ati_remote2 *ar2 = input_get_drvdata(idev);
|
|
|
|
dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
|
|
|
|
mutex_lock(&ati_remote2_mutex);
|
|
|
|
if (!(ar2->flags & ATI_REMOTE2_SUSPENDED))
|
|
ati_remote2_kill_urbs(ar2);
|
|
|
|
ar2->flags &= ~ATI_REMOTE2_OPENED;
|
|
|
|
mutex_unlock(&ati_remote2_mutex);
|
|
}
|
|
|
|
static void ati_remote2_input_mouse(struct ati_remote2 *ar2)
|
|
{
|
|
struct input_dev *idev = ar2->idev;
|
|
u8 *data = ar2->buf[0];
|
|
int channel, mode;
|
|
|
|
channel = data[0] >> 4;
|
|
|
|
if (!((1 << channel) & ar2->channel_mask))
|
|
return;
|
|
|
|
mode = data[0] & 0x0F;
|
|
|
|
if (mode > ATI_REMOTE2_PC) {
|
|
dev_err(&ar2->intf[0]->dev,
|
|
"Unknown mode byte (%02x %02x %02x %02x)\n",
|
|
data[3], data[2], data[1], data[0]);
|
|
return;
|
|
}
|
|
|
|
if (!((1 << mode) & ar2->mode_mask))
|
|
return;
|
|
|
|
input_event(idev, EV_REL, REL_X, (s8) data[1]);
|
|
input_event(idev, EV_REL, REL_Y, (s8) data[2]);
|
|
input_sync(idev);
|
|
}
|
|
|
|
static int ati_remote2_lookup(unsigned int hw_code)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(ati_remote2_key_table); i++)
|
|
if (ati_remote2_key_table[i].hw_code == hw_code)
|
|
return i;
|
|
|
|
return -1;
|
|
}
|
|
|
|
static void ati_remote2_input_key(struct ati_remote2 *ar2)
|
|
{
|
|
struct input_dev *idev = ar2->idev;
|
|
u8 *data = ar2->buf[1];
|
|
int channel, mode, hw_code, index;
|
|
|
|
channel = data[0] >> 4;
|
|
|
|
if (!((1 << channel) & ar2->channel_mask))
|
|
return;
|
|
|
|
mode = data[0] & 0x0F;
|
|
|
|
if (mode > ATI_REMOTE2_PC) {
|
|
dev_err(&ar2->intf[1]->dev,
|
|
"Unknown mode byte (%02x %02x %02x %02x)\n",
|
|
data[3], data[2], data[1], data[0]);
|
|
return;
|
|
}
|
|
|
|
hw_code = data[2];
|
|
if (hw_code == 0x3f) {
|
|
/*
|
|
* For some incomprehensible reason the mouse pad generates
|
|
* events which look identical to the events from the last
|
|
* pressed mode key. Naturally we don't want to generate key
|
|
* events for the mouse pad so we filter out any subsequent
|
|
* events from the same mode key.
|
|
*/
|
|
if (ar2->mode == mode)
|
|
return;
|
|
|
|
if (data[1] == 0)
|
|
ar2->mode = mode;
|
|
}
|
|
|
|
if (!((1 << mode) & ar2->mode_mask))
|
|
return;
|
|
|
|
index = ati_remote2_lookup(hw_code);
|
|
if (index < 0) {
|
|
dev_err(&ar2->intf[1]->dev,
|
|
"Unknown code byte (%02x %02x %02x %02x)\n",
|
|
data[3], data[2], data[1], data[0]);
|
|
return;
|
|
}
|
|
|
|
switch (data[1]) {
|
|
case 0: /* release */
|
|
break;
|
|
case 1: /* press */
|
|
ar2->jiffies = jiffies + msecs_to_jiffies(idev->rep[REP_DELAY]);
|
|
break;
|
|
case 2: /* repeat */
|
|
|
|
/* No repeat for mouse buttons. */
|
|
if (ar2->keycode[mode][index] == BTN_LEFT ||
|
|
ar2->keycode[mode][index] == BTN_RIGHT)
|
|
return;
|
|
|
|
if (!time_after_eq(jiffies, ar2->jiffies))
|
|
return;
|
|
|
|
ar2->jiffies = jiffies + msecs_to_jiffies(idev->rep[REP_PERIOD]);
|
|
break;
|
|
default:
|
|
dev_err(&ar2->intf[1]->dev,
|
|
"Unknown state byte (%02x %02x %02x %02x)\n",
|
|
data[3], data[2], data[1], data[0]);
|
|
return;
|
|
}
|
|
|
|
input_event(idev, EV_KEY, ar2->keycode[mode][index], data[1]);
|
|
input_sync(idev);
|
|
}
|
|
|
|
static void ati_remote2_complete_mouse(struct urb *urb)
|
|
{
|
|
struct ati_remote2 *ar2 = urb->context;
|
|
int r;
|
|
|
|
switch (urb->status) {
|
|
case 0:
|
|
usb_mark_last_busy(ar2->udev);
|
|
ati_remote2_input_mouse(ar2);
|
|
break;
|
|
case -ENOENT:
|
|
case -EILSEQ:
|
|
case -ECONNRESET:
|
|
case -ESHUTDOWN:
|
|
dev_dbg(&ar2->intf[0]->dev,
|
|
"%s(): urb status = %d\n", __func__, urb->status);
|
|
return;
|
|
default:
|
|
usb_mark_last_busy(ar2->udev);
|
|
dev_err(&ar2->intf[0]->dev,
|
|
"%s(): urb status = %d\n", __func__, urb->status);
|
|
}
|
|
|
|
r = usb_submit_urb(urb, GFP_ATOMIC);
|
|
if (r)
|
|
dev_err(&ar2->intf[0]->dev,
|
|
"%s(): usb_submit_urb() = %d\n", __func__, r);
|
|
}
|
|
|
|
static void ati_remote2_complete_key(struct urb *urb)
|
|
{
|
|
struct ati_remote2 *ar2 = urb->context;
|
|
int r;
|
|
|
|
switch (urb->status) {
|
|
case 0:
|
|
usb_mark_last_busy(ar2->udev);
|
|
ati_remote2_input_key(ar2);
|
|
break;
|
|
case -ENOENT:
|
|
case -EILSEQ:
|
|
case -ECONNRESET:
|
|
case -ESHUTDOWN:
|
|
dev_dbg(&ar2->intf[1]->dev,
|
|
"%s(): urb status = %d\n", __func__, urb->status);
|
|
return;
|
|
default:
|
|
usb_mark_last_busy(ar2->udev);
|
|
dev_err(&ar2->intf[1]->dev,
|
|
"%s(): urb status = %d\n", __func__, urb->status);
|
|
}
|
|
|
|
r = usb_submit_urb(urb, GFP_ATOMIC);
|
|
if (r)
|
|
dev_err(&ar2->intf[1]->dev,
|
|
"%s(): usb_submit_urb() = %d\n", __func__, r);
|
|
}
|
|
|
|
static int ati_remote2_getkeycode(struct input_dev *idev,
|
|
int scancode, int *keycode)
|
|
{
|
|
struct ati_remote2 *ar2 = input_get_drvdata(idev);
|
|
int index, mode;
|
|
|
|
mode = scancode >> 8;
|
|
if (mode > ATI_REMOTE2_PC || !((1 << mode) & ar2->mode_mask))
|
|
return -EINVAL;
|
|
|
|
index = ati_remote2_lookup(scancode & 0xFF);
|
|
if (index < 0)
|
|
return -EINVAL;
|
|
|
|
*keycode = ar2->keycode[mode][index];
|
|
return 0;
|
|
}
|
|
|
|
static int ati_remote2_setkeycode(struct input_dev *idev, int scancode, int keycode)
|
|
{
|
|
struct ati_remote2 *ar2 = input_get_drvdata(idev);
|
|
int index, mode, old_keycode;
|
|
|
|
mode = scancode >> 8;
|
|
if (mode > ATI_REMOTE2_PC || !((1 << mode) & ar2->mode_mask))
|
|
return -EINVAL;
|
|
|
|
index = ati_remote2_lookup(scancode & 0xFF);
|
|
if (index < 0)
|
|
return -EINVAL;
|
|
|
|
if (keycode < KEY_RESERVED || keycode > KEY_MAX)
|
|
return -EINVAL;
|
|
|
|
old_keycode = ar2->keycode[mode][index];
|
|
ar2->keycode[mode][index] = keycode;
|
|
set_bit(keycode, idev->keybit);
|
|
|
|
for (mode = 0; mode < ATI_REMOTE2_MODES; mode++) {
|
|
for (index = 0; index < ARRAY_SIZE(ati_remote2_key_table); index++) {
|
|
if (ar2->keycode[mode][index] == old_keycode)
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
clear_bit(old_keycode, idev->keybit);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ati_remote2_input_init(struct ati_remote2 *ar2)
|
|
{
|
|
struct input_dev *idev;
|
|
int index, mode, retval;
|
|
|
|
idev = input_allocate_device();
|
|
if (!idev)
|
|
return -ENOMEM;
|
|
|
|
ar2->idev = idev;
|
|
input_set_drvdata(idev, ar2);
|
|
|
|
idev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP) | BIT_MASK(EV_REL);
|
|
idev->keybit[BIT_WORD(BTN_MOUSE)] = BIT_MASK(BTN_LEFT) |
|
|
BIT_MASK(BTN_RIGHT);
|
|
idev->relbit[0] = BIT_MASK(REL_X) | BIT_MASK(REL_Y);
|
|
|
|
for (mode = 0; mode < ATI_REMOTE2_MODES; mode++) {
|
|
for (index = 0; index < ARRAY_SIZE(ati_remote2_key_table); index++) {
|
|
ar2->keycode[mode][index] = ati_remote2_key_table[index].keycode;
|
|
set_bit(ar2->keycode[mode][index], idev->keybit);
|
|
}
|
|
}
|
|
|
|
/* AUX1-AUX4 and PC generate the same scancode. */
|
|
index = ati_remote2_lookup(0x3f);
|
|
ar2->keycode[ATI_REMOTE2_AUX1][index] = KEY_PROG1;
|
|
ar2->keycode[ATI_REMOTE2_AUX2][index] = KEY_PROG2;
|
|
ar2->keycode[ATI_REMOTE2_AUX3][index] = KEY_PROG3;
|
|
ar2->keycode[ATI_REMOTE2_AUX4][index] = KEY_PROG4;
|
|
ar2->keycode[ATI_REMOTE2_PC][index] = KEY_PC;
|
|
set_bit(KEY_PROG1, idev->keybit);
|
|
set_bit(KEY_PROG2, idev->keybit);
|
|
set_bit(KEY_PROG3, idev->keybit);
|
|
set_bit(KEY_PROG4, idev->keybit);
|
|
set_bit(KEY_PC, idev->keybit);
|
|
|
|
idev->rep[REP_DELAY] = 250;
|
|
idev->rep[REP_PERIOD] = 33;
|
|
|
|
idev->open = ati_remote2_open;
|
|
idev->close = ati_remote2_close;
|
|
|
|
idev->getkeycode = ati_remote2_getkeycode;
|
|
idev->setkeycode = ati_remote2_setkeycode;
|
|
|
|
idev->name = ar2->name;
|
|
idev->phys = ar2->phys;
|
|
|
|
usb_to_input_id(ar2->udev, &idev->id);
|
|
idev->dev.parent = &ar2->udev->dev;
|
|
|
|
retval = input_register_device(idev);
|
|
if (retval)
|
|
input_free_device(idev);
|
|
|
|
return retval;
|
|
}
|
|
|
|
static int ati_remote2_urb_init(struct ati_remote2 *ar2)
|
|
{
|
|
struct usb_device *udev = ar2->udev;
|
|
int i, pipe, maxp;
|
|
|
|
for (i = 0; i < 2; i++) {
|
|
ar2->buf[i] = usb_buffer_alloc(udev, 4, GFP_KERNEL, &ar2->buf_dma[i]);
|
|
if (!ar2->buf[i])
|
|
return -ENOMEM;
|
|
|
|
ar2->urb[i] = usb_alloc_urb(0, GFP_KERNEL);
|
|
if (!ar2->urb[i])
|
|
return -ENOMEM;
|
|
|
|
pipe = usb_rcvintpipe(udev, ar2->ep[i]->bEndpointAddress);
|
|
maxp = usb_maxpacket(udev, pipe, usb_pipeout(pipe));
|
|
maxp = maxp > 4 ? 4 : maxp;
|
|
|
|
usb_fill_int_urb(ar2->urb[i], udev, pipe, ar2->buf[i], maxp,
|
|
i ? ati_remote2_complete_key : ati_remote2_complete_mouse,
|
|
ar2, ar2->ep[i]->bInterval);
|
|
ar2->urb[i]->transfer_dma = ar2->buf_dma[i];
|
|
ar2->urb[i]->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void ati_remote2_urb_cleanup(struct ati_remote2 *ar2)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < 2; i++) {
|
|
usb_free_urb(ar2->urb[i]);
|
|
usb_buffer_free(ar2->udev, 4, ar2->buf[i], ar2->buf_dma[i]);
|
|
}
|
|
}
|
|
|
|
static int ati_remote2_setup(struct ati_remote2 *ar2, unsigned int ch_mask)
|
|
{
|
|
int r, i, channel;
|
|
|
|
/*
|
|
* Configure receiver to only accept input from remote "channel"
|
|
* channel == 0 -> Accept input from any remote channel
|
|
* channel == 1 -> Only accept input from remote channel 1
|
|
* channel == 2 -> Only accept input from remote channel 2
|
|
* ...
|
|
* channel == 16 -> Only accept input from remote channel 16
|
|
*/
|
|
|
|
channel = 0;
|
|
for (i = 0; i < 16; i++) {
|
|
if ((1 << i) & ch_mask) {
|
|
if (!(~(1 << i) & ch_mask))
|
|
channel = i + 1;
|
|
break;
|
|
}
|
|
}
|
|
|
|
r = usb_control_msg(ar2->udev, usb_sndctrlpipe(ar2->udev, 0),
|
|
0x20,
|
|
USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
|
|
channel, 0x0, NULL, 0, USB_CTRL_SET_TIMEOUT);
|
|
if (r) {
|
|
dev_err(&ar2->udev->dev, "%s - failed to set channel due to error: %d\n",
|
|
__func__, r);
|
|
return r;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static ssize_t ati_remote2_show_channel_mask(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct usb_device *udev = to_usb_device(dev);
|
|
struct usb_interface *intf = usb_ifnum_to_if(udev, 0);
|
|
struct ati_remote2 *ar2 = usb_get_intfdata(intf);
|
|
|
|
return sprintf(buf, "0x%04x\n", ar2->channel_mask);
|
|
}
|
|
|
|
static ssize_t ati_remote2_store_channel_mask(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct usb_device *udev = to_usb_device(dev);
|
|
struct usb_interface *intf = usb_ifnum_to_if(udev, 0);
|
|
struct ati_remote2 *ar2 = usb_get_intfdata(intf);
|
|
unsigned long mask;
|
|
int r;
|
|
|
|
if (strict_strtoul(buf, 0, &mask))
|
|
return -EINVAL;
|
|
|
|
if (mask & ~ATI_REMOTE2_MAX_CHANNEL_MASK)
|
|
return -EINVAL;
|
|
|
|
r = usb_autopm_get_interface(ar2->intf[0]);
|
|
if (r) {
|
|
dev_err(&ar2->intf[0]->dev,
|
|
"%s(): usb_autopm_get_interface() = %d\n", __func__, r);
|
|
return r;
|
|
}
|
|
|
|
mutex_lock(&ati_remote2_mutex);
|
|
|
|
if (mask != ar2->channel_mask && !ati_remote2_setup(ar2, mask))
|
|
ar2->channel_mask = mask;
|
|
|
|
mutex_unlock(&ati_remote2_mutex);
|
|
|
|
usb_autopm_put_interface(ar2->intf[0]);
|
|
|
|
return count;
|
|
}
|
|
|
|
static ssize_t ati_remote2_show_mode_mask(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct usb_device *udev = to_usb_device(dev);
|
|
struct usb_interface *intf = usb_ifnum_to_if(udev, 0);
|
|
struct ati_remote2 *ar2 = usb_get_intfdata(intf);
|
|
|
|
return sprintf(buf, "0x%02x\n", ar2->mode_mask);
|
|
}
|
|
|
|
static ssize_t ati_remote2_store_mode_mask(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct usb_device *udev = to_usb_device(dev);
|
|
struct usb_interface *intf = usb_ifnum_to_if(udev, 0);
|
|
struct ati_remote2 *ar2 = usb_get_intfdata(intf);
|
|
unsigned long mask;
|
|
|
|
if (strict_strtoul(buf, 0, &mask))
|
|
return -EINVAL;
|
|
|
|
if (mask & ~ATI_REMOTE2_MAX_MODE_MASK)
|
|
return -EINVAL;
|
|
|
|
ar2->mode_mask = mask;
|
|
|
|
return count;
|
|
}
|
|
|
|
static DEVICE_ATTR(channel_mask, 0644, ati_remote2_show_channel_mask,
|
|
ati_remote2_store_channel_mask);
|
|
|
|
static DEVICE_ATTR(mode_mask, 0644, ati_remote2_show_mode_mask,
|
|
ati_remote2_store_mode_mask);
|
|
|
|
static struct attribute *ati_remote2_attrs[] = {
|
|
&dev_attr_channel_mask.attr,
|
|
&dev_attr_mode_mask.attr,
|
|
NULL,
|
|
};
|
|
|
|
static struct attribute_group ati_remote2_attr_group = {
|
|
.attrs = ati_remote2_attrs,
|
|
};
|
|
|
|
static int ati_remote2_probe(struct usb_interface *interface, const struct usb_device_id *id)
|
|
{
|
|
struct usb_device *udev = interface_to_usbdev(interface);
|
|
struct usb_host_interface *alt = interface->cur_altsetting;
|
|
struct ati_remote2 *ar2;
|
|
int r;
|
|
|
|
if (alt->desc.bInterfaceNumber)
|
|
return -ENODEV;
|
|
|
|
ar2 = kzalloc(sizeof (struct ati_remote2), GFP_KERNEL);
|
|
if (!ar2)
|
|
return -ENOMEM;
|
|
|
|
ar2->udev = udev;
|
|
|
|
ar2->intf[0] = interface;
|
|
ar2->ep[0] = &alt->endpoint[0].desc;
|
|
|
|
ar2->intf[1] = usb_ifnum_to_if(udev, 1);
|
|
r = usb_driver_claim_interface(&ati_remote2_driver, ar2->intf[1], ar2);
|
|
if (r)
|
|
goto fail1;
|
|
alt = ar2->intf[1]->cur_altsetting;
|
|
ar2->ep[1] = &alt->endpoint[0].desc;
|
|
|
|
r = ati_remote2_urb_init(ar2);
|
|
if (r)
|
|
goto fail2;
|
|
|
|
ar2->channel_mask = channel_mask;
|
|
ar2->mode_mask = mode_mask;
|
|
|
|
r = ati_remote2_setup(ar2, ar2->channel_mask);
|
|
if (r)
|
|
goto fail2;
|
|
|
|
usb_make_path(udev, ar2->phys, sizeof(ar2->phys));
|
|
strlcat(ar2->phys, "/input0", sizeof(ar2->phys));
|
|
|
|
strlcat(ar2->name, "ATI Remote Wonder II", sizeof(ar2->name));
|
|
|
|
r = sysfs_create_group(&udev->dev.kobj, &ati_remote2_attr_group);
|
|
if (r)
|
|
goto fail2;
|
|
|
|
r = ati_remote2_input_init(ar2);
|
|
if (r)
|
|
goto fail3;
|
|
|
|
usb_set_intfdata(interface, ar2);
|
|
|
|
interface->needs_remote_wakeup = 1;
|
|
|
|
return 0;
|
|
|
|
fail3:
|
|
sysfs_remove_group(&udev->dev.kobj, &ati_remote2_attr_group);
|
|
fail2:
|
|
ati_remote2_urb_cleanup(ar2);
|
|
usb_driver_release_interface(&ati_remote2_driver, ar2->intf[1]);
|
|
fail1:
|
|
kfree(ar2);
|
|
|
|
return r;
|
|
}
|
|
|
|
static void ati_remote2_disconnect(struct usb_interface *interface)
|
|
{
|
|
struct ati_remote2 *ar2;
|
|
struct usb_host_interface *alt = interface->cur_altsetting;
|
|
|
|
if (alt->desc.bInterfaceNumber)
|
|
return;
|
|
|
|
ar2 = usb_get_intfdata(interface);
|
|
usb_set_intfdata(interface, NULL);
|
|
|
|
input_unregister_device(ar2->idev);
|
|
|
|
sysfs_remove_group(&ar2->udev->dev.kobj, &ati_remote2_attr_group);
|
|
|
|
ati_remote2_urb_cleanup(ar2);
|
|
|
|
usb_driver_release_interface(&ati_remote2_driver, ar2->intf[1]);
|
|
|
|
kfree(ar2);
|
|
}
|
|
|
|
static int ati_remote2_suspend(struct usb_interface *interface,
|
|
pm_message_t message)
|
|
{
|
|
struct ati_remote2 *ar2;
|
|
struct usb_host_interface *alt = interface->cur_altsetting;
|
|
|
|
if (alt->desc.bInterfaceNumber)
|
|
return 0;
|
|
|
|
ar2 = usb_get_intfdata(interface);
|
|
|
|
dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
|
|
|
|
mutex_lock(&ati_remote2_mutex);
|
|
|
|
if (ar2->flags & ATI_REMOTE2_OPENED)
|
|
ati_remote2_kill_urbs(ar2);
|
|
|
|
ar2->flags |= ATI_REMOTE2_SUSPENDED;
|
|
|
|
mutex_unlock(&ati_remote2_mutex);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ati_remote2_resume(struct usb_interface *interface)
|
|
{
|
|
struct ati_remote2 *ar2;
|
|
struct usb_host_interface *alt = interface->cur_altsetting;
|
|
int r = 0;
|
|
|
|
if (alt->desc.bInterfaceNumber)
|
|
return 0;
|
|
|
|
ar2 = usb_get_intfdata(interface);
|
|
|
|
dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
|
|
|
|
mutex_lock(&ati_remote2_mutex);
|
|
|
|
if (ar2->flags & ATI_REMOTE2_OPENED)
|
|
r = ati_remote2_submit_urbs(ar2);
|
|
|
|
if (!r)
|
|
ar2->flags &= ~ATI_REMOTE2_SUSPENDED;
|
|
|
|
mutex_unlock(&ati_remote2_mutex);
|
|
|
|
return r;
|
|
}
|
|
|
|
static int ati_remote2_reset_resume(struct usb_interface *interface)
|
|
{
|
|
struct ati_remote2 *ar2;
|
|
struct usb_host_interface *alt = interface->cur_altsetting;
|
|
int r = 0;
|
|
|
|
if (alt->desc.bInterfaceNumber)
|
|
return 0;
|
|
|
|
ar2 = usb_get_intfdata(interface);
|
|
|
|
dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
|
|
|
|
mutex_lock(&ati_remote2_mutex);
|
|
|
|
r = ati_remote2_setup(ar2, ar2->channel_mask);
|
|
if (r)
|
|
goto out;
|
|
|
|
if (ar2->flags & ATI_REMOTE2_OPENED)
|
|
r = ati_remote2_submit_urbs(ar2);
|
|
|
|
if (!r)
|
|
ar2->flags &= ~ATI_REMOTE2_SUSPENDED;
|
|
|
|
out:
|
|
mutex_unlock(&ati_remote2_mutex);
|
|
|
|
return r;
|
|
}
|
|
|
|
static int ati_remote2_pre_reset(struct usb_interface *interface)
|
|
{
|
|
struct ati_remote2 *ar2;
|
|
struct usb_host_interface *alt = interface->cur_altsetting;
|
|
|
|
if (alt->desc.bInterfaceNumber)
|
|
return 0;
|
|
|
|
ar2 = usb_get_intfdata(interface);
|
|
|
|
dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
|
|
|
|
mutex_lock(&ati_remote2_mutex);
|
|
|
|
if (ar2->flags == ATI_REMOTE2_OPENED)
|
|
ati_remote2_kill_urbs(ar2);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ati_remote2_post_reset(struct usb_interface *interface)
|
|
{
|
|
struct ati_remote2 *ar2;
|
|
struct usb_host_interface *alt = interface->cur_altsetting;
|
|
int r = 0;
|
|
|
|
if (alt->desc.bInterfaceNumber)
|
|
return 0;
|
|
|
|
ar2 = usb_get_intfdata(interface);
|
|
|
|
dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
|
|
|
|
if (ar2->flags == ATI_REMOTE2_OPENED)
|
|
r = ati_remote2_submit_urbs(ar2);
|
|
|
|
mutex_unlock(&ati_remote2_mutex);
|
|
|
|
return r;
|
|
}
|
|
|
|
static int __init ati_remote2_init(void)
|
|
{
|
|
int r;
|
|
|
|
r = usb_register(&ati_remote2_driver);
|
|
if (r)
|
|
printk(KERN_ERR "ati_remote2: usb_register() = %d\n", r);
|
|
else
|
|
printk(KERN_INFO "ati_remote2: " DRIVER_DESC " " DRIVER_VERSION "\n");
|
|
|
|
return r;
|
|
}
|
|
|
|
static void __exit ati_remote2_exit(void)
|
|
{
|
|
usb_deregister(&ati_remote2_driver);
|
|
}
|
|
|
|
module_init(ati_remote2_init);
|
|
module_exit(ati_remote2_exit);
|