Lines Matching refs:fusbh200
97 #define fusbh200_dbg(fusbh200, fmt, args...) \ argument
98 dev_dbg (fusbh200_to_hcd(fusbh200)->self.controller , fmt , ## args )
99 #define fusbh200_err(fusbh200, fmt, args...) \ argument
100 dev_err (fusbh200_to_hcd(fusbh200)->self.controller , fmt , ## args )
101 #define fusbh200_info(fusbh200, fmt, args...) \ argument
102 dev_info (fusbh200_to_hcd(fusbh200)->self.controller , fmt , ## args )
103 #define fusbh200_warn(fusbh200, fmt, args...) \ argument
104 dev_warn (fusbh200_to_hcd(fusbh200)->self.controller , fmt , ## args )
110 static void dbg_hcs_params (struct fusbh200_hcd *fusbh200, char *label) in dbg_hcs_params() argument
112 u32 params = fusbh200_readl(fusbh200, &fusbh200->caps->hcs_params); in dbg_hcs_params()
114 fusbh200_dbg (fusbh200, in dbg_hcs_params()
125 static void dbg_hcc_params (struct fusbh200_hcd *fusbh200, char *label) in dbg_hcc_params() argument
127 u32 params = fusbh200_readl(fusbh200, &fusbh200->caps->hcc_params); in dbg_hcc_params()
129 fusbh200_dbg (fusbh200, in dbg_hcc_params()
138 dbg_qtd (const char *label, struct fusbh200_hcd *fusbh200, struct fusbh200_qtd *qtd) in dbg_qtd() argument
140 fusbh200_dbg(fusbh200, "%s td %p n%08x %08x t%08x p0=%08x\n", label, qtd, in dbg_qtd()
141 hc32_to_cpup(fusbh200, &qtd->hw_next), in dbg_qtd()
142 hc32_to_cpup(fusbh200, &qtd->hw_alt_next), in dbg_qtd()
143 hc32_to_cpup(fusbh200, &qtd->hw_token), in dbg_qtd()
144 hc32_to_cpup(fusbh200, &qtd->hw_buf [0])); in dbg_qtd()
146 fusbh200_dbg(fusbh200, " p1=%08x p2=%08x p3=%08x p4=%08x\n", in dbg_qtd()
147 hc32_to_cpup(fusbh200, &qtd->hw_buf[1]), in dbg_qtd()
148 hc32_to_cpup(fusbh200, &qtd->hw_buf[2]), in dbg_qtd()
149 hc32_to_cpup(fusbh200, &qtd->hw_buf[3]), in dbg_qtd()
150 hc32_to_cpup(fusbh200, &qtd->hw_buf[4])); in dbg_qtd()
154 dbg_qh (const char *label, struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh) in dbg_qh() argument
158 fusbh200_dbg (fusbh200, "%s qh %p n%08x info %x %x qtd %x\n", label, in dbg_qh()
160 dbg_qtd("overlay", fusbh200, (struct fusbh200_qtd *) &hw->hw_qtd_next); in dbg_qh()
164 dbg_itd (const char *label, struct fusbh200_hcd *fusbh200, struct fusbh200_itd *itd) in dbg_itd() argument
166 fusbh200_dbg (fusbh200, "%s [%d] itd %p, next %08x, urb %p\n", in dbg_itd()
167 label, itd->frame, itd, hc32_to_cpu(fusbh200, itd->hw_next), in dbg_itd()
169 fusbh200_dbg (fusbh200, in dbg_itd()
171 hc32_to_cpu(fusbh200, itd->hw_transaction[0]), in dbg_itd()
172 hc32_to_cpu(fusbh200, itd->hw_transaction[1]), in dbg_itd()
173 hc32_to_cpu(fusbh200, itd->hw_transaction[2]), in dbg_itd()
174 hc32_to_cpu(fusbh200, itd->hw_transaction[3]), in dbg_itd()
175 hc32_to_cpu(fusbh200, itd->hw_transaction[4]), in dbg_itd()
176 hc32_to_cpu(fusbh200, itd->hw_transaction[5]), in dbg_itd()
177 hc32_to_cpu(fusbh200, itd->hw_transaction[6]), in dbg_itd()
178 hc32_to_cpu(fusbh200, itd->hw_transaction[7])); in dbg_itd()
179 fusbh200_dbg (fusbh200, in dbg_itd()
181 hc32_to_cpu(fusbh200, itd->hw_bufp[0]), in dbg_itd()
182 hc32_to_cpu(fusbh200, itd->hw_bufp[1]), in dbg_itd()
183 hc32_to_cpu(fusbh200, itd->hw_bufp[2]), in dbg_itd()
184 hc32_to_cpu(fusbh200, itd->hw_bufp[3]), in dbg_itd()
185 hc32_to_cpu(fusbh200, itd->hw_bufp[4]), in dbg_itd()
186 hc32_to_cpu(fusbh200, itd->hw_bufp[5]), in dbg_itd()
187 hc32_to_cpu(fusbh200, itd->hw_bufp[6])); in dbg_itd()
188 fusbh200_dbg (fusbh200, " index: %d %d %d %d %d %d %d %d\n", in dbg_itd()
279 #define dbg_status(fusbh200, label, status) { \ argument
282 fusbh200_dbg (fusbh200, "%s\n", _buf); \
285 #define dbg_cmd(fusbh200, label, command) { \ argument
288 fusbh200_dbg (fusbh200, "%s\n", _buf); \
291 #define dbg_port(fusbh200, label, port, status) { \ argument
294 fusbh200_dbg (fusbh200, "%s\n", _buf); \
350 static inline char token_mark(struct fusbh200_hcd *fusbh200, __hc32 token) in token_mark() argument
352 __u32 v = hc32_to_cpu(fusbh200, token); in token_mark()
365 struct fusbh200_hcd *fusbh200, in qh_lines() argument
378 __le32 list_end = FUSBH200_LIST_END(fusbh200); in qh_lines()
384 mark = token_mark(fusbh200, hw->hw_token); in qh_lines()
386 if ((hw->hw_alt_next & QTD_MASK(fusbh200)) in qh_lines()
387 == fusbh200->async->hw->hw_alt_next) in qh_lines()
393 scratch = hc32_to_cpup(fusbh200, &hw->hw_info1); in qh_lines()
394 hw_curr = (mark == '*') ? hc32_to_cpup(fusbh200, &hw->hw_current) : 0; in qh_lines()
400 scratch, hc32_to_cpup(fusbh200, &hw->hw_info2), in qh_lines()
401 hc32_to_cpup(fusbh200, &hw->hw_token), mark, in qh_lines()
402 (cpu_to_hc32(fusbh200, QTD_TOGGLE) & hw->hw_token) in qh_lines()
404 (hc32_to_cpup(fusbh200, &hw->hw_alt_next) >> 1) & 0x0f); in qh_lines()
410 scratch = hc32_to_cpup(fusbh200, &td->hw_token); in qh_lines()
414 else if (hw->hw_qtd_next == cpu_to_hc32(fusbh200, td->qtd_dma)) in qh_lines()
417 if (td->hw_alt_next == fusbh200->async->hw->hw_alt_next) in qh_lines()
456 struct fusbh200_hcd *fusbh200; in fill_async_buffer() local
463 fusbh200 = hcd_to_fusbh200 (hcd); in fill_async_buffer()
473 spin_lock_irqsave (&fusbh200->lock, flags); in fill_async_buffer()
474 for (qh = fusbh200->async->qh_next.qh; size > 0 && qh; qh = qh->qh_next.qh) in fill_async_buffer()
475 qh_lines (fusbh200, qh, &next, &size); in fill_async_buffer()
476 if (fusbh200->async_unlink && size > 0) { in fill_async_buffer()
481 for (qh = fusbh200->async_unlink; size > 0 && qh; in fill_async_buffer()
483 qh_lines (fusbh200, qh, &next, &size); in fill_async_buffer()
485 spin_unlock_irqrestore (&fusbh200->lock, flags); in fill_async_buffer()
494 struct fusbh200_hcd *fusbh200; in fill_periodic_buffer() local
507 fusbh200 = hcd_to_fusbh200 (hcd); in fill_periodic_buffer()
511 temp = scnprintf (next, size, "size = %d\n", fusbh200->periodic_size); in fill_periodic_buffer()
518 spin_lock_irqsave (&fusbh200->lock, flags); in fill_periodic_buffer()
519 for (i = 0; i < fusbh200->periodic_size; i++) { in fill_periodic_buffer()
520 p = fusbh200->pshadow [i]; in fill_periodic_buffer()
523 tag = Q_NEXT_TYPE(fusbh200, fusbh200->periodic [i]); in fill_periodic_buffer()
532 switch (hc32_to_cpu(fusbh200, tag)) { in fill_periodic_buffer()
537 hc32_to_cpup(fusbh200, in fill_periodic_buffer()
558 u32 scratch = hc32_to_cpup(fusbh200, in fill_periodic_buffer()
570 fusbh200, in fill_periodic_buffer()
591 tag = Q_NEXT_TYPE(fusbh200, hw->hw_next); in fill_periodic_buffer()
598 tag = Q_NEXT_TYPE(fusbh200, p.fstn->hw_next); in fill_periodic_buffer()
604 tag = Q_NEXT_TYPE(fusbh200, p.itd->hw_next); in fill_periodic_buffer()
616 spin_unlock_irqrestore (&fusbh200->lock, flags); in fill_periodic_buffer()
623 static const char *rh_state_string(struct fusbh200_hcd *fusbh200) in rh_state_string() argument
625 switch (fusbh200->rh_state) { in rh_state_string()
641 struct fusbh200_hcd *fusbh200; in fill_registers_buffer() local
649 fusbh200 = hcd_to_fusbh200 (hcd); in fill_registers_buffer()
653 spin_lock_irqsave (&fusbh200->lock, flags); in fill_registers_buffer()
667 i = HC_VERSION(fusbh200, fusbh200_readl(fusbh200, &fusbh200->caps->hc_capbase)); in fill_registers_buffer()
675 i >> 8, i & 0x0ff, rh_state_string(fusbh200)); in fill_registers_buffer()
680 i = fusbh200_readl(fusbh200, &fusbh200->caps->hcs_params); in fill_registers_buffer()
685 i = fusbh200_readl(fusbh200, &fusbh200->caps->hcc_params); in fill_registers_buffer()
692 fusbh200_readl(fusbh200, &fusbh200->regs->status)); in fill_registers_buffer()
698 fusbh200_readl(fusbh200, &fusbh200->regs->command)); in fill_registers_buffer()
704 fusbh200_readl(fusbh200, &fusbh200->regs->intr_enable)); in fill_registers_buffer()
710 fusbh200_read_frame_index(fusbh200)); in fill_registers_buffer()
714 if (fusbh200->async_unlink) { in fill_registers_buffer()
716 fusbh200->async_unlink); in fill_registers_buffer()
723 fusbh200->stats.normal, fusbh200->stats.error, fusbh200->stats.iaa, in fill_registers_buffer()
724 fusbh200->stats.lost_iaa); in fill_registers_buffer()
729 fusbh200->stats.complete, fusbh200->stats.unlink); in fill_registers_buffer()
734 spin_unlock_irqrestore (&fusbh200->lock, flags); in fill_registers_buffer()
841 static inline void create_debug_files (struct fusbh200_hcd *fusbh200) in create_debug_files() argument
843 struct usb_bus *bus = &fusbh200_to_hcd(fusbh200)->self; in create_debug_files()
845 fusbh200->debug_dir = debugfs_create_dir(bus->bus_name, fusbh200_debug_root); in create_debug_files()
846 if (!fusbh200->debug_dir) in create_debug_files()
849 if (!debugfs_create_file("async", S_IRUGO, fusbh200->debug_dir, bus, in create_debug_files()
853 if (!debugfs_create_file("periodic", S_IRUGO, fusbh200->debug_dir, bus, in create_debug_files()
857 if (!debugfs_create_file("registers", S_IRUGO, fusbh200->debug_dir, bus, in create_debug_files()
864 debugfs_remove_recursive(fusbh200->debug_dir); in create_debug_files()
867 static inline void remove_debug_files (struct fusbh200_hcd *fusbh200) in remove_debug_files() argument
869 debugfs_remove_recursive(fusbh200->debug_dir); in remove_debug_files()
891 static int handshake (struct fusbh200_hcd *fusbh200, void __iomem *ptr, in handshake() argument
897 result = fusbh200_readl(fusbh200, ptr); in handshake()
913 static int fusbh200_halt (struct fusbh200_hcd *fusbh200) in fusbh200_halt() argument
917 spin_lock_irq(&fusbh200->lock); in fusbh200_halt()
920 fusbh200_writel(fusbh200, 0, &fusbh200->regs->intr_enable); in fusbh200_halt()
926 fusbh200->command &= ~CMD_RUN; in fusbh200_halt()
927 temp = fusbh200_readl(fusbh200, &fusbh200->regs->command); in fusbh200_halt()
929 fusbh200_writel(fusbh200, temp, &fusbh200->regs->command); in fusbh200_halt()
931 spin_unlock_irq(&fusbh200->lock); in fusbh200_halt()
932 synchronize_irq(fusbh200_to_hcd(fusbh200)->irq); in fusbh200_halt()
934 return handshake(fusbh200, &fusbh200->regs->status, in fusbh200_halt()
942 static int fusbh200_reset (struct fusbh200_hcd *fusbh200) in fusbh200_reset() argument
945 u32 command = fusbh200_readl(fusbh200, &fusbh200->regs->command); in fusbh200_reset()
949 if (fusbh200->debug && !dbgp_reset_prep(fusbh200_to_hcd(fusbh200))) in fusbh200_reset()
950 fusbh200->debug = NULL; in fusbh200_reset()
953 dbg_cmd (fusbh200, "reset", command); in fusbh200_reset()
954 fusbh200_writel(fusbh200, command, &fusbh200->regs->command); in fusbh200_reset()
955 fusbh200->rh_state = FUSBH200_RH_HALTED; in fusbh200_reset()
956 fusbh200->next_statechange = jiffies; in fusbh200_reset()
957 retval = handshake (fusbh200, &fusbh200->regs->command, in fusbh200_reset()
963 if (fusbh200->debug) in fusbh200_reset()
964 dbgp_external_startup(fusbh200_to_hcd(fusbh200)); in fusbh200_reset()
966 fusbh200->port_c_suspend = fusbh200->suspended_ports = in fusbh200_reset()
967 fusbh200->resuming_ports = 0; in fusbh200_reset()
975 static void fusbh200_quiesce (struct fusbh200_hcd *fusbh200) in fusbh200_quiesce() argument
979 if (fusbh200->rh_state != FUSBH200_RH_RUNNING) in fusbh200_quiesce()
983 temp = (fusbh200->command << 10) & (STS_ASS | STS_PSS); in fusbh200_quiesce()
984 handshake(fusbh200, &fusbh200->regs->status, STS_ASS | STS_PSS, temp, 16 * 125); in fusbh200_quiesce()
987 spin_lock_irq(&fusbh200->lock); in fusbh200_quiesce()
988 fusbh200->command &= ~(CMD_ASE | CMD_PSE); in fusbh200_quiesce()
989 fusbh200_writel(fusbh200, fusbh200->command, &fusbh200->regs->command); in fusbh200_quiesce()
990 spin_unlock_irq(&fusbh200->lock); in fusbh200_quiesce()
993 handshake(fusbh200, &fusbh200->regs->status, STS_ASS | STS_PSS, 0, 16 * 125); in fusbh200_quiesce()
998 static void end_unlink_async(struct fusbh200_hcd *fusbh200);
999 static void unlink_empty_async(struct fusbh200_hcd *fusbh200);
1000 static void fusbh200_work(struct fusbh200_hcd *fusbh200);
1001 static void start_unlink_intr(struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh);
1002 static void end_unlink_intr(struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh);
1007 static void fusbh200_set_command_bit(struct fusbh200_hcd *fusbh200, u32 bit) in fusbh200_set_command_bit() argument
1009 fusbh200->command |= bit; in fusbh200_set_command_bit()
1010 fusbh200_writel(fusbh200, fusbh200->command, &fusbh200->regs->command); in fusbh200_set_command_bit()
1013 fusbh200_readl(fusbh200, &fusbh200->regs->command); in fusbh200_set_command_bit()
1017 static void fusbh200_clear_command_bit(struct fusbh200_hcd *fusbh200, u32 bit) in fusbh200_clear_command_bit() argument
1019 fusbh200->command &= ~bit; in fusbh200_clear_command_bit()
1020 fusbh200_writel(fusbh200, fusbh200->command, &fusbh200->regs->command); in fusbh200_clear_command_bit()
1023 fusbh200_readl(fusbh200, &fusbh200->regs->command); in fusbh200_clear_command_bit()
1070 static void fusbh200_enable_event(struct fusbh200_hcd *fusbh200, unsigned event, in fusbh200_enable_event() argument
1073 ktime_t *timeout = &fusbh200->hr_timeouts[event]; in fusbh200_enable_event()
1078 fusbh200->enabled_hrtimer_events |= (1 << event); in fusbh200_enable_event()
1081 if (event < fusbh200->next_hrtimer_event) { in fusbh200_enable_event()
1082 fusbh200->next_hrtimer_event = event; in fusbh200_enable_event()
1083 hrtimer_start_range_ns(&fusbh200->hrtimer, *timeout, in fusbh200_enable_event()
1090 static void fusbh200_poll_ASS(struct fusbh200_hcd *fusbh200) in fusbh200_poll_ASS() argument
1095 if (fusbh200->rh_state != FUSBH200_RH_RUNNING) in fusbh200_poll_ASS()
1098 want = (fusbh200->command & CMD_ASE) ? STS_ASS : 0; in fusbh200_poll_ASS()
1099 actual = fusbh200_readl(fusbh200, &fusbh200->regs->status) & STS_ASS; in fusbh200_poll_ASS()
1104 if (fusbh200->ASS_poll_count++ < 20) { in fusbh200_poll_ASS()
1105 fusbh200_enable_event(fusbh200, FUSBH200_HRTIMER_POLL_ASS, true); in fusbh200_poll_ASS()
1108 fusbh200_dbg(fusbh200, "Waited too long for the async schedule status (%x/%x), giving up\n", in fusbh200_poll_ASS()
1111 fusbh200->ASS_poll_count = 0; in fusbh200_poll_ASS()
1115 if (fusbh200->async_count > 0) in fusbh200_poll_ASS()
1116 fusbh200_set_command_bit(fusbh200, CMD_ASE); in fusbh200_poll_ASS()
1119 if (fusbh200->async_count == 0) { in fusbh200_poll_ASS()
1122 fusbh200_enable_event(fusbh200, FUSBH200_HRTIMER_DISABLE_ASYNC, in fusbh200_poll_ASS()
1129 static void fusbh200_disable_ASE(struct fusbh200_hcd *fusbh200) in fusbh200_disable_ASE() argument
1131 fusbh200_clear_command_bit(fusbh200, CMD_ASE); in fusbh200_disable_ASE()
1136 static void fusbh200_poll_PSS(struct fusbh200_hcd *fusbh200) in fusbh200_poll_PSS() argument
1141 if (fusbh200->rh_state != FUSBH200_RH_RUNNING) in fusbh200_poll_PSS()
1144 want = (fusbh200->command & CMD_PSE) ? STS_PSS : 0; in fusbh200_poll_PSS()
1145 actual = fusbh200_readl(fusbh200, &fusbh200->regs->status) & STS_PSS; in fusbh200_poll_PSS()
1150 if (fusbh200->PSS_poll_count++ < 20) { in fusbh200_poll_PSS()
1151 fusbh200_enable_event(fusbh200, FUSBH200_HRTIMER_POLL_PSS, true); in fusbh200_poll_PSS()
1154 fusbh200_dbg(fusbh200, "Waited too long for the periodic schedule status (%x/%x), giving up\n", in fusbh200_poll_PSS()
1157 fusbh200->PSS_poll_count = 0; in fusbh200_poll_PSS()
1161 if (fusbh200->periodic_count > 0) in fusbh200_poll_PSS()
1162 fusbh200_set_command_bit(fusbh200, CMD_PSE); in fusbh200_poll_PSS()
1165 if (fusbh200->periodic_count == 0) { in fusbh200_poll_PSS()
1168 fusbh200_enable_event(fusbh200, FUSBH200_HRTIMER_DISABLE_PERIODIC, in fusbh200_poll_PSS()
1175 static void fusbh200_disable_PSE(struct fusbh200_hcd *fusbh200) in fusbh200_disable_PSE() argument
1177 fusbh200_clear_command_bit(fusbh200, CMD_PSE); in fusbh200_disable_PSE()
1182 static void fusbh200_handle_controller_death(struct fusbh200_hcd *fusbh200) in fusbh200_handle_controller_death() argument
1184 if (!(fusbh200_readl(fusbh200, &fusbh200->regs->status) & STS_HALT)) { in fusbh200_handle_controller_death()
1187 if (fusbh200->died_poll_count++ < 5) { in fusbh200_handle_controller_death()
1189 fusbh200_enable_event(fusbh200, FUSBH200_HRTIMER_POLL_DEAD, true); in fusbh200_handle_controller_death()
1192 fusbh200_warn(fusbh200, "Waited too long for the controller to stop, giving up\n"); in fusbh200_handle_controller_death()
1196 fusbh200->rh_state = FUSBH200_RH_HALTED; in fusbh200_handle_controller_death()
1197 fusbh200_writel(fusbh200, 0, &fusbh200->regs->intr_enable); in fusbh200_handle_controller_death()
1198 fusbh200_work(fusbh200); in fusbh200_handle_controller_death()
1199 end_unlink_async(fusbh200); in fusbh200_handle_controller_death()
1206 static void fusbh200_handle_intr_unlinks(struct fusbh200_hcd *fusbh200) in fusbh200_handle_intr_unlinks() argument
1208 bool stopped = (fusbh200->rh_state < FUSBH200_RH_RUNNING); in fusbh200_handle_intr_unlinks()
1217 fusbh200->intr_unlinking = true; in fusbh200_handle_intr_unlinks()
1218 while (fusbh200->intr_unlink) { in fusbh200_handle_intr_unlinks()
1219 struct fusbh200_qh *qh = fusbh200->intr_unlink; in fusbh200_handle_intr_unlinks()
1221 if (!stopped && qh->unlink_cycle == fusbh200->intr_unlink_cycle) in fusbh200_handle_intr_unlinks()
1223 fusbh200->intr_unlink = qh->unlink_next; in fusbh200_handle_intr_unlinks()
1225 end_unlink_intr(fusbh200, qh); in fusbh200_handle_intr_unlinks()
1229 if (fusbh200->intr_unlink) { in fusbh200_handle_intr_unlinks()
1230 fusbh200_enable_event(fusbh200, FUSBH200_HRTIMER_UNLINK_INTR, true); in fusbh200_handle_intr_unlinks()
1231 ++fusbh200->intr_unlink_cycle; in fusbh200_handle_intr_unlinks()
1233 fusbh200->intr_unlinking = false; in fusbh200_handle_intr_unlinks()
1238 static void start_free_itds(struct fusbh200_hcd *fusbh200) in start_free_itds() argument
1240 if (!(fusbh200->enabled_hrtimer_events & BIT(FUSBH200_HRTIMER_FREE_ITDS))) { in start_free_itds()
1241 fusbh200->last_itd_to_free = list_entry( in start_free_itds()
1242 fusbh200->cached_itd_list.prev, in start_free_itds()
1244 fusbh200_enable_event(fusbh200, FUSBH200_HRTIMER_FREE_ITDS, true); in start_free_itds()
1249 static void end_free_itds(struct fusbh200_hcd *fusbh200) in end_free_itds() argument
1253 if (fusbh200->rh_state < FUSBH200_RH_RUNNING) { in end_free_itds()
1254 fusbh200->last_itd_to_free = NULL; in end_free_itds()
1257 list_for_each_entry_safe(itd, n, &fusbh200->cached_itd_list, itd_list) { in end_free_itds()
1259 dma_pool_free(fusbh200->itd_pool, itd, itd->itd_dma); in end_free_itds()
1260 if (itd == fusbh200->last_itd_to_free) in end_free_itds()
1264 if (!list_empty(&fusbh200->cached_itd_list)) in end_free_itds()
1265 start_free_itds(fusbh200); in end_free_itds()
1270 static void fusbh200_iaa_watchdog(struct fusbh200_hcd *fusbh200) in fusbh200_iaa_watchdog() argument
1272 if (fusbh200->rh_state != FUSBH200_RH_RUNNING) in fusbh200_iaa_watchdog()
1281 if (fusbh200->async_iaa) { in fusbh200_iaa_watchdog()
1290 cmd = fusbh200_readl(fusbh200, &fusbh200->regs->command); in fusbh200_iaa_watchdog()
1299 status = fusbh200_readl(fusbh200, &fusbh200->regs->status); in fusbh200_iaa_watchdog()
1301 COUNT(fusbh200->stats.lost_iaa); in fusbh200_iaa_watchdog()
1302 fusbh200_writel(fusbh200, STS_IAA, &fusbh200->regs->status); in fusbh200_iaa_watchdog()
1305 fusbh200_dbg(fusbh200, "IAA watchdog: status %x cmd %x\n", in fusbh200_iaa_watchdog()
1307 end_unlink_async(fusbh200); in fusbh200_iaa_watchdog()
1313 static void turn_on_io_watchdog(struct fusbh200_hcd *fusbh200) in turn_on_io_watchdog() argument
1316 if (fusbh200->rh_state != FUSBH200_RH_RUNNING || in turn_on_io_watchdog()
1317 (fusbh200->enabled_hrtimer_events & in turn_on_io_watchdog()
1325 if (fusbh200->isoc_count > 0 || (fusbh200->need_io_watchdog && in turn_on_io_watchdog()
1326 fusbh200->async_count + fusbh200->intr_count > 0)) in turn_on_io_watchdog()
1327 fusbh200_enable_event(fusbh200, FUSBH200_HRTIMER_IO_WATCHDOG, true); in turn_on_io_watchdog()
1351 struct fusbh200_hcd *fusbh200 = container_of(t, struct fusbh200_hcd, hrtimer); in fusbh200_hrtimer_func() local
1357 spin_lock_irqsave(&fusbh200->lock, flags); in fusbh200_hrtimer_func()
1359 events = fusbh200->enabled_hrtimer_events; in fusbh200_hrtimer_func()
1360 fusbh200->enabled_hrtimer_events = 0; in fusbh200_hrtimer_func()
1361 fusbh200->next_hrtimer_event = FUSBH200_HRTIMER_NO_EVENT; in fusbh200_hrtimer_func()
1369 if (now.tv64 >= fusbh200->hr_timeouts[e].tv64) in fusbh200_hrtimer_func()
1370 event_handlers[e](fusbh200); in fusbh200_hrtimer_func()
1372 fusbh200_enable_event(fusbh200, e, false); in fusbh200_hrtimer_func()
1375 spin_unlock_irqrestore(&fusbh200->lock, flags); in fusbh200_hrtimer_func()
1387 struct fusbh200_hcd *fusbh200, in check_reset_complete() argument
1398 fusbh200_dbg (fusbh200, in check_reset_complete()
1403 fusbh200_dbg(fusbh200, "port %d reset complete, port enabled\n", in check_reset_complete()
1418 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200 (hcd); in fusbh200_hub_status_data() local
1430 status = fusbh200->resuming_ports; in fusbh200_hub_status_data()
1438 spin_lock_irqsave (&fusbh200->lock, flags); in fusbh200_hub_status_data()
1440 temp = fusbh200_readl(fusbh200, &fusbh200->regs->port_status); in fusbh200_hub_status_data()
1449 if ((temp & mask) != 0 || test_bit(0, &fusbh200->port_c_suspend) in fusbh200_hub_status_data()
1450 || (fusbh200->reset_done[0] && time_after_eq( in fusbh200_hub_status_data()
1451 jiffies, fusbh200->reset_done[0]))) { in fusbh200_hub_status_data()
1456 spin_unlock_irqrestore (&fusbh200->lock, flags); in fusbh200_hub_status_data()
1464 struct fusbh200_hcd *fusbh200, in fusbh200_hub_descriptor() argument
1467 int ports = HCS_N_PORTS (fusbh200->hcs_params); in fusbh200_hub_descriptor()
1497 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200 (hcd); in fusbh200_hub_control() local
1498 int ports = HCS_N_PORTS (fusbh200->hcs_params); in fusbh200_hub_control()
1499 u32 __iomem *status_reg = &fusbh200->regs->port_status; in fusbh200_hub_control()
1512 spin_lock_irqsave (&fusbh200->lock, flags); in fusbh200_hub_control()
1528 temp = fusbh200_readl(fusbh200, status_reg); in fusbh200_hub_control()
1540 fusbh200_writel(fusbh200, temp & ~PORT_PE, status_reg); in fusbh200_hub_control()
1543 fusbh200_writel(fusbh200, temp | PORT_PEC, status_reg); in fusbh200_hub_control()
1553 fusbh200_writel(fusbh200, temp | PORT_RESUME, status_reg); in fusbh200_hub_control()
1554 fusbh200->reset_done[wIndex] = jiffies in fusbh200_hub_control()
1558 clear_bit(wIndex, &fusbh200->port_c_suspend); in fusbh200_hub_control()
1561 fusbh200_writel(fusbh200, temp | PORT_CSC, status_reg); in fusbh200_hub_control()
1564 fusbh200_writel(fusbh200, temp | BMISR_OVC, &fusbh200->regs->bmisr); in fusbh200_hub_control()
1572 fusbh200_readl(fusbh200, &fusbh200->regs->command); /* unblock posted write */ in fusbh200_hub_control()
1575 fusbh200_hub_descriptor (fusbh200, (struct usb_hub_descriptor *) in fusbh200_hub_control()
1588 temp = fusbh200_readl(fusbh200, status_reg); in fusbh200_hub_control()
1596 temp1 = fusbh200_readl(fusbh200, &fusbh200->regs->bmisr); in fusbh200_hub_control()
1604 if (!fusbh200->reset_done[wIndex]) { in fusbh200_hub_control()
1606 fusbh200->reset_done[wIndex] = jiffies in fusbh200_hub_control()
1609 mod_timer(&fusbh200_to_hcd(fusbh200)->rh_timer, in fusbh200_hub_control()
1610 fusbh200->reset_done[wIndex]); in fusbh200_hub_control()
1615 fusbh200->reset_done[wIndex])) { in fusbh200_hub_control()
1616 clear_bit(wIndex, &fusbh200->suspended_ports); in fusbh200_hub_control()
1617 set_bit(wIndex, &fusbh200->port_c_suspend); in fusbh200_hub_control()
1618 fusbh200->reset_done[wIndex] = 0; in fusbh200_hub_control()
1621 temp = fusbh200_readl(fusbh200, status_reg); in fusbh200_hub_control()
1622 fusbh200_writel(fusbh200, in fusbh200_hub_control()
1625 clear_bit(wIndex, &fusbh200->resuming_ports); in fusbh200_hub_control()
1626 retval = handshake(fusbh200, status_reg, in fusbh200_hub_control()
1629 fusbh200_err(fusbh200, in fusbh200_hub_control()
1641 fusbh200->reset_done[wIndex])) { in fusbh200_hub_control()
1643 fusbh200->reset_done [wIndex] = 0; in fusbh200_hub_control()
1644 clear_bit(wIndex, &fusbh200->resuming_ports); in fusbh200_hub_control()
1647 fusbh200_writel(fusbh200, temp & ~(PORT_RWC_BITS | PORT_RESET), in fusbh200_hub_control()
1652 retval = handshake(fusbh200, status_reg, in fusbh200_hub_control()
1655 fusbh200_err (fusbh200, "port %d reset error %d\n", in fusbh200_hub_control()
1661 temp = check_reset_complete (fusbh200, wIndex, status_reg, in fusbh200_hub_control()
1662 fusbh200_readl(fusbh200, status_reg)); in fusbh200_hub_control()
1666 fusbh200->reset_done[wIndex] = 0; in fusbh200_hub_control()
1667 clear_bit(wIndex, &fusbh200->resuming_ports); in fusbh200_hub_control()
1672 test_bit(wIndex, &fusbh200->companion_ports)) { in fusbh200_hub_control()
1674 fusbh200_writel(fusbh200, temp, status_reg); in fusbh200_hub_control()
1675 fusbh200_dbg(fusbh200, "port %d --> companion\n", wIndex + 1); in fusbh200_hub_control()
1676 temp = fusbh200_readl(fusbh200, status_reg); in fusbh200_hub_control()
1687 status |= fusbh200_port_speed(fusbh200, temp); in fusbh200_hub_control()
1695 } else if (test_bit(wIndex, &fusbh200->suspended_ports)) { in fusbh200_hub_control()
1696 clear_bit(wIndex, &fusbh200->suspended_ports); in fusbh200_hub_control()
1697 clear_bit(wIndex, &fusbh200->resuming_ports); in fusbh200_hub_control()
1698 fusbh200->reset_done[wIndex] = 0; in fusbh200_hub_control()
1700 set_bit(wIndex, &fusbh200->port_c_suspend); in fusbh200_hub_control()
1703 temp1 = fusbh200_readl(fusbh200, &fusbh200->regs->bmisr); in fusbh200_hub_control()
1708 if (test_bit(wIndex, &fusbh200->port_c_suspend)) in fusbh200_hub_control()
1712 dbg_port(fusbh200, "GetStatus", wIndex + 1, temp); in fusbh200_hub_control()
1732 temp = fusbh200_readl(fusbh200, status_reg); in fusbh200_hub_control()
1744 fusbh200_writel(fusbh200, temp | PORT_SUSPEND, status_reg); in fusbh200_hub_control()
1745 set_bit(wIndex, &fusbh200->suspended_ports); in fusbh200_hub_control()
1754 fusbh200_dbg(fusbh200, "port %d reset\n", wIndex + 1); in fusbh200_hub_control()
1762 fusbh200->reset_done [wIndex] = jiffies in fusbh200_hub_control()
1764 fusbh200_writel(fusbh200, temp, status_reg); in fusbh200_hub_control()
1776 spin_unlock_irqrestore(&fusbh200->lock, flags); in fusbh200_hub_control()
1777 fusbh200_quiesce(fusbh200); in fusbh200_hub_control()
1778 spin_lock_irqsave(&fusbh200->lock, flags); in fusbh200_hub_control()
1781 temp = fusbh200_readl(fusbh200, status_reg) & ~PORT_RWC_BITS; in fusbh200_hub_control()
1783 fusbh200_writel(fusbh200, temp | PORT_SUSPEND, in fusbh200_hub_control()
1786 spin_unlock_irqrestore(&fusbh200->lock, flags); in fusbh200_hub_control()
1787 fusbh200_halt(fusbh200); in fusbh200_hub_control()
1788 spin_lock_irqsave(&fusbh200->lock, flags); in fusbh200_hub_control()
1790 temp = fusbh200_readl(fusbh200, status_reg); in fusbh200_hub_control()
1792 fusbh200_writel(fusbh200, temp, status_reg); in fusbh200_hub_control()
1798 fusbh200_readl(fusbh200, &fusbh200->regs->command); /* unblock posted writes */ in fusbh200_hub_control()
1806 spin_unlock_irqrestore (&fusbh200->lock, flags); in fusbh200_hub_control()
1837 static inline void fusbh200_qtd_init(struct fusbh200_hcd *fusbh200, struct fusbh200_qtd *qtd, in fusbh200_qtd_init() argument
1842 qtd->hw_token = cpu_to_hc32(fusbh200, QTD_STS_HALT); in fusbh200_qtd_init()
1843 qtd->hw_next = FUSBH200_LIST_END(fusbh200); in fusbh200_qtd_init()
1844 qtd->hw_alt_next = FUSBH200_LIST_END(fusbh200); in fusbh200_qtd_init()
1848 static struct fusbh200_qtd *fusbh200_qtd_alloc (struct fusbh200_hcd *fusbh200, gfp_t flags) in fusbh200_qtd_alloc() argument
1853 qtd = dma_pool_alloc (fusbh200->qtd_pool, flags, &dma); in fusbh200_qtd_alloc()
1855 fusbh200_qtd_init(fusbh200, qtd, dma); in fusbh200_qtd_alloc()
1860 static inline void fusbh200_qtd_free (struct fusbh200_hcd *fusbh200, struct fusbh200_qtd *qtd) in fusbh200_qtd_free() argument
1862 dma_pool_free (fusbh200->qtd_pool, qtd, qtd->qtd_dma); in fusbh200_qtd_free()
1866 static void qh_destroy(struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh) in qh_destroy() argument
1870 fusbh200_dbg (fusbh200, "unused qh not empty!\n"); in qh_destroy()
1874 fusbh200_qtd_free (fusbh200, qh->dummy); in qh_destroy()
1875 dma_pool_free(fusbh200->qh_pool, qh->hw, qh->qh_dma); in qh_destroy()
1879 static struct fusbh200_qh *fusbh200_qh_alloc (struct fusbh200_hcd *fusbh200, gfp_t flags) in fusbh200_qh_alloc() argument
1888 dma_pool_alloc(fusbh200->qh_pool, flags, &dma); in fusbh200_qh_alloc()
1897 qh->dummy = fusbh200_qtd_alloc (fusbh200, flags); in fusbh200_qh_alloc()
1899 fusbh200_dbg (fusbh200, "no dummy td\n"); in fusbh200_qh_alloc()
1905 dma_pool_free(fusbh200->qh_pool, qh->hw, qh->qh_dma); in fusbh200_qh_alloc()
1918 static void fusbh200_mem_cleanup (struct fusbh200_hcd *fusbh200) in fusbh200_mem_cleanup() argument
1920 if (fusbh200->async) in fusbh200_mem_cleanup()
1921 qh_destroy(fusbh200, fusbh200->async); in fusbh200_mem_cleanup()
1922 fusbh200->async = NULL; in fusbh200_mem_cleanup()
1924 if (fusbh200->dummy) in fusbh200_mem_cleanup()
1925 qh_destroy(fusbh200, fusbh200->dummy); in fusbh200_mem_cleanup()
1926 fusbh200->dummy = NULL; in fusbh200_mem_cleanup()
1929 if (fusbh200->qtd_pool) in fusbh200_mem_cleanup()
1930 dma_pool_destroy (fusbh200->qtd_pool); in fusbh200_mem_cleanup()
1931 fusbh200->qtd_pool = NULL; in fusbh200_mem_cleanup()
1933 if (fusbh200->qh_pool) { in fusbh200_mem_cleanup()
1934 dma_pool_destroy (fusbh200->qh_pool); in fusbh200_mem_cleanup()
1935 fusbh200->qh_pool = NULL; in fusbh200_mem_cleanup()
1938 if (fusbh200->itd_pool) in fusbh200_mem_cleanup()
1939 dma_pool_destroy (fusbh200->itd_pool); in fusbh200_mem_cleanup()
1940 fusbh200->itd_pool = NULL; in fusbh200_mem_cleanup()
1942 if (fusbh200->periodic) in fusbh200_mem_cleanup()
1943 dma_free_coherent (fusbh200_to_hcd(fusbh200)->self.controller, in fusbh200_mem_cleanup()
1944 fusbh200->periodic_size * sizeof (u32), in fusbh200_mem_cleanup()
1945 fusbh200->periodic, fusbh200->periodic_dma); in fusbh200_mem_cleanup()
1946 fusbh200->periodic = NULL; in fusbh200_mem_cleanup()
1949 kfree(fusbh200->pshadow); in fusbh200_mem_cleanup()
1950 fusbh200->pshadow = NULL; in fusbh200_mem_cleanup()
1954 static int fusbh200_mem_init (struct fusbh200_hcd *fusbh200, gfp_t flags) in fusbh200_mem_init() argument
1959 fusbh200->qtd_pool = dma_pool_create ("fusbh200_qtd", in fusbh200_mem_init()
1960 fusbh200_to_hcd(fusbh200)->self.controller, in fusbh200_mem_init()
1964 if (!fusbh200->qtd_pool) { in fusbh200_mem_init()
1969 fusbh200->qh_pool = dma_pool_create ("fusbh200_qh", in fusbh200_mem_init()
1970 fusbh200_to_hcd(fusbh200)->self.controller, in fusbh200_mem_init()
1974 if (!fusbh200->qh_pool) { in fusbh200_mem_init()
1977 fusbh200->async = fusbh200_qh_alloc (fusbh200, flags); in fusbh200_mem_init()
1978 if (!fusbh200->async) { in fusbh200_mem_init()
1983 fusbh200->itd_pool = dma_pool_create ("fusbh200_itd", in fusbh200_mem_init()
1984 fusbh200_to_hcd(fusbh200)->self.controller, in fusbh200_mem_init()
1988 if (!fusbh200->itd_pool) { in fusbh200_mem_init()
1993 fusbh200->periodic = (__le32 *) in fusbh200_mem_init()
1994 dma_alloc_coherent (fusbh200_to_hcd(fusbh200)->self.controller, in fusbh200_mem_init()
1995 fusbh200->periodic_size * sizeof(__le32), in fusbh200_mem_init()
1996 &fusbh200->periodic_dma, 0); in fusbh200_mem_init()
1997 if (fusbh200->periodic == NULL) { in fusbh200_mem_init()
2001 for (i = 0; i < fusbh200->periodic_size; i++) in fusbh200_mem_init()
2002 fusbh200->periodic[i] = FUSBH200_LIST_END(fusbh200); in fusbh200_mem_init()
2005 fusbh200->pshadow = kcalloc(fusbh200->periodic_size, sizeof(void *), flags); in fusbh200_mem_init()
2006 if (fusbh200->pshadow != NULL) in fusbh200_mem_init()
2010 fusbh200_dbg (fusbh200, "couldn't init memory\n"); in fusbh200_mem_init()
2011 fusbh200_mem_cleanup (fusbh200); in fusbh200_mem_init()
2038 qtd_fill(struct fusbh200_hcd *fusbh200, struct fusbh200_qtd *qtd, dma_addr_t buf, in qtd_fill() argument
2045 qtd->hw_buf[0] = cpu_to_hc32(fusbh200, (u32)addr); in qtd_fill()
2046 qtd->hw_buf_hi[0] = cpu_to_hc32(fusbh200, (u32)(addr >> 32)); in qtd_fill()
2057 qtd->hw_buf[i] = cpu_to_hc32(fusbh200, (u32)addr); in qtd_fill()
2058 qtd->hw_buf_hi[i] = cpu_to_hc32(fusbh200, in qtd_fill()
2071 qtd->hw_token = cpu_to_hc32(fusbh200, (count << 16) | token); in qtd_fill()
2080 qh_update (struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh, struct fusbh200_qtd *qtd) in qh_update() argument
2087 hw->hw_qtd_next = QTD_NEXT(fusbh200, qtd->qtd_dma); in qh_update()
2088 hw->hw_alt_next = FUSBH200_LIST_END(fusbh200); in qh_update()
2095 if (!(hw->hw_info1 & cpu_to_hc32(fusbh200, QH_TOGGLE_CTL))) { in qh_update()
2099 epnum = (hc32_to_cpup(fusbh200, &hw->hw_info1) >> 8) & 0x0f; in qh_update()
2101 hw->hw_token &= ~cpu_to_hc32(fusbh200, QTD_TOGGLE); in qh_update()
2106 hw->hw_token &= cpu_to_hc32(fusbh200, QTD_TOGGLE | QTD_STS_PING); in qh_update()
2114 qh_refresh (struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh) in qh_refresh() argument
2130 if (cpu_to_hc32(fusbh200, qtd->qtd_dma) == qh->hw->hw_current) { in qh_refresh()
2137 qh_update (fusbh200, qh, qtd); in qh_refresh()
2142 static void qh_link_async(struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh);
2147 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200(hcd); in fusbh200_clear_tt_buffer_complete() local
2151 spin_lock_irqsave(&fusbh200->lock, flags); in fusbh200_clear_tt_buffer_complete()
2154 && fusbh200->rh_state == FUSBH200_RH_RUNNING) in fusbh200_clear_tt_buffer_complete()
2155 qh_link_async(fusbh200, qh); in fusbh200_clear_tt_buffer_complete()
2156 spin_unlock_irqrestore(&fusbh200->lock, flags); in fusbh200_clear_tt_buffer_complete()
2159 static void fusbh200_clear_tt_buffer(struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh, in fusbh200_clear_tt_buffer() argument
2178 fusbh200_to_hcd(fusbh200)->self.root_hub) { in fusbh200_clear_tt_buffer()
2186 struct fusbh200_hcd *fusbh200, in qtd_copy_status() argument
2228 fusbh200_dbg(fusbh200, "devpath %s ep%d%s 3strikes\n", in qtd_copy_status()
2237 fusbh200_dbg(fusbh200, in qtd_copy_status()
2249 fusbh200_urb_done(struct fusbh200_hcd *fusbh200, struct urb *urb, int status) in fusbh200_urb_done() argument
2250 __releases(fusbh200->lock) in fusbh200_urb_done()
2251 __acquires(fusbh200->lock) in fusbh200_urb_done()
2257 if ((qh->hw->hw_info2 & cpu_to_hc32(fusbh200, QH_SMASK)) != 0) { in fusbh200_urb_done()
2260 fusbh200_to_hcd(fusbh200)->self.bandwidth_int_reqs--; in fusbh200_urb_done()
2265 COUNT(fusbh200->stats.unlink); in fusbh200_urb_done()
2270 COUNT(fusbh200->stats.complete); in fusbh200_urb_done()
2274 fusbh200_dbg (fusbh200, in fusbh200_urb_done()
2284 usb_hcd_unlink_urb_from_ep(fusbh200_to_hcd(fusbh200), urb); in fusbh200_urb_done()
2285 spin_unlock (&fusbh200->lock); in fusbh200_urb_done()
2286 usb_hcd_giveback_urb(fusbh200_to_hcd(fusbh200), urb, status); in fusbh200_urb_done()
2287 spin_lock (&fusbh200->lock); in fusbh200_urb_done()
2290 static int qh_schedule (struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh);
2298 qh_completions (struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh) in qh_completions() argument
2346 fusbh200_urb_done(fusbh200, last->urb, last_status); in qh_completions()
2350 fusbh200_qtd_free (fusbh200, last); in qh_completions()
2360 token = hc32_to_cpu(fusbh200, qtd->hw_token); in qh_completions()
2368 fusbh200_dbg(fusbh200, in qh_completions()
2389 fusbh200_dbg(fusbh200, in qh_completions()
2401 qtd->hw_token = cpu_to_hc32(fusbh200, in qh_completions()
2404 hw->hw_token = cpu_to_hc32(fusbh200, in qh_completions()
2421 & FUSBH200_LIST_END(fusbh200))) { in qh_completions()
2427 && fusbh200->rh_state >= FUSBH200_RH_RUNNING)) { in qh_completions()
2435 if (fusbh200->rh_state < FUSBH200_RH_RUNNING) in qh_completions()
2446 && cpu_to_hc32(fusbh200, qtd->qtd_dma) in qh_completions()
2448 token = hc32_to_cpu(fusbh200, hw->hw_token); in qh_completions()
2454 fusbh200_clear_tt_buffer(fusbh200, qh, urb, token); in qh_completions()
2466 last_status = qtd_copy_status(fusbh200, urb, in qh_completions()
2470 & FUSBH200_LIST_END(fusbh200))) in qh_completions()
2488 fusbh200_clear_tt_buffer(fusbh200, qh, urb, in qh_completions()
2512 fusbh200_urb_done(fusbh200, last->urb, last_status); in qh_completions()
2514 fusbh200_qtd_free (fusbh200, last); in qh_completions()
2539 if (stopped != 0 || hw->hw_qtd_next == FUSBH200_LIST_END(fusbh200)) { in qh_completions()
2542 qh_refresh(fusbh200, qh); in qh_completions()
2579 struct fusbh200_hcd *fusbh200, in qtd_list_free() argument
2590 fusbh200_qtd_free (fusbh200, qtd); in qtd_list_free()
2599 struct fusbh200_hcd *fusbh200, in qh_urb_transaction() argument
2615 qtd = fusbh200_qtd_alloc (fusbh200, flags); in qh_urb_transaction()
2629 qtd_fill(fusbh200, qtd, urb->setup_dma, in qh_urb_transaction()
2636 qtd = fusbh200_qtd_alloc (fusbh200, flags); in qh_urb_transaction()
2640 qtd_prev->hw_next = QTD_NEXT(fusbh200, qtd->qtd_dma); in qh_urb_transaction()
2680 this_qtd_len = qtd_fill(fusbh200, qtd, buf, this_sg_len, token, in qh_urb_transaction()
2692 qtd->hw_alt_next = fusbh200->async->hw->hw_alt_next; in qh_urb_transaction()
2707 qtd = fusbh200_qtd_alloc (fusbh200, flags); in qh_urb_transaction()
2711 qtd_prev->hw_next = QTD_NEXT(fusbh200, qtd->qtd_dma); in qh_urb_transaction()
2722 qtd->hw_alt_next = FUSBH200_LIST_END(fusbh200); in qh_urb_transaction()
2743 qtd = fusbh200_qtd_alloc (fusbh200, flags); in qh_urb_transaction()
2747 qtd_prev->hw_next = QTD_NEXT(fusbh200, qtd->qtd_dma); in qh_urb_transaction()
2751 qtd_fill(fusbh200, qtd, 0, 0, token, 0); in qh_urb_transaction()
2757 qtd->hw_token |= cpu_to_hc32(fusbh200, QTD_IOC); in qh_urb_transaction()
2761 qtd_list_free (fusbh200, urb, head); in qh_urb_transaction()
2784 struct fusbh200_hcd *fusbh200, in qh_make() argument
2788 struct fusbh200_qh *qh = fusbh200_qh_alloc (fusbh200, flags); in qh_make()
2812 fusbh200_dbg(fusbh200, "bogus qh maxpacket %d\n", max_packet(maxp)); in qh_make()
2841 } else if (qh->period > fusbh200->periodic_size) { in qh_make()
2842 qh->period = fusbh200->periodic_size; in qh_make()
2866 if (qh->period > fusbh200->periodic_size) { in qh_make()
2867 qh->period = fusbh200->periodic_size; in qh_make()
2897 if (fusbh200_has_fsl_portno_bug(fusbh200)) in qh_make()
2905 if (tt && tt->hub != fusbh200_to_hcd(fusbh200)->self.root_hub) in qh_make()
2935 fusbh200_dbg(fusbh200, "bogus dev %p speed %d\n", urb->dev, in qh_make()
2938 qh_destroy(fusbh200, qh); in qh_make()
2947 hw->hw_info1 = cpu_to_hc32(fusbh200, info1); in qh_make()
2948 hw->hw_info2 = cpu_to_hc32(fusbh200, info2); in qh_make()
2951 qh_refresh (fusbh200, qh); in qh_make()
2957 static void enable_async(struct fusbh200_hcd *fusbh200) in enable_async() argument
2959 if (fusbh200->async_count++) in enable_async()
2963 fusbh200->enabled_hrtimer_events &= ~BIT(FUSBH200_HRTIMER_DISABLE_ASYNC); in enable_async()
2966 fusbh200_poll_ASS(fusbh200); in enable_async()
2967 turn_on_io_watchdog(fusbh200); in enable_async()
2970 static void disable_async(struct fusbh200_hcd *fusbh200) in disable_async() argument
2972 if (--fusbh200->async_count) in disable_async()
2976 WARN_ON(fusbh200->async->qh_next.qh || fusbh200->async_unlink); in disable_async()
2979 fusbh200_poll_ASS(fusbh200); in disable_async()
2984 static void qh_link_async (struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh) in qh_link_async() argument
2986 __hc32 dma = QH_NEXT(fusbh200, qh->qh_dma); in qh_link_async()
2996 qh_refresh(fusbh200, qh); in qh_link_async()
2999 head = fusbh200->async; in qh_link_async()
3011 enable_async(fusbh200); in qh_link_async()
3023 struct fusbh200_hcd *fusbh200, in qh_append_tds() argument
3031 __hc32 qh_addr_mask = cpu_to_hc32(fusbh200, 0x7f); in qh_append_tds()
3036 qh = qh_make (fusbh200, urb, GFP_ATOMIC); in qh_append_tds()
3070 qtd->hw_token = HALT_BIT(fusbh200); in qh_append_tds()
3082 fusbh200_qtd_init(fusbh200, qtd, qtd->qtd_dma); in qh_append_tds()
3089 qtd->hw_next = QTD_NEXT(fusbh200, dma); in qh_append_tds()
3105 struct fusbh200_hcd *fusbh200, in submit_async() argument
3121 fusbh200_dbg(fusbh200, in submit_async()
3130 spin_lock_irqsave (&fusbh200->lock, flags); in submit_async()
3131 if (unlikely(!HCD_HW_ACCESSIBLE(fusbh200_to_hcd(fusbh200)))) { in submit_async()
3135 rc = usb_hcd_link_urb_to_ep(fusbh200_to_hcd(fusbh200), urb); in submit_async()
3139 qh = qh_append_tds(fusbh200, urb, qtd_list, epnum, &urb->ep->hcpriv); in submit_async()
3141 usb_hcd_unlink_urb_from_ep(fusbh200_to_hcd(fusbh200), urb); in submit_async()
3150 qh_link_async(fusbh200, qh); in submit_async()
3152 spin_unlock_irqrestore (&fusbh200->lock, flags); in submit_async()
3154 qtd_list_free (fusbh200, urb, qtd_list); in submit_async()
3160 static void single_unlink_async(struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh) in single_unlink_async() argument
3166 if (fusbh200->async_unlink) in single_unlink_async()
3167 fusbh200->async_unlink_last->unlink_next = qh; in single_unlink_async()
3169 fusbh200->async_unlink = qh; in single_unlink_async()
3170 fusbh200->async_unlink_last = qh; in single_unlink_async()
3173 prev = fusbh200->async; in single_unlink_async()
3179 if (fusbh200->qh_scan_next == qh) in single_unlink_async()
3180 fusbh200->qh_scan_next = qh->qh_next.qh; in single_unlink_async()
3183 static void start_iaa_cycle(struct fusbh200_hcd *fusbh200, bool nested) in start_iaa_cycle() argument
3189 if (fusbh200->async_iaa || fusbh200->async_unlinking) in start_iaa_cycle()
3193 fusbh200->async_iaa = fusbh200->async_unlink; in start_iaa_cycle()
3194 fusbh200->async_unlink = NULL; in start_iaa_cycle()
3197 if (unlikely(fusbh200->rh_state < FUSBH200_RH_RUNNING)) { in start_iaa_cycle()
3199 end_unlink_async(fusbh200); in start_iaa_cycle()
3202 } else if (likely(fusbh200->rh_state == FUSBH200_RH_RUNNING)) { in start_iaa_cycle()
3206 fusbh200_writel(fusbh200, fusbh200->command | CMD_IAAD, in start_iaa_cycle()
3207 &fusbh200->regs->command); in start_iaa_cycle()
3208 fusbh200_readl(fusbh200, &fusbh200->regs->command); in start_iaa_cycle()
3209 fusbh200_enable_event(fusbh200, FUSBH200_HRTIMER_IAA_WATCHDOG, true); in start_iaa_cycle()
3215 static void end_unlink_async(struct fusbh200_hcd *fusbh200) in end_unlink_async() argument
3221 fusbh200->async_unlinking = true; in end_unlink_async()
3222 while (fusbh200->async_iaa) { in end_unlink_async()
3223 qh = fusbh200->async_iaa; in end_unlink_async()
3224 fusbh200->async_iaa = qh->unlink_next; in end_unlink_async()
3230 qh_completions(fusbh200, qh); in end_unlink_async()
3232 fusbh200->rh_state == FUSBH200_RH_RUNNING) in end_unlink_async()
3233 qh_link_async(fusbh200, qh); in end_unlink_async()
3234 disable_async(fusbh200); in end_unlink_async()
3236 fusbh200->async_unlinking = false; in end_unlink_async()
3239 if (fusbh200->async_unlink) { in end_unlink_async()
3240 start_iaa_cycle(fusbh200, true); in end_unlink_async()
3241 if (unlikely(fusbh200->rh_state < FUSBH200_RH_RUNNING)) in end_unlink_async()
3246 static void unlink_empty_async(struct fusbh200_hcd *fusbh200) in unlink_empty_async() argument
3249 bool stopped = (fusbh200->rh_state < FUSBH200_RH_RUNNING); in unlink_empty_async()
3253 next = fusbh200->async->qh_next.qh; in unlink_empty_async()
3261 fusbh200->async_unlink_cycle) in unlink_empty_async()
3264 single_unlink_async(fusbh200, qh); in unlink_empty_async()
3269 if (fusbh200->async_unlink) in unlink_empty_async()
3270 start_iaa_cycle(fusbh200, false); in unlink_empty_async()
3274 fusbh200_enable_event(fusbh200, FUSBH200_HRTIMER_ASYNC_UNLINKS, true); in unlink_empty_async()
3275 ++fusbh200->async_unlink_cycle; in unlink_empty_async()
3282 static void start_unlink_async(struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh) in start_unlink_async() argument
3295 single_unlink_async(fusbh200, qh); in start_unlink_async()
3296 start_iaa_cycle(fusbh200, false); in start_unlink_async()
3301 static void scan_async (struct fusbh200_hcd *fusbh200) in scan_async() argument
3306 fusbh200->qh_scan_next = fusbh200->async->qh_next.qh; in scan_async()
3307 while (fusbh200->qh_scan_next) { in scan_async()
3308 qh = fusbh200->qh_scan_next; in scan_async()
3309 fusbh200->qh_scan_next = qh->qh_next.qh; in scan_async()
3322 temp = qh_completions(fusbh200, qh); in scan_async()
3324 start_unlink_async(fusbh200, qh); in scan_async()
3327 qh->unlink_cycle = fusbh200->async_unlink_cycle; in scan_async()
3340 if (check_unlinks_later && fusbh200->rh_state == FUSBH200_RH_RUNNING && in scan_async()
3341 !(fusbh200->enabled_hrtimer_events & in scan_async()
3343 fusbh200_enable_event(fusbh200, FUSBH200_HRTIMER_ASYNC_UNLINKS, true); in scan_async()
3344 ++fusbh200->async_unlink_cycle; in scan_async()
3371 periodic_next_shadow(struct fusbh200_hcd *fusbh200, union fusbh200_shadow *periodic, in periodic_next_shadow() argument
3374 switch (hc32_to_cpu(fusbh200, tag)) { in periodic_next_shadow()
3385 shadow_next_periodic(struct fusbh200_hcd *fusbh200, union fusbh200_shadow *periodic, in shadow_next_periodic() argument
3388 switch (hc32_to_cpu(fusbh200, tag)) { in shadow_next_periodic()
3399 static void periodic_unlink (struct fusbh200_hcd *fusbh200, unsigned frame, void *ptr) in periodic_unlink() argument
3401 union fusbh200_shadow *prev_p = &fusbh200->pshadow[frame]; in periodic_unlink()
3402 __hc32 *hw_p = &fusbh200->periodic[frame]; in periodic_unlink()
3407 prev_p = periodic_next_shadow(fusbh200, prev_p, in periodic_unlink()
3408 Q_NEXT_TYPE(fusbh200, *hw_p)); in periodic_unlink()
3409 hw_p = shadow_next_periodic(fusbh200, &here, in periodic_unlink()
3410 Q_NEXT_TYPE(fusbh200, *hw_p)); in periodic_unlink()
3420 *prev_p = *periodic_next_shadow(fusbh200, &here, in periodic_unlink()
3421 Q_NEXT_TYPE(fusbh200, *hw_p)); in periodic_unlink()
3423 *hw_p = *shadow_next_periodic(fusbh200, &here, in periodic_unlink()
3424 Q_NEXT_TYPE(fusbh200, *hw_p)); in periodic_unlink()
3429 periodic_usecs (struct fusbh200_hcd *fusbh200, unsigned frame, unsigned uframe) in periodic_usecs() argument
3431 __hc32 *hw_p = &fusbh200->periodic [frame]; in periodic_usecs()
3432 union fusbh200_shadow *q = &fusbh200->pshadow [frame]; in periodic_usecs()
3437 switch (hc32_to_cpu(fusbh200, Q_NEXT_TYPE(fusbh200, *hw_p))) { in periodic_usecs()
3441 if (hw->hw_info2 & cpu_to_hc32(fusbh200, 1 << uframe)) in periodic_usecs()
3444 if (hw->hw_info2 & cpu_to_hc32(fusbh200, in periodic_usecs()
3455 if (q->fstn->hw_prev != FUSBH200_LIST_END(fusbh200)) { in periodic_usecs()
3456 fusbh200_dbg (fusbh200, "ignoring FSTN cost ...\n"); in periodic_usecs()
3469 if (usecs > fusbh200->uframe_periodic_max) in periodic_usecs()
3470 fusbh200_err (fusbh200, "uframe %d sched overrun: %d usecs\n", in periodic_usecs()
3494 struct fusbh200_hcd *fusbh200, in tt_no_collision() argument
3508 for (; frame < fusbh200->periodic_size; frame += period) { in tt_no_collision()
3513 here = fusbh200->pshadow [frame]; in tt_no_collision()
3514 type = Q_NEXT_TYPE(fusbh200, fusbh200->periodic [frame]); in tt_no_collision()
3516 switch (hc32_to_cpu(fusbh200, type)) { in tt_no_collision()
3518 type = Q_NEXT_TYPE(fusbh200, here.itd->hw_next); in tt_no_collision()
3526 mask = hc32_to_cpu(fusbh200, in tt_no_collision()
3533 type = Q_NEXT_TYPE(fusbh200, hw->hw_next); in tt_no_collision()
3538 fusbh200_dbg (fusbh200, in tt_no_collision()
3554 static void enable_periodic(struct fusbh200_hcd *fusbh200) in enable_periodic() argument
3556 if (fusbh200->periodic_count++) in enable_periodic()
3560 fusbh200->enabled_hrtimer_events &= ~BIT(FUSBH200_HRTIMER_DISABLE_PERIODIC); in enable_periodic()
3563 fusbh200_poll_PSS(fusbh200); in enable_periodic()
3564 turn_on_io_watchdog(fusbh200); in enable_periodic()
3567 static void disable_periodic(struct fusbh200_hcd *fusbh200) in disable_periodic() argument
3569 if (--fusbh200->periodic_count) in disable_periodic()
3573 fusbh200_poll_PSS(fusbh200); in disable_periodic()
3584 static void qh_link_periodic(struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh) in qh_link_periodic() argument
3591 period, hc32_to_cpup(fusbh200, &qh->hw->hw_info2) in qh_link_periodic()
3599 for (i = qh->start; i < fusbh200->periodic_size; i += period) { in qh_link_periodic()
3600 union fusbh200_shadow *prev = &fusbh200->pshadow[i]; in qh_link_periodic()
3601 __hc32 *hw_p = &fusbh200->periodic[i]; in qh_link_periodic()
3607 type = Q_NEXT_TYPE(fusbh200, *hw_p); in qh_link_periodic()
3608 if (type == cpu_to_hc32(fusbh200, Q_TYPE_QH)) in qh_link_periodic()
3610 prev = periodic_next_shadow(fusbh200, prev, type); in qh_link_periodic()
3611 hw_p = shadow_next_periodic(fusbh200, &here, type); in qh_link_periodic()
3632 *hw_p = QH_NEXT (fusbh200, qh->qh_dma); in qh_link_periodic()
3639 fusbh200_to_hcd(fusbh200)->self.bandwidth_allocated += qh->period in qh_link_periodic()
3643 list_add(&qh->intr_node, &fusbh200->intr_qh_list); in qh_link_periodic()
3646 ++fusbh200->intr_count; in qh_link_periodic()
3647 enable_periodic(fusbh200); in qh_link_periodic()
3650 static void qh_unlink_periodic(struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh) in qh_unlink_periodic() argument
3674 for (i = qh->start; i < fusbh200->periodic_size; i += period) in qh_unlink_periodic()
3675 periodic_unlink (fusbh200, i, qh); in qh_unlink_periodic()
3678 fusbh200_to_hcd(fusbh200)->self.bandwidth_allocated -= qh->period in qh_unlink_periodic()
3685 hc32_to_cpup(fusbh200, &qh->hw->hw_info2) & (QH_CMASK | QH_SMASK), in qh_unlink_periodic()
3692 if (fusbh200->qh_scan_next == qh) in qh_unlink_periodic()
3693 fusbh200->qh_scan_next = list_entry(qh->intr_node.next, in qh_unlink_periodic()
3698 static void start_unlink_intr(struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh) in start_unlink_intr() argument
3710 qh_unlink_periodic (fusbh200, qh); in start_unlink_intr()
3720 qh->unlink_cycle = fusbh200->intr_unlink_cycle; in start_unlink_intr()
3723 if (fusbh200->intr_unlink) in start_unlink_intr()
3724 fusbh200->intr_unlink_last->unlink_next = qh; in start_unlink_intr()
3726 fusbh200->intr_unlink = qh; in start_unlink_intr()
3727 fusbh200->intr_unlink_last = qh; in start_unlink_intr()
3729 if (fusbh200->intr_unlinking) in start_unlink_intr()
3731 else if (fusbh200->rh_state < FUSBH200_RH_RUNNING) in start_unlink_intr()
3732 fusbh200_handle_intr_unlinks(fusbh200); in start_unlink_intr()
3733 else if (fusbh200->intr_unlink == qh) { in start_unlink_intr()
3734 fusbh200_enable_event(fusbh200, FUSBH200_HRTIMER_UNLINK_INTR, true); in start_unlink_intr()
3735 ++fusbh200->intr_unlink_cycle; in start_unlink_intr()
3739 static void end_unlink_intr(struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh) in end_unlink_intr() argument
3745 hw->hw_next = FUSBH200_LIST_END(fusbh200); in end_unlink_intr()
3747 qh_completions(fusbh200, qh); in end_unlink_intr()
3750 if (!list_empty(&qh->qtd_list) && fusbh200->rh_state == FUSBH200_RH_RUNNING) { in end_unlink_intr()
3751 rc = qh_schedule(fusbh200, qh); in end_unlink_intr()
3760 fusbh200_err(fusbh200, "can't reschedule qh %p, err %d\n", in end_unlink_intr()
3765 --fusbh200->intr_count; in end_unlink_intr()
3766 disable_periodic(fusbh200); in end_unlink_intr()
3772 struct fusbh200_hcd *fusbh200, in check_period() argument
3787 usecs = fusbh200->uframe_periodic_max - usecs; in check_period()
3795 claimed = periodic_usecs (fusbh200, frame, uframe); in check_period()
3799 } while ((frame += 1) < fusbh200->periodic_size); in check_period()
3804 claimed = periodic_usecs (fusbh200, frame, uframe); in check_period()
3807 } while ((frame += period) < fusbh200->periodic_size); in check_period()
3815 struct fusbh200_hcd *fusbh200, in check_intr_schedule() argument
3828 if (!check_period (fusbh200, frame, uframe, qh->period, qh->usecs)) in check_intr_schedule()
3844 *c_maskp = cpu_to_hc32(fusbh200, mask << 8); in check_intr_schedule()
3847 if (tt_no_collision (fusbh200, qh->period, qh->dev, frame, mask)) { in check_intr_schedule()
3848 if (!check_period (fusbh200, frame, uframe + qh->gap_uf + 1, in check_intr_schedule()
3851 if (!check_period (fusbh200, frame, uframe + qh->gap_uf, in check_intr_schedule()
3863 static int qh_schedule(struct fusbh200_hcd *fusbh200, struct fusbh200_qh *qh) in qh_schedule() argument
3871 qh_refresh(fusbh200, qh); in qh_schedule()
3872 hw->hw_next = FUSBH200_LIST_END(fusbh200); in qh_schedule()
3877 uframe = ffs(hc32_to_cpup(fusbh200, &hw->hw_info2) & QH_SMASK); in qh_schedule()
3878 status = check_intr_schedule (fusbh200, frame, --uframe, in qh_schedule()
3895 frame = ++fusbh200->random_frame % qh->period; in qh_schedule()
3897 status = check_intr_schedule (fusbh200, in qh_schedule()
3908 status = check_intr_schedule (fusbh200, 0, 0, qh, &c_mask); in qh_schedule()
3915 hw->hw_info2 &= cpu_to_hc32(fusbh200, ~(QH_CMASK | QH_SMASK)); in qh_schedule()
3917 ? cpu_to_hc32(fusbh200, 1 << uframe) in qh_schedule()
3918 : cpu_to_hc32(fusbh200, QH_SMASK); in qh_schedule()
3921 fusbh200_dbg (fusbh200, "reused qh %p schedule\n", qh); in qh_schedule()
3924 qh_link_periodic(fusbh200, qh); in qh_schedule()
3930 struct fusbh200_hcd *fusbh200, in intr_submit() argument
3944 spin_lock_irqsave (&fusbh200->lock, flags); in intr_submit()
3946 if (unlikely(!HCD_HW_ACCESSIBLE(fusbh200_to_hcd(fusbh200)))) { in intr_submit()
3950 status = usb_hcd_link_urb_to_ep(fusbh200_to_hcd(fusbh200), urb); in intr_submit()
3956 qh = qh_append_tds(fusbh200, urb, &empty, epnum, &urb->ep->hcpriv); in intr_submit()
3962 if ((status = qh_schedule (fusbh200, qh)) != 0) in intr_submit()
3967 qh = qh_append_tds(fusbh200, urb, qtd_list, epnum, &urb->ep->hcpriv); in intr_submit()
3971 fusbh200_to_hcd(fusbh200)->self.bandwidth_int_reqs++; in intr_submit()
3975 usb_hcd_unlink_urb_from_ep(fusbh200_to_hcd(fusbh200), urb); in intr_submit()
3977 spin_unlock_irqrestore (&fusbh200->lock, flags); in intr_submit()
3979 qtd_list_free (fusbh200, urb, qtd_list); in intr_submit()
3984 static void scan_intr(struct fusbh200_hcd *fusbh200) in scan_intr() argument
3988 list_for_each_entry_safe(qh, fusbh200->qh_scan_next, &fusbh200->intr_qh_list, in scan_intr()
4002 temp = qh_completions(fusbh200, qh); in scan_intr()
4006 start_unlink_intr(fusbh200, qh); in scan_intr()
4033 struct fusbh200_hcd *fusbh200, in iso_stream_init() argument
4064 stream->buf0 = cpu_to_hc32(fusbh200, (epnum << 8) | dev->devnum); in iso_stream_init()
4065 stream->buf1 = cpu_to_hc32(fusbh200, buf1); in iso_stream_init()
4066 stream->buf2 = cpu_to_hc32(fusbh200, multi); in iso_stream_init()
4091 iso_stream_find (struct fusbh200_hcd *fusbh200, struct urb *urb) in iso_stream_find() argument
4104 spin_lock_irqsave (&fusbh200->lock, flags); in iso_stream_find()
4112 iso_stream_init(fusbh200, stream, urb->dev, urb->pipe, in iso_stream_find()
4118 fusbh200_dbg (fusbh200, "dev %s ep%d%s, not iso??\n", in iso_stream_find()
4124 spin_unlock_irqrestore (&fusbh200->lock, flags); in iso_stream_find()
4148 struct fusbh200_hcd *fusbh200, in itd_sched_init() argument
4178 uframe->transaction = cpu_to_hc32(fusbh200, trans); in itd_sched_init()
4204 struct fusbh200_hcd *fusbh200, in itd_urb_transaction() argument
4220 itd_sched_init(fusbh200, sched, stream, urb); in itd_urb_transaction()
4228 spin_lock_irqsave (&fusbh200->lock, flags); in itd_urb_transaction()
4238 if (itd->frame == fusbh200->now_frame) in itd_urb_transaction()
4244 spin_unlock_irqrestore (&fusbh200->lock, flags); in itd_urb_transaction()
4245 itd = dma_pool_alloc (fusbh200->itd_pool, mem_flags, in itd_urb_transaction()
4247 spin_lock_irqsave (&fusbh200->lock, flags); in itd_urb_transaction()
4250 spin_unlock_irqrestore(&fusbh200->lock, flags); in itd_urb_transaction()
4259 spin_unlock_irqrestore (&fusbh200->lock, flags); in itd_urb_transaction()
4271 struct fusbh200_hcd *fusbh200, in itd_slot_ok() argument
4281 if (periodic_usecs (fusbh200, uframe >> 3, uframe & 0x7) in itd_slot_ok()
4282 > (fusbh200->uframe_periodic_max - usecs)) in itd_slot_ok()
4306 struct fusbh200_hcd *fusbh200, in iso_stream_schedule() argument
4313 unsigned mod = fusbh200->periodic_size << 3; in iso_stream_schedule()
4320 fusbh200_dbg (fusbh200, "iso request %p too long\n", urb); in iso_stream_schedule()
4325 now = fusbh200_read_frame_index(fusbh200) & (mod - 1); in iso_stream_schedule()
4340 if (!stream->highspeed && fusbh200->fs_i_thresh) in iso_stream_schedule()
4341 next = now + fusbh200->i_thresh; in iso_stream_schedule()
4356 fusbh200_dbg(fusbh200, "request %p would overflow (%d+%d >= %d)\n", in iso_stream_schedule()
4386 if (itd_slot_ok(fusbh200, mod, start, in iso_stream_schedule()
4393 fusbh200_dbg(fusbh200, "iso resched full %p (now %d max %d)\n", in iso_stream_schedule()
4403 fusbh200_dbg(fusbh200, "request %p would overflow (%d+%d >= %d)\n", in iso_stream_schedule()
4418 if (fusbh200->isoc_count == 0) in iso_stream_schedule()
4419 fusbh200->next_frame = now >> 3; in iso_stream_schedule()
4431 itd_init(struct fusbh200_hcd *fusbh200, struct fusbh200_iso_stream *stream, in itd_init() argument
4437 itd->hw_next = FUSBH200_LIST_END(fusbh200); in itd_init()
4450 struct fusbh200_hcd *fusbh200, in itd_patch() argument
4466 itd->hw_transaction[uframe] |= cpu_to_hc32(fusbh200, pg << 12); in itd_patch()
4467 itd->hw_bufp[pg] |= cpu_to_hc32(fusbh200, uf->bufp & ~(u32)0); in itd_patch()
4468 itd->hw_bufp_hi[pg] |= cpu_to_hc32(fusbh200, (u32)(uf->bufp >> 32)); in itd_patch()
4475 itd->hw_bufp[pg] |= cpu_to_hc32(fusbh200, bufp & ~(u32)0); in itd_patch()
4476 itd->hw_bufp_hi[pg] |= cpu_to_hc32(fusbh200, (u32)(bufp >> 32)); in itd_patch()
4481 itd_link (struct fusbh200_hcd *fusbh200, unsigned frame, struct fusbh200_itd *itd) in itd_link() argument
4483 union fusbh200_shadow *prev = &fusbh200->pshadow[frame]; in itd_link()
4484 __hc32 *hw_p = &fusbh200->periodic[frame]; in itd_link()
4490 type = Q_NEXT_TYPE(fusbh200, *hw_p); in itd_link()
4491 if (type == cpu_to_hc32(fusbh200, Q_TYPE_QH)) in itd_link()
4493 prev = periodic_next_shadow(fusbh200, prev, type); in itd_link()
4494 hw_p = shadow_next_periodic(fusbh200, &here, type); in itd_link()
4503 *hw_p = cpu_to_hc32(fusbh200, itd->itd_dma | Q_TYPE_ITD); in itd_link()
4508 struct fusbh200_hcd *fusbh200, in itd_link_urb() argument
4522 fusbh200_to_hcd(fusbh200)->self.bandwidth_allocated in itd_link_urb()
4524 fusbh200_dbg(fusbh200, in itd_link_urb()
4545 itd_init (fusbh200, stream, itd); in itd_link_urb()
4551 itd_patch(fusbh200, itd, iso_sched, packet, uframe); in itd_link_urb()
4560 itd_link(fusbh200, frame & (fusbh200->periodic_size - 1), itd); in itd_link_urb()
4570 ++fusbh200->isoc_count; in itd_link_urb()
4571 enable_periodic(fusbh200); in itd_link_urb()
4586 static bool itd_complete(struct fusbh200_hcd *fusbh200, struct fusbh200_itd *itd) in itd_complete() argument
4604 t = hc32_to_cpup(fusbh200, &itd->hw_transaction [uframe]); in itd_complete()
4645 fusbh200_urb_done(fusbh200, urb, 0); in itd_complete()
4649 --fusbh200->isoc_count; in itd_complete()
4650 disable_periodic(fusbh200); in itd_complete()
4653 fusbh200_to_hcd(fusbh200)->self.bandwidth_allocated in itd_complete()
4655 fusbh200_dbg(fusbh200, in itd_complete()
4670 &fusbh200->cached_itd_list); in itd_complete()
4671 start_free_itds(fusbh200); in itd_complete()
4679 static int itd_submit (struct fusbh200_hcd *fusbh200, struct urb *urb, in itd_submit() argument
4687 stream = iso_stream_find (fusbh200, urb); in itd_submit()
4689 fusbh200_dbg (fusbh200, "can't get iso stream\n"); in itd_submit()
4693 fusbh200_port_speed(fusbh200, 0) == USB_PORT_STAT_HIGH_SPEED)) { in itd_submit()
4694 fusbh200_dbg (fusbh200, "can't change iso interval %d --> %d\n", in itd_submit()
4700 fusbh200_dbg (fusbh200, in itd_submit()
4711 status = itd_urb_transaction (stream, fusbh200, urb, mem_flags); in itd_submit()
4713 fusbh200_dbg (fusbh200, "can't init itds\n"); in itd_submit()
4718 spin_lock_irqsave (&fusbh200->lock, flags); in itd_submit()
4719 if (unlikely(!HCD_HW_ACCESSIBLE(fusbh200_to_hcd(fusbh200)))) { in itd_submit()
4723 status = usb_hcd_link_urb_to_ep(fusbh200_to_hcd(fusbh200), urb); in itd_submit()
4726 status = iso_stream_schedule(fusbh200, urb, stream); in itd_submit()
4728 itd_link_urb (fusbh200, urb, fusbh200->periodic_size << 3, stream); in itd_submit()
4730 usb_hcd_unlink_urb_from_ep(fusbh200_to_hcd(fusbh200), urb); in itd_submit()
4732 spin_unlock_irqrestore (&fusbh200->lock, flags); in itd_submit()
4739 static void scan_isoc(struct fusbh200_hcd *fusbh200) in scan_isoc() argument
4742 unsigned fmask = fusbh200->periodic_size - 1; in scan_isoc()
4750 if (fusbh200->rh_state >= FUSBH200_RH_RUNNING) { in scan_isoc()
4751 uf = fusbh200_read_frame_index(fusbh200); in scan_isoc()
4755 now_frame = (fusbh200->next_frame - 1) & fmask; in scan_isoc()
4758 fusbh200->now_frame = now_frame; in scan_isoc()
4760 frame = fusbh200->next_frame; in scan_isoc()
4767 q_p = &fusbh200->pshadow [frame]; in scan_isoc()
4768 hw_p = &fusbh200->periodic [frame]; in scan_isoc()
4770 type = Q_NEXT_TYPE(fusbh200, *hw_p); in scan_isoc()
4774 switch (hc32_to_cpu(fusbh200, type)) { in scan_isoc()
4785 ITD_ACTIVE(fusbh200)) in scan_isoc()
4791 type = Q_NEXT_TYPE(fusbh200, in scan_isoc()
4805 type = Q_NEXT_TYPE(fusbh200, q.itd->hw_next); in scan_isoc()
4807 modified = itd_complete (fusbh200, q.itd); in scan_isoc()
4811 fusbh200_dbg(fusbh200, "corrupt type %d frame %d shadow %p\n", in scan_isoc()
4823 if (unlikely(modified && fusbh200->isoc_count > 0)) in scan_isoc()
4832 fusbh200->next_frame = now_frame; in scan_isoc()
4842 struct fusbh200_hcd *fusbh200; in show_uframe_periodic_max() local
4845 fusbh200 = hcd_to_fusbh200(bus_to_hcd(dev_get_drvdata(dev))); in show_uframe_periodic_max()
4846 n = scnprintf(buf, PAGE_SIZE, "%d\n", fusbh200->uframe_periodic_max); in show_uframe_periodic_max()
4855 struct fusbh200_hcd *fusbh200; in store_uframe_periodic_max() local
4862 fusbh200 = hcd_to_fusbh200(bus_to_hcd(dev_get_drvdata(dev))); in store_uframe_periodic_max()
4867 fusbh200_info(fusbh200, "rejecting invalid request for " in store_uframe_periodic_max()
4878 spin_lock_irqsave (&fusbh200->lock, flags); in store_uframe_periodic_max()
4885 if (uframe_periodic_max < fusbh200->uframe_periodic_max) { in store_uframe_periodic_max()
4888 for (frame = 0; frame < fusbh200->periodic_size; ++frame) in store_uframe_periodic_max()
4891 periodic_usecs (fusbh200, frame, uframe)); in store_uframe_periodic_max()
4894 fusbh200_info(fusbh200, in store_uframe_periodic_max()
4905 fusbh200_info(fusbh200, "setting max periodic bandwidth to %u%% " in store_uframe_periodic_max()
4910 fusbh200_warn(fusbh200, "max periodic bandwidth set is non-standard\n"); in store_uframe_periodic_max()
4912 fusbh200->uframe_periodic_max = uframe_periodic_max; in store_uframe_periodic_max()
4916 spin_unlock_irqrestore (&fusbh200->lock, flags); in store_uframe_periodic_max()
4922 static inline int create_sysfs_files(struct fusbh200_hcd *fusbh200) in create_sysfs_files() argument
4924 struct device *controller = fusbh200_to_hcd(fusbh200)->self.controller; in create_sysfs_files()
4935 static inline void remove_sysfs_files(struct fusbh200_hcd *fusbh200) in remove_sysfs_files() argument
4937 struct device *controller = fusbh200_to_hcd(fusbh200)->self.controller; in remove_sysfs_files()
4947 static void fusbh200_turn_off_all_ports(struct fusbh200_hcd *fusbh200) in fusbh200_turn_off_all_ports() argument
4949 u32 __iomem *status_reg = &fusbh200->regs->port_status; in fusbh200_turn_off_all_ports()
4951 fusbh200_writel(fusbh200, PORT_RWC_BITS, status_reg); in fusbh200_turn_off_all_ports()
4958 static void fusbh200_silence_controller(struct fusbh200_hcd *fusbh200) in fusbh200_silence_controller() argument
4960 fusbh200_halt(fusbh200); in fusbh200_silence_controller()
4962 spin_lock_irq(&fusbh200->lock); in fusbh200_silence_controller()
4963 fusbh200->rh_state = FUSBH200_RH_HALTED; in fusbh200_silence_controller()
4964 fusbh200_turn_off_all_ports(fusbh200); in fusbh200_silence_controller()
4965 spin_unlock_irq(&fusbh200->lock); in fusbh200_silence_controller()
4974 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200(hcd); in fusbh200_shutdown() local
4976 spin_lock_irq(&fusbh200->lock); in fusbh200_shutdown()
4977 fusbh200->shutdown = true; in fusbh200_shutdown()
4978 fusbh200->rh_state = FUSBH200_RH_STOPPING; in fusbh200_shutdown()
4979 fusbh200->enabled_hrtimer_events = 0; in fusbh200_shutdown()
4980 spin_unlock_irq(&fusbh200->lock); in fusbh200_shutdown()
4982 fusbh200_silence_controller(fusbh200); in fusbh200_shutdown()
4984 hrtimer_cancel(&fusbh200->hrtimer); in fusbh200_shutdown()
4993 static void fusbh200_work (struct fusbh200_hcd *fusbh200) in fusbh200_work() argument
4999 if (fusbh200->scanning) { in fusbh200_work()
5000 fusbh200->need_rescan = true; in fusbh200_work()
5003 fusbh200->scanning = true; in fusbh200_work()
5006 fusbh200->need_rescan = false; in fusbh200_work()
5007 if (fusbh200->async_count) in fusbh200_work()
5008 scan_async(fusbh200); in fusbh200_work()
5009 if (fusbh200->intr_count > 0) in fusbh200_work()
5010 scan_intr(fusbh200); in fusbh200_work()
5011 if (fusbh200->isoc_count > 0) in fusbh200_work()
5012 scan_isoc(fusbh200); in fusbh200_work()
5013 if (fusbh200->need_rescan) in fusbh200_work()
5015 fusbh200->scanning = false; in fusbh200_work()
5021 turn_on_io_watchdog(fusbh200); in fusbh200_work()
5029 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200 (hcd); in fusbh200_stop() local
5031 fusbh200_dbg (fusbh200, "stop\n"); in fusbh200_stop()
5035 spin_lock_irq(&fusbh200->lock); in fusbh200_stop()
5036 fusbh200->enabled_hrtimer_events = 0; in fusbh200_stop()
5037 spin_unlock_irq(&fusbh200->lock); in fusbh200_stop()
5039 fusbh200_quiesce(fusbh200); in fusbh200_stop()
5040 fusbh200_silence_controller(fusbh200); in fusbh200_stop()
5041 fusbh200_reset (fusbh200); in fusbh200_stop()
5043 hrtimer_cancel(&fusbh200->hrtimer); in fusbh200_stop()
5044 remove_sysfs_files(fusbh200); in fusbh200_stop()
5045 remove_debug_files (fusbh200); in fusbh200_stop()
5048 spin_lock_irq (&fusbh200->lock); in fusbh200_stop()
5049 end_free_itds(fusbh200); in fusbh200_stop()
5050 spin_unlock_irq (&fusbh200->lock); in fusbh200_stop()
5051 fusbh200_mem_cleanup (fusbh200); in fusbh200_stop()
5053 fusbh200_dbg(fusbh200, "irq normal %ld err %ld iaa %ld (lost %ld)\n", in fusbh200_stop()
5054 fusbh200->stats.normal, fusbh200->stats.error, fusbh200->stats.iaa, in fusbh200_stop()
5055 fusbh200->stats.lost_iaa); in fusbh200_stop()
5056 fusbh200_dbg (fusbh200, "complete %ld unlink %ld\n", in fusbh200_stop()
5057 fusbh200->stats.complete, fusbh200->stats.unlink); in fusbh200_stop()
5059 dbg_status (fusbh200, "fusbh200_stop completed", in fusbh200_stop()
5060 fusbh200_readl(fusbh200, &fusbh200->regs->status)); in fusbh200_stop()
5066 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200(hcd); in hcd_fusbh200_init() local
5072 spin_lock_init(&fusbh200->lock); in hcd_fusbh200_init()
5077 fusbh200->need_io_watchdog = 1; in hcd_fusbh200_init()
5079 hrtimer_init(&fusbh200->hrtimer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS); in hcd_fusbh200_init()
5080 fusbh200->hrtimer.function = fusbh200_hrtimer_func; in hcd_fusbh200_init()
5081 fusbh200->next_hrtimer_event = FUSBH200_HRTIMER_NO_EVENT; in hcd_fusbh200_init()
5083 hcc_params = fusbh200_readl(fusbh200, &fusbh200->caps->hcc_params); in hcd_fusbh200_init()
5089 fusbh200->uframe_periodic_max = 100; in hcd_fusbh200_init()
5095 fusbh200->periodic_size = DEFAULT_I_TDPS; in hcd_fusbh200_init()
5096 INIT_LIST_HEAD(&fusbh200->intr_qh_list); in hcd_fusbh200_init()
5097 INIT_LIST_HEAD(&fusbh200->cached_itd_list); in hcd_fusbh200_init()
5102 case 0: fusbh200->periodic_size = 1024; break; in hcd_fusbh200_init()
5103 case 1: fusbh200->periodic_size = 512; break; in hcd_fusbh200_init()
5104 case 2: fusbh200->periodic_size = 256; break; in hcd_fusbh200_init()
5108 if ((retval = fusbh200_mem_init(fusbh200, GFP_KERNEL)) < 0) in hcd_fusbh200_init()
5112 fusbh200->i_thresh = 2; in hcd_fusbh200_init()
5121 fusbh200->async->qh_next.qh = NULL; in hcd_fusbh200_init()
5122 hw = fusbh200->async->hw; in hcd_fusbh200_init()
5123 hw->hw_next = QH_NEXT(fusbh200, fusbh200->async->qh_dma); in hcd_fusbh200_init()
5124 hw->hw_info1 = cpu_to_hc32(fusbh200, QH_HEAD); in hcd_fusbh200_init()
5125 hw->hw_token = cpu_to_hc32(fusbh200, QTD_STS_HALT); in hcd_fusbh200_init()
5126 hw->hw_qtd_next = FUSBH200_LIST_END(fusbh200); in hcd_fusbh200_init()
5127 fusbh200->async->qh_state = QH_STATE_LINKED; in hcd_fusbh200_init()
5128 hw->hw_alt_next = QTD_NEXT(fusbh200, fusbh200->async->dummy->qtd_dma); in hcd_fusbh200_init()
5147 fusbh200_dbg(fusbh200, "park %d\n", park); in hcd_fusbh200_init()
5154 fusbh200->command = temp; in hcd_fusbh200_init()
5165 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200 (hcd); in fusbh200_run() local
5173 fusbh200_writel(fusbh200, fusbh200->periodic_dma, &fusbh200->regs->frame_list); in fusbh200_run()
5174 fusbh200_writel(fusbh200, (u32)fusbh200->async->qh_dma, &fusbh200->regs->async_next); in fusbh200_run()
5188 hcc_params = fusbh200_readl(fusbh200, &fusbh200->caps->hcc_params); in fusbh200_run()
5192 fusbh200->command &= ~(CMD_IAAD|CMD_PSE|CMD_ASE|CMD_RESET); in fusbh200_run()
5193 fusbh200->command |= CMD_RUN; in fusbh200_run()
5194 fusbh200_writel(fusbh200, fusbh200->command, &fusbh200->regs->command); in fusbh200_run()
5195 dbg_cmd (fusbh200, "init", fusbh200->command); in fusbh200_run()
5212 fusbh200->rh_state = FUSBH200_RH_RUNNING; in fusbh200_run()
5213 fusbh200_readl(fusbh200, &fusbh200->regs->command); /* unblock posted writes */ in fusbh200_run()
5216 fusbh200->last_periodic_enable = ktime_get_real(); in fusbh200_run()
5218 temp = HC_VERSION(fusbh200, fusbh200_readl(fusbh200, &fusbh200->caps->hc_capbase)); in fusbh200_run()
5219 fusbh200_info (fusbh200, in fusbh200_run()
5221 ((fusbh200->sbrn & 0xf0)>>4), (fusbh200->sbrn & 0x0f), in fusbh200_run()
5224 fusbh200_writel(fusbh200, INTR_MASK, in fusbh200_run()
5225 &fusbh200->regs->intr_enable); /* Turn On Interrupts */ in fusbh200_run()
5231 create_debug_files(fusbh200); in fusbh200_run()
5232 create_sysfs_files(fusbh200); in fusbh200_run()
5239 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200(hcd); in fusbh200_setup() local
5242 fusbh200->regs = (void __iomem *)fusbh200->caps + in fusbh200_setup()
5243 HC_LENGTH(fusbh200, fusbh200_readl(fusbh200, &fusbh200->caps->hc_capbase)); in fusbh200_setup()
5244 dbg_hcs_params(fusbh200, "reset"); in fusbh200_setup()
5245 dbg_hcc_params(fusbh200, "reset"); in fusbh200_setup()
5248 fusbh200->hcs_params = fusbh200_readl(fusbh200, &fusbh200->caps->hcs_params); in fusbh200_setup()
5250 fusbh200->sbrn = HCD_USB2; in fusbh200_setup()
5257 retval = fusbh200_halt(fusbh200); in fusbh200_setup()
5261 fusbh200_reset(fusbh200); in fusbh200_setup()
5270 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200 (hcd); in fusbh200_irq() local
5274 spin_lock (&fusbh200->lock); in fusbh200_irq()
5276 status = fusbh200_readl(fusbh200, &fusbh200->regs->status); in fusbh200_irq()
5280 fusbh200_dbg (fusbh200, "device removed\n"); in fusbh200_irq()
5291 if (!masked_status || unlikely(fusbh200->rh_state == FUSBH200_RH_HALTED)) { in fusbh200_irq()
5292 spin_unlock(&fusbh200->lock); in fusbh200_irq()
5297 fusbh200_writel(fusbh200, masked_status, &fusbh200->regs->status); in fusbh200_irq()
5298 cmd = fusbh200_readl(fusbh200, &fusbh200->regs->command); in fusbh200_irq()
5304 COUNT (fusbh200->stats.normal); in fusbh200_irq()
5306 COUNT (fusbh200->stats.error); in fusbh200_irq()
5314 fusbh200->enabled_hrtimer_events &= ~BIT(FUSBH200_HRTIMER_IAA_WATCHDOG); in fusbh200_irq()
5323 if (fusbh200->next_hrtimer_event == FUSBH200_HRTIMER_IAA_WATCHDOG) in fusbh200_irq()
5324 ++fusbh200->next_hrtimer_event; in fusbh200_irq()
5328 fusbh200_dbg(fusbh200, "IAA with IAAD still set?\n"); in fusbh200_irq()
5329 if (fusbh200->async_iaa) { in fusbh200_irq()
5330 COUNT(fusbh200->stats.iaa); in fusbh200_irq()
5331 end_unlink_async(fusbh200); in fusbh200_irq()
5333 fusbh200_dbg(fusbh200, "IAA with nothing unlinked?\n"); in fusbh200_irq()
5339 u32 __iomem *status_reg = &fusbh200->regs->port_status; in fusbh200_irq()
5345 if (fusbh200->rh_state == FUSBH200_RH_SUSPENDED) in fusbh200_irq()
5348 pstatus = fusbh200_readl(fusbh200, status_reg); in fusbh200_irq()
5350 if (test_bit(0, &fusbh200->suspended_ports) && in fusbh200_irq()
5354 fusbh200->reset_done[0] == 0) { in fusbh200_irq()
5361 fusbh200->reset_done[0] = jiffies + msecs_to_jiffies(25); in fusbh200_irq()
5362 set_bit(0, &fusbh200->resuming_ports); in fusbh200_irq()
5363 fusbh200_dbg (fusbh200, "port 1 remote wakeup\n"); in fusbh200_irq()
5364 mod_timer(&hcd->rh_timer, fusbh200->reset_done[0]); in fusbh200_irq()
5370 fusbh200_err(fusbh200, "fatal error\n"); in fusbh200_irq()
5371 dbg_cmd(fusbh200, "fatal", cmd); in fusbh200_irq()
5372 dbg_status(fusbh200, "fatal", status); in fusbh200_irq()
5377 fusbh200->shutdown = true; in fusbh200_irq()
5378 fusbh200->rh_state = FUSBH200_RH_STOPPING; in fusbh200_irq()
5379 fusbh200->command &= ~(CMD_RUN | CMD_ASE | CMD_PSE); in fusbh200_irq()
5380 fusbh200_writel(fusbh200, fusbh200->command, &fusbh200->regs->command); in fusbh200_irq()
5381 fusbh200_writel(fusbh200, 0, &fusbh200->regs->intr_enable); in fusbh200_irq()
5382 fusbh200_handle_controller_death(fusbh200); in fusbh200_irq()
5389 fusbh200_work (fusbh200); in fusbh200_irq()
5390 spin_unlock (&fusbh200->lock); in fusbh200_irq()
5415 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200 (hcd); in fusbh200_urb_enqueue() local
5430 if (!qh_urb_transaction (fusbh200, urb, &qtd_list, mem_flags)) in fusbh200_urb_enqueue()
5432 return submit_async(fusbh200, urb, &qtd_list, mem_flags); in fusbh200_urb_enqueue()
5435 if (!qh_urb_transaction (fusbh200, urb, &qtd_list, mem_flags)) in fusbh200_urb_enqueue()
5437 return intr_submit(fusbh200, urb, &qtd_list, mem_flags); in fusbh200_urb_enqueue()
5440 return itd_submit (fusbh200, urb, mem_flags); in fusbh200_urb_enqueue()
5450 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200 (hcd); in fusbh200_urb_dequeue() local
5455 spin_lock_irqsave (&fusbh200->lock, flags); in fusbh200_urb_dequeue()
5470 start_unlink_async(fusbh200, qh); in fusbh200_urb_dequeue()
5478 qh_completions(fusbh200, qh); in fusbh200_urb_dequeue()
5490 start_unlink_intr(fusbh200, qh); in fusbh200_urb_dequeue()
5493 qh_completions (fusbh200, qh); in fusbh200_urb_dequeue()
5496 fusbh200_dbg (fusbh200, "bogus qh %p state %d\n", in fusbh200_urb_dequeue()
5510 spin_unlock_irqrestore (&fusbh200->lock, flags); in fusbh200_urb_dequeue()
5521 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200 (hcd); in fusbh200_endpoint_disable() local
5529 spin_lock_irqsave (&fusbh200->lock, flags); in fusbh200_endpoint_disable()
5548 if (fusbh200->rh_state < FUSBH200_RH_RUNNING) in fusbh200_endpoint_disable()
5553 for (tmp = fusbh200->async->qh_next.qh; in fusbh200_endpoint_disable()
5561 start_unlink_async(fusbh200, qh); in fusbh200_endpoint_disable()
5566 spin_unlock_irqrestore (&fusbh200->lock, flags); in fusbh200_endpoint_disable()
5573 qh_destroy(fusbh200, qh); in fusbh200_endpoint_disable()
5581 fusbh200_err (fusbh200, "qh %p (#%02x) state %d%s\n", in fusbh200_endpoint_disable()
5588 spin_unlock_irqrestore (&fusbh200->lock, flags); in fusbh200_endpoint_disable()
5594 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200(hcd); in fusbh200_endpoint_reset() local
5604 spin_lock_irqsave(&fusbh200->lock, flags); in fusbh200_endpoint_reset()
5624 start_unlink_async(fusbh200, qh); in fusbh200_endpoint_reset()
5626 start_unlink_intr(fusbh200, qh); in fusbh200_endpoint_reset()
5629 spin_unlock_irqrestore(&fusbh200->lock, flags); in fusbh200_endpoint_reset()
5634 struct fusbh200_hcd *fusbh200 = hcd_to_fusbh200 (hcd); in fusbh200_get_frame() local
5635 return (fusbh200_read_frame_index(fusbh200) >> 3) % fusbh200->periodic_size; in fusbh200_get_frame()
5696 static void fusbh200_init(struct fusbh200_hcd *fusbh200) in fusbh200_init() argument
5700 reg = fusbh200_readl(fusbh200, &fusbh200->regs->bmcsr); in fusbh200_init()
5703 fusbh200_writel(fusbh200, reg, &fusbh200->regs->bmcsr); in fusbh200_init()
5705 reg = fusbh200_readl(fusbh200, &fusbh200->regs->bmier); in fusbh200_init()
5706 fusbh200_writel(fusbh200, reg | BMIER_OVC_EN | BMIER_VBUS_ERR_EN, in fusbh200_init()
5707 &fusbh200->regs->bmier); in fusbh200_init()
5724 struct fusbh200_hcd *fusbh200; in fusbh200_hcd_probe() local
5785 fusbh200 = hcd_to_fusbh200(hcd); in fusbh200_hcd_probe()
5787 fusbh200->caps = hcd->regs; in fusbh200_hcd_probe()
5793 fusbh200_init(fusbh200); in fusbh200_hcd_probe()