+static void control_quirk()
+{
+ static struct endpoint_descriptor *ed; /* empty ED */
+ static struct general_td *td; /* dummy TD */
+ u32 head;
+ u32 current;
+ u32 status;
+
+ /*
+ * One time only.
+ * Allocate and keep a special empty ED with just a dummy TD.
+ */
+ if (!ed) {
+ ed = allocate_endpoint();
+ if (!ed)
+ return;
+
+ td = allocate_general_td(0);
+ if (!td) {
+ free(ed);
+ ed = NULL;
+ return;
+ }
+
+#define ED_MASK ((u32)~0x0f)
+ ed->tailp = ed->headp = virt_to_phys((void*) ((u32)td & ED_MASK));
+ ed->flags |= OHCI_ENDPOINT_DIRECTION_OUT;
+ }
+
+ /*
+ * The OHCI USB host controllers on the Nintendo Wii
+ * video game console stop working when new TDs are
+ * added to a scheduled control ED after a transfer has
+ * has taken place on it.
+ *
+ * Before scheduling any new control TD, we make the
+ * controller happy by always loading a special control ED
+ * with a single dummy TD and letting the controller attempt
+ * the transfer.
+ * The controller won't do anything with it, as the special
+ * ED has no TDs, but it will keep the controller from failing
+ * on the next transfer.
+ */
+ head = read32(OHCI0_HC_CTRL_HEAD_ED);
+ if (head) {
+ printf("head: 0x%08X\n", head);
+ /*
+ * Load the special empty ED and tell the controller to
+ * process the control list.
+ */
+ sync_after_write(ed, 64);
+ sync_after_write(td, 64);
+ write32(OHCI0_HC_CTRL_HEAD_ED, virt_to_phys(ed));
+
+ status = read32(OHCI0_HC_CONTROL);
+ set32(OHCI0_HC_CONTROL, OHCI_CTRL_CLE);
+ write32(OHCI0_HC_COMMAND_STATUS, OHCI_CLF);
+
+ /* spin until the controller is done with the control list */
+ current = read32(OHCI0_HC_CTRL_CURRENT_ED);
+ while(!current) {
+ udelay(10);
+ current = read32(OHCI0_HC_CTRL_CURRENT_ED);
+ }
+
+ printf("current: 0x%08X\n", current);
+
+ /* restore the old control head and control settings */
+ write32(OHCI0_HC_CONTROL, status);
+ write32(OHCI0_HC_CTRL_HEAD_ED, head);
+ } else {
+ printf("nohead!\n");
+ }
+}
+
+