3  * aspeed-vhub -- Driver for Aspeed SoC "vHub" USB gadget
37 #include "vhub.h"
179 	if (ep->vhub->wakeup_en)  in ast_vhub_hub_dev_status()
196 		if (ep->vhub->ep1_stalled)  in ast_vhub_hub_ep_status()
214 	ep->vhub->wakeup_en = is_set;  in ast_vhub_hub_dev_feature()
242 	ep->vhub->ep1_stalled = is_set;  in ast_vhub_hub_ep_feature()
243 	reg = readl(ep->vhub->regs + AST_VHUB_EP1_CTRL);  in ast_vhub_hub_ep_feature()
250 	writel(reg, ep->vhub->regs + AST_VHUB_EP1_CTRL);  in ast_vhub_hub_ep_feature()
259 	struct ast_vhub *vhub = ep->vhub;  in ast_vhub_rep_desc()  local
275 		memcpy(ep->buf, &vhub->vhub_dev_desc, dsize);  in ast_vhub_rep_desc()
276 		BUILD_BUG_ON(dsize > sizeof(vhub->vhub_dev_desc));  in ast_vhub_rep_desc()
281 		memcpy(ep->buf, &vhub->vhub_conf_desc, dsize);  in ast_vhub_rep_desc()
282 		BUILD_BUG_ON(dsize > sizeof(vhub->vhub_conf_desc));  in ast_vhub_rep_desc()
287 		memcpy(ep->buf, &vhub->vhub_hub_desc, dsize);  in ast_vhub_rep_desc()
288 		BUILD_BUG_ON(dsize > sizeof(vhub->vhub_hub_desc));  in ast_vhub_rep_desc()
309 static int ast_vhub_collect_languages(struct ast_vhub *vhub, void *buf,  in ast_vhub_collect_languages()  argument
320 	list_for_each_entry(container, &vhub->vhub_str_desc, list) {  in ast_vhub_collect_languages()
335 static struct usb_gadget_strings *ast_vhub_lookup_string(struct ast_vhub *vhub,  in ast_vhub_lookup_string()  argument
341 	list_for_each_entry(container, &vhub->vhub_str_desc, list) {  in ast_vhub_lookup_string()
356 	struct ast_vhub *vhub = ep->vhub;  in ast_vhub_rep_string()  local
360 		rc = ast_vhub_collect_languages(vhub, buf, sizeof(buf));  in ast_vhub_rep_string()
362 		lang_str = ast_vhub_lookup_string(vhub, lang_id);  in ast_vhub_rep_string()
380 	struct ast_vhub *vhub = ep->vhub;  in ast_vhub_std_hub_request()  local
388 	if (vhub->speed == USB_SPEED_UNKNOWN) {  in ast_vhub_std_hub_request()
389 		u32 ustat = readl(vhub->regs + AST_VHUB_USBSTS);  in ast_vhub_std_hub_request()
391 			vhub->speed = USB_SPEED_HIGH;  in ast_vhub_std_hub_request()
393 			vhub->speed = USB_SPEED_FULL;  in ast_vhub_std_hub_request()
394 		UDCDBG(vhub, "USB status=%08x speed=%s\n", ustat,  in ast_vhub_std_hub_request()
395 		       vhub->speed == USB_SPEED_HIGH ? "high" : "full");  in ast_vhub_std_hub_request()
402 		writel(wValue, vhub->regs + AST_VHUB_CONF);  in ast_vhub_std_hub_request()
455 static void ast_vhub_update_hub_ep1(struct ast_vhub *vhub,  in ast_vhub_update_hub_ep1()  argument
459 	u32 reg = readl(vhub->regs + AST_VHUB_EP1_STS_CHG);  in ast_vhub_update_hub_ep1()
461 	if (vhub->ports[port].change)  in ast_vhub_update_hub_ep1()
465 	writel(reg, vhub->regs + AST_VHUB_EP1_STS_CHG);  in ast_vhub_update_hub_ep1()
468 static void ast_vhub_change_port_stat(struct ast_vhub *vhub,  in ast_vhub_change_port_stat()  argument
474 	struct ast_vhub_port *p = &vhub->ports[port];  in ast_vhub_change_port_stat()
503 		ast_vhub_update_hub_ep1(vhub, port);  in ast_vhub_change_port_stat()
507 static void ast_vhub_send_host_wakeup(struct ast_vhub *vhub)  in ast_vhub_send_host_wakeup()  argument
509 	u32 reg = readl(vhub->regs + AST_VHUB_CTRL);  in ast_vhub_send_host_wakeup()
510 	UDCDBG(vhub, "Waking up host !\n");  in ast_vhub_send_host_wakeup()
512 	writel(reg, vhub->regs + AST_VHUB_CTRL);  in ast_vhub_send_host_wakeup()
515 void ast_vhub_device_connect(struct ast_vhub *vhub,  in ast_vhub_device_connect()  argument
519 		ast_vhub_change_port_stat(vhub, port, 0,  in ast_vhub_device_connect()
522 		ast_vhub_change_port_stat(vhub, port,  in ast_vhub_device_connect()
531 	if (vhub->wakeup_en)  in ast_vhub_device_connect()
532 		ast_vhub_send_host_wakeup(vhub);  in ast_vhub_device_connect()
537 	struct ast_vhub *vhub = container_of(work,  in ast_vhub_wake_work()  local
548 	spin_lock_irqsave(&vhub->lock, flags);  in ast_vhub_wake_work()
549 	for (i = 0; i < vhub->max_ports; i++) {  in ast_vhub_wake_work()
550 		struct ast_vhub_port *p = &vhub->ports[i];  in ast_vhub_wake_work()
554 		ast_vhub_change_port_stat(vhub, i,  in ast_vhub_wake_work()
559 	ast_vhub_send_host_wakeup(vhub);  in ast_vhub_wake_work()
560 	spin_unlock_irqrestore(&vhub->lock, flags);  in ast_vhub_wake_work()
563 void ast_vhub_hub_wake_all(struct ast_vhub *vhub)  in ast_vhub_hub_wake_all()  argument
570 	schedule_work(&vhub->wake_work);  in ast_vhub_hub_wake_all()
573 static void ast_vhub_port_reset(struct ast_vhub *vhub, u8 port)  in ast_vhub_port_reset()  argument
575 	struct ast_vhub_port *p = &vhub->ports[port];  in ast_vhub_port_reset()
579 	ast_vhub_change_port_stat(vhub, port,  in ast_vhub_port_reset()
596 	if (speed == USB_SPEED_UNKNOWN || speed > vhub->speed)  in ast_vhub_port_reset()
597 		speed = vhub->speed;  in ast_vhub_port_reset()
614 		UDCDBG(vhub, "Unsupported speed %d when"  in ast_vhub_port_reset()
623 	ast_vhub_change_port_stat(vhub, port, clr, set, true);  in ast_vhub_port_reset()
629 	struct ast_vhub *vhub = ep->vhub;  in ast_vhub_set_port_feature()  local
632 	if (port == 0 || port > vhub->max_ports)  in ast_vhub_set_port_feature()
635 	p = &vhub->ports[port];  in ast_vhub_set_port_feature()
641 		ast_vhub_change_port_stat(vhub, port,  in ast_vhub_set_port_feature()
648 		ast_vhub_port_reset(vhub, port);  in ast_vhub_set_port_feature()
658 			ast_vhub_update_hub_ep1(vhub, port);  in ast_vhub_set_port_feature()
672 	struct ast_vhub *vhub = ep->vhub;  in ast_vhub_clr_port_feature()  local
675 	if (port == 0 || port > vhub->max_ports)  in ast_vhub_clr_port_feature()
678 	p = &vhub->ports[port];  in ast_vhub_clr_port_feature()
682 		ast_vhub_change_port_stat(vhub, port,  in ast_vhub_clr_port_feature()
691 		ast_vhub_change_port_stat(vhub, port,  in ast_vhub_clr_port_feature()
709 		ast_vhub_update_hub_ep1(vhub, port);  in ast_vhub_clr_port_feature()
718 	struct ast_vhub *vhub = ep->vhub;  in ast_vhub_get_port_stat()  local
721 	if (port == 0 || port > vhub->max_ports)  in ast_vhub_get_port_stat()
725 	stat = vhub->ports[port].status;  in ast_vhub_get_port_stat()
726 	chg = vhub->ports[port].change;  in ast_vhub_get_port_stat()
787 void ast_vhub_hub_suspend(struct ast_vhub *vhub)  in ast_vhub_hub_suspend()  argument
791 	UDCDBG(vhub, "USB bus suspend\n");  in ast_vhub_hub_suspend()
793 	if (vhub->suspended)  in ast_vhub_hub_suspend()
796 	vhub->suspended = true;  in ast_vhub_hub_suspend()
802 	for (i = 0; i < vhub->max_ports; i++) {  in ast_vhub_hub_suspend()
803 		struct ast_vhub_port *p = &vhub->ports[i];  in ast_vhub_hub_suspend()
810 void ast_vhub_hub_resume(struct ast_vhub *vhub)  in ast_vhub_hub_resume()  argument
814 	UDCDBG(vhub, "USB bus resume\n");  in ast_vhub_hub_resume()
816 	if (!vhub->suspended)  in ast_vhub_hub_resume()
819 	vhub->suspended = false;  in ast_vhub_hub_resume()
825 	for (i = 0; i < vhub->max_ports; i++) {  in ast_vhub_hub_resume()
826 		struct ast_vhub_port *p = &vhub->ports[i];  in ast_vhub_hub_resume()
833 void ast_vhub_hub_reset(struct ast_vhub *vhub)  in ast_vhub_hub_reset()  argument
837 	UDCDBG(vhub, "USB bus reset\n");  in ast_vhub_hub_reset()
843 	if (vhub->speed == USB_SPEED_UNKNOWN)  in ast_vhub_hub_reset()
847 	vhub->suspended = false;  in ast_vhub_hub_reset()
850 	vhub->speed = USB_SPEED_UNKNOWN;  in ast_vhub_hub_reset()
853 	vhub->wakeup_en = false;  in ast_vhub_hub_reset()
859 	for (i = 0; i < vhub->max_ports; i++) {  in ast_vhub_hub_reset()
860 		struct ast_vhub_port *p = &vhub->ports[i];  in ast_vhub_hub_reset()
871 	writel(0, vhub->regs + AST_VHUB_CONF);  in ast_vhub_hub_reset()
872 	writel(0, vhub->regs + AST_VHUB_EP0_CTRL);  in ast_vhub_hub_reset()
875 	       vhub->regs + AST_VHUB_EP1_CTRL);  in ast_vhub_hub_reset()
876 	writel(0, vhub->regs + AST_VHUB_EP1_STS_CHG);  in ast_vhub_hub_reset()
879 static void ast_vhub_of_parse_dev_desc(struct ast_vhub *vhub,  in ast_vhub_of_parse_dev_desc()  argument
885 	if (!of_property_read_u32(vhub_np, "vhub-vendor-id", &data)) {  in ast_vhub_of_parse_dev_desc()
887 		vhub->vhub_dev_desc.idVendor = cpu_to_le16(id);  in ast_vhub_of_parse_dev_desc()
889 	if (!of_property_read_u32(vhub_np, "vhub-product-id", &data)) {  in ast_vhub_of_parse_dev_desc()
891 		vhub->vhub_dev_desc.idProduct = cpu_to_le16(id);  in ast_vhub_of_parse_dev_desc()
893 	if (!of_property_read_u32(vhub_np, "vhub-device-revision", &data)) {  in ast_vhub_of_parse_dev_desc()
895 		vhub->vhub_dev_desc.bcdDevice = cpu_to_le16(id);  in ast_vhub_of_parse_dev_desc()
899 static void ast_vhub_fixup_usb1_dev_desc(struct ast_vhub *vhub)  in ast_vhub_fixup_usb1_dev_desc()  argument
901 	vhub->vhub_dev_desc.bcdUSB = cpu_to_le16(0x0100);  in ast_vhub_fixup_usb1_dev_desc()
902 	vhub->vhub_dev_desc.bDeviceProtocol = 0;  in ast_vhub_fixup_usb1_dev_desc()
906 ast_vhub_str_container_alloc(struct ast_vhub *vhub)  in ast_vhub_str_container_alloc()  argument
916 	container = devm_kzalloc(&vhub->pdev->dev, size, GFP_KERNEL);  in ast_vhub_str_container_alloc()
942 static int ast_vhub_str_alloc_add(struct ast_vhub *vhub,  in ast_vhub_str_alloc_add()  argument
948 	container = ast_vhub_str_container_alloc(vhub);  in ast_vhub_str_alloc_add()
954 	list_add_tail(&container->list, &vhub->vhub_str_desc);  in ast_vhub_str_alloc_add()
969 static int ast_vhub_of_parse_str_desc(struct ast_vhub *vhub,  in ast_vhub_of_parse_str_desc()  argument
1001 		ret = ast_vhub_str_alloc_add(vhub, &lang_str);  in ast_vhub_of_parse_str_desc()
1011 static int ast_vhub_init_desc(struct ast_vhub *vhub)  in ast_vhub_init_desc()  argument
1015 	const struct device_node *vhub_np = vhub->pdev->dev.of_node;  in ast_vhub_init_desc()
1017 	/* Initialize vhub Device Descriptor. */  in ast_vhub_init_desc()
1018 	memcpy(&vhub->vhub_dev_desc, &ast_vhub_dev_desc,  in ast_vhub_init_desc()
1019 		sizeof(vhub->vhub_dev_desc));  in ast_vhub_init_desc()
1020 	ast_vhub_of_parse_dev_desc(vhub, vhub_np);  in ast_vhub_init_desc()
1021 	if (vhub->force_usb1)  in ast_vhub_init_desc()
1022 		ast_vhub_fixup_usb1_dev_desc(vhub);  in ast_vhub_init_desc()
1024 	/* Initialize vhub Configuration Descriptor. */  in ast_vhub_init_desc()
1025 	memcpy(&vhub->vhub_conf_desc, &ast_vhub_conf_desc,  in ast_vhub_init_desc()
1026 		sizeof(vhub->vhub_conf_desc));  in ast_vhub_init_desc()
1028 	/* Initialize vhub Hub Descriptor. */  in ast_vhub_init_desc()
1029 	memcpy(&vhub->vhub_hub_desc, &ast_vhub_hub_desc,  in ast_vhub_init_desc()
1030 		sizeof(vhub->vhub_hub_desc));  in ast_vhub_init_desc()
1031 	vhub->vhub_hub_desc.bNbrPorts = vhub->max_ports;  in ast_vhub_init_desc()
1033 	/* Initialize vhub String Descriptors. */  in ast_vhub_init_desc()
1034 	INIT_LIST_HEAD(&vhub->vhub_str_desc);  in ast_vhub_init_desc()
1035 	desc_np = of_get_child_by_name(vhub_np, "vhub-strings");  in ast_vhub_init_desc()
1037 		ret = ast_vhub_of_parse_str_desc(vhub, desc_np);  in ast_vhub_init_desc()
1041 		ret = ast_vhub_str_alloc_add(vhub, &ast_vhub_strings);  in ast_vhub_init_desc()
1046 int ast_vhub_init_hub(struct ast_vhub *vhub)  in ast_vhub_init_hub()  argument
1048 	vhub->speed = USB_SPEED_UNKNOWN;  in ast_vhub_init_hub()
1049 	INIT_WORK(&vhub->wake_work, ast_vhub_wake_work);  in ast_vhub_init_hub()
1051 	return ast_vhub_init_desc(vhub);  in ast_vhub_init_hub()