#include <linux/device.h>
#include <linux/hid.h>
#include <linux/module.h>
#include "hid-ids.h"
MODULE_AUTHOR("Bastien Nocera <hadess@hadess.net>");
MODULE_DESCRIPTION("HID Creative SB0540 receiver");
MODULE_LICENSE("GPL");
static const unsigned short creative_sb0540_key_table[] = {
KEY_POWER,
KEY_RESERVED,
KEY_RESERVED,
KEY_RESERVED,
KEY_RESERVED,
KEY_RESERVED,
KEY_RESERVED,
KEY_RESERVED,
KEY_RESERVED,
KEY_RESERVED,
KEY_RESERVED,
KEY_RESERVED,
KEY_RESERVED,
KEY_MUTE,
KEY_VOLUMEUP,
KEY_VOLUMEDOWN,
KEY_UP,
KEY_LEFT,
KEY_RIGHT,
KEY_REWIND,
KEY_OK,
KEY_FASTFORWARD,
KEY_DOWN,
KEY_AGAIN,
KEY_PLAY,
KEY_ESC,
KEY_RECORD,
KEY_OPTION,
KEY_MENU,
KEY_PREVIOUS,
KEY_PLAYPAUSE,
KEY_NEXT,
KEY_SLOW,
KEY_STOP,
KEY_NUMERIC_1,
KEY_NUMERIC_2,
KEY_NUMERIC_3,
KEY_NUMERIC_4,
KEY_NUMERIC_5,
KEY_NUMERIC_6,
KEY_NUMERIC_7,
KEY_NUMERIC_8,
KEY_NUMERIC_9,
KEY_NUMERIC_0
};
static const unsigned short creative_sb0540_codes[] = {
0x619E,
0x916E,
0x926D,
0x936C,
0x718E,
0x946B,
0x956A,
0x8C73,
0x9669,
0x9768,
0x9867,
0x9966,
0x9A65,
0x6E91,
0x629D,
0x639C,
0x7B84,
0x6B94,
0x728D,
0x8778,
0x817E,
0x758A,
0x8D72,
0x8E71,
0x8877,
0x7C83,
0x738C,
0x827D,
0x7689,
0x7F80,
0x7986,
0x7A85,
0x7D82,
0x857A,
0x8B74,
0x8F70,
0x906F,
0x8A75,
0x847B,
0x7887,
0x8976,
0x837C,
0x7788,
0x807F
};
struct creative_sb0540 {
struct input_dev *input_dev;
struct hid_device *hid;
unsigned short keymap[ARRAY_SIZE(creative_sb0540_key_table)];
};
static inline u64 reverse(u64 data, int bits)
{
int i;
u64 c;
c = 0;
for (i = 0; i < bits; i++) {
c |= (u64) (((data & (((u64) 1) << i)) ? 1 : 0))
<< (bits - 1 - i);
}
return (c);
}
static int get_key(struct creative_sb0540 *creative_sb0540, u64 keycode)
{
int i;
for (i = 0; i < ARRAY_SIZE(creative_sb0540_codes); i++) {
if (creative_sb0540_codes[i] == keycode)
return creative_sb0540->keymap[i];
}
return 0;
}
static int creative_sb0540_raw_event(struct hid_device *hid,
struct hid_report *report, u8 *data, int len)
{
struct creative_sb0540 *creative_sb0540 = hid_get_drvdata(hid);
u64 code, main_code;
int key;
if (len != 6)
return 0;
code = reverse(data[5], 8);
main_code = (code << 8) + ((~code) & 0xff);
main_code = ((main_code & 0xff) << 8) +
((main_code & 0xff00) >> 8);
key = get_key(creative_sb0540, main_code);
if (key == 0 || key == KEY_RESERVED) {
hid_err(hid, "Could not get a key for main_code %llX\n",
main_code);
return 0;
}
input_report_key(creative_sb0540->input_dev, key, 1);
input_report_key(creative_sb0540->input_dev, key, 0);
input_sync(creative_sb0540->input_dev);
return 0;
}
static int creative_sb0540_input_configured(struct hid_device *hid,
struct hid_input *hidinput)
{
struct input_dev *input_dev = hidinput->input;
struct creative_sb0540 *creative_sb0540 = hid_get_drvdata(hid);
int i;
creative_sb0540->input_dev = input_dev;
input_dev->keycode = creative_sb0540->keymap;
input_dev->keycodesize = sizeof(unsigned short);
input_dev->keycodemax = ARRAY_SIZE(creative_sb0540->keymap);
input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP);
memcpy(creative_sb0540->keymap, creative_sb0540_key_table,
sizeof(creative_sb0540->keymap));
for (i = 0; i < ARRAY_SIZE(creative_sb0540_key_table); i++)
set_bit(creative_sb0540->keymap[i], input_dev->keybit);
clear_bit(KEY_RESERVED, input_dev->keybit);
return 0;
}
static int creative_sb0540_input_mapping(struct hid_device *hid,
struct hid_input *hi, struct hid_field *field,
struct hid_usage *usage, unsigned long **bit, int *max)
{
return -1;
}
static int creative_sb0540_probe(struct hid_device *hid,
const struct hid_device_id *id)
{
int ret;
struct creative_sb0540 *creative_sb0540;
creative_sb0540 = devm_kzalloc(&hid->dev,
sizeof(struct creative_sb0540), GFP_KERNEL);
if (!creative_sb0540)
return -ENOMEM;
creative_sb0540->hid = hid;
hid->quirks |= HID_QUIRK_HIDINPUT_FORCE;
hid_set_drvdata(hid, creative_sb0540);
ret = hid_parse(hid);
if (ret) {
hid_err(hid, "parse failed\n");
return ret;
}
ret = hid_hw_start(hid, HID_CONNECT_DEFAULT);
if (ret) {
hid_err(hid, "hw start failed\n");
return ret;
}
return ret;
}
static const struct hid_device_id creative_sb0540_devices[] = {
{ HID_USB_DEVICE(USB_VENDOR_ID_CREATIVELABS, USB_DEVICE_ID_CREATIVE_SB0540) },
{ }
};
MODULE_DEVICE_TABLE(hid, creative_sb0540_devices);
static struct hid_driver creative_sb0540_driver = {
.name = "creative-sb0540",
.id_table = creative_sb0540_devices,
.raw_event = creative_sb0540_raw_event,
.input_configured = creative_sb0540_input_configured,
.probe = creative_sb0540_probe,
.input_mapping = creative_sb0540_input_mapping,
};
module_hid_driver