| /* |
| * Roccat Kone[+] driver for Linux |
| * |
| * Copyright (c) 2010 Stefan Achatz <erazor_de@users.sourceforge.net> |
| */ |
| |
| /* |
| * 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. |
| */ |
| |
| /* |
| * Roccat Kone[+] is an updated/improved version of the Kone with more memory |
| * and functionality and without the non-standard behaviours the Kone had. |
| */ |
| |
| #include <linux/device.h> |
| #include <linux/input.h> |
| #include <linux/hid.h> |
| #include <linux/usb.h> |
| #include <linux/module.h> |
| #include <linux/slab.h> |
| #include "hid-ids.h" |
| #include "hid-roccat.h" |
| #include "hid-roccat-koneplus.h" |
| |
| static uint profile_numbers[5] = {0, 1, 2, 3, 4}; |
| |
| static struct class *koneplus_class; |
| |
| static void koneplus_profile_activated(struct koneplus_device *koneplus, |
| uint new_profile) |
| { |
| koneplus->actual_profile = new_profile; |
| } |
| |
| static int koneplus_send_control(struct usb_device *usb_dev, uint value, |
| enum koneplus_control_requests request) |
| { |
| int len; |
| struct koneplus_control *control; |
| |
| if ((request == KONEPLUS_CONTROL_REQUEST_PROFILE_SETTINGS || |
| request == KONEPLUS_CONTROL_REQUEST_PROFILE_BUTTONS) && |
| value > 4) |
| return -EINVAL; |
| |
| control = kmalloc(sizeof(struct koneplus_control), GFP_KERNEL); |
| if (!control) |
| return -ENOMEM; |
| |
| control->command = KONEPLUS_COMMAND_CONTROL; |
| control->value = value; |
| control->request = request; |
| |
| len = usb_control_msg(usb_dev, usb_sndctrlpipe(usb_dev, 0), |
| USB_REQ_SET_CONFIGURATION, |
| USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_OUT, |
| KONEPLUS_USB_COMMAND_CONTROL, 0, control, |
| sizeof(struct koneplus_control), |
| USB_CTRL_SET_TIMEOUT); |
| |
| kfree(control); |
| |
| if (len != sizeof(struct koneplus_control)) |
| return len; |
| |
| return 0; |
| } |
| |
| static int koneplus_receive(struct usb_device *usb_dev, uint usb_command, |
| void *buf, uint size) { |
| int len; |
| |
| len = usb_control_msg(usb_dev, usb_rcvctrlpipe(usb_dev, 0), |
| USB_REQ_CLEAR_FEATURE, |
| USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_IN, |
| usb_command, 0, buf, size, USB_CTRL_SET_TIMEOUT); |
| |
| return (len != size) ? -EIO : 0; |
| } |
| |
| static int koneplus_receive_control_status(struct usb_device *usb_dev) |
| { |
| int retval; |
| struct koneplus_control *control; |
| |
| control = kmalloc(sizeof(struct koneplus_control), GFP_KERNEL); |
| if (!control) |
| return -ENOMEM; |
| |
| do { |
| retval = koneplus_receive(usb_dev, KONEPLUS_USB_COMMAND_CONTROL, |
| control, sizeof(struct koneplus_control)); |
| |
| /* check if we get a completely wrong answer */ |
| if (retval) |
| goto out; |
| |
| if (control->value == KONEPLUS_CONTROL_REQUEST_STATUS_OK) { |
| retval = 0; |
| goto out; |
| } |
| |
| /* indicates that hardware needs some more time to complete action */ |
| if (control->value == KONEPLUS_CONTROL_REQUEST_STATUS_WAIT) { |
| msleep(500); /* windows driver uses 1000 */ |
| continue; |
| } |
| |
| /* seems to be critical - replug necessary */ |
| if (control->value == KONEPLUS_CONTROL_REQUEST_STATUS_OVERLOAD) { |
| retval = -EINVAL; |
| goto out; |
| } |
| |
| dev_err(&usb_dev->dev, "koneplus_receive_control_status: " |
| "unknown response value 0x%x\n", control->value); |
| retval = -EINVAL; |
| goto out; |
| |
| } while (1); |
| out: |
| kfree(control); |
| return retval; |
| } |
| |
| static int koneplus_send(struct usb_device *usb_dev, uint command, |
| void *buf, uint size) { |
| int len; |
| |
| len = usb_control_msg(usb_dev, usb_sndctrlpipe(usb_dev, 0), |
| USB_REQ_SET_CONFIGURATION, |
| USB_TYPE_CLASS | USB_RECIP_INTERFACE | USB_DIR_OUT, |
| command, 0, buf, size, USB_CTRL_SET_TIMEOUT); |
| |
| if (len != size) |
| return -EIO; |
| |
| if (koneplus_receive_control_status(usb_dev)) |
| return -EIO; |
| |
| return 0; |
| } |
| |
| static int koneplus_select_profile(struct usb_device *usb_dev, uint number, |
| enum koneplus_control_requests request) |
| { |
| int retval; |
| |
| retval = koneplus_send_control(usb_dev, number, request); |
| if (retval) |
| return retval; |
| |
| /* allow time to settle things - windows driver uses 500 */ |
| msleep(100); |
| |
| retval = koneplus_receive_control_status(usb_dev); |
| if (retval) |
| return retval; |
| |
| return 0; |
| } |
| |
| static int koneplus_get_info(struct usb_device *usb_dev, |
| struct koneplus_info *buf) |
| { |
| return koneplus_receive(usb_dev, KONEPLUS_USB_COMMAND_INFO, |
| buf, sizeof(struct koneplus_info)); |
| } |
| |
| static int koneplus_get_profile_settings(struct usb_device *usb_dev, |
| struct koneplus_profile_settings *buf, uint number) |
| { |
| int retval; |
| |
| retval = koneplus_select_profile(usb_dev, number, |
| KONEPLUS_CONTROL_REQUEST_PROFILE_SETTINGS); |
| if (retval) |
| return retval; |
| |
| return koneplus_receive(usb_dev, KONEPLUS_USB_COMMAND_PROFILE_SETTINGS, |
| buf, sizeof(struct koneplus_profile_settings)); |
| } |
| |
| static int koneplus_set_profile_settings(struct usb_device *usb_dev, |
| struct koneplus_profile_settings const *settings) |
| { |
| return koneplus_send(usb_dev, KONEPLUS_USB_COMMAND_PROFILE_SETTINGS, |
| (void *)settings, sizeof(struct koneplus_profile_settings)); |
| } |
| |
| static int koneplus_get_profile_buttons(struct usb_device *usb_dev, |
| struct koneplus_profile_buttons *buf, int number) |
| { |
| int retval; |
| |
| retval = koneplus_select_profile(usb_dev, number, |
| KONEPLUS_CONTROL_REQUEST_PROFILE_BUTTONS); |
| if (retval) |
| return retval; |
| |
| return koneplus_receive(usb_dev, KONEPLUS_USB_COMMAND_PROFILE_BUTTONS, |
| buf, sizeof(struct koneplus_profile_buttons)); |
| } |
| |
| static int koneplus_set_profile_buttons(struct usb_device *usb_dev, |
| struct koneplus_profile_buttons const *buttons) |
| { |
| return koneplus_send(usb_dev, KONEPLUS_USB_COMMAND_PROFILE_BUTTONS, |
| (void *)buttons, sizeof(struct koneplus_profile_buttons)); |
| } |
| |
| /* retval is 0-4 on success, < 0 on error */ |
| static int koneplus_get_startup_profile(struct usb_device *usb_dev) |
| { |
| struct koneplus_startup_profile *buf; |
| int retval; |
| |
| buf = kmalloc(sizeof(struct koneplus_startup_profile), GFP_KERNEL); |
| |
| retval = koneplus_receive(usb_dev, KONEPLUS_USB_COMMAND_STARTUP_PROFILE, |
| buf, sizeof(struct koneplus_startup_profile)); |
| |
| if (retval) |
| goto out; |
| |
| retval = buf->startup_profile; |
| out: |
| kfree(buf); |
| return retval; |
| } |
| |
| static int koneplus_set_startup_profile(struct usb_device *usb_dev, |
| int startup_profile) |
| { |
| struct koneplus_startup_profile buf; |
| |
| buf.command = KONEPLUS_COMMAND_STARTUP_PROFILE; |
| buf.size = sizeof(struct koneplus_startup_profile); |
| buf.startup_profile = startup_profile; |
| |
| return koneplus_send(usb_dev, KONEPLUS_USB_COMMAND_STARTUP_PROFILE, |
| (char *)&buf, sizeof(struct koneplus_profile_buttons)); |
| } |
| |
| static ssize_t koneplus_sysfs_read(struct file *fp, struct kobject *kobj, |
| char *buf, loff_t off, size_t count, |
| size_t real_size, uint command) |
| { |
| struct device *dev = |
| container_of(kobj, struct device, kobj)->parent->parent; |
| struct koneplus_device *koneplus = hid_get_drvdata(dev_get_drvdata(dev)); |
| struct usb_device *usb_dev = interface_to_usbdev(to_usb_interface(dev)); |
| int retval; |
| |
| if (off != 0 || count != real_size) |
| return -EINVAL; |
| |
| mutex_lock(&koneplus->koneplus_lock); |
| retval = koneplus_receive(usb_dev, command, buf, real_size); |
| mutex_unlock(&koneplus->koneplus_lock); |
| |
| if (retval) |
| return retval; |
| |
| return real_size; |
| } |
| |
| static ssize_t koneplus_sysfs_write(struct file *fp, struct kobject *kobj, |
| void const *buf, loff_t off, size_t count, |
| size_t real_size, uint command) |
| { |
| struct device *dev = |
| container_of(kobj, struct device, kobj)->parent->parent; |
| struct koneplus_device *koneplus = hid_get_drvdata(dev_get_drvdata(dev)); |
| struct usb_device *usb_dev = interface_to_usbdev(to_usb_interface(dev)); |
| int retval; |
| |
| if (off != 0 || count != real_size) |
| return -EINVAL; |
| |
| mutex_lock(&koneplus->koneplus_lock); |
| retval = koneplus_send(usb_dev, command, (void *)buf, real_size); |
| mutex_unlock(&koneplus->koneplus_lock); |
| |
| if (retval) |
| return retval; |
| |
| return real_size; |
| } |
| |
| static ssize_t koneplus_sysfs_write_macro(struct file *fp, |
| struct kobject *kobj, struct bin_attribute *attr, char *buf, |
| loff_t off, size_t count) |
| { |
| return koneplus_sysfs_write(fp, kobj, buf, off, count, |
| sizeof(struct koneplus_macro), KONEPLUS_USB_COMMAND_MACRO); |
| } |
| |
| static ssize_t koneplus_sysfs_read_sensor(struct file *fp, |
| struct kobject *kobj, struct bin_attribute *attr, char *buf, |
| loff_t off, size_t count) |
| { |
| return koneplus_sysfs_read(fp, kobj, buf, off, count, |
| sizeof(struct koneplus_sensor), KONEPLUS_USB_COMMAND_SENSOR); |
| } |
| |
| static ssize_t koneplus_sysfs_write_sensor(struct file *fp, |
| struct kobject *kobj, struct bin_attribute *attr, char *buf, |
| loff_t off, size_t count) |
| { |
| return koneplus_sysfs_write(fp, kobj, buf, off, count, |
| sizeof(struct koneplus_sensor), KONEPLUS_USB_COMMAND_SENSOR); |
| } |
| |
| static ssize_t koneplus_sysfs_write_tcu(struct file *fp, |
| struct kobject *kobj, struct bin_attribute *attr, char *buf, |
| loff_t off, size_t count) |
| { |
| return koneplus_sysfs_write(fp, kobj, buf, off, count, |
| sizeof(struct koneplus_tcu), KONEPLUS_USB_COMMAND_TCU); |
| } |
| |
| static ssize_t koneplus_sysfs_read_tcu_image(struct file *fp, |
| struct kobject *kobj, struct bin_attribute *attr, char *buf, |
| loff_t off, size_t count) |
| { |
| return koneplus_sysfs_read(fp, kobj, buf, off, count, |
| sizeof(struct koneplus_tcu_image), KONEPLUS_USB_COMMAND_TCU); |
| } |
| |
| static ssize_t koneplus_sysfs_read_profilex_settings(struct file *fp, |
| struct kobject *kobj, struct bin_attribute *attr, char *buf, |
| loff_t off, size_t count) |
| { |
| struct device *dev = |
| container_of(kobj, struct device, kobj)->parent->parent; |
| struct koneplus_device *koneplus = hid_get_drvdata(dev_get_drvdata(dev)); |
| |
| if (off >= sizeof(struct koneplus_profile_settings)) |
| return 0; |
| |
| if (off + count > sizeof(struct koneplus_profile_settings)) |
| count = sizeof(struct koneplus_profile_settings) - off; |
| |
| mutex_lock(&koneplus->koneplus_lock); |
| memcpy(buf, ((void const *)&koneplus->profile_settings[*(uint *)(attr->private)]) + off, |
| count); |
| mutex_unlock(&koneplus->koneplus_lock); |
| |
| return count; |
| } |
| |
| static ssize_t koneplus_sysfs_write_profile_settings(struct file *fp, |
| struct kobject *kobj, struct bin_attribute *attr, char *buf, |
| loff_t off, size_t count) |
| { |
| struct device *dev = |
| container_of(kobj, struct device, kobj)->parent->parent; |
| struct koneplus_device *koneplus = hid_get_drvdata(dev_get_drvdata(dev)); |
| struct usb_device *usb_dev = interface_to_usbdev(to_usb_interface(dev)); |
| int retval = 0; |
| int difference; |
| int profile_number; |
| struct koneplus_profile_settings *profile_settings; |
| |
| if (off != 0 || count != sizeof(struct koneplus_profile_settings)) |
| return -EINVAL; |
| |
| profile_number = ((struct koneplus_profile_settings const *)buf)->number; |
| profile_settings = &koneplus->profile_settings[profile_number]; |
| |
| mutex_lock(&koneplus->koneplus_lock); |
| difference = memcmp(buf, profile_settings, |
| sizeof(struct koneplus_profile_settings)); |
| if (difference) { |
| retval = koneplus_set_profile_settings(usb_dev, |
| (struct koneplus_profile_settings const *)buf); |
| if (!retval) |
| memcpy(profile_settings, buf, |
| sizeof(struct koneplus_profile_settings)); |
| } |
| mutex_unlock(&koneplus->koneplus_lock); |
| |
| if (retval) |
| return retval; |
| |
| return sizeof(struct koneplus_profile_settings); |
| } |
| |
| static ssize_t koneplus_sysfs_read_profilex_buttons(struct file *fp, |
| struct kobject *kobj, struct bin_attribute *attr, char *buf, |
| loff_t off, size_t count) |
| { |
| struct device *dev = |
| container_of(kobj, struct device, kobj)->parent->parent; |
| struct koneplus_device *koneplus = hid_get_drvdata(dev_get_drvdata(dev)); |
| |
| if (off >= sizeof(struct koneplus_profile_buttons)) |
| return 0; |
| |
| if (off + count > sizeof(struct koneplus_profile_buttons)) |
| count = sizeof(struct koneplus_profile_buttons) - off; |
| |
| mutex_lock(&koneplus->koneplus_lock); |
| memcpy(buf, ((void const *)&koneplus->profile_buttons[*(uint *)(attr->private)]) + off, |
| count); |
| mutex_unlock(&koneplus->koneplus_lock); |
| |
| return count; |
| } |
| |
| static ssize_t koneplus_sysfs_write_profile_buttons(struct file *fp, |
| struct kobject *kobj, struct bin_attribute *attr, char *buf, |
| loff_t off, size_t count) |
| { |
| struct device *dev = |
| container_of(kobj, struct device, kobj)->parent->parent; |
| struct koneplus_device *koneplus = hid_get_drvdata(dev_get_drvdata(dev)); |
| struct usb_device *usb_dev = interface_to_usbdev(to_usb_interface(dev)); |
| int retval = 0; |
| int difference; |
| uint profile_number; |
| struct koneplus_profile_buttons *profile_buttons; |
| |
| if (off != 0 || count != sizeof(struct koneplus_profile_buttons)) |
| return -EINVAL; |
| |
| profile_number = ((struct koneplus_profile_buttons const *)buf)->number; |
| profile_buttons = &koneplus->profile_buttons[profile_number]; |
| |
| mutex_lock(&koneplus->koneplus_lock); |
| difference = memcmp(buf, profile_buttons, |
| sizeof(struct koneplus_profile_buttons)); |
| if (difference) { |
| retval = koneplus_set_profile_buttons(usb_dev, |
| (struct koneplus_profile_buttons const *)buf); |
| if (!retval) |
| memcpy(profile_buttons, buf, |
| sizeof(struct koneplus_profile_buttons)); |
| } |
| mutex_unlock(&koneplus->koneplus_lock); |
| |
| if (retval) |
| return retval; |
| |
| return sizeof(struct koneplus_profile_buttons); |
| } |
| |
| static ssize_t koneplus_sysfs_show_startup_profile(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct koneplus_device *koneplus = |
| hid_get_drvdata(dev_get_drvdata(dev->parent->parent)); |
| return snprintf(buf, PAGE_SIZE, "%d\n", koneplus->startup_profile); |
| } |
| |
| static ssize_t koneplus_sysfs_set_startup_profile(struct device *dev, |
| struct device_attribute *attr, char const *buf, size_t size) |
| { |
| struct koneplus_device *koneplus; |
| struct usb_device *usb_dev; |
| unsigned long profile; |
| int retval; |
| |
| dev = dev->parent->parent; |
| koneplus = hid_get_drvdata(dev_get_drvdata(dev)); |
| usb_dev = interface_to_usbdev(to_usb_interface(dev)); |
| |
| retval = strict_strtoul(buf, 10, &profile); |
| if (retval) |
| return retval; |
| |
| mutex_lock(&koneplus->koneplus_lock); |
| retval = koneplus_set_startup_profile(usb_dev, profile); |
| mutex_unlock(&koneplus->koneplus_lock); |
| if (retval) |
| return retval; |
| |
| return size; |
| } |
| |
| static ssize_t koneplus_sysfs_show_actual_profile(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct koneplus_device *koneplus = |
| hid_get_drvdata(dev_get_drvdata(dev->parent->parent)); |
| return snprintf(buf, PAGE_SIZE, "%d\n", koneplus->actual_profile); |
| } |
| |
| static ssize_t koneplus_sysfs_show_firmware_version(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct koneplus_device *koneplus = |
| hid_get_drvdata(dev_get_drvdata(dev->parent->parent)); |
| return snprintf(buf, PAGE_SIZE, "%d\n", koneplus->info.firmware_version); |
| } |
| |
| static struct device_attribute koneplus_attributes[] = { |
| __ATTR(startup_profile, 0660, |
| koneplus_sysfs_show_startup_profile, |
| koneplus_sysfs_set_startup_profile), |
| __ATTR(actual_profile, 0440, |
| koneplus_sysfs_show_actual_profile, NULL), |
| __ATTR(firmware_version, 0440, |
| koneplus_sysfs_show_firmware_version, NULL), |
| __ATTR_NULL |
| }; |
| |
| static struct bin_attribute koneplus_bin_attributes[] = { |
| { |
| .attr = { .name = "sensor", .mode = 0220 }, |
| .size = sizeof(struct koneplus_sensor), |
| .read = koneplus_sysfs_read_sensor, |
| .write = koneplus_sysfs_write_sensor |
| }, |
| { |
| .attr = { .name = "tcu", .mode = 0220 }, |
| .size = sizeof(struct koneplus_tcu), |
| .write = koneplus_sysfs_write_tcu |
| }, |
| { |
| .attr = { .name = "tcu_image", .mode = 0440 }, |
| .size = sizeof(struct koneplus_tcu_image), |
| .read = koneplus_sysfs_read_tcu_image |
| }, |
| { |
| .attr = { .name = "profile_settings", .mode = 0220 }, |
| .size = sizeof(struct koneplus_profile_settings), |
| .write = koneplus_sysfs_write_profile_settings |
| }, |
| { |
| .attr = { .name = "profile1_settings", .mode = 0440 }, |
| .size = sizeof(struct koneplus_profile_settings), |
| .read = koneplus_sysfs_read_profilex_settings, |
| .private = &profile_numbers[0] |
| }, |
| { |
| .attr = { .name = "profile2_settings", .mode = 0440 }, |
| .size = sizeof(struct koneplus_profile_settings), |
| .read = koneplus_sysfs_read_profilex_settings, |
| .private = &profile_numbers[1] |
| }, |
| { |
| .attr = { .name = "profile3_settings", .mode = 0440 }, |
| .size = sizeof(struct koneplus_profile_settings), |
| .read = koneplus_sysfs_read_profilex_settings, |
| .private = &profile_numbers[2] |
| }, |
| { |
| .attr = { .name = "profile4_settings", .mode = 0440 }, |
| .size = sizeof(struct koneplus_profile_settings), |
| .read = koneplus_sysfs_read_profilex_settings, |
| .private = &profile_numbers[3] |
| }, |
| { |
| .attr = { .name = "profile5_settings", .mode = 0440 }, |
| .size = sizeof(struct koneplus_profile_settings), |
| .read = koneplus_sysfs_read_profilex_settings, |
| .private = &profile_numbers[4] |
| }, |
| { |
| .attr = { .name = "profile_buttons", .mode = 0220 }, |
| .size = sizeof(struct koneplus_profile_buttons), |
| .write = koneplus_sysfs_write_profile_buttons |
| }, |
| { |
| .attr = { .name = "profile1_buttons", .mode = 0440 }, |
| .size = sizeof(struct koneplus_profile_buttons), |
| .read = koneplus_sysfs_read_profilex_buttons, |
| .private = &profile_numbers[0] |
| }, |
| { |
| .attr = { .name = "profile2_buttons", .mode = 0440 }, |
| .size = sizeof(struct koneplus_profile_buttons), |
| .read = koneplus_sysfs_read_profilex_buttons, |
| .private = &profile_numbers[1] |
| }, |
| { |
| .attr = { .name = "profile3_buttons", .mode = 0440 }, |
| .size = sizeof(struct koneplus_profile_buttons), |
| .read = koneplus_sysfs_read_profilex_buttons, |
| .private = &profile_numbers[2] |
| }, |
| { |
| .attr = { .name = "profile4_buttons", .mode = 0440 }, |
| .size = sizeof(struct koneplus_profile_buttons), |
| .read = koneplus_sysfs_read_profilex_buttons, |
| .private = &profile_numbers[3] |
| }, |
| { |
| .attr = { .name = "profile5_buttons", .mode = 0440 }, |
| .size = sizeof(struct koneplus_profile_buttons), |
| .read = koneplus_sysfs_read_profilex_buttons, |
| .private = &profile_numbers[4] |
| }, |
| { |
| .attr = { .name = "macro", .mode = 0220 }, |
| .size = sizeof(struct koneplus_macro), |
| .write = koneplus_sysfs_write_macro |
| }, |
| __ATTR_NULL |
| }; |
| |
| static int koneplus_init_koneplus_device_struct(struct usb_device *usb_dev, |
| struct koneplus_device *koneplus) |
| { |
| int retval, i; |
| static uint wait = 70; /* device will freeze with just 60 */ |
| |
| mutex_init(&koneplus->koneplus_lock); |
| |
| koneplus->startup_profile = koneplus_get_startup_profile(usb_dev); |
| |
| msleep(wait); |
| retval = koneplus_get_info(usb_dev, &koneplus->info); |
| if (retval) |
| return retval; |
| |
| for (i = 0; i < 5; ++i) { |
| msleep(wait); |
| retval = koneplus_get_profile_settings(usb_dev, |
| &koneplus->profile_settings[i], i); |
| if (retval) |
| return retval; |
| |
| msleep(wait); |
| retval = koneplus_get_profile_buttons(usb_dev, |
| &koneplus->profile_buttons[i], i); |
| if (retval) |
| return retval; |
| } |
| |
| koneplus_profile_activated(koneplus, koneplus->startup_profile); |
| |
| return 0; |
| } |
| |
| static int koneplus_init_specials(struct hid_device *hdev) |
| { |
| struct usb_interface *intf = to_usb_interface(hdev->dev.parent); |
| struct usb_device *usb_dev = interface_to_usbdev(intf); |
| struct koneplus_device *koneplus; |
| int retval; |
| |
| if (intf->cur_altsetting->desc.bInterfaceProtocol |
| == USB_INTERFACE_PROTOCOL_MOUSE) { |
| |
| koneplus = kzalloc(sizeof(*koneplus), GFP_KERNEL); |
| if (!koneplus) { |
| dev_err(&hdev->dev, "can't alloc device descriptor\n"); |
| return -ENOMEM; |
| } |
| hid_set_drvdata(hdev, koneplus); |
| |
| retval = koneplus_init_koneplus_device_struct(usb_dev, koneplus); |
| if (retval) { |
| dev_err(&hdev->dev, |
| "couldn't init struct koneplus_device\n"); |
| goto exit_free; |
| } |
| |
| retval = roccat_connect(koneplus_class, hdev); |
| if (retval < 0) { |
| dev_err(&hdev->dev, "couldn't init char dev\n"); |
| } else { |
| koneplus->chrdev_minor = retval; |
| koneplus->roccat_claimed = 1; |
| } |
| } else { |
| hid_set_drvdata(hdev, NULL); |
| } |
| |
| return 0; |
| exit_free: |
| kfree(koneplus); |
| return retval; |
| } |
| |
| static void koneplus_remove_specials(struct hid_device *hdev) |
| { |
| struct usb_interface *intf = to_usb_interface(hdev->dev.parent); |
| struct koneplus_device *koneplus; |
| |
| if (intf->cur_altsetting->desc.bInterfaceProtocol |
| == USB_INTERFACE_PROTOCOL_MOUSE) { |
| koneplus = hid_get_drvdata(hdev); |
| if (koneplus->roccat_claimed) |
| roccat_disconnect(koneplus->chrdev_minor); |
| kfree(koneplus); |
| } |
| } |
| |
| static int koneplus_probe(struct hid_device *hdev, |
| const struct hid_device_id *id) |
| { |
| int retval; |
| |
| retval = hid_parse(hdev); |
| if (retval) { |
| dev_err(&hdev->dev, "parse failed\n"); |
| goto exit; |
| } |
| |
| retval = hid_hw_start(hdev, HID_CONNECT_DEFAULT); |
| if (retval) { |
| dev_err(&hdev->dev, "hw start failed\n"); |
| goto exit; |
| } |
| |
| retval = koneplus_init_specials(hdev); |
| if (retval) { |
| dev_err(&hdev->dev, "couldn't install mouse\n"); |
| goto exit_stop; |
| } |
| |
| return 0; |
| |
| exit_stop: |
| hid_hw_stop(hdev); |
| exit: |
| return retval; |
| } |
| |
| static void koneplus_remove(struct hid_device *hdev) |
| { |
| koneplus_remove_specials(hdev); |
| hid_hw_stop(hdev); |
| } |
| |
| static void koneplus_keep_values_up_to_date(struct koneplus_device *koneplus, |
| u8 const *data) |
| { |
| struct koneplus_mouse_report_button const *button_report; |
| |
| switch (data[0]) { |
| case KONEPLUS_MOUSE_REPORT_NUMBER_BUTTON: |
| button_report = (struct koneplus_mouse_report_button const *)data; |
| switch (button_report->type) { |
| case KONEPLUS_MOUSE_REPORT_BUTTON_TYPE_PROFILE: |
| koneplus_profile_activated(koneplus, button_report->data1 - 1); |
| break; |
| } |
| break; |
| } |
| } |
| |
| static void koneplus_report_to_chrdev(struct koneplus_device const *koneplus, |
| u8 const *data) |
| { |
| struct koneplus_roccat_report roccat_report; |
| struct koneplus_mouse_report_button const *button_report; |
| |
| if (data[0] != KONEPLUS_MOUSE_REPORT_NUMBER_BUTTON) |
| return; |
| |
| button_report = (struct koneplus_mouse_report_button const *)data; |
| |
| if ((button_report->type == KONEPLUS_MOUSE_REPORT_BUTTON_TYPE_QUICKLAUNCH || |
| button_report->type == KONEPLUS_MOUSE_REPORT_BUTTON_TYPE_TIMER) && |
| button_report->data2 != KONEPLUS_MOUSE_REPORT_BUTTON_ACTION_PRESS) |
| return; |
| |
| roccat_report.type = button_report->type; |
| roccat_report.data1 = button_report->data1; |
| roccat_report.data2 = button_report->data2; |
| roccat_report.profile = koneplus->actual_profile + 1; |
| roccat_report_event(koneplus->chrdev_minor, |
| (uint8_t const *)&roccat_report, |
| sizeof(struct koneplus_roccat_report)); |
| } |
| |
| static int koneplus_raw_event(struct hid_device *hdev, |
| struct hid_report *report, u8 *data, int size) |
| { |
| struct usb_interface *intf = to_usb_interface(hdev->dev.parent); |
| struct koneplus_device *koneplus = hid_get_drvdata(hdev); |
| |
| if (intf->cur_altsetting->desc.bInterfaceProtocol |
| != USB_INTERFACE_PROTOCOL_MOUSE) |
| return 0; |
| |
| koneplus_keep_values_up_to_date(koneplus, data); |
| |
| if (koneplus->roccat_claimed) |
| koneplus_report_to_chrdev(koneplus, data); |
| |
| return 0; |
| } |
| |
| static const struct hid_device_id koneplus_devices[] = { |
| { HID_USB_DEVICE(USB_VENDOR_ID_ROCCAT, USB_DEVICE_ID_ROCCAT_KONEPLUS) }, |
| { } |
| }; |
| |
| MODULE_DEVICE_TABLE(hid, koneplus_devices); |
| |
| static struct hid_driver koneplus_driver = { |
| .name = "koneplus", |
| .id_table = koneplus_devices, |
| .probe = koneplus_probe, |
| .remove = koneplus_remove, |
| .raw_event = koneplus_raw_event |
| }; |
| |
| static int __init koneplus_init(void) |
| { |
| int retval; |
| |
| /* class name has to be same as driver name */ |
| koneplus_class = class_create(THIS_MODULE, "koneplus"); |
| if (IS_ERR(koneplus_class)) |
| return PTR_ERR(koneplus_class); |
| koneplus_class->dev_attrs = koneplus_attributes; |
| koneplus_class->dev_bin_attrs = koneplus_bin_attributes; |
| |
| retval = hid_register_driver(&koneplus_driver); |
| if (retval) |
| class_destroy(koneplus_class); |
| return retval; |
| } |
| |
| static void __exit koneplus_exit(void) |
| { |
| class_destroy(koneplus_class); |
| hid_unregister_driver(&koneplus_driver); |
| } |
| |
| module_init(koneplus_init); |
| module_exit(koneplus_exit); |
| |
| MODULE_AUTHOR("Stefan Achatz"); |
| MODULE_DESCRIPTION("USB Roccat Kone[+] driver"); |
| MODULE_LICENSE("GPL v2"); |