Lines Matching refs:wdata
45 struct wiimote_data *wdata = container_of(queue, struct wiimote_data, in wiimote_queue_worker() local
50 spin_lock_irqsave(&wdata->queue.lock, flags); in wiimote_queue_worker()
52 while (wdata->queue.head != wdata->queue.tail) { in wiimote_queue_worker()
53 spin_unlock_irqrestore(&wdata->queue.lock, flags); in wiimote_queue_worker()
54 ret = wiimote_hid_send(wdata->hdev, in wiimote_queue_worker()
55 wdata->queue.outq[wdata->queue.tail].data, in wiimote_queue_worker()
56 wdata->queue.outq[wdata->queue.tail].size); in wiimote_queue_worker()
58 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_queue_worker()
59 wiimote_cmd_abort(wdata); in wiimote_queue_worker()
60 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_queue_worker()
62 spin_lock_irqsave(&wdata->queue.lock, flags); in wiimote_queue_worker()
64 wdata->queue.tail = (wdata->queue.tail + 1) % WIIMOTE_BUFSIZE; in wiimote_queue_worker()
67 spin_unlock_irqrestore(&wdata->queue.lock, flags); in wiimote_queue_worker()
70 static void wiimote_queue(struct wiimote_data *wdata, const __u8 *buffer, in wiimote_queue() argument
77 hid_warn(wdata->hdev, "Sending too large output report\n"); in wiimote_queue()
79 spin_lock_irqsave(&wdata->queue.lock, flags); in wiimote_queue()
93 spin_lock_irqsave(&wdata->queue.lock, flags); in wiimote_queue()
95 memcpy(wdata->queue.outq[wdata->queue.head].data, buffer, count); in wiimote_queue()
96 wdata->queue.outq[wdata->queue.head].size = count; in wiimote_queue()
97 newhead = (wdata->queue.head + 1) % WIIMOTE_BUFSIZE; in wiimote_queue()
99 if (wdata->queue.head == wdata->queue.tail) { in wiimote_queue()
100 wdata->queue.head = newhead; in wiimote_queue()
101 schedule_work(&wdata->queue.worker); in wiimote_queue()
102 } else if (newhead != wdata->queue.tail) { in wiimote_queue()
103 wdata->queue.head = newhead; in wiimote_queue()
105 hid_warn(wdata->hdev, "Output queue is full"); in wiimote_queue()
112 wiimote_cmd_abort(wdata); in wiimote_queue()
114 spin_unlock_irqrestore(&wdata->queue.lock, flags); in wiimote_queue()
124 static inline void wiiproto_keep_rumble(struct wiimote_data *wdata, __u8 *cmd1) in wiiproto_keep_rumble() argument
126 if (wdata->state.flags & WIIPROTO_FLAG_RUMBLE) in wiiproto_keep_rumble()
130 void wiiproto_req_rumble(struct wiimote_data *wdata, __u8 rumble) in wiiproto_req_rumble() argument
135 if (rumble == !!(wdata->state.flags & WIIPROTO_FLAG_RUMBLE)) in wiiproto_req_rumble()
139 wdata->state.flags |= WIIPROTO_FLAG_RUMBLE; in wiiproto_req_rumble()
141 wdata->state.flags &= ~WIIPROTO_FLAG_RUMBLE; in wiiproto_req_rumble()
146 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_rumble()
147 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_rumble()
150 void wiiproto_req_leds(struct wiimote_data *wdata, int leds) in wiiproto_req_leds() argument
155 if ((wdata->state.flags & WIIPROTO_FLAGS_LEDS) == leds) in wiiproto_req_leds()
157 wdata->state.flags = (wdata->state.flags & ~WIIPROTO_FLAGS_LEDS) | leds; in wiiproto_req_leds()
171 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_leds()
172 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_leds()
194 static __u8 select_drm(struct wiimote_data *wdata) in select_drm() argument
196 __u8 ir = wdata->state.flags & WIIPROTO_FLAGS_IR; in select_drm()
199 ext = (wdata->state.flags & WIIPROTO_FLAG_EXT_USED) || in select_drm()
200 (wdata->state.flags & WIIPROTO_FLAG_MP_USED); in select_drm()
203 if (wdata->state.devtype == WIIMOTE_DEV_BALANCE_BOARD) { in select_drm()
211 if (wdata->state.flags & WIIPROTO_FLAG_ACCEL) { in select_drm()
226 if (wdata->state.flags & WIIPROTO_FLAG_ACCEL) { in select_drm()
240 void wiiproto_req_drm(struct wiimote_data *wdata, __u8 drm) in wiiproto_req_drm() argument
244 if (wdata->state.flags & WIIPROTO_FLAG_DRM_LOCKED) in wiiproto_req_drm()
245 drm = wdata->state.drm; in wiiproto_req_drm()
247 drm = select_drm(wdata); in wiiproto_req_drm()
253 wdata->state.drm = drm; in wiiproto_req_drm()
254 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_drm()
255 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_drm()
258 void wiiproto_req_status(struct wiimote_data *wdata) in wiiproto_req_status() argument
265 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_status()
266 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_status()
269 void wiiproto_req_accel(struct wiimote_data *wdata, __u8 accel) in wiiproto_req_accel() argument
272 if (accel == !!(wdata->state.flags & WIIPROTO_FLAG_ACCEL)) in wiiproto_req_accel()
276 wdata->state.flags |= WIIPROTO_FLAG_ACCEL; in wiiproto_req_accel()
278 wdata->state.flags &= ~WIIPROTO_FLAG_ACCEL; in wiiproto_req_accel()
280 wiiproto_req_drm(wdata, WIIPROTO_REQ_NULL); in wiiproto_req_accel()
283 void wiiproto_req_ir1(struct wiimote_data *wdata, __u8 flags) in wiiproto_req_ir1() argument
290 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_ir1()
291 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_ir1()
294 void wiiproto_req_ir2(struct wiimote_data *wdata, __u8 flags) in wiiproto_req_ir2() argument
301 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_ir2()
302 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_ir2()
305 #define wiiproto_req_wreg(wdata, os, buf, sz) \ argument
306 wiiproto_req_wmem((wdata), false, (os), (buf), (sz))
308 #define wiiproto_req_weeprom(wdata, os, buf, sz) \ argument
309 wiiproto_req_wmem((wdata), true, (os), (buf), (sz))
311 static void wiiproto_req_wmem(struct wiimote_data *wdata, bool eeprom, in wiiproto_req_wmem() argument
317 hid_warn(wdata->hdev, "Invalid length %d wmem request\n", size); in wiiproto_req_wmem()
332 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_wmem()
333 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_wmem()
336 void wiiproto_req_rmem(struct wiimote_data *wdata, bool eeprom, __u32 offset, in wiiproto_req_rmem() argument
342 hid_warn(wdata->hdev, "Invalid length %d rmem request\n", size); in wiiproto_req_rmem()
357 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_rmem()
358 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_rmem()
362 int wiimote_cmd_write(struct wiimote_data *wdata, __u32 offset, in wiimote_cmd_write() argument
368 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_cmd_write()
369 wiimote_cmd_set(wdata, WIIPROTO_REQ_WMEM, 0); in wiimote_cmd_write()
370 wiiproto_req_wreg(wdata, offset, wmem, size); in wiimote_cmd_write()
371 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_cmd_write()
373 ret = wiimote_cmd_wait(wdata); in wiimote_cmd_write()
374 if (!ret && wdata->state.cmd_err) in wiimote_cmd_write()
381 ssize_t wiimote_cmd_read(struct wiimote_data *wdata, __u32 offset, __u8 *rmem, in wiimote_cmd_read() argument
387 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_cmd_read()
388 wdata->state.cmd_read_size = size; in wiimote_cmd_read()
389 wdata->state.cmd_read_buf = rmem; in wiimote_cmd_read()
390 wiimote_cmd_set(wdata, WIIPROTO_REQ_RMEM, offset & 0xffff); in wiimote_cmd_read()
391 wiiproto_req_rreg(wdata, offset, size); in wiimote_cmd_read()
392 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_cmd_read()
394 ret = wiimote_cmd_wait(wdata); in wiimote_cmd_read()
396 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_cmd_read()
397 wdata->state.cmd_read_buf = NULL; in wiimote_cmd_read()
398 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_cmd_read()
401 if (wdata->state.cmd_read_size == 0) in wiimote_cmd_read()
404 ret = wdata->state.cmd_read_size; in wiimote_cmd_read()
411 static int wiimote_cmd_init_ext(struct wiimote_data *wdata) in wiimote_cmd_init_ext() argument
418 ret = wiimote_cmd_write(wdata, 0xa400f0, &wmem, sizeof(wmem)); in wiimote_cmd_init_ext()
424 ret = wiimote_cmd_write(wdata, 0xa400fb, &wmem, sizeof(wmem)); in wiimote_cmd_init_ext()
432 static __u8 wiimote_cmd_read_ext(struct wiimote_data *wdata, __u8 *rmem) in wiimote_cmd_read_ext() argument
437 ret = wiimote_cmd_read(wdata, 0xa400fa, rmem, 6); in wiimote_cmd_read_ext()
441 hid_dbg(wdata->hdev, "extension ID: %6phC\n", rmem); in wiimote_cmd_read_ext()
469 static int wiimote_cmd_init_mp(struct wiimote_data *wdata) in wiimote_cmd_init_mp() argument
476 ret = wiimote_cmd_write(wdata, 0xa600f0, &wmem, sizeof(wmem)); in wiimote_cmd_init_mp()
482 ret = wiimote_cmd_write(wdata, 0xa600fb, &wmem, sizeof(wmem)); in wiimote_cmd_init_mp()
490 static bool wiimote_cmd_map_mp(struct wiimote_data *wdata, __u8 exttype) in wiimote_cmd_map_mp() argument
510 return wiimote_cmd_write(wdata, 0xa600fe, &wmem, sizeof(wmem)); in wiimote_cmd_map_mp()
514 static bool wiimote_cmd_read_mp(struct wiimote_data *wdata, __u8 *rmem) in wiimote_cmd_read_mp() argument
519 ret = wiimote_cmd_read(wdata, 0xa600fa, rmem, 6); in wiimote_cmd_read_mp()
523 hid_dbg(wdata->hdev, "motion plus ID: %6phC\n", rmem); in wiimote_cmd_read_mp()
528 hid_info(wdata->hdev, "unknown motion plus ID: %6phC\n", rmem); in wiimote_cmd_read_mp()
534 static __u8 wiimote_cmd_read_mp_mapped(struct wiimote_data *wdata) in wiimote_cmd_read_mp_mapped() argument
540 ret = wiimote_cmd_read(wdata, 0xa400fa, rmem, 6); in wiimote_cmd_read_mp_mapped()
544 hid_dbg(wdata->hdev, "mapped motion plus ID: %6phC\n", rmem); in wiimote_cmd_read_mp_mapped()
624 static void wiimote_modules_load(struct wiimote_data *wdata, in wiimote_modules_load() argument
642 wdata->input = input_allocate_device(); in wiimote_modules_load()
643 if (!wdata->input) in wiimote_modules_load()
646 input_set_drvdata(wdata->input, wdata); in wiimote_modules_load()
647 wdata->input->dev.parent = &wdata->hdev->dev; in wiimote_modules_load()
648 wdata->input->id.bustype = wdata->hdev->bus; in wiimote_modules_load()
649 wdata->input->id.vendor = wdata->hdev->vendor; in wiimote_modules_load()
650 wdata->input->id.product = wdata->hdev->product; in wiimote_modules_load()
651 wdata->input->id.version = wdata->hdev->version; in wiimote_modules_load()
652 wdata->input->name = WIIMOTE_NAME; in wiimote_modules_load()
660 ret = ops->probe(ops, wdata); in wiimote_modules_load()
665 if (wdata->input) { in wiimote_modules_load()
666 ret = input_register_device(wdata->input); in wiimote_modules_load()
671 spin_lock_irq(&wdata->state.lock); in wiimote_modules_load()
672 wdata->state.devtype = devtype; in wiimote_modules_load()
673 spin_unlock_irq(&wdata->state.lock); in wiimote_modules_load()
680 ops->remove(ops, wdata); in wiimote_modules_load()
683 if (wdata->input) { in wiimote_modules_load()
684 input_free_device(wdata->input); in wiimote_modules_load()
685 wdata->input = NULL; in wiimote_modules_load()
689 static void wiimote_modules_unload(struct wiimote_data *wdata) in wiimote_modules_unload() argument
695 mods = wiimote_devtype_mods[wdata->state.devtype]; in wiimote_modules_unload()
697 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_modules_unload()
698 wdata->state.devtype = WIIMOTE_DEV_UNKNOWN; in wiimote_modules_unload()
699 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_modules_unload()
705 if (wdata->input) { in wiimote_modules_unload()
706 input_get_device(wdata->input); in wiimote_modules_unload()
707 input_unregister_device(wdata->input); in wiimote_modules_unload()
713 ops->remove(ops, wdata); in wiimote_modules_unload()
716 if (wdata->input) { in wiimote_modules_unload()
717 input_put_device(wdata->input); in wiimote_modules_unload()
718 wdata->input = NULL; in wiimote_modules_unload()
724 static void wiimote_ext_load(struct wiimote_data *wdata, unsigned int ext) in wiimote_ext_load() argument
733 ret = ops->probe(ops, wdata); in wiimote_ext_load()
738 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_ext_load()
739 wdata->state.exttype = ext; in wiimote_ext_load()
740 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_ext_load()
743 static void wiimote_ext_unload(struct wiimote_data *wdata) in wiimote_ext_unload() argument
748 ops = wiimod_ext_table[wdata->state.exttype]; in wiimote_ext_unload()
750 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_ext_unload()
751 wdata->state.exttype = WIIMOTE_EXT_UNKNOWN; in wiimote_ext_unload()
752 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_USED; in wiimote_ext_unload()
753 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_ext_unload()
756 ops->remove(ops, wdata); in wiimote_ext_unload()
759 static void wiimote_mp_load(struct wiimote_data *wdata) in wiimote_mp_load() argument
768 ret = ops->probe(ops, wdata); in wiimote_mp_load()
773 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_mp_load()
774 wdata->state.mp = mode; in wiimote_mp_load()
775 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_mp_load()
778 static void wiimote_mp_unload(struct wiimote_data *wdata) in wiimote_mp_unload() argument
783 if (wdata->state.mp < 2) in wiimote_mp_unload()
788 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_mp_unload()
789 wdata->state.mp = 0; in wiimote_mp_unload()
790 wdata->state.flags &= ~WIIPROTO_FLAG_MP_USED; in wiimote_mp_unload()
791 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_mp_unload()
794 ops->remove(ops, wdata); in wiimote_mp_unload()
813 static void wiimote_init_set_type(struct wiimote_data *wdata, in wiimote_init_set_type() argument
820 vendor = wdata->hdev->vendor; in wiimote_init_set_type()
821 product = wdata->hdev->product; in wiimote_init_set_type()
822 name = wdata->hdev->name; in wiimote_init_set_type()
858 hid_info(wdata->hdev, "cannot detect device; NAME: %s VID: %04x PID: %04x EXT: %04x\n", in wiimote_init_set_type()
861 hid_info(wdata->hdev, "detected device: %s\n", in wiimote_init_set_type()
864 wiimote_modules_load(wdata, devtype); in wiimote_init_set_type()
867 static void wiimote_init_detect(struct wiimote_data *wdata) in wiimote_init_detect() argument
873 wiimote_cmd_acquire_noint(wdata); in wiimote_init_detect()
875 spin_lock_irq(&wdata->state.lock); in wiimote_init_detect()
876 wdata->state.devtype = WIIMOTE_DEV_UNKNOWN; in wiimote_init_detect()
877 wiimote_cmd_set(wdata, WIIPROTO_REQ_SREQ, 0); in wiimote_init_detect()
878 wiiproto_req_status(wdata); in wiimote_init_detect()
879 spin_unlock_irq(&wdata->state.lock); in wiimote_init_detect()
881 ret = wiimote_cmd_wait_noint(wdata); in wiimote_init_detect()
885 spin_lock_irq(&wdata->state.lock); in wiimote_init_detect()
886 ext = wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED; in wiimote_init_detect()
887 spin_unlock_irq(&wdata->state.lock); in wiimote_init_detect()
892 wiimote_cmd_init_ext(wdata); in wiimote_init_detect()
893 exttype = wiimote_cmd_read_ext(wdata, extdata); in wiimote_init_detect()
896 wiimote_cmd_release(wdata); in wiimote_init_detect()
897 wiimote_init_set_type(wdata, exttype); in wiimote_init_detect()
900 spin_lock_irq(&wdata->state.lock); in wiimote_init_detect()
901 if (!(wdata->state.flags & WIIPROTO_FLAG_BUILTIN_MP) && in wiimote_init_detect()
902 !(wdata->state.flags & WIIPROTO_FLAG_NO_MP)) in wiimote_init_detect()
903 mod_timer(&wdata->timer, jiffies + HZ * 4); in wiimote_init_detect()
904 spin_unlock_irq(&wdata->state.lock); in wiimote_init_detect()
913 static void wiimote_init_poll_mp(struct wiimote_data *wdata) in wiimote_init_poll_mp() argument
918 wiimote_cmd_acquire_noint(wdata); in wiimote_init_poll_mp()
919 wiimote_cmd_init_mp(wdata); in wiimote_init_poll_mp()
920 mp = wiimote_cmd_read_mp(wdata, mpdata); in wiimote_init_poll_mp()
921 wiimote_cmd_release(wdata); in wiimote_init_poll_mp()
925 if (!wdata->state.mp) { in wiimote_init_poll_mp()
926 hid_info(wdata->hdev, "detected extension: Nintendo Wii Motion Plus\n"); in wiimote_init_poll_mp()
927 wiimote_mp_load(wdata); in wiimote_init_poll_mp()
929 } else if (wdata->state.mp) { in wiimote_init_poll_mp()
930 wiimote_mp_unload(wdata); in wiimote_init_poll_mp()
933 mod_timer(&wdata->timer, jiffies + HZ * 4); in wiimote_init_poll_mp()
946 static bool wiimote_init_check(struct wiimote_data *wdata) in wiimote_init_check() argument
952 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
953 flags = wdata->state.flags; in wiimote_init_check()
954 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
956 wiimote_cmd_acquire_noint(wdata); in wiimote_init_check()
965 if (wdata->state.exttype == WIIMOTE_EXT_NONE && in wiimote_init_check()
966 wdata->state.mp > 0 && (flags & WIIPROTO_FLAG_MP_USED)) { in wiimote_init_check()
967 type = wiimote_cmd_read_mp_mapped(wdata); in wiimote_init_check()
970 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
971 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE); in wiimote_init_check()
972 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_MP_PLUGGED); in wiimote_init_check()
973 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE); in wiimote_init_check()
974 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
977 hid_dbg(wdata->hdev, "state left: !EXT && MP\n"); in wiimote_init_check()
991 wdata->state.exttype != WIIMOTE_EXT_NONE) { in wiimote_init_check()
992 type = wiimote_cmd_read_ext(wdata, data); in wiimote_init_check()
993 ret = type == wdata->state.exttype; in wiimote_init_check()
995 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
996 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE); in wiimote_init_check()
997 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE); in wiimote_init_check()
998 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
1001 hid_dbg(wdata->hdev, "state left: EXT && !MP\n"); in wiimote_init_check()
1017 wdata->state.exttype == WIIMOTE_EXT_NONE) { in wiimote_init_check()
1018 type = wiimote_cmd_read_ext(wdata, data); in wiimote_init_check()
1019 ret = type == wdata->state.exttype; in wiimote_init_check()
1021 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
1022 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE); in wiimote_init_check()
1023 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE); in wiimote_init_check()
1024 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED); in wiimote_init_check()
1025 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
1028 hid_dbg(wdata->hdev, "state left: !EXT && !MP\n"); in wiimote_init_check()
1044 if (wdata->state.exttype != WIIMOTE_EXT_NONE && in wiimote_init_check()
1045 wdata->state.mp > 0 && (flags & WIIPROTO_FLAG_MP_USED)) { in wiimote_init_check()
1046 type = wiimote_cmd_read_mp_mapped(wdata); in wiimote_init_check()
1051 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
1052 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED); in wiimote_init_check()
1053 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE); in wiimote_init_check()
1054 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE); in wiimote_init_check()
1055 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
1058 hid_dbg(wdata->hdev, "state left: EXT && MP\n"); in wiimote_init_check()
1070 wiimote_cmd_release(wdata); in wiimote_init_check()
1075 wiimote_init_poll_mp(wdata); in wiimote_init_check()
1100 static void wiimote_init_hotplug(struct wiimote_data *wdata) in wiimote_init_hotplug() argument
1106 hid_dbg(wdata->hdev, "detect extensions..\n"); in wiimote_init_hotplug()
1108 wiimote_cmd_acquire_noint(wdata); in wiimote_init_hotplug()
1110 spin_lock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1113 flags = wdata->state.flags; in wiimote_init_hotplug()
1116 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_ACTIVE; in wiimote_init_hotplug()
1117 wdata->state.flags &= ~WIIPROTO_FLAG_MP_ACTIVE; in wiimote_init_hotplug()
1119 spin_unlock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1122 wiimote_cmd_init_ext(wdata); in wiimote_init_hotplug()
1126 wiimote_cmd_init_mp(wdata); in wiimote_init_hotplug()
1127 mp = wiimote_cmd_read_mp(wdata, mpdata); in wiimote_init_hotplug()
1129 exttype = wiimote_cmd_read_ext(wdata, extdata); in wiimote_init_hotplug()
1131 wiimote_cmd_release(wdata); in wiimote_init_hotplug()
1134 if (exttype != wdata->state.exttype) { in wiimote_init_hotplug()
1136 wiimote_ext_unload(wdata); in wiimote_init_hotplug()
1139 hid_info(wdata->hdev, "cannot detect extension; %6phC\n", in wiimote_init_hotplug()
1142 spin_lock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1143 wdata->state.exttype = WIIMOTE_EXT_NONE; in wiimote_init_hotplug()
1144 spin_unlock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1146 hid_info(wdata->hdev, "detected extension: %s\n", in wiimote_init_hotplug()
1149 wiimote_ext_load(wdata, exttype); in wiimote_init_hotplug()
1155 if (!wdata->state.mp) { in wiimote_init_hotplug()
1156 hid_info(wdata->hdev, "detected extension: Nintendo Wii Motion Plus\n"); in wiimote_init_hotplug()
1157 wiimote_mp_load(wdata); in wiimote_init_hotplug()
1159 } else if (wdata->state.mp) { in wiimote_init_hotplug()
1160 wiimote_mp_unload(wdata); in wiimote_init_hotplug()
1169 wiimote_cmd_acquire_noint(wdata); in wiimote_init_hotplug()
1170 wiimote_cmd_map_mp(wdata, exttype); in wiimote_init_hotplug()
1171 wiimote_cmd_release(wdata); in wiimote_init_hotplug()
1174 del_timer_sync(&wdata->timer); in wiimote_init_hotplug()
1179 mod_timer(&wdata->timer, jiffies + HZ * 4); in wiimote_init_hotplug()
1182 spin_lock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1186 wdata->state.flags |= WIIPROTO_FLAG_MP_ACTIVE; in wiimote_init_hotplug()
1187 if (wdata->state.exttype == WIIMOTE_EXT_NONE) { in wiimote_init_hotplug()
1188 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_PLUGGED; in wiimote_init_hotplug()
1189 wdata->state.flags &= ~WIIPROTO_FLAG_MP_PLUGGED; in wiimote_init_hotplug()
1191 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_PLUGGED; in wiimote_init_hotplug()
1192 wdata->state.flags |= WIIPROTO_FLAG_MP_PLUGGED; in wiimote_init_hotplug()
1193 wdata->state.flags |= WIIPROTO_FLAG_EXT_ACTIVE; in wiimote_init_hotplug()
1195 } else if (wdata->state.exttype != WIIMOTE_EXT_NONE) { in wiimote_init_hotplug()
1196 wdata->state.flags |= WIIPROTO_FLAG_EXT_ACTIVE; in wiimote_init_hotplug()
1200 wiiproto_req_status(wdata); in wiimote_init_hotplug()
1202 spin_unlock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1204 hid_dbg(wdata->hdev, "detected extensions: MP: %d EXT: %d\n", in wiimote_init_hotplug()
1205 wdata->state.mp, wdata->state.exttype); in wiimote_init_hotplug()
1210 struct wiimote_data *wdata = container_of(work, struct wiimote_data, in wiimote_init_worker() local
1214 if (wdata->state.devtype == WIIMOTE_DEV_PENDING) { in wiimote_init_worker()
1215 wiimote_init_detect(wdata); in wiimote_init_worker()
1219 if (changed || !wiimote_init_check(wdata)) in wiimote_init_worker()
1220 wiimote_init_hotplug(wdata); in wiimote_init_worker()
1223 kobject_uevent(&wdata->hdev->dev.kobj, KOBJ_CHANGE); in wiimote_init_worker()
1226 void __wiimote_schedule(struct wiimote_data *wdata) in __wiimote_schedule() argument
1228 if (!(wdata->state.flags & WIIPROTO_FLAG_EXITING)) in __wiimote_schedule()
1229 schedule_work(&wdata->init_worker); in __wiimote_schedule()
1232 static void wiimote_schedule(struct wiimote_data *wdata) in wiimote_schedule() argument
1236 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_schedule()
1237 __wiimote_schedule(wdata); in wiimote_schedule()
1238 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_schedule()
1243 struct wiimote_data *wdata = from_timer(wdata, t, timer); in wiimote_init_timeout() local
1245 wiimote_schedule(wdata); in wiimote_init_timeout()
1250 static void handler_keys(struct wiimote_data *wdata, const __u8 *payload) in handler_keys() argument
1255 ops = wiimod_ext_table[wdata->state.exttype]; in handler_keys()
1257 ops->in_keys(wdata, payload); in handler_keys()
1261 mods = wiimote_devtype_mods[wdata->state.devtype]; in handler_keys()
1265 ops->in_keys(wdata, payload); in handler_keys()
1271 static void handler_accel(struct wiimote_data *wdata, const __u8 *payload) in handler_accel() argument
1276 ops = wiimod_ext_table[wdata->state.exttype]; in handler_accel()
1278 ops->in_accel(wdata, payload); in handler_accel()
1282 mods = wiimote_devtype_mods[wdata->state.devtype]; in handler_accel()
1286 ops->in_accel(wdata, payload); in handler_accel()
1304 static void handler_ext(struct wiimote_data *wdata, const __u8 *payload, in handler_ext() argument
1323 if (wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE) { in handler_ext()
1329 if (!(wdata->state.flags & WIIPROTO_FLAG_MP_PLUGGED)) { in handler_ext()
1330 hid_dbg(wdata->hdev, "MP hotplug: 1\n"); in handler_ext()
1331 wdata->state.flags |= WIIPROTO_FLAG_MP_PLUGGED; in handler_ext()
1332 __wiimote_schedule(wdata); in handler_ext()
1335 if (wdata->state.flags & WIIPROTO_FLAG_MP_PLUGGED) { in handler_ext()
1336 hid_dbg(wdata->hdev, "MP hotplug: 0\n"); in handler_ext()
1337 wdata->state.flags &= ~WIIPROTO_FLAG_MP_PLUGGED; in handler_ext()
1338 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_ACTIVE; in handler_ext()
1339 __wiimote_schedule(wdata); in handler_ext()
1350 if (!(wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE) && !is_mp) in handler_ext()
1354 ops = wiimod_ext_table[wdata->state.exttype]; in handler_ext()
1356 ops->in_mp(wdata, payload); in handler_ext()
1359 ops->in_ext(wdata, payload); in handler_ext()
1366 ops->in_mp(wdata, payload); in handler_ext()
1369 ops->in_ext(wdata, payload); in handler_ext()
1374 mods = wiimote_devtype_mods[wdata->state.devtype]; in handler_ext()
1378 ops->in_mp(wdata, payload); in handler_ext()
1381 ops->in_ext(wdata, payload); in handler_ext()
1387 #define ir_to_input0(wdata, ir, packed) handler_ir((wdata), (ir), (packed), 0) argument
1388 #define ir_to_input1(wdata, ir, packed) handler_ir((wdata), (ir), (packed), 1) argument
1389 #define ir_to_input2(wdata, ir, packed) handler_ir((wdata), (ir), (packed), 2) argument
1390 #define ir_to_input3(wdata, ir, packed) handler_ir((wdata), (ir), (packed), 3) argument
1392 static void handler_ir(struct wiimote_data *wdata, const __u8 *payload, in handler_ir() argument
1398 ops = wiimod_ext_table[wdata->state.exttype]; in handler_ir()
1400 ops->in_ir(wdata, payload, packed, id); in handler_ir()
1404 mods = wiimote_devtype_mods[wdata->state.devtype]; in handler_ir()
1408 ops->in_ir(wdata, payload, packed, id); in handler_ir()
1415 static void handler_status_K(struct wiimote_data *wdata, in handler_status_K() argument
1418 handler_keys(wdata, payload); in handler_status_K()
1421 wiiproto_req_drm(wdata, WIIPROTO_REQ_NULL); in handler_status_K()
1425 static void handler_status(struct wiimote_data *wdata, const __u8 *payload) in handler_status() argument
1427 handler_status_K(wdata, payload); in handler_status()
1431 if (!(wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED)) { in handler_status()
1432 hid_dbg(wdata->hdev, "EXT hotplug: 1\n"); in handler_status()
1433 wdata->state.flags |= WIIPROTO_FLAG_EXT_PLUGGED; in handler_status()
1434 __wiimote_schedule(wdata); in handler_status()
1437 if (wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED) { in handler_status()
1438 hid_dbg(wdata->hdev, "EXT hotplug: 0\n"); in handler_status()
1439 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_PLUGGED; in handler_status()
1440 wdata->state.flags &= ~WIIPROTO_FLAG_MP_PLUGGED; in handler_status()
1441 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_ACTIVE; in handler_status()
1442 wdata->state.flags &= ~WIIPROTO_FLAG_MP_ACTIVE; in handler_status()
1443 __wiimote_schedule(wdata); in handler_status()
1447 wdata->state.cmd_battery = payload[5]; in handler_status()
1448 if (wiimote_cmd_pending(wdata, WIIPROTO_REQ_SREQ, 0)) in handler_status()
1449 wiimote_cmd_complete(wdata); in handler_status()
1453 static void handler_generic_K(struct wiimote_data *wdata, const __u8 *payload) in handler_generic_K() argument
1455 handler_keys(wdata, payload); in handler_generic_K()
1458 static void handler_data(struct wiimote_data *wdata, const __u8 *payload) in handler_data() argument
1464 handler_keys(wdata, payload); in handler_data()
1466 if (wiimote_cmd_pending(wdata, WIIPROTO_REQ_RMEM, offset)) { in handler_data()
1469 else if (size > wdata->state.cmd_read_size) in handler_data()
1470 size = wdata->state.cmd_read_size; in handler_data()
1472 wdata->state.cmd_read_size = size; in handler_data()
1473 if (wdata->state.cmd_read_buf) in handler_data()
1474 memcpy(wdata->state.cmd_read_buf, &payload[5], size); in handler_data()
1475 wiimote_cmd_complete(wdata); in handler_data()
1479 static void handler_return(struct wiimote_data *wdata, const __u8 *payload) in handler_return() argument
1484 handler_keys(wdata, payload); in handler_return()
1486 if (wiimote_cmd_pending(wdata, cmd, 0)) { in handler_return()
1487 wdata->state.cmd_err = err; in handler_return()
1488 wiimote_cmd_complete(wdata); in handler_return()
1490 hid_warn(wdata->hdev, "Remote error %u on req %u\n", err, in handler_return()
1495 static void handler_drm_KA(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KA() argument
1497 handler_keys(wdata, payload); in handler_drm_KA()
1498 handler_accel(wdata, payload); in handler_drm_KA()
1501 static void handler_drm_KE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KE() argument
1503 handler_keys(wdata, payload); in handler_drm_KE()
1504 handler_ext(wdata, &payload[2], 8); in handler_drm_KE()
1507 static void handler_drm_KAI(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KAI() argument
1509 handler_keys(wdata, payload); in handler_drm_KAI()
1510 handler_accel(wdata, payload); in handler_drm_KAI()
1511 ir_to_input0(wdata, &payload[5], false); in handler_drm_KAI()
1512 ir_to_input1(wdata, &payload[8], false); in handler_drm_KAI()
1513 ir_to_input2(wdata, &payload[11], false); in handler_drm_KAI()
1514 ir_to_input3(wdata, &payload[14], false); in handler_drm_KAI()
1517 static void handler_drm_KEE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KEE() argument
1519 handler_keys(wdata, payload); in handler_drm_KEE()
1520 handler_ext(wdata, &payload[2], 19); in handler_drm_KEE()
1523 static void handler_drm_KIE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KIE() argument
1525 handler_keys(wdata, payload); in handler_drm_KIE()
1526 ir_to_input0(wdata, &payload[2], false); in handler_drm_KIE()
1527 ir_to_input1(wdata, &payload[4], true); in handler_drm_KIE()
1528 ir_to_input2(wdata, &payload[7], false); in handler_drm_KIE()
1529 ir_to_input3(wdata, &payload[9], true); in handler_drm_KIE()
1530 handler_ext(wdata, &payload[12], 9); in handler_drm_KIE()
1533 static void handler_drm_KAE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KAE() argument
1535 handler_keys(wdata, payload); in handler_drm_KAE()
1536 handler_accel(wdata, payload); in handler_drm_KAE()
1537 handler_ext(wdata, &payload[5], 16); in handler_drm_KAE()
1540 static void handler_drm_KAIE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KAIE() argument
1542 handler_keys(wdata, payload); in handler_drm_KAIE()
1543 handler_accel(wdata, payload); in handler_drm_KAIE()
1544 ir_to_input0(wdata, &payload[5], false); in handler_drm_KAIE()
1545 ir_to_input1(wdata, &payload[7], true); in handler_drm_KAIE()
1546 ir_to_input2(wdata, &payload[10], false); in handler_drm_KAIE()
1547 ir_to_input3(wdata, &payload[12], true); in handler_drm_KAIE()
1548 handler_ext(wdata, &payload[15], 6); in handler_drm_KAIE()
1551 static void handler_drm_E(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_E() argument
1553 handler_ext(wdata, payload, 21); in handler_drm_E()
1556 static void handler_drm_SKAI1(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_SKAI1() argument
1558 handler_keys(wdata, payload); in handler_drm_SKAI1()
1560 wdata->state.accel_split[0] = payload[2]; in handler_drm_SKAI1()
1561 wdata->state.accel_split[1] = (payload[0] >> 1) & (0x10 | 0x20); in handler_drm_SKAI1()
1562 wdata->state.accel_split[1] |= (payload[1] << 1) & (0x40 | 0x80); in handler_drm_SKAI1()
1564 ir_to_input0(wdata, &payload[3], false); in handler_drm_SKAI1()
1565 ir_to_input1(wdata, &payload[12], false); in handler_drm_SKAI1()
1568 static void handler_drm_SKAI2(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_SKAI2() argument
1572 handler_keys(wdata, payload); in handler_drm_SKAI2()
1574 wdata->state.accel_split[1] |= (payload[0] >> 5) & (0x01 | 0x02); in handler_drm_SKAI2()
1575 wdata->state.accel_split[1] |= (payload[1] >> 3) & (0x04 | 0x08); in handler_drm_SKAI2()
1579 buf[2] = wdata->state.accel_split[0]; in handler_drm_SKAI2()
1581 buf[4] = wdata->state.accel_split[1]; in handler_drm_SKAI2()
1582 handler_accel(wdata, buf); in handler_drm_SKAI2()
1584 ir_to_input2(wdata, &payload[3], false); in handler_drm_SKAI2()
1585 ir_to_input3(wdata, &payload[12], false); in handler_drm_SKAI2()
1591 void (*func)(struct wiimote_data *wdata, const __u8 *payload);
1625 struct wiimote_data *wdata = hid_get_drvdata(hdev); in wiimote_hid_event() local
1636 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_hid_event()
1637 h->func(wdata, &raw_data[1]); in wiimote_hid_event()
1638 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_hid_event()
1654 struct wiimote_data *wdata = dev_to_wii(dev); in wiimote_ext_show() local
1658 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_ext_show()
1659 type = wdata->state.exttype; in wiimote_ext_show()
1660 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_ext_show()
1689 struct wiimote_data *wdata = dev_to_wii(dev); in wiimote_ext_store() local
1692 wiimote_schedule(wdata); in wiimote_ext_store()
1707 struct wiimote_data *wdata = dev_to_wii(dev); in wiimote_dev_show() local
1711 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_dev_show()
1712 type = wdata->state.devtype; in wiimote_dev_show()
1713 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_dev_show()
1738 struct wiimote_data *wdata; in wiimote_create() local
1740 wdata = kzalloc(sizeof(*wdata), GFP_KERNEL); in wiimote_create()
1741 if (!wdata) in wiimote_create()
1744 wdata->hdev = hdev; in wiimote_create()
1745 hid_set_drvdata(hdev, wdata); in wiimote_create()
1747 spin_lock_init(&wdata->queue.lock); in wiimote_create()
1748 INIT_WORK(&wdata->queue.worker, wiimote_queue_worker); in wiimote_create()
1750 spin_lock_init(&wdata->state.lock); in wiimote_create()
1751 init_completion(&wdata->state.ready); in wiimote_create()
1752 mutex_init(&wdata->state.sync); in wiimote_create()
1753 wdata->state.drm = WIIPROTO_REQ_DRM_K; in wiimote_create()
1754 wdata->state.cmd_battery = 0xff; in wiimote_create()
1756 INIT_WORK(&wdata->init_worker, wiimote_init_worker); in wiimote_create()
1757 timer_setup(&wdata->timer, wiimote_init_timeout, 0); in wiimote_create()
1759 return wdata; in wiimote_create()
1762 static void wiimote_destroy(struct wiimote_data *wdata) in wiimote_destroy() argument
1766 wiidebug_deinit(wdata); in wiimote_destroy()
1769 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_destroy()
1770 wdata->state.flags |= WIIPROTO_FLAG_EXITING; in wiimote_destroy()
1771 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_destroy()
1773 cancel_work_sync(&wdata->init_worker); in wiimote_destroy()
1774 timer_shutdown_sync(&wdata->timer); in wiimote_destroy()
1776 device_remove_file(&wdata->hdev->dev, &dev_attr_devtype); in wiimote_destroy()
1777 device_remove_file(&wdata->hdev->dev, &dev_attr_extension); in wiimote_destroy()
1779 wiimote_mp_unload(wdata); in wiimote_destroy()
1780 wiimote_ext_unload(wdata); in wiimote_destroy()
1781 wiimote_modules_unload(wdata); in wiimote_destroy()
1782 cancel_work_sync(&wdata->queue.worker); in wiimote_destroy()
1783 hid_hw_close(wdata->hdev); in wiimote_destroy()
1784 hid_hw_stop(wdata->hdev); in wiimote_destroy()
1786 kfree(wdata); in wiimote_destroy()
1792 struct wiimote_data *wdata; in wiimote_hid_probe() local
1797 wdata = wiimote_create(hdev); in wiimote_hid_probe()
1798 if (!wdata) { in wiimote_hid_probe()
1833 ret = wiidebug_init(wdata); in wiimote_hid_probe()
1840 wiimote_schedule(wdata); in wiimote_hid_probe()
1845 wiimote_destroy(wdata); in wiimote_hid_probe()
1849 device_remove_file(&wdata->hdev->dev, &dev_attr_extension); in wiimote_hid_probe()
1855 input_free_device(wdata->ir); in wiimote_hid_probe()
1856 input_free_device(wdata->accel); in wiimote_hid_probe()
1857 kfree(wdata); in wiimote_hid_probe()
1863 struct wiimote_data *wdata = hid_get_drvdata(hdev); in wiimote_hid_remove() local
1866 wiimote_destroy(wdata); in wiimote_hid_remove()