drivers/hid/hid-wiimote.c

   1 /*
   2  * HID driver for Nintendo Wiimote devices
   3  * Copyright (c) 2011 David Herrmann
   4  */
   5
   6 /*
   7  * This program is free software; you can redistribute it and/or modify it
   8  * under the terms of the GNU General Public License as published by the Free
   9  * Software Foundation; either version 2 of the License, or (at your option)
  10  * any later version.
  11  */
  12
  13 #include <linux/hid.h>
  14 #include <linux/module.h>
  15 #include "hid-ids.h"
  16
  17 #define WIIMOTE_VERSION "0.1"
  18 #define WIIMOTE_NAME "Nintendo Wii Remote"
  19
  20 struct wiimote_data {
  21         struct hid_device *hdev;
  22 };
  23
  24 static int wiimote_hid_event(struct hid_device *hdev, struct hid_report *report,
  25                                                         u8 *raw_data, int size)
  26 {
  27         if (size < 1)
  28                 return -EINVAL;
  29
  30         return 0;
  31 }
  32
  33 static struct wiimote_data *wiimote_create(struct hid_device *hdev)
  34 {
  35         struct wiimote_data *wdata;
  36
  37         wdata = kzalloc(sizeof(*wdata), GFP_KERNEL);
  38         if (!wdata)
  39                 return NULL;
  40
  41         wdata->hdev = hdev;
  42         hid_set_drvdata(hdev, wdata);
  43
  44         return wdata;
  45 }
  46
  47 static void wiimote_destroy(struct wiimote_data *wdata)
  48 {
  49         kfree(wdata);
  50 }
  51
  52 static int wiimote_hid_probe(struct hid_device *hdev,
  53                                 const struct hid_device_id *id)
  54 {
  55         struct wiimote_data *wdata;
  56         int ret;
  57
  58         wdata = wiimote_create(hdev);
  59         if (!wdata) {
  60                 hid_err(hdev, "Can't alloc device\n");
  61                 return -ENOMEM;
  62         }
  63
  64         ret = hid_parse(hdev);
  65         if (ret) {
  66                 hid_err(hdev, "HID parse failed\n");
  67                 goto err;
  68         }
  69
  70         ret = hid_hw_start(hdev, HID_CONNECT_HIDRAW);
  71         if (ret) {
  72                 hid_err(hdev, "HW start failed\n");
  73                 goto err;
  74         }
  75
  76         hid_info(hdev, "New device registered\n");
  77         return 0;
  78
  79 err:
  80         wiimote_destroy(wdata);
  81         return ret;
  82 }
  83
  84 static void wiimote_hid_remove(struct hid_device *hdev)
  85 {
  86         struct wiimote_data *wdata = hid_get_drvdata(hdev);
  87
  88         hid_info(hdev, "Device removed\n");
  89         hid_hw_stop(hdev);
  90         wiimote_destroy(wdata);
  91 }
  92
  93 static const struct hid_device_id wiimote_hid_devices[] = {
  94         { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NINTENDO,
  95                                 USB_DEVICE_ID_NINTENDO_WIIMOTE) },
  96         { }
  97 };
  98 MODULE_DEVICE_TABLE(hid, wiimote_hid_devices);
  99
 100 static struct hid_driver wiimote_hid_driver = {
 101         .name = "wiimote",
 102         .id_table = wiimote_hid_devices,
 103         .probe = wiimote_hid_probe,
 104         .remove = wiimote_hid_remove,
 105         .raw_event = wiimote_hid_event,
 106 };
 107
 108 static int __init wiimote_init(void)
 109 {
 110         int ret;
 111
 112         ret = hid_register_driver(&wiimote_hid_driver);
 113         if (ret)
 114                 pr_err("Can't register wiimote hid driver\n");
 115
 116         return ret;
 117 }
 118
 119 static void __exit wiimote_exit(void)
 120 {
 121         hid_unregister_driver(&wiimote_hid_driver);
 122 }
 123
 124 module_init(wiimote_init);
 125 module_exit(wiimote_exit);
 126 MODULE_LICENSE("GPL");
 127 MODULE_AUTHOR("David Herrmann <dh.herrmann@gmail.com>");
 128 MODULE_DESCRIPTION(WIIMOTE_NAME " Device Driver");
 129 MODULE_VERSION(WIIMOTE_VERSION);