Lines Matching refs:wdata
48 struct wiimote_data *wdata = container_of(queue, struct wiimote_data, in wiimote_queue_worker() local
53 spin_lock_irqsave(&wdata->queue.lock, flags); in wiimote_queue_worker()
55 while (wdata->queue.head != wdata->queue.tail) { in wiimote_queue_worker()
56 spin_unlock_irqrestore(&wdata->queue.lock, flags); in wiimote_queue_worker()
57 ret = wiimote_hid_send(wdata->hdev, in wiimote_queue_worker()
58 wdata->queue.outq[wdata->queue.tail].data, in wiimote_queue_worker()
59 wdata->queue.outq[wdata->queue.tail].size); in wiimote_queue_worker()
61 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_queue_worker()
62 wiimote_cmd_abort(wdata); in wiimote_queue_worker()
63 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_queue_worker()
65 spin_lock_irqsave(&wdata->queue.lock, flags); in wiimote_queue_worker()
67 wdata->queue.tail = (wdata->queue.tail + 1) % WIIMOTE_BUFSIZE; in wiimote_queue_worker()
70 spin_unlock_irqrestore(&wdata->queue.lock, flags); in wiimote_queue_worker()
73 static void wiimote_queue(struct wiimote_data *wdata, const __u8 *buffer, in wiimote_queue() argument
80 hid_warn(wdata->hdev, "Sending too large output report\n"); in wiimote_queue()
82 spin_lock_irqsave(&wdata->queue.lock, flags); in wiimote_queue()
96 spin_lock_irqsave(&wdata->queue.lock, flags); in wiimote_queue()
98 memcpy(wdata->queue.outq[wdata->queue.head].data, buffer, count); in wiimote_queue()
99 wdata->queue.outq[wdata->queue.head].size = count; in wiimote_queue()
100 newhead = (wdata->queue.head + 1) % WIIMOTE_BUFSIZE; in wiimote_queue()
102 if (wdata->queue.head == wdata->queue.tail) { in wiimote_queue()
103 wdata->queue.head = newhead; in wiimote_queue()
104 schedule_work(&wdata->queue.worker); in wiimote_queue()
105 } else if (newhead != wdata->queue.tail) { in wiimote_queue()
106 wdata->queue.head = newhead; in wiimote_queue()
108 hid_warn(wdata->hdev, "Output queue is full"); in wiimote_queue()
115 wiimote_cmd_abort(wdata); in wiimote_queue()
117 spin_unlock_irqrestore(&wdata->queue.lock, flags); in wiimote_queue()
127 static inline void wiiproto_keep_rumble(struct wiimote_data *wdata, __u8 *cmd1) in wiiproto_keep_rumble() argument
129 if (wdata->state.flags & WIIPROTO_FLAG_RUMBLE) in wiiproto_keep_rumble()
133 void wiiproto_req_rumble(struct wiimote_data *wdata, __u8 rumble) in wiiproto_req_rumble() argument
138 if (rumble == !!(wdata->state.flags & WIIPROTO_FLAG_RUMBLE)) in wiiproto_req_rumble()
142 wdata->state.flags |= WIIPROTO_FLAG_RUMBLE; in wiiproto_req_rumble()
144 wdata->state.flags &= ~WIIPROTO_FLAG_RUMBLE; in wiiproto_req_rumble()
149 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_rumble()
150 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_rumble()
153 void wiiproto_req_leds(struct wiimote_data *wdata, int leds) in wiiproto_req_leds() argument
158 if ((wdata->state.flags & WIIPROTO_FLAGS_LEDS) == leds) in wiiproto_req_leds()
160 wdata->state.flags = (wdata->state.flags & ~WIIPROTO_FLAGS_LEDS) | leds; in wiiproto_req_leds()
174 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_leds()
175 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_leds()
197 static __u8 select_drm(struct wiimote_data *wdata) in select_drm() argument
199 __u8 ir = wdata->state.flags & WIIPROTO_FLAGS_IR; in select_drm()
202 ext = (wdata->state.flags & WIIPROTO_FLAG_EXT_USED) || in select_drm()
203 (wdata->state.flags & WIIPROTO_FLAG_MP_USED); in select_drm()
206 if (wdata->state.devtype == WIIMOTE_DEV_BALANCE_BOARD) { in select_drm()
214 if (wdata->state.flags & WIIPROTO_FLAG_ACCEL) { in select_drm()
229 if (wdata->state.flags & WIIPROTO_FLAG_ACCEL) { in select_drm()
243 void wiiproto_req_drm(struct wiimote_data *wdata, __u8 drm) in wiiproto_req_drm() argument
247 if (wdata->state.flags & WIIPROTO_FLAG_DRM_LOCKED) in wiiproto_req_drm()
248 drm = wdata->state.drm; in wiiproto_req_drm()
250 drm = select_drm(wdata); in wiiproto_req_drm()
256 wdata->state.drm = drm; in wiiproto_req_drm()
257 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_drm()
258 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_drm()
261 void wiiproto_req_status(struct wiimote_data *wdata) in wiiproto_req_status() argument
268 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_status()
269 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_status()
272 void wiiproto_req_accel(struct wiimote_data *wdata, __u8 accel) in wiiproto_req_accel() argument
275 if (accel == !!(wdata->state.flags & WIIPROTO_FLAG_ACCEL)) in wiiproto_req_accel()
279 wdata->state.flags |= WIIPROTO_FLAG_ACCEL; in wiiproto_req_accel()
281 wdata->state.flags &= ~WIIPROTO_FLAG_ACCEL; in wiiproto_req_accel()
283 wiiproto_req_drm(wdata, WIIPROTO_REQ_NULL); in wiiproto_req_accel()
286 void wiiproto_req_ir1(struct wiimote_data *wdata, __u8 flags) in wiiproto_req_ir1() argument
293 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_ir1()
294 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_ir1()
297 void wiiproto_req_ir2(struct wiimote_data *wdata, __u8 flags) in wiiproto_req_ir2() argument
304 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_ir2()
305 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_ir2()
308 #define wiiproto_req_wreg(wdata, os, buf, sz) \ argument
309 wiiproto_req_wmem((wdata), false, (os), (buf), (sz))
311 #define wiiproto_req_weeprom(wdata, os, buf, sz) \ argument
312 wiiproto_req_wmem((wdata), true, (os), (buf), (sz))
314 static void wiiproto_req_wmem(struct wiimote_data *wdata, bool eeprom, in wiiproto_req_wmem() argument
320 hid_warn(wdata->hdev, "Invalid length %d wmem request\n", size); in wiiproto_req_wmem()
335 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_wmem()
336 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_wmem()
339 void wiiproto_req_rmem(struct wiimote_data *wdata, bool eeprom, __u32 offset, in wiiproto_req_rmem() argument
345 hid_warn(wdata->hdev, "Invalid length %d rmem request\n", size); in wiiproto_req_rmem()
360 wiiproto_keep_rumble(wdata, &cmd[1]); in wiiproto_req_rmem()
361 wiimote_queue(wdata, cmd, sizeof(cmd)); in wiiproto_req_rmem()
365 int wiimote_cmd_write(struct wiimote_data *wdata, __u32 offset, in wiimote_cmd_write() argument
371 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_cmd_write()
372 wiimote_cmd_set(wdata, WIIPROTO_REQ_WMEM, 0); in wiimote_cmd_write()
373 wiiproto_req_wreg(wdata, offset, wmem, size); in wiimote_cmd_write()
374 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_cmd_write()
376 ret = wiimote_cmd_wait(wdata); in wiimote_cmd_write()
377 if (!ret && wdata->state.cmd_err) in wiimote_cmd_write()
384 ssize_t wiimote_cmd_read(struct wiimote_data *wdata, __u32 offset, __u8 *rmem, in wiimote_cmd_read() argument
390 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_cmd_read()
391 wdata->state.cmd_read_size = size; in wiimote_cmd_read()
392 wdata->state.cmd_read_buf = rmem; in wiimote_cmd_read()
393 wiimote_cmd_set(wdata, WIIPROTO_REQ_RMEM, offset & 0xffff); in wiimote_cmd_read()
394 wiiproto_req_rreg(wdata, offset, size); in wiimote_cmd_read()
395 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_cmd_read()
397 ret = wiimote_cmd_wait(wdata); in wiimote_cmd_read()
399 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_cmd_read()
400 wdata->state.cmd_read_buf = NULL; in wiimote_cmd_read()
401 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_cmd_read()
404 if (wdata->state.cmd_read_size == 0) in wiimote_cmd_read()
407 ret = wdata->state.cmd_read_size; in wiimote_cmd_read()
414 static int wiimote_cmd_init_ext(struct wiimote_data *wdata) in wiimote_cmd_init_ext() argument
421 ret = wiimote_cmd_write(wdata, 0xa400f0, &wmem, sizeof(wmem)); in wiimote_cmd_init_ext()
427 ret = wiimote_cmd_write(wdata, 0xa400fb, &wmem, sizeof(wmem)); in wiimote_cmd_init_ext()
435 static __u8 wiimote_cmd_read_ext(struct wiimote_data *wdata, __u8 *rmem) in wiimote_cmd_read_ext() argument
440 ret = wiimote_cmd_read(wdata, 0xa400fa, rmem, 6); in wiimote_cmd_read_ext()
444 hid_dbg(wdata->hdev, "extension ID: %6phC\n", rmem); in wiimote_cmd_read_ext()
463 static int wiimote_cmd_init_mp(struct wiimote_data *wdata) in wiimote_cmd_init_mp() argument
470 ret = wiimote_cmd_write(wdata, 0xa600f0, &wmem, sizeof(wmem)); in wiimote_cmd_init_mp()
476 ret = wiimote_cmd_write(wdata, 0xa600fb, &wmem, sizeof(wmem)); in wiimote_cmd_init_mp()
484 static bool wiimote_cmd_map_mp(struct wiimote_data *wdata, __u8 exttype) in wiimote_cmd_map_mp() argument
501 return wiimote_cmd_write(wdata, 0xa600fe, &wmem, sizeof(wmem)); in wiimote_cmd_map_mp()
505 static bool wiimote_cmd_read_mp(struct wiimote_data *wdata, __u8 *rmem) in wiimote_cmd_read_mp() argument
510 ret = wiimote_cmd_read(wdata, 0xa600fa, rmem, 6); in wiimote_cmd_read_mp()
514 hid_dbg(wdata->hdev, "motion plus ID: %6phC\n", rmem); in wiimote_cmd_read_mp()
519 hid_info(wdata->hdev, "unknown motion plus ID: %6phC\n", rmem); in wiimote_cmd_read_mp()
525 static __u8 wiimote_cmd_read_mp_mapped(struct wiimote_data *wdata) in wiimote_cmd_read_mp_mapped() argument
531 ret = wiimote_cmd_read(wdata, 0xa400fa, rmem, 6); in wiimote_cmd_read_mp_mapped()
535 hid_dbg(wdata->hdev, "mapped motion plus ID: %6phC\n", rmem); in wiimote_cmd_read_mp_mapped()
615 static void wiimote_modules_load(struct wiimote_data *wdata, in wiimote_modules_load() argument
633 wdata->input = input_allocate_device(); in wiimote_modules_load()
634 if (!wdata->input) in wiimote_modules_load()
637 input_set_drvdata(wdata->input, wdata); in wiimote_modules_load()
638 wdata->input->dev.parent = &wdata->hdev->dev; in wiimote_modules_load()
639 wdata->input->id.bustype = wdata->hdev->bus; in wiimote_modules_load()
640 wdata->input->id.vendor = wdata->hdev->vendor; in wiimote_modules_load()
641 wdata->input->id.product = wdata->hdev->product; in wiimote_modules_load()
642 wdata->input->id.version = wdata->hdev->version; in wiimote_modules_load()
643 wdata->input->name = WIIMOTE_NAME; in wiimote_modules_load()
651 ret = ops->probe(ops, wdata); in wiimote_modules_load()
656 if (wdata->input) { in wiimote_modules_load()
657 ret = input_register_device(wdata->input); in wiimote_modules_load()
662 spin_lock_irq(&wdata->state.lock); in wiimote_modules_load()
663 wdata->state.devtype = devtype; in wiimote_modules_load()
664 spin_unlock_irq(&wdata->state.lock); in wiimote_modules_load()
671 ops->remove(ops, wdata); in wiimote_modules_load()
674 if (wdata->input) { in wiimote_modules_load()
675 input_free_device(wdata->input); in wiimote_modules_load()
676 wdata->input = NULL; in wiimote_modules_load()
680 static void wiimote_modules_unload(struct wiimote_data *wdata) in wiimote_modules_unload() argument
686 mods = wiimote_devtype_mods[wdata->state.devtype]; in wiimote_modules_unload()
688 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_modules_unload()
689 wdata->state.devtype = WIIMOTE_DEV_UNKNOWN; in wiimote_modules_unload()
690 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_modules_unload()
696 if (wdata->input) { in wiimote_modules_unload()
697 input_get_device(wdata->input); in wiimote_modules_unload()
698 input_unregister_device(wdata->input); in wiimote_modules_unload()
704 ops->remove(ops, wdata); in wiimote_modules_unload()
707 if (wdata->input) { in wiimote_modules_unload()
708 input_put_device(wdata->input); in wiimote_modules_unload()
709 wdata->input = NULL; in wiimote_modules_unload()
715 static void wiimote_ext_load(struct wiimote_data *wdata, unsigned int ext) in wiimote_ext_load() argument
724 ret = ops->probe(ops, wdata); in wiimote_ext_load()
729 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_ext_load()
730 wdata->state.exttype = ext; in wiimote_ext_load()
731 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_ext_load()
734 static void wiimote_ext_unload(struct wiimote_data *wdata) in wiimote_ext_unload() argument
739 ops = wiimod_ext_table[wdata->state.exttype]; in wiimote_ext_unload()
741 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_ext_unload()
742 wdata->state.exttype = WIIMOTE_EXT_UNKNOWN; in wiimote_ext_unload()
743 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_USED; in wiimote_ext_unload()
744 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_ext_unload()
747 ops->remove(ops, wdata); in wiimote_ext_unload()
750 static void wiimote_mp_load(struct wiimote_data *wdata) in wiimote_mp_load() argument
759 ret = ops->probe(ops, wdata); in wiimote_mp_load()
764 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_mp_load()
765 wdata->state.mp = mode; in wiimote_mp_load()
766 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_mp_load()
769 static void wiimote_mp_unload(struct wiimote_data *wdata) in wiimote_mp_unload() argument
774 if (wdata->state.mp < 2) in wiimote_mp_unload()
779 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_mp_unload()
780 wdata->state.mp = 0; in wiimote_mp_unload()
781 wdata->state.flags &= ~WIIPROTO_FLAG_MP_USED; in wiimote_mp_unload()
782 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_mp_unload()
785 ops->remove(ops, wdata); in wiimote_mp_unload()
804 static void wiimote_init_set_type(struct wiimote_data *wdata, in wiimote_init_set_type() argument
811 vendor = wdata->hdev->vendor; in wiimote_init_set_type()
812 product = wdata->hdev->product; in wiimote_init_set_type()
813 name = wdata->hdev->name; in wiimote_init_set_type()
849 hid_info(wdata->hdev, "cannot detect device; NAME: %s VID: %04x PID: %04x EXT: %04x\n", in wiimote_init_set_type()
852 hid_info(wdata->hdev, "detected device: %s\n", in wiimote_init_set_type()
855 wiimote_modules_load(wdata, devtype); in wiimote_init_set_type()
858 static void wiimote_init_detect(struct wiimote_data *wdata) in wiimote_init_detect() argument
864 wiimote_cmd_acquire_noint(wdata); in wiimote_init_detect()
866 spin_lock_irq(&wdata->state.lock); in wiimote_init_detect()
867 wdata->state.devtype = WIIMOTE_DEV_UNKNOWN; in wiimote_init_detect()
868 wiimote_cmd_set(wdata, WIIPROTO_REQ_SREQ, 0); in wiimote_init_detect()
869 wiiproto_req_status(wdata); in wiimote_init_detect()
870 spin_unlock_irq(&wdata->state.lock); in wiimote_init_detect()
872 ret = wiimote_cmd_wait_noint(wdata); in wiimote_init_detect()
876 spin_lock_irq(&wdata->state.lock); in wiimote_init_detect()
877 ext = wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED; in wiimote_init_detect()
878 spin_unlock_irq(&wdata->state.lock); in wiimote_init_detect()
883 wiimote_cmd_init_ext(wdata); in wiimote_init_detect()
884 exttype = wiimote_cmd_read_ext(wdata, extdata); in wiimote_init_detect()
887 wiimote_cmd_release(wdata); in wiimote_init_detect()
888 wiimote_init_set_type(wdata, exttype); in wiimote_init_detect()
891 spin_lock_irq(&wdata->state.lock); in wiimote_init_detect()
892 if (!(wdata->state.flags & WIIPROTO_FLAG_BUILTIN_MP) && in wiimote_init_detect()
893 !(wdata->state.flags & WIIPROTO_FLAG_NO_MP)) in wiimote_init_detect()
894 mod_timer(&wdata->timer, jiffies + HZ * 4); in wiimote_init_detect()
895 spin_unlock_irq(&wdata->state.lock); in wiimote_init_detect()
904 static void wiimote_init_poll_mp(struct wiimote_data *wdata) in wiimote_init_poll_mp() argument
909 wiimote_cmd_acquire_noint(wdata); in wiimote_init_poll_mp()
910 wiimote_cmd_init_mp(wdata); in wiimote_init_poll_mp()
911 mp = wiimote_cmd_read_mp(wdata, mpdata); in wiimote_init_poll_mp()
912 wiimote_cmd_release(wdata); in wiimote_init_poll_mp()
916 if (!wdata->state.mp) { in wiimote_init_poll_mp()
917 hid_info(wdata->hdev, "detected extension: Nintendo Wii Motion Plus\n"); in wiimote_init_poll_mp()
918 wiimote_mp_load(wdata); in wiimote_init_poll_mp()
920 } else if (wdata->state.mp) { in wiimote_init_poll_mp()
921 wiimote_mp_unload(wdata); in wiimote_init_poll_mp()
924 mod_timer(&wdata->timer, jiffies + HZ * 4); in wiimote_init_poll_mp()
937 static bool wiimote_init_check(struct wiimote_data *wdata) in wiimote_init_check() argument
943 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
944 flags = wdata->state.flags; in wiimote_init_check()
945 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
947 wiimote_cmd_acquire_noint(wdata); in wiimote_init_check()
956 if (wdata->state.exttype == WIIMOTE_EXT_NONE && in wiimote_init_check()
957 wdata->state.mp > 0 && (flags & WIIPROTO_FLAG_MP_USED)) { in wiimote_init_check()
958 type = wiimote_cmd_read_mp_mapped(wdata); in wiimote_init_check()
961 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
962 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE); in wiimote_init_check()
963 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_MP_PLUGGED); in wiimote_init_check()
964 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE); in wiimote_init_check()
965 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
968 hid_dbg(wdata->hdev, "state left: !EXT && MP\n"); in wiimote_init_check()
982 wdata->state.exttype != WIIMOTE_EXT_NONE) { in wiimote_init_check()
983 type = wiimote_cmd_read_ext(wdata, data); in wiimote_init_check()
984 ret = type == wdata->state.exttype; in wiimote_init_check()
986 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
987 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE); in wiimote_init_check()
988 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE); in wiimote_init_check()
989 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
992 hid_dbg(wdata->hdev, "state left: EXT && !MP\n"); in wiimote_init_check()
1008 wdata->state.exttype == WIIMOTE_EXT_NONE) { in wiimote_init_check()
1009 type = wiimote_cmd_read_ext(wdata, data); in wiimote_init_check()
1010 ret = type == wdata->state.exttype; in wiimote_init_check()
1012 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
1013 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE); in wiimote_init_check()
1014 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE); in wiimote_init_check()
1015 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED); in wiimote_init_check()
1016 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
1019 hid_dbg(wdata->hdev, "state left: !EXT && !MP\n"); in wiimote_init_check()
1035 if (wdata->state.exttype != WIIMOTE_EXT_NONE && in wiimote_init_check()
1036 wdata->state.mp > 0 && (flags & WIIPROTO_FLAG_MP_USED)) { in wiimote_init_check()
1037 type = wiimote_cmd_read_mp_mapped(wdata); in wiimote_init_check()
1042 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
1043 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED); in wiimote_init_check()
1044 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE); in wiimote_init_check()
1045 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE); in wiimote_init_check()
1046 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
1049 hid_dbg(wdata->hdev, "state left: EXT && MP\n"); in wiimote_init_check()
1061 wiimote_cmd_release(wdata); in wiimote_init_check()
1066 wiimote_init_poll_mp(wdata); in wiimote_init_check()
1088 static void wiimote_init_hotplug(struct wiimote_data *wdata) in wiimote_init_hotplug() argument
1094 hid_dbg(wdata->hdev, "detect extensions..\n"); in wiimote_init_hotplug()
1096 wiimote_cmd_acquire_noint(wdata); in wiimote_init_hotplug()
1098 spin_lock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1101 flags = wdata->state.flags; in wiimote_init_hotplug()
1104 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_ACTIVE; in wiimote_init_hotplug()
1105 wdata->state.flags &= ~WIIPROTO_FLAG_MP_ACTIVE; in wiimote_init_hotplug()
1107 spin_unlock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1110 wiimote_cmd_init_ext(wdata); in wiimote_init_hotplug()
1114 wiimote_cmd_init_mp(wdata); in wiimote_init_hotplug()
1115 mp = wiimote_cmd_read_mp(wdata, mpdata); in wiimote_init_hotplug()
1117 exttype = wiimote_cmd_read_ext(wdata, extdata); in wiimote_init_hotplug()
1119 wiimote_cmd_release(wdata); in wiimote_init_hotplug()
1122 if (exttype != wdata->state.exttype) { in wiimote_init_hotplug()
1124 wiimote_ext_unload(wdata); in wiimote_init_hotplug()
1127 hid_info(wdata->hdev, "cannot detect extension; %6phC\n", in wiimote_init_hotplug()
1130 spin_lock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1131 wdata->state.exttype = WIIMOTE_EXT_NONE; in wiimote_init_hotplug()
1132 spin_unlock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1134 hid_info(wdata->hdev, "detected extension: %s\n", in wiimote_init_hotplug()
1137 wiimote_ext_load(wdata, exttype); in wiimote_init_hotplug()
1143 if (!wdata->state.mp) { in wiimote_init_hotplug()
1144 hid_info(wdata->hdev, "detected extension: Nintendo Wii Motion Plus\n"); in wiimote_init_hotplug()
1145 wiimote_mp_load(wdata); in wiimote_init_hotplug()
1147 } else if (wdata->state.mp) { in wiimote_init_hotplug()
1148 wiimote_mp_unload(wdata); in wiimote_init_hotplug()
1157 wiimote_cmd_acquire_noint(wdata); in wiimote_init_hotplug()
1158 wiimote_cmd_map_mp(wdata, exttype); in wiimote_init_hotplug()
1159 wiimote_cmd_release(wdata); in wiimote_init_hotplug()
1162 del_timer_sync(&wdata->timer); in wiimote_init_hotplug()
1167 mod_timer(&wdata->timer, jiffies + HZ * 4); in wiimote_init_hotplug()
1170 spin_lock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1174 wdata->state.flags |= WIIPROTO_FLAG_MP_ACTIVE; in wiimote_init_hotplug()
1175 if (wdata->state.exttype == WIIMOTE_EXT_NONE) { in wiimote_init_hotplug()
1176 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_PLUGGED; in wiimote_init_hotplug()
1177 wdata->state.flags &= ~WIIPROTO_FLAG_MP_PLUGGED; in wiimote_init_hotplug()
1179 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_PLUGGED; in wiimote_init_hotplug()
1180 wdata->state.flags |= WIIPROTO_FLAG_MP_PLUGGED; in wiimote_init_hotplug()
1181 wdata->state.flags |= WIIPROTO_FLAG_EXT_ACTIVE; in wiimote_init_hotplug()
1183 } else if (wdata->state.exttype != WIIMOTE_EXT_NONE) { in wiimote_init_hotplug()
1184 wdata->state.flags |= WIIPROTO_FLAG_EXT_ACTIVE; in wiimote_init_hotplug()
1188 wiiproto_req_status(wdata); in wiimote_init_hotplug()
1190 spin_unlock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1192 hid_dbg(wdata->hdev, "detected extensions: MP: %d EXT: %d\n", in wiimote_init_hotplug()
1193 wdata->state.mp, wdata->state.exttype); in wiimote_init_hotplug()
1198 struct wiimote_data *wdata = container_of(work, struct wiimote_data, in wiimote_init_worker() local
1202 if (wdata->state.devtype == WIIMOTE_DEV_PENDING) { in wiimote_init_worker()
1203 wiimote_init_detect(wdata); in wiimote_init_worker()
1207 if (changed || !wiimote_init_check(wdata)) in wiimote_init_worker()
1208 wiimote_init_hotplug(wdata); in wiimote_init_worker()
1211 kobject_uevent(&wdata->hdev->dev.kobj, KOBJ_CHANGE); in wiimote_init_worker()
1214 void __wiimote_schedule(struct wiimote_data *wdata) in __wiimote_schedule() argument
1216 if (!(wdata->state.flags & WIIPROTO_FLAG_EXITING)) in __wiimote_schedule()
1217 schedule_work(&wdata->init_worker); in __wiimote_schedule()
1220 static void wiimote_schedule(struct wiimote_data *wdata) in wiimote_schedule() argument
1224 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_schedule()
1225 __wiimote_schedule(wdata); in wiimote_schedule()
1226 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_schedule()
1231 struct wiimote_data *wdata = (void*)arg; in wiimote_init_timeout() local
1233 wiimote_schedule(wdata); in wiimote_init_timeout()
1238 static void handler_keys(struct wiimote_data *wdata, const __u8 *payload) in handler_keys() argument
1243 ops = wiimod_ext_table[wdata->state.exttype]; in handler_keys()
1245 ops->in_keys(wdata, payload); in handler_keys()
1249 mods = wiimote_devtype_mods[wdata->state.devtype]; in handler_keys()
1253 ops->in_keys(wdata, payload); in handler_keys()
1259 static void handler_accel(struct wiimote_data *wdata, const __u8 *payload) in handler_accel() argument
1264 ops = wiimod_ext_table[wdata->state.exttype]; in handler_accel()
1266 ops->in_accel(wdata, payload); in handler_accel()
1270 mods = wiimote_devtype_mods[wdata->state.devtype]; in handler_accel()
1274 ops->in_accel(wdata, payload); in handler_accel()
1292 static void handler_ext(struct wiimote_data *wdata, const __u8 *payload, in handler_ext() argument
1311 if (wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE) { in handler_ext()
1317 if (!(wdata->state.flags & WIIPROTO_FLAG_MP_PLUGGED)) { in handler_ext()
1318 hid_dbg(wdata->hdev, "MP hotplug: 1\n"); in handler_ext()
1319 wdata->state.flags |= WIIPROTO_FLAG_MP_PLUGGED; in handler_ext()
1320 __wiimote_schedule(wdata); in handler_ext()
1323 if (wdata->state.flags & WIIPROTO_FLAG_MP_PLUGGED) { in handler_ext()
1324 hid_dbg(wdata->hdev, "MP hotplug: 0\n"); in handler_ext()
1325 wdata->state.flags &= ~WIIPROTO_FLAG_MP_PLUGGED; in handler_ext()
1326 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_ACTIVE; in handler_ext()
1327 __wiimote_schedule(wdata); in handler_ext()
1338 if (!(wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE) && !is_mp) in handler_ext()
1342 ops = wiimod_ext_table[wdata->state.exttype]; in handler_ext()
1344 ops->in_mp(wdata, payload); in handler_ext()
1347 ops->in_ext(wdata, payload); in handler_ext()
1354 ops->in_mp(wdata, payload); in handler_ext()
1357 ops->in_ext(wdata, payload); in handler_ext()
1362 mods = wiimote_devtype_mods[wdata->state.devtype]; in handler_ext()
1366 ops->in_mp(wdata, payload); in handler_ext()
1369 ops->in_ext(wdata, payload); in handler_ext()
1375 #define ir_to_input0(wdata, ir, packed) handler_ir((wdata), (ir), (packed), 0) argument
1376 #define ir_to_input1(wdata, ir, packed) handler_ir((wdata), (ir), (packed), 1) argument
1377 #define ir_to_input2(wdata, ir, packed) handler_ir((wdata), (ir), (packed), 2) argument
1378 #define ir_to_input3(wdata, ir, packed) handler_ir((wdata), (ir), (packed), 3) argument
1380 static void handler_ir(struct wiimote_data *wdata, const __u8 *payload, in handler_ir() argument
1386 ops = wiimod_ext_table[wdata->state.exttype]; in handler_ir()
1388 ops->in_ir(wdata, payload, packed, id); in handler_ir()
1392 mods = wiimote_devtype_mods[wdata->state.devtype]; in handler_ir()
1396 ops->in_ir(wdata, payload, packed, id); in handler_ir()
1403 static void handler_status_K(struct wiimote_data *wdata, in handler_status_K() argument
1406 handler_keys(wdata, payload); in handler_status_K()
1409 wiiproto_req_drm(wdata, WIIPROTO_REQ_NULL); in handler_status_K()
1413 static void handler_status(struct wiimote_data *wdata, const __u8 *payload) in handler_status() argument
1415 handler_status_K(wdata, payload); in handler_status()
1419 if (!(wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED)) { in handler_status()
1420 hid_dbg(wdata->hdev, "EXT hotplug: 1\n"); in handler_status()
1421 wdata->state.flags |= WIIPROTO_FLAG_EXT_PLUGGED; in handler_status()
1422 __wiimote_schedule(wdata); in handler_status()
1425 if (wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED) { in handler_status()
1426 hid_dbg(wdata->hdev, "EXT hotplug: 0\n"); in handler_status()
1427 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_PLUGGED; in handler_status()
1428 wdata->state.flags &= ~WIIPROTO_FLAG_MP_PLUGGED; in handler_status()
1429 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_ACTIVE; in handler_status()
1430 wdata->state.flags &= ~WIIPROTO_FLAG_MP_ACTIVE; in handler_status()
1431 __wiimote_schedule(wdata); in handler_status()
1435 wdata->state.cmd_battery = payload[5]; in handler_status()
1436 if (wiimote_cmd_pending(wdata, WIIPROTO_REQ_SREQ, 0)) in handler_status()
1437 wiimote_cmd_complete(wdata); in handler_status()
1441 static void handler_generic_K(struct wiimote_data *wdata, const __u8 *payload) in handler_generic_K() argument
1443 handler_keys(wdata, payload); in handler_generic_K()
1446 static void handler_data(struct wiimote_data *wdata, const __u8 *payload) in handler_data() argument
1452 handler_keys(wdata, payload); in handler_data()
1454 if (wiimote_cmd_pending(wdata, WIIPROTO_REQ_RMEM, offset)) { in handler_data()
1457 else if (size > wdata->state.cmd_read_size) in handler_data()
1458 size = wdata->state.cmd_read_size; in handler_data()
1460 wdata->state.cmd_read_size = size; in handler_data()
1461 if (wdata->state.cmd_read_buf) in handler_data()
1462 memcpy(wdata->state.cmd_read_buf, &payload[5], size); in handler_data()
1463 wiimote_cmd_complete(wdata); in handler_data()
1467 static void handler_return(struct wiimote_data *wdata, const __u8 *payload) in handler_return() argument
1472 handler_keys(wdata, payload); in handler_return()
1474 if (wiimote_cmd_pending(wdata, cmd, 0)) { in handler_return()
1475 wdata->state.cmd_err = err; in handler_return()
1476 wiimote_cmd_complete(wdata); in handler_return()
1478 hid_warn(wdata->hdev, "Remote error %hhu on req %hhu\n", err, in handler_return()
1483 static void handler_drm_KA(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KA() argument
1485 handler_keys(wdata, payload); in handler_drm_KA()
1486 handler_accel(wdata, payload); in handler_drm_KA()
1489 static void handler_drm_KE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KE() argument
1491 handler_keys(wdata, payload); in handler_drm_KE()
1492 handler_ext(wdata, &payload[2], 8); in handler_drm_KE()
1495 static void handler_drm_KAI(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KAI() argument
1497 handler_keys(wdata, payload); in handler_drm_KAI()
1498 handler_accel(wdata, payload); in handler_drm_KAI()
1499 ir_to_input0(wdata, &payload[5], false); in handler_drm_KAI()
1500 ir_to_input1(wdata, &payload[8], false); in handler_drm_KAI()
1501 ir_to_input2(wdata, &payload[11], false); in handler_drm_KAI()
1502 ir_to_input3(wdata, &payload[14], false); in handler_drm_KAI()
1505 static void handler_drm_KEE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KEE() argument
1507 handler_keys(wdata, payload); in handler_drm_KEE()
1508 handler_ext(wdata, &payload[2], 19); in handler_drm_KEE()
1511 static void handler_drm_KIE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KIE() argument
1513 handler_keys(wdata, payload); in handler_drm_KIE()
1514 ir_to_input0(wdata, &payload[2], false); in handler_drm_KIE()
1515 ir_to_input1(wdata, &payload[4], true); in handler_drm_KIE()
1516 ir_to_input2(wdata, &payload[7], false); in handler_drm_KIE()
1517 ir_to_input3(wdata, &payload[9], true); in handler_drm_KIE()
1518 handler_ext(wdata, &payload[12], 9); in handler_drm_KIE()
1521 static void handler_drm_KAE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KAE() argument
1523 handler_keys(wdata, payload); in handler_drm_KAE()
1524 handler_accel(wdata, payload); in handler_drm_KAE()
1525 handler_ext(wdata, &payload[5], 16); in handler_drm_KAE()
1528 static void handler_drm_KAIE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KAIE() argument
1530 handler_keys(wdata, payload); in handler_drm_KAIE()
1531 handler_accel(wdata, payload); in handler_drm_KAIE()
1532 ir_to_input0(wdata, &payload[5], false); in handler_drm_KAIE()
1533 ir_to_input1(wdata, &payload[7], true); in handler_drm_KAIE()
1534 ir_to_input2(wdata, &payload[10], false); in handler_drm_KAIE()
1535 ir_to_input3(wdata, &payload[12], true); in handler_drm_KAIE()
1536 handler_ext(wdata, &payload[15], 6); in handler_drm_KAIE()
1539 static void handler_drm_E(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_E() argument
1541 handler_ext(wdata, payload, 21); in handler_drm_E()
1544 static void handler_drm_SKAI1(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_SKAI1() argument
1546 handler_keys(wdata, payload); in handler_drm_SKAI1()
1548 wdata->state.accel_split[0] = payload[2]; in handler_drm_SKAI1()
1549 wdata->state.accel_split[1] = (payload[0] >> 1) & (0x10 | 0x20); in handler_drm_SKAI1()
1550 wdata->state.accel_split[1] |= (payload[1] << 1) & (0x40 | 0x80); in handler_drm_SKAI1()
1552 ir_to_input0(wdata, &payload[3], false); in handler_drm_SKAI1()
1553 ir_to_input1(wdata, &payload[12], false); in handler_drm_SKAI1()
1556 static void handler_drm_SKAI2(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_SKAI2() argument
1560 handler_keys(wdata, payload); in handler_drm_SKAI2()
1562 wdata->state.accel_split[1] |= (payload[0] >> 5) & (0x01 | 0x02); in handler_drm_SKAI2()
1563 wdata->state.accel_split[1] |= (payload[1] >> 3) & (0x04 | 0x08); in handler_drm_SKAI2()
1567 buf[2] = wdata->state.accel_split[0]; in handler_drm_SKAI2()
1569 buf[4] = wdata->state.accel_split[1]; in handler_drm_SKAI2()
1570 handler_accel(wdata, buf); in handler_drm_SKAI2()
1572 ir_to_input2(wdata, &payload[3], false); in handler_drm_SKAI2()
1573 ir_to_input3(wdata, &payload[12], false); in handler_drm_SKAI2()
1579 void (*func)(struct wiimote_data *wdata, const __u8 *payload);
1613 struct wiimote_data *wdata = hid_get_drvdata(hdev); in wiimote_hid_event() local
1621 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_hid_event()
1626 h->func(wdata, &raw_data[1]); in wiimote_hid_event()
1635 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_hid_event()
1644 struct wiimote_data *wdata = dev_to_wii(dev); in wiimote_ext_show() local
1648 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_ext_show()
1649 type = wdata->state.exttype; in wiimote_ext_show()
1650 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_ext_show()
1674 struct wiimote_data *wdata = dev_to_wii(dev); in wiimote_ext_store() local
1677 wiimote_schedule(wdata); in wiimote_ext_store()
1692 struct wiimote_data *wdata = dev_to_wii(dev); in wiimote_dev_show() local
1696 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_dev_show()
1697 type = wdata->state.devtype; in wiimote_dev_show()
1698 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_dev_show()
1724 struct wiimote_data *wdata; in wiimote_create() local
1726 wdata = kzalloc(sizeof(*wdata), GFP_KERNEL); in wiimote_create()
1727 if (!wdata) in wiimote_create()
1730 wdata->hdev = hdev; in wiimote_create()
1731 hid_set_drvdata(hdev, wdata); in wiimote_create()
1733 spin_lock_init(&wdata->queue.lock); in wiimote_create()
1734 INIT_WORK(&wdata->queue.worker, wiimote_queue_worker); in wiimote_create()
1736 spin_lock_init(&wdata->state.lock); in wiimote_create()
1737 init_completion(&wdata->state.ready); in wiimote_create()
1738 mutex_init(&wdata->state.sync); in wiimote_create()
1739 wdata->state.drm = WIIPROTO_REQ_DRM_K; in wiimote_create()
1740 wdata->state.cmd_battery = 0xff; in wiimote_create()
1742 INIT_WORK(&wdata->init_worker, wiimote_init_worker); in wiimote_create()
1743 setup_timer(&wdata->timer, wiimote_init_timeout, (long)wdata); in wiimote_create()
1745 return wdata; in wiimote_create()
1748 static void wiimote_destroy(struct wiimote_data *wdata) in wiimote_destroy() argument
1752 wiidebug_deinit(wdata); in wiimote_destroy()
1755 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_destroy()
1756 wdata->state.flags |= WIIPROTO_FLAG_EXITING; in wiimote_destroy()
1757 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_destroy()
1759 cancel_work_sync(&wdata->init_worker); in wiimote_destroy()
1760 del_timer_sync(&wdata->timer); in wiimote_destroy()
1762 device_remove_file(&wdata->hdev->dev, &dev_attr_devtype); in wiimote_destroy()
1763 device_remove_file(&wdata->hdev->dev, &dev_attr_extension); in wiimote_destroy()
1765 wiimote_mp_unload(wdata); in wiimote_destroy()
1766 wiimote_ext_unload(wdata); in wiimote_destroy()
1767 wiimote_modules_unload(wdata); in wiimote_destroy()
1768 cancel_work_sync(&wdata->queue.worker); in wiimote_destroy()
1769 hid_hw_close(wdata->hdev); in wiimote_destroy()
1770 hid_hw_stop(wdata->hdev); in wiimote_destroy()
1772 kfree(wdata); in wiimote_destroy()
1778 struct wiimote_data *wdata; in wiimote_hid_probe() local
1783 wdata = wiimote_create(hdev); in wiimote_hid_probe()
1784 if (!wdata) { in wiimote_hid_probe()
1819 ret = wiidebug_init(wdata); in wiimote_hid_probe()
1826 wiimote_schedule(wdata); in wiimote_hid_probe()
1831 wiimote_destroy(wdata); in wiimote_hid_probe()
1835 device_remove_file(&wdata->hdev->dev, &dev_attr_extension); in wiimote_hid_probe()
1841 input_free_device(wdata->ir); in wiimote_hid_probe()
1842 input_free_device(wdata->accel); in wiimote_hid_probe()
1843 kfree(wdata); in wiimote_hid_probe()
1849 struct wiimote_data *wdata = hid_get_drvdata(hdev); in wiimote_hid_remove() local
1852 wiimote_destroy(wdata); in wiimote_hid_remove()