Lines Matching full:d
37 void ast_vhub_dev_irq(struct ast_vhub_dev *d) in ast_vhub_dev_irq() argument
39 u32 istat = readl(d->regs + AST_VHUB_DEV_ISR); in ast_vhub_dev_irq()
41 writel(istat, d->regs + AST_VHUB_DEV_ISR); in ast_vhub_dev_irq()
44 ast_vhub_ep0_handle_ack(&d->ep0, true); in ast_vhub_dev_irq()
46 ast_vhub_ep0_handle_ack(&d->ep0, false); in ast_vhub_dev_irq()
48 ast_vhub_ep0_handle_setup(&d->ep0); in ast_vhub_dev_irq()
51 static void ast_vhub_dev_enable(struct ast_vhub_dev *d) in ast_vhub_dev_enable() argument
55 if (d->enabled) in ast_vhub_dev_enable()
59 ast_vhub_reset_ep0(d); in ast_vhub_dev_enable()
66 if (d->gadget.speed == USB_SPEED_HIGH) in ast_vhub_dev_enable()
68 writel(reg, d->regs + AST_VHUB_DEV_EN_CTRL); in ast_vhub_dev_enable()
71 hmsk = VHUB_IRQ_DEVICE1 << d->index; in ast_vhub_dev_enable()
72 reg = readl(d->vhub->regs + AST_VHUB_IER); in ast_vhub_dev_enable()
74 writel(reg, d->vhub->regs + AST_VHUB_IER); in ast_vhub_dev_enable()
77 writel(d->ep0.buf_dma, d->regs + AST_VHUB_DEV_EP0_DATA); in ast_vhub_dev_enable()
80 for (i = 0; i < d->max_epns; i++) { in ast_vhub_dev_enable()
81 struct ast_vhub_ep *ep = d->epns[i]; in ast_vhub_dev_enable()
91 d->wakeup_en = false; in ast_vhub_dev_enable()
92 d->enabled = true; in ast_vhub_dev_enable()
95 static void ast_vhub_dev_disable(struct ast_vhub_dev *d) in ast_vhub_dev_disable() argument
99 if (!d->enabled) in ast_vhub_dev_disable()
103 hmsk = VHUB_IRQ_DEVICE1 << d->index; in ast_vhub_dev_disable()
104 reg = readl(d->vhub->regs + AST_VHUB_IER); in ast_vhub_dev_disable()
106 writel(reg, d->vhub->regs + AST_VHUB_IER); in ast_vhub_dev_disable()
109 writel(0, d->regs + AST_VHUB_DEV_EN_CTRL); in ast_vhub_dev_disable()
110 d->gadget.speed = USB_SPEED_UNKNOWN; in ast_vhub_dev_disable()
111 d->enabled = false; in ast_vhub_dev_disable()
114 static int ast_vhub_dev_feature(struct ast_vhub_dev *d, in ast_vhub_dev_feature() argument
118 DDBG(d, "%s_FEATURE(dev val=%02x)\n", in ast_vhub_dev_feature()
124 d->wakeup_en = is_set; in ast_vhub_dev_feature()
129 static int ast_vhub_ep_feature(struct ast_vhub_dev *d, in ast_vhub_ep_feature() argument
136 DDBG(d, "%s_FEATURE(ep%d val=%02x)\n", in ast_vhub_ep_feature()
140 if (ep_num >= d->max_epns || !d->epns[ep_num - 1]) in ast_vhub_ep_feature()
145 ep = d->epns[ep_num - 1]; in ast_vhub_ep_feature()
153 DDBG(d, "%s stall on EP %d\n", in ast_vhub_ep_feature()
161 static int ast_vhub_dev_status(struct ast_vhub_dev *d, in ast_vhub_dev_status() argument
166 DDBG(d, "GET_STATUS(dev)\n"); in ast_vhub_dev_status()
168 st0 = d->gadget.is_selfpowered << USB_DEVICE_SELF_POWERED; in ast_vhub_dev_status()
169 if (d->wakeup_en) in ast_vhub_dev_status()
172 return ast_vhub_simple_reply(&d->ep0, st0, 0); in ast_vhub_dev_status()
175 static int ast_vhub_ep_status(struct ast_vhub_dev *d, in ast_vhub_ep_status() argument
182 DDBG(d, "GET_STATUS(ep%d)\n", ep_num); in ast_vhub_ep_status()
184 if (ep_num >= d->max_epns) in ast_vhub_ep_status()
187 ep = d->epns[ep_num - 1]; in ast_vhub_ep_status()
197 return ast_vhub_simple_reply(&d->ep0, st0, 0); in ast_vhub_ep_status()
200 static void ast_vhub_dev_set_address(struct ast_vhub_dev *d, u8 addr) in ast_vhub_dev_set_address() argument
204 DDBG(d, "SET_ADDRESS: Got address %x\n", addr); in ast_vhub_dev_set_address()
206 reg = readl(d->regs + AST_VHUB_DEV_EN_CTRL); in ast_vhub_dev_set_address()
209 writel(reg, d->regs + AST_VHUB_DEV_EN_CTRL); in ast_vhub_dev_set_address()
215 struct ast_vhub_dev *d = ep->dev; in ast_vhub_std_dev_request() local
219 if (!d->driver || !d->enabled) { in ast_vhub_std_dev_request()
221 "Device is wrong state driver=%p enabled=%d\n", in ast_vhub_std_dev_request()
222 d->driver, d->enabled); in ast_vhub_std_dev_request()
233 if (d->gadget.speed == USB_SPEED_UNKNOWN) { in ast_vhub_std_dev_request()
234 d->gadget.speed = ep->vhub->speed; in ast_vhub_std_dev_request()
235 if (d->gadget.speed > d->driver->max_speed) in ast_vhub_std_dev_request()
236 d->gadget.speed = d->driver->max_speed; in ast_vhub_std_dev_request()
237 DDBG(d, "fist packet, captured speed %d\n", in ast_vhub_std_dev_request()
238 d->gadget.speed); in ast_vhub_std_dev_request()
247 ast_vhub_dev_set_address(d, wValue); in ast_vhub_std_dev_request()
252 return ast_vhub_dev_status(d, wIndex, wValue); in ast_vhub_std_dev_request()
256 return ast_vhub_ep_status(d, wIndex, wValue); in ast_vhub_std_dev_request()
260 return ast_vhub_dev_feature(d, wIndex, wValue, true); in ast_vhub_std_dev_request()
262 return ast_vhub_dev_feature(d, wIndex, wValue, false); in ast_vhub_std_dev_request()
264 return ast_vhub_ep_feature(d, wIndex, wValue, true); in ast_vhub_std_dev_request()
266 return ast_vhub_ep_feature(d, wIndex, wValue, false); in ast_vhub_std_dev_request()
273 struct ast_vhub_dev *d = to_ast_dev(gadget); in ast_vhub_udc_wakeup() local
277 spin_lock_irqsave(&d->vhub->lock, flags); in ast_vhub_udc_wakeup()
278 if (!d->wakeup_en) in ast_vhub_udc_wakeup()
281 DDBG(d, "Device initiated wakeup\n"); in ast_vhub_udc_wakeup()
284 ast_vhub_hub_wake_all(d->vhub); in ast_vhub_udc_wakeup()
287 spin_unlock_irqrestore(&d->vhub->lock, flags); in ast_vhub_udc_wakeup()
293 struct ast_vhub_dev *d = to_ast_dev(gadget); in ast_vhub_udc_get_frame() local
295 return (readl(d->vhub->regs + AST_VHUB_USBSTS) >> 16) & 0x7ff; in ast_vhub_udc_get_frame()
298 static void ast_vhub_dev_nuke(struct ast_vhub_dev *d) in ast_vhub_dev_nuke() argument
302 for (i = 0; i < d->max_epns; i++) { in ast_vhub_dev_nuke()
303 if (!d->epns[i]) in ast_vhub_dev_nuke()
305 ast_vhub_nuke(d->epns[i], -ESHUTDOWN); in ast_vhub_dev_nuke()
311 struct ast_vhub_dev *d = to_ast_dev(gadget); in ast_vhub_udc_pullup() local
314 spin_lock_irqsave(&d->vhub->lock, flags); in ast_vhub_udc_pullup()
316 DDBG(d, "pullup(%d)\n", on); in ast_vhub_udc_pullup()
319 ast_vhub_device_connect(d->vhub, d->index, on); in ast_vhub_udc_pullup()
325 if (d->enabled) { in ast_vhub_udc_pullup()
326 ast_vhub_dev_nuke(d); in ast_vhub_udc_pullup()
327 ast_vhub_dev_disable(d); in ast_vhub_udc_pullup()
330 spin_unlock_irqrestore(&d->vhub->lock, flags); in ast_vhub_udc_pullup()
338 struct ast_vhub_dev *d = to_ast_dev(gadget); in ast_vhub_udc_start() local
341 spin_lock_irqsave(&d->vhub->lock, flags); in ast_vhub_udc_start()
343 DDBG(d, "start\n"); in ast_vhub_udc_start()
346 d->driver = driver; in ast_vhub_udc_start()
347 d->gadget.is_selfpowered = 1; in ast_vhub_udc_start()
349 spin_unlock_irqrestore(&d->vhub->lock, flags); in ast_vhub_udc_start()
358 struct ast_vhub_dev *d = to_ast_dev(gadget); in ast_vhub_udc_match_ep() local
363 DDBG(d, "Match EP type %d\n", usb_endpoint_type(desc)); in ast_vhub_udc_match_ep()
373 DDBG(d, " -> using existing EP%d\n", in ast_vhub_udc_match_ep()
419 for (i = 0; i < d->max_epns; i++) in ast_vhub_udc_match_ep()
420 if (d->epns[i] == NULL) in ast_vhub_udc_match_ep()
422 if (i >= d->max_epns) in ast_vhub_udc_match_ep()
430 ep = ast_vhub_alloc_epn(d, addr); in ast_vhub_udc_match_ep()
433 DDBG(d, "Allocated epn#%d for port EP%d\n", in ast_vhub_udc_match_ep()
441 struct ast_vhub_dev *d = to_ast_dev(gadget); in ast_vhub_udc_stop() local
444 spin_lock_irqsave(&d->vhub->lock, flags); in ast_vhub_udc_stop()
446 DDBG(d, "stop\n"); in ast_vhub_udc_stop()
448 d->driver = NULL; in ast_vhub_udc_stop()
449 d->gadget.speed = USB_SPEED_UNKNOWN; in ast_vhub_udc_stop()
451 ast_vhub_dev_nuke(d); in ast_vhub_udc_stop()
453 if (d->enabled) in ast_vhub_udc_stop()
454 ast_vhub_dev_disable(d); in ast_vhub_udc_stop()
456 spin_unlock_irqrestore(&d->vhub->lock, flags); in ast_vhub_udc_stop()
470 void ast_vhub_dev_suspend(struct ast_vhub_dev *d) in ast_vhub_dev_suspend() argument
472 if (d->driver && d->driver->suspend) { in ast_vhub_dev_suspend()
473 spin_unlock(&d->vhub->lock); in ast_vhub_dev_suspend()
474 d->driver->suspend(&d->gadget); in ast_vhub_dev_suspend()
475 spin_lock(&d->vhub->lock); in ast_vhub_dev_suspend()
479 void ast_vhub_dev_resume(struct ast_vhub_dev *d) in ast_vhub_dev_resume() argument
481 if (d->driver && d->driver->resume) { in ast_vhub_dev_resume()
482 spin_unlock(&d->vhub->lock); in ast_vhub_dev_resume()
483 d->driver->resume(&d->gadget); in ast_vhub_dev_resume()
484 spin_lock(&d->vhub->lock); in ast_vhub_dev_resume()
488 void ast_vhub_dev_reset(struct ast_vhub_dev *d) in ast_vhub_dev_reset() argument
491 if (!d->driver) { in ast_vhub_dev_reset()
492 ast_vhub_dev_disable(d); in ast_vhub_dev_reset()
497 if (!d->enabled) { in ast_vhub_dev_reset()
498 DDBG(d, "Reset of disabled device, enabling...\n"); in ast_vhub_dev_reset()
499 ast_vhub_dev_enable(d); in ast_vhub_dev_reset()
501 DDBG(d, "Reset of enabled device, resetting...\n"); in ast_vhub_dev_reset()
502 spin_unlock(&d->vhub->lock); in ast_vhub_dev_reset()
503 usb_gadget_udc_reset(&d->gadget, d->driver); in ast_vhub_dev_reset()
504 spin_lock(&d->vhub->lock); in ast_vhub_dev_reset()
510 ast_vhub_dev_disable(d); in ast_vhub_dev_reset()
511 ast_vhub_dev_enable(d); in ast_vhub_dev_reset()
515 void ast_vhub_del_dev(struct ast_vhub_dev *d) in ast_vhub_del_dev() argument
519 spin_lock_irqsave(&d->vhub->lock, flags); in ast_vhub_del_dev()
520 if (!d->registered) { in ast_vhub_del_dev()
521 spin_unlock_irqrestore(&d->vhub->lock, flags); in ast_vhub_del_dev()
524 d->registered = false; in ast_vhub_del_dev()
525 spin_unlock_irqrestore(&d->vhub->lock, flags); in ast_vhub_del_dev()
527 usb_del_gadget_udc(&d->gadget); in ast_vhub_del_dev()
528 device_unregister(d->port_dev); in ast_vhub_del_dev()
529 kfree(d->epns); in ast_vhub_del_dev()
539 struct ast_vhub_dev *d = &vhub->ports[idx].dev; in ast_vhub_init_dev() local
543 d->vhub = vhub; in ast_vhub_init_dev()
544 d->index = idx; in ast_vhub_init_dev()
545 d->name = devm_kasprintf(parent, GFP_KERNEL, "port%d", idx+1); in ast_vhub_init_dev()
546 d->regs = vhub->regs + 0x100 + 0x10 * idx; in ast_vhub_init_dev()
548 ast_vhub_init_ep0(vhub, &d->ep0, d); in ast_vhub_init_dev()
554 d->max_epns = min_t(u32, vhub->max_epns, 30); in ast_vhub_init_dev()
555 d->epns = kcalloc(d->max_epns, sizeof(*d->epns), GFP_KERNEL); in ast_vhub_init_dev()
556 if (!d->epns) in ast_vhub_init_dev()
564 d->port_dev = kzalloc(sizeof(struct device), GFP_KERNEL); in ast_vhub_init_dev()
565 if (!d->port_dev) { in ast_vhub_init_dev()
569 device_initialize(d->port_dev); in ast_vhub_init_dev()
570 d->port_dev->release = ast_vhub_dev_release; in ast_vhub_init_dev()
571 d->port_dev->parent = parent; in ast_vhub_init_dev()
572 dev_set_name(d->port_dev, "%s:p%d", dev_name(parent), idx + 1); in ast_vhub_init_dev()
573 rc = device_add(d->port_dev); in ast_vhub_init_dev()
578 INIT_LIST_HEAD(&d->gadget.ep_list); in ast_vhub_init_dev()
579 d->gadget.ops = &ast_vhub_udc_ops; in ast_vhub_init_dev()
580 d->gadget.ep0 = &d->ep0.ep; in ast_vhub_init_dev()
581 d->gadget.name = KBUILD_MODNAME; in ast_vhub_init_dev()
583 d->gadget.max_speed = USB_SPEED_FULL; in ast_vhub_init_dev()
585 d->gadget.max_speed = USB_SPEED_HIGH; in ast_vhub_init_dev()
586 d->gadget.speed = USB_SPEED_UNKNOWN; in ast_vhub_init_dev()
587 d->gadget.dev.of_node = vhub->pdev->dev.of_node; in ast_vhub_init_dev()
589 rc = usb_add_gadget_udc(d->port_dev, &d->gadget); in ast_vhub_init_dev()
592 d->registered = true; in ast_vhub_init_dev()
596 device_del(d->port_dev); in ast_vhub_init_dev()
598 put_device(d->port_dev); in ast_vhub_init_dev()
600 kfree(d->epns); in ast_vhub_init_dev()