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()
466 static int wiimote_cmd_init_mp(struct wiimote_data *wdata) in wiimote_cmd_init_mp() argument
473 ret = wiimote_cmd_write(wdata, 0xa600f0, &wmem, sizeof(wmem)); in wiimote_cmd_init_mp()
479 ret = wiimote_cmd_write(wdata, 0xa600fb, &wmem, sizeof(wmem)); in wiimote_cmd_init_mp()
487 static bool wiimote_cmd_map_mp(struct wiimote_data *wdata, __u8 exttype) in wiimote_cmd_map_mp() argument
506 return wiimote_cmd_write(wdata, 0xa600fe, &wmem, sizeof(wmem)); in wiimote_cmd_map_mp()
510 static bool wiimote_cmd_read_mp(struct wiimote_data *wdata, __u8 *rmem) in wiimote_cmd_read_mp() argument
515 ret = wiimote_cmd_read(wdata, 0xa600fa, rmem, 6); in wiimote_cmd_read_mp()
519 hid_dbg(wdata->hdev, "motion plus ID: %6phC\n", rmem); in wiimote_cmd_read_mp()
524 hid_info(wdata->hdev, "unknown motion plus ID: %6phC\n", rmem); in wiimote_cmd_read_mp()
530 static __u8 wiimote_cmd_read_mp_mapped(struct wiimote_data *wdata) in wiimote_cmd_read_mp_mapped() argument
536 ret = wiimote_cmd_read(wdata, 0xa400fa, rmem, 6); in wiimote_cmd_read_mp_mapped()
540 hid_dbg(wdata->hdev, "mapped motion plus ID: %6phC\n", rmem); in wiimote_cmd_read_mp_mapped()
620 static void wiimote_modules_load(struct wiimote_data *wdata, in wiimote_modules_load() argument
638 wdata->input = input_allocate_device(); in wiimote_modules_load()
639 if (!wdata->input) in wiimote_modules_load()
642 input_set_drvdata(wdata->input, wdata); in wiimote_modules_load()
643 wdata->input->dev.parent = &wdata->hdev->dev; in wiimote_modules_load()
644 wdata->input->id.bustype = wdata->hdev->bus; in wiimote_modules_load()
645 wdata->input->id.vendor = wdata->hdev->vendor; in wiimote_modules_load()
646 wdata->input->id.product = wdata->hdev->product; in wiimote_modules_load()
647 wdata->input->id.version = wdata->hdev->version; in wiimote_modules_load()
648 wdata->input->name = WIIMOTE_NAME; in wiimote_modules_load()
656 ret = ops->probe(ops, wdata); in wiimote_modules_load()
661 if (wdata->input) { in wiimote_modules_load()
662 ret = input_register_device(wdata->input); in wiimote_modules_load()
667 spin_lock_irq(&wdata->state.lock); in wiimote_modules_load()
668 wdata->state.devtype = devtype; in wiimote_modules_load()
669 spin_unlock_irq(&wdata->state.lock); in wiimote_modules_load()
676 ops->remove(ops, wdata); in wiimote_modules_load()
679 if (wdata->input) { in wiimote_modules_load()
680 input_free_device(wdata->input); in wiimote_modules_load()
681 wdata->input = NULL; in wiimote_modules_load()
685 static void wiimote_modules_unload(struct wiimote_data *wdata) in wiimote_modules_unload() argument
691 mods = wiimote_devtype_mods[wdata->state.devtype]; in wiimote_modules_unload()
693 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_modules_unload()
694 wdata->state.devtype = WIIMOTE_DEV_UNKNOWN; in wiimote_modules_unload()
695 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_modules_unload()
701 if (wdata->input) { in wiimote_modules_unload()
702 input_get_device(wdata->input); in wiimote_modules_unload()
703 input_unregister_device(wdata->input); in wiimote_modules_unload()
709 ops->remove(ops, wdata); in wiimote_modules_unload()
712 if (wdata->input) { in wiimote_modules_unload()
713 input_put_device(wdata->input); in wiimote_modules_unload()
714 wdata->input = NULL; in wiimote_modules_unload()
720 static void wiimote_ext_load(struct wiimote_data *wdata, unsigned int ext) in wiimote_ext_load() argument
729 ret = ops->probe(ops, wdata); in wiimote_ext_load()
734 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_ext_load()
735 wdata->state.exttype = ext; in wiimote_ext_load()
736 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_ext_load()
739 static void wiimote_ext_unload(struct wiimote_data *wdata) in wiimote_ext_unload() argument
744 ops = wiimod_ext_table[wdata->state.exttype]; in wiimote_ext_unload()
746 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_ext_unload()
747 wdata->state.exttype = WIIMOTE_EXT_UNKNOWN; in wiimote_ext_unload()
748 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_USED; in wiimote_ext_unload()
749 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_ext_unload()
752 ops->remove(ops, wdata); in wiimote_ext_unload()
755 static void wiimote_mp_load(struct wiimote_data *wdata) in wiimote_mp_load() argument
764 ret = ops->probe(ops, wdata); in wiimote_mp_load()
769 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_mp_load()
770 wdata->state.mp = mode; in wiimote_mp_load()
771 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_mp_load()
774 static void wiimote_mp_unload(struct wiimote_data *wdata) in wiimote_mp_unload() argument
779 if (wdata->state.mp < 2) in wiimote_mp_unload()
784 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_mp_unload()
785 wdata->state.mp = 0; in wiimote_mp_unload()
786 wdata->state.flags &= ~WIIPROTO_FLAG_MP_USED; in wiimote_mp_unload()
787 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_mp_unload()
790 ops->remove(ops, wdata); in wiimote_mp_unload()
809 static void wiimote_init_set_type(struct wiimote_data *wdata, in wiimote_init_set_type() argument
816 vendor = wdata->hdev->vendor; in wiimote_init_set_type()
817 product = wdata->hdev->product; in wiimote_init_set_type()
818 name = wdata->hdev->name; in wiimote_init_set_type()
854 hid_info(wdata->hdev, "cannot detect device; NAME: %s VID: %04x PID: %04x EXT: %04x\n", in wiimote_init_set_type()
857 hid_info(wdata->hdev, "detected device: %s\n", in wiimote_init_set_type()
860 wiimote_modules_load(wdata, devtype); in wiimote_init_set_type()
863 static void wiimote_init_detect(struct wiimote_data *wdata) in wiimote_init_detect() argument
869 wiimote_cmd_acquire_noint(wdata); in wiimote_init_detect()
871 spin_lock_irq(&wdata->state.lock); in wiimote_init_detect()
872 wdata->state.devtype = WIIMOTE_DEV_UNKNOWN; in wiimote_init_detect()
873 wiimote_cmd_set(wdata, WIIPROTO_REQ_SREQ, 0); in wiimote_init_detect()
874 wiiproto_req_status(wdata); in wiimote_init_detect()
875 spin_unlock_irq(&wdata->state.lock); in wiimote_init_detect()
877 ret = wiimote_cmd_wait_noint(wdata); in wiimote_init_detect()
881 spin_lock_irq(&wdata->state.lock); in wiimote_init_detect()
882 ext = wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED; in wiimote_init_detect()
883 spin_unlock_irq(&wdata->state.lock); in wiimote_init_detect()
888 wiimote_cmd_init_ext(wdata); in wiimote_init_detect()
889 exttype = wiimote_cmd_read_ext(wdata, extdata); in wiimote_init_detect()
892 wiimote_cmd_release(wdata); in wiimote_init_detect()
893 wiimote_init_set_type(wdata, exttype); in wiimote_init_detect()
896 spin_lock_irq(&wdata->state.lock); in wiimote_init_detect()
897 if (!(wdata->state.flags & WIIPROTO_FLAG_BUILTIN_MP) && in wiimote_init_detect()
898 !(wdata->state.flags & WIIPROTO_FLAG_NO_MP)) in wiimote_init_detect()
899 mod_timer(&wdata->timer, jiffies + HZ * 4); in wiimote_init_detect()
900 spin_unlock_irq(&wdata->state.lock); in wiimote_init_detect()
909 static void wiimote_init_poll_mp(struct wiimote_data *wdata) in wiimote_init_poll_mp() argument
914 wiimote_cmd_acquire_noint(wdata); in wiimote_init_poll_mp()
915 wiimote_cmd_init_mp(wdata); in wiimote_init_poll_mp()
916 mp = wiimote_cmd_read_mp(wdata, mpdata); in wiimote_init_poll_mp()
917 wiimote_cmd_release(wdata); in wiimote_init_poll_mp()
921 if (!wdata->state.mp) { in wiimote_init_poll_mp()
922 hid_info(wdata->hdev, "detected extension: Nintendo Wii Motion Plus\n"); in wiimote_init_poll_mp()
923 wiimote_mp_load(wdata); in wiimote_init_poll_mp()
925 } else if (wdata->state.mp) { in wiimote_init_poll_mp()
926 wiimote_mp_unload(wdata); in wiimote_init_poll_mp()
929 mod_timer(&wdata->timer, jiffies + HZ * 4); in wiimote_init_poll_mp()
942 static bool wiimote_init_check(struct wiimote_data *wdata) in wiimote_init_check() argument
948 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
949 flags = wdata->state.flags; in wiimote_init_check()
950 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
952 wiimote_cmd_acquire_noint(wdata); in wiimote_init_check()
961 if (wdata->state.exttype == WIIMOTE_EXT_NONE && in wiimote_init_check()
962 wdata->state.mp > 0 && (flags & WIIPROTO_FLAG_MP_USED)) { in wiimote_init_check()
963 type = wiimote_cmd_read_mp_mapped(wdata); in wiimote_init_check()
966 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
967 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE); in wiimote_init_check()
968 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_MP_PLUGGED); in wiimote_init_check()
969 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE); in wiimote_init_check()
970 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
973 hid_dbg(wdata->hdev, "state left: !EXT && MP\n"); in wiimote_init_check()
987 wdata->state.exttype != WIIMOTE_EXT_NONE) { in wiimote_init_check()
988 type = wiimote_cmd_read_ext(wdata, data); in wiimote_init_check()
989 ret = type == wdata->state.exttype; in wiimote_init_check()
991 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
992 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE); in wiimote_init_check()
993 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE); in wiimote_init_check()
994 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
997 hid_dbg(wdata->hdev, "state left: EXT && !MP\n"); in wiimote_init_check()
1013 wdata->state.exttype == WIIMOTE_EXT_NONE) { in wiimote_init_check()
1014 type = wiimote_cmd_read_ext(wdata, data); in wiimote_init_check()
1015 ret = type == wdata->state.exttype; in wiimote_init_check()
1017 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
1018 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE); in wiimote_init_check()
1019 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE); in wiimote_init_check()
1020 ret = ret && !(wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED); in wiimote_init_check()
1021 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
1024 hid_dbg(wdata->hdev, "state left: !EXT && !MP\n"); in wiimote_init_check()
1040 if (wdata->state.exttype != WIIMOTE_EXT_NONE && in wiimote_init_check()
1041 wdata->state.mp > 0 && (flags & WIIPROTO_FLAG_MP_USED)) { in wiimote_init_check()
1042 type = wiimote_cmd_read_mp_mapped(wdata); in wiimote_init_check()
1047 spin_lock_irq(&wdata->state.lock); in wiimote_init_check()
1048 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED); in wiimote_init_check()
1049 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE); in wiimote_init_check()
1050 ret = ret && (wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE); in wiimote_init_check()
1051 spin_unlock_irq(&wdata->state.lock); in wiimote_init_check()
1054 hid_dbg(wdata->hdev, "state left: EXT && MP\n"); in wiimote_init_check()
1066 wiimote_cmd_release(wdata); in wiimote_init_check()
1071 wiimote_init_poll_mp(wdata); in wiimote_init_check()
1095 static void wiimote_init_hotplug(struct wiimote_data *wdata) in wiimote_init_hotplug() argument
1101 hid_dbg(wdata->hdev, "detect extensions..\n"); in wiimote_init_hotplug()
1103 wiimote_cmd_acquire_noint(wdata); in wiimote_init_hotplug()
1105 spin_lock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1108 flags = wdata->state.flags; in wiimote_init_hotplug()
1111 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_ACTIVE; in wiimote_init_hotplug()
1112 wdata->state.flags &= ~WIIPROTO_FLAG_MP_ACTIVE; in wiimote_init_hotplug()
1114 spin_unlock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1117 wiimote_cmd_init_ext(wdata); in wiimote_init_hotplug()
1121 wiimote_cmd_init_mp(wdata); in wiimote_init_hotplug()
1122 mp = wiimote_cmd_read_mp(wdata, mpdata); in wiimote_init_hotplug()
1124 exttype = wiimote_cmd_read_ext(wdata, extdata); in wiimote_init_hotplug()
1126 wiimote_cmd_release(wdata); in wiimote_init_hotplug()
1129 if (exttype != wdata->state.exttype) { in wiimote_init_hotplug()
1131 wiimote_ext_unload(wdata); in wiimote_init_hotplug()
1134 hid_info(wdata->hdev, "cannot detect extension; %6phC\n", in wiimote_init_hotplug()
1137 spin_lock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1138 wdata->state.exttype = WIIMOTE_EXT_NONE; in wiimote_init_hotplug()
1139 spin_unlock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1141 hid_info(wdata->hdev, "detected extension: %s\n", in wiimote_init_hotplug()
1144 wiimote_ext_load(wdata, exttype); in wiimote_init_hotplug()
1150 if (!wdata->state.mp) { in wiimote_init_hotplug()
1151 hid_info(wdata->hdev, "detected extension: Nintendo Wii Motion Plus\n"); in wiimote_init_hotplug()
1152 wiimote_mp_load(wdata); in wiimote_init_hotplug()
1154 } else if (wdata->state.mp) { in wiimote_init_hotplug()
1155 wiimote_mp_unload(wdata); in wiimote_init_hotplug()
1164 wiimote_cmd_acquire_noint(wdata); in wiimote_init_hotplug()
1165 wiimote_cmd_map_mp(wdata, exttype); in wiimote_init_hotplug()
1166 wiimote_cmd_release(wdata); in wiimote_init_hotplug()
1169 del_timer_sync(&wdata->timer); in wiimote_init_hotplug()
1174 mod_timer(&wdata->timer, jiffies + HZ * 4); in wiimote_init_hotplug()
1177 spin_lock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1181 wdata->state.flags |= WIIPROTO_FLAG_MP_ACTIVE; in wiimote_init_hotplug()
1182 if (wdata->state.exttype == WIIMOTE_EXT_NONE) { in wiimote_init_hotplug()
1183 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_PLUGGED; in wiimote_init_hotplug()
1184 wdata->state.flags &= ~WIIPROTO_FLAG_MP_PLUGGED; in wiimote_init_hotplug()
1186 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_PLUGGED; in wiimote_init_hotplug()
1187 wdata->state.flags |= WIIPROTO_FLAG_MP_PLUGGED; in wiimote_init_hotplug()
1188 wdata->state.flags |= WIIPROTO_FLAG_EXT_ACTIVE; in wiimote_init_hotplug()
1190 } else if (wdata->state.exttype != WIIMOTE_EXT_NONE) { in wiimote_init_hotplug()
1191 wdata->state.flags |= WIIPROTO_FLAG_EXT_ACTIVE; in wiimote_init_hotplug()
1195 wiiproto_req_status(wdata); in wiimote_init_hotplug()
1197 spin_unlock_irq(&wdata->state.lock); in wiimote_init_hotplug()
1199 hid_dbg(wdata->hdev, "detected extensions: MP: %d EXT: %d\n", in wiimote_init_hotplug()
1200 wdata->state.mp, wdata->state.exttype); in wiimote_init_hotplug()
1205 struct wiimote_data *wdata = container_of(work, struct wiimote_data, in wiimote_init_worker() local
1209 if (wdata->state.devtype == WIIMOTE_DEV_PENDING) { in wiimote_init_worker()
1210 wiimote_init_detect(wdata); in wiimote_init_worker()
1214 if (changed || !wiimote_init_check(wdata)) in wiimote_init_worker()
1215 wiimote_init_hotplug(wdata); in wiimote_init_worker()
1218 kobject_uevent(&wdata->hdev->dev.kobj, KOBJ_CHANGE); in wiimote_init_worker()
1221 void __wiimote_schedule(struct wiimote_data *wdata) in __wiimote_schedule() argument
1223 if (!(wdata->state.flags & WIIPROTO_FLAG_EXITING)) in __wiimote_schedule()
1224 schedule_work(&wdata->init_worker); in __wiimote_schedule()
1227 static void wiimote_schedule(struct wiimote_data *wdata) in wiimote_schedule() argument
1231 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_schedule()
1232 __wiimote_schedule(wdata); in wiimote_schedule()
1233 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_schedule()
1238 struct wiimote_data *wdata = from_timer(wdata, t, timer); in wiimote_init_timeout() local
1240 wiimote_schedule(wdata); in wiimote_init_timeout()
1245 static void handler_keys(struct wiimote_data *wdata, const __u8 *payload) in handler_keys() argument
1250 ops = wiimod_ext_table[wdata->state.exttype]; in handler_keys()
1252 ops->in_keys(wdata, payload); in handler_keys()
1256 mods = wiimote_devtype_mods[wdata->state.devtype]; in handler_keys()
1260 ops->in_keys(wdata, payload); in handler_keys()
1266 static void handler_accel(struct wiimote_data *wdata, const __u8 *payload) in handler_accel() argument
1271 ops = wiimod_ext_table[wdata->state.exttype]; in handler_accel()
1273 ops->in_accel(wdata, payload); in handler_accel()
1277 mods = wiimote_devtype_mods[wdata->state.devtype]; in handler_accel()
1281 ops->in_accel(wdata, payload); in handler_accel()
1299 static void handler_ext(struct wiimote_data *wdata, const __u8 *payload, in handler_ext() argument
1318 if (wdata->state.flags & WIIPROTO_FLAG_MP_ACTIVE) { in handler_ext()
1324 if (!(wdata->state.flags & WIIPROTO_FLAG_MP_PLUGGED)) { in handler_ext()
1325 hid_dbg(wdata->hdev, "MP hotplug: 1\n"); in handler_ext()
1326 wdata->state.flags |= WIIPROTO_FLAG_MP_PLUGGED; in handler_ext()
1327 __wiimote_schedule(wdata); in handler_ext()
1330 if (wdata->state.flags & WIIPROTO_FLAG_MP_PLUGGED) { in handler_ext()
1331 hid_dbg(wdata->hdev, "MP hotplug: 0\n"); in handler_ext()
1332 wdata->state.flags &= ~WIIPROTO_FLAG_MP_PLUGGED; in handler_ext()
1333 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_ACTIVE; in handler_ext()
1334 __wiimote_schedule(wdata); in handler_ext()
1345 if (!(wdata->state.flags & WIIPROTO_FLAG_EXT_ACTIVE) && !is_mp) in handler_ext()
1349 ops = wiimod_ext_table[wdata->state.exttype]; in handler_ext()
1351 ops->in_mp(wdata, payload); in handler_ext()
1354 ops->in_ext(wdata, payload); in handler_ext()
1361 ops->in_mp(wdata, payload); in handler_ext()
1364 ops->in_ext(wdata, payload); in handler_ext()
1369 mods = wiimote_devtype_mods[wdata->state.devtype]; in handler_ext()
1373 ops->in_mp(wdata, payload); in handler_ext()
1376 ops->in_ext(wdata, payload); in handler_ext()
1382 #define ir_to_input0(wdata, ir, packed) handler_ir((wdata), (ir), (packed), 0) argument
1383 #define ir_to_input1(wdata, ir, packed) handler_ir((wdata), (ir), (packed), 1) argument
1384 #define ir_to_input2(wdata, ir, packed) handler_ir((wdata), (ir), (packed), 2) argument
1385 #define ir_to_input3(wdata, ir, packed) handler_ir((wdata), (ir), (packed), 3) argument
1387 static void handler_ir(struct wiimote_data *wdata, const __u8 *payload, in handler_ir() argument
1393 ops = wiimod_ext_table[wdata->state.exttype]; in handler_ir()
1395 ops->in_ir(wdata, payload, packed, id); in handler_ir()
1399 mods = wiimote_devtype_mods[wdata->state.devtype]; in handler_ir()
1403 ops->in_ir(wdata, payload, packed, id); in handler_ir()
1410 static void handler_status_K(struct wiimote_data *wdata, in handler_status_K() argument
1413 handler_keys(wdata, payload); in handler_status_K()
1416 wiiproto_req_drm(wdata, WIIPROTO_REQ_NULL); in handler_status_K()
1420 static void handler_status(struct wiimote_data *wdata, const __u8 *payload) in handler_status() argument
1422 handler_status_K(wdata, payload); in handler_status()
1426 if (!(wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED)) { in handler_status()
1427 hid_dbg(wdata->hdev, "EXT hotplug: 1\n"); in handler_status()
1428 wdata->state.flags |= WIIPROTO_FLAG_EXT_PLUGGED; in handler_status()
1429 __wiimote_schedule(wdata); in handler_status()
1432 if (wdata->state.flags & WIIPROTO_FLAG_EXT_PLUGGED) { in handler_status()
1433 hid_dbg(wdata->hdev, "EXT hotplug: 0\n"); in handler_status()
1434 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_PLUGGED; in handler_status()
1435 wdata->state.flags &= ~WIIPROTO_FLAG_MP_PLUGGED; in handler_status()
1436 wdata->state.flags &= ~WIIPROTO_FLAG_EXT_ACTIVE; in handler_status()
1437 wdata->state.flags &= ~WIIPROTO_FLAG_MP_ACTIVE; in handler_status()
1438 __wiimote_schedule(wdata); in handler_status()
1442 wdata->state.cmd_battery = payload[5]; in handler_status()
1443 if (wiimote_cmd_pending(wdata, WIIPROTO_REQ_SREQ, 0)) in handler_status()
1444 wiimote_cmd_complete(wdata); in handler_status()
1448 static void handler_generic_K(struct wiimote_data *wdata, const __u8 *payload) in handler_generic_K() argument
1450 handler_keys(wdata, payload); in handler_generic_K()
1453 static void handler_data(struct wiimote_data *wdata, const __u8 *payload) in handler_data() argument
1459 handler_keys(wdata, payload); in handler_data()
1461 if (wiimote_cmd_pending(wdata, WIIPROTO_REQ_RMEM, offset)) { in handler_data()
1464 else if (size > wdata->state.cmd_read_size) in handler_data()
1465 size = wdata->state.cmd_read_size; in handler_data()
1467 wdata->state.cmd_read_size = size; in handler_data()
1468 if (wdata->state.cmd_read_buf) in handler_data()
1469 memcpy(wdata->state.cmd_read_buf, &payload[5], size); in handler_data()
1470 wiimote_cmd_complete(wdata); in handler_data()
1474 static void handler_return(struct wiimote_data *wdata, const __u8 *payload) in handler_return() argument
1479 handler_keys(wdata, payload); in handler_return()
1481 if (wiimote_cmd_pending(wdata, cmd, 0)) { in handler_return()
1482 wdata->state.cmd_err = err; in handler_return()
1483 wiimote_cmd_complete(wdata); in handler_return()
1485 hid_warn(wdata->hdev, "Remote error %u on req %u\n", err, in handler_return()
1490 static void handler_drm_KA(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KA() argument
1492 handler_keys(wdata, payload); in handler_drm_KA()
1493 handler_accel(wdata, payload); in handler_drm_KA()
1496 static void handler_drm_KE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KE() argument
1498 handler_keys(wdata, payload); in handler_drm_KE()
1499 handler_ext(wdata, &payload[2], 8); in handler_drm_KE()
1502 static void handler_drm_KAI(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KAI() argument
1504 handler_keys(wdata, payload); in handler_drm_KAI()
1505 handler_accel(wdata, payload); in handler_drm_KAI()
1506 ir_to_input0(wdata, &payload[5], false); in handler_drm_KAI()
1507 ir_to_input1(wdata, &payload[8], false); in handler_drm_KAI()
1508 ir_to_input2(wdata, &payload[11], false); in handler_drm_KAI()
1509 ir_to_input3(wdata, &payload[14], false); in handler_drm_KAI()
1512 static void handler_drm_KEE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KEE() argument
1514 handler_keys(wdata, payload); in handler_drm_KEE()
1515 handler_ext(wdata, &payload[2], 19); in handler_drm_KEE()
1518 static void handler_drm_KIE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KIE() argument
1520 handler_keys(wdata, payload); in handler_drm_KIE()
1521 ir_to_input0(wdata, &payload[2], false); in handler_drm_KIE()
1522 ir_to_input1(wdata, &payload[4], true); in handler_drm_KIE()
1523 ir_to_input2(wdata, &payload[7], false); in handler_drm_KIE()
1524 ir_to_input3(wdata, &payload[9], true); in handler_drm_KIE()
1525 handler_ext(wdata, &payload[12], 9); in handler_drm_KIE()
1528 static void handler_drm_KAE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KAE() argument
1530 handler_keys(wdata, payload); in handler_drm_KAE()
1531 handler_accel(wdata, payload); in handler_drm_KAE()
1532 handler_ext(wdata, &payload[5], 16); in handler_drm_KAE()
1535 static void handler_drm_KAIE(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_KAIE() argument
1537 handler_keys(wdata, payload); in handler_drm_KAIE()
1538 handler_accel(wdata, payload); in handler_drm_KAIE()
1539 ir_to_input0(wdata, &payload[5], false); in handler_drm_KAIE()
1540 ir_to_input1(wdata, &payload[7], true); in handler_drm_KAIE()
1541 ir_to_input2(wdata, &payload[10], false); in handler_drm_KAIE()
1542 ir_to_input3(wdata, &payload[12], true); in handler_drm_KAIE()
1543 handler_ext(wdata, &payload[15], 6); in handler_drm_KAIE()
1546 static void handler_drm_E(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_E() argument
1548 handler_ext(wdata, payload, 21); in handler_drm_E()
1551 static void handler_drm_SKAI1(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_SKAI1() argument
1553 handler_keys(wdata, payload); in handler_drm_SKAI1()
1555 wdata->state.accel_split[0] = payload[2]; in handler_drm_SKAI1()
1556 wdata->state.accel_split[1] = (payload[0] >> 1) & (0x10 | 0x20); in handler_drm_SKAI1()
1557 wdata->state.accel_split[1] |= (payload[1] << 1) & (0x40 | 0x80); in handler_drm_SKAI1()
1559 ir_to_input0(wdata, &payload[3], false); in handler_drm_SKAI1()
1560 ir_to_input1(wdata, &payload[12], false); in handler_drm_SKAI1()
1563 static void handler_drm_SKAI2(struct wiimote_data *wdata, const __u8 *payload) in handler_drm_SKAI2() argument
1567 handler_keys(wdata, payload); in handler_drm_SKAI2()
1569 wdata->state.accel_split[1] |= (payload[0] >> 5) & (0x01 | 0x02); in handler_drm_SKAI2()
1570 wdata->state.accel_split[1] |= (payload[1] >> 3) & (0x04 | 0x08); in handler_drm_SKAI2()
1574 buf[2] = wdata->state.accel_split[0]; in handler_drm_SKAI2()
1576 buf[4] = wdata->state.accel_split[1]; in handler_drm_SKAI2()
1577 handler_accel(wdata, buf); in handler_drm_SKAI2()
1579 ir_to_input2(wdata, &payload[3], false); in handler_drm_SKAI2()
1580 ir_to_input3(wdata, &payload[12], false); in handler_drm_SKAI2()
1586 void (*func)(struct wiimote_data *wdata, const __u8 *payload);
1620 struct wiimote_data *wdata = hid_get_drvdata(hdev); in wiimote_hid_event() local
1631 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_hid_event()
1632 h->func(wdata, &raw_data[1]); in wiimote_hid_event()
1633 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_hid_event()
1649 struct wiimote_data *wdata = dev_to_wii(dev); in wiimote_ext_show() local
1653 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_ext_show()
1654 type = wdata->state.exttype; in wiimote_ext_show()
1655 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_ext_show()
1682 struct wiimote_data *wdata = dev_to_wii(dev); in wiimote_ext_store() local
1685 wiimote_schedule(wdata); in wiimote_ext_store()
1700 struct wiimote_data *wdata = dev_to_wii(dev); in wiimote_dev_show() local
1704 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_dev_show()
1705 type = wdata->state.devtype; in wiimote_dev_show()
1706 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_dev_show()
1731 struct wiimote_data *wdata; in wiimote_create() local
1733 wdata = kzalloc(sizeof(*wdata), GFP_KERNEL); in wiimote_create()
1734 if (!wdata) in wiimote_create()
1737 wdata->hdev = hdev; in wiimote_create()
1738 hid_set_drvdata(hdev, wdata); in wiimote_create()
1740 spin_lock_init(&wdata->queue.lock); in wiimote_create()
1741 INIT_WORK(&wdata->queue.worker, wiimote_queue_worker); in wiimote_create()
1743 spin_lock_init(&wdata->state.lock); in wiimote_create()
1744 init_completion(&wdata->state.ready); in wiimote_create()
1745 mutex_init(&wdata->state.sync); in wiimote_create()
1746 wdata->state.drm = WIIPROTO_REQ_DRM_K; in wiimote_create()
1747 wdata->state.cmd_battery = 0xff; in wiimote_create()
1749 INIT_WORK(&wdata->init_worker, wiimote_init_worker); in wiimote_create()
1750 timer_setup(&wdata->timer, wiimote_init_timeout, 0); in wiimote_create()
1752 return wdata; in wiimote_create()
1755 static void wiimote_destroy(struct wiimote_data *wdata) in wiimote_destroy() argument
1759 wiidebug_deinit(wdata); in wiimote_destroy()
1762 spin_lock_irqsave(&wdata->state.lock, flags); in wiimote_destroy()
1763 wdata->state.flags |= WIIPROTO_FLAG_EXITING; in wiimote_destroy()
1764 spin_unlock_irqrestore(&wdata->state.lock, flags); in wiimote_destroy()
1766 cancel_work_sync(&wdata->init_worker); in wiimote_destroy()
1767 del_timer_sync(&wdata->timer); in wiimote_destroy()
1769 device_remove_file(&wdata->hdev->dev, &dev_attr_devtype); in wiimote_destroy()
1770 device_remove_file(&wdata->hdev->dev, &dev_attr_extension); in wiimote_destroy()
1772 wiimote_mp_unload(wdata); in wiimote_destroy()
1773 wiimote_ext_unload(wdata); in wiimote_destroy()
1774 wiimote_modules_unload(wdata); in wiimote_destroy()
1775 cancel_work_sync(&wdata->queue.worker); in wiimote_destroy()
1776 hid_hw_close(wdata->hdev); in wiimote_destroy()
1777 hid_hw_stop(wdata->hdev); in wiimote_destroy()
1779 kfree(wdata); in wiimote_destroy()
1785 struct wiimote_data *wdata; in wiimote_hid_probe() local
1790 wdata = wiimote_create(hdev); in wiimote_hid_probe()
1791 if (!wdata) { in wiimote_hid_probe()
1826 ret = wiidebug_init(wdata); in wiimote_hid_probe()
1833 wiimote_schedule(wdata); in wiimote_hid_probe()
1838 wiimote_destroy(wdata); in wiimote_hid_probe()
1842 device_remove_file(&wdata->hdev->dev, &dev_attr_extension); in wiimote_hid_probe()
1848 input_free_device(wdata->ir); in wiimote_hid_probe()
1849 input_free_device(wdata->accel); in wiimote_hid_probe()
1850 kfree(wdata); in wiimote_hid_probe()
1856 struct wiimote_data *wdata = hid_get_drvdata(hdev); in wiimote_hid_remove() local
1859 wiimote_destroy(wdata); in wiimote_hid_remove()