usb/renesas_usbhs/mod_gadget.c

36 	struct usbhsg_gpriv *gpriv;
81 #define usbhsg_for_each_uep(pos, gpriv, i)	\
82 	__usbhsg_for_each_uep(1, pos, gpriv, i)
84 #define usbhsg_for_each_uep_with_dcp(pos, gpriv, i)	\
85 	__usbhsg_for_each_uep(0, pos, gpriv, i)
98 #define usbhsg_uep_to_gpriv(u)		((u)->gpriv)
101 #define usbhsg_is_dcp(u)		((u) == usbhsg_gpriv_to_dcp((u)->gpriv))
122 	struct usbhsg_gpriv *gpriv = usbhsg_uep_to_gpriv(uep);
124 	struct device *dev = usbhsg_gpriv_to_dev(gpriv);
125 	struct usbhs_priv *priv = usbhsg_gpriv_to_priv(gpriv);
140 	struct usbhsg_gpriv *gpriv = usbhsg_uep_to_gpriv(uep);
141 	struct usbhs_priv *priv = usbhsg_gpriv_to_priv(gpriv);
167 	struct usbhsg_gpriv *gpriv = usbhsg_uep_to_gpriv(uep);
168 	struct device *dev = usbhsg_gpriv_to_dev(gpriv);
221 	struct usbhsg_gpriv *gpriv = usbhsg_priv_to_gpriv(priv);
222 	struct usbhsg_uep *dcp = usbhsg_gpriv_to_dcp(gpriv);
234 	struct usbhsg_gpriv *gpriv = usbhsg_uep_to_gpriv(uep);
237 	if (!usbhsg_status_has(gpriv, USBHSG_STATUS_WEDGE)) {
311 static void __usbhsg_recip_send_status(struct usbhsg_gpriv *gpriv,
314 	struct usbhsg_uep *dcp = usbhsg_gpriv_to_dcp(gpriv);
316 	struct device *dev = usbhsg_gpriv_to_dev(gpriv);
352 	struct usbhsg_gpriv *gpriv = usbhsg_uep_to_gpriv(uep);
355 	if (usbhsg_status_has(gpriv, USBHSG_STATUS_SELF_POWERED))
358 	__usbhsg_recip_send_status(gpriv, status);
367 	struct usbhsg_gpriv *gpriv = usbhsg_uep_to_gpriv(uep);
370 	__usbhsg_recip_send_status(gpriv, status);
379 	struct usbhsg_gpriv *gpriv = usbhsg_uep_to_gpriv(uep);
386 	__usbhsg_recip_send_status(gpriv, status);
405 	struct usbhsg_gpriv *gpriv = usbhsg_priv_to_gpriv(priv);
406 	struct device *dev = usbhsg_gpriv_to_dev(gpriv);
416 	uep = usbhsg_gpriv_to_nth_uep(gpriv, nth);
458 	struct usbhsg_gpriv *gpriv = usbhsg_priv_to_gpriv(priv);
459 	struct device *dev = usbhsg_gpriv_to_dev(gpriv);
462 	gpriv->gadget.speed = usbhs_bus_get_speed(priv);
464 	dev_dbg(dev, "state = %x : speed : %d\n", state, gpriv->gadget.speed);
466 	if (gpriv->gadget.speed != USB_SPEED_UNKNOWN &&
468 		if (gpriv->driver && gpriv->driver->suspend)
469 			gpriv->driver->suspend(&gpriv->gadget);
470 		usb_gadget_set_state(&gpriv->gadget, USB_STATE_SUSPENDED);
479 	struct usbhsg_gpriv *gpriv = usbhsg_priv_to_gpriv(priv);
480 	struct usbhsg_uep *dcp = usbhsg_gpriv_to_dcp(gpriv);
482 	struct device *dev = usbhsg_gpriv_to_dev(gpriv);
543 		ret = gpriv->driver->setup(&gpriv->gadget, &ctrl);
583 	struct usbhsg_gpriv *gpriv = usbhsg_uep_to_gpriv(uep);
584 	struct usbhs_priv *priv = usbhsg_gpriv_to_priv(gpriv);
686 	struct usbhsg_gpriv *gpriv = usbhsg_uep_to_gpriv(uep);
691 	if (usbhsg_is_not_connected(gpriv)	||
692 	    unlikely(!gpriv->driver)		||
727 	struct usbhsg_gpriv *gpriv = usbhsg_uep_to_gpriv(uep);
728 	struct usbhs_priv *priv = usbhsg_gpriv_to_priv(gpriv);
729 	struct device *dev = usbhsg_gpriv_to_dev(gpriv);
757 		usbhsg_status_set(gpriv, USBHSG_STATUS_WEDGE);
759 		usbhsg_status_clr(gpriv, USBHSG_STATUS_WEDGE);
797 	struct usbhsg_gpriv *gpriv = usbhsg_priv_to_gpriv(priv);
799 	return gpriv->driver &&
800 	       usbhsg_status_has(gpriv, USBHSG_STATUS_SOFT_CONNECT);
816 	struct usbhsg_gpriv *gpriv = usbhsg_priv_to_gpriv(priv);
817 	struct usbhsg_uep *dcp = usbhsg_gpriv_to_dcp(gpriv);
826 	usbhsg_status_set(gpriv, status);
827 	if (!(usbhsg_status_has(gpriv, USBHSG_STATUS_STARTED) &&
828 	      usbhsg_status_has(gpriv, USBHSG_STATUS_REGISTERD)))
875 	struct usbhsg_gpriv *gpriv = usbhsg_priv_to_gpriv(priv);
885 	usbhsg_status_clr(gpriv, status);
886 	if (!usbhsg_status_has(gpriv, USBHSG_STATUS_STARTED) &&
887 	    !usbhsg_status_has(gpriv, USBHSG_STATUS_REGISTERD))
906 	gpriv->gadget.speed = USB_SPEED_UNKNOWN;
913 	usbhsg_for_each_uep_with_dcp(uep, gpriv, i)
927 	struct usbhsg_gpriv *gpriv = usbhsg_priv_to_gpriv(priv);
929 	return  gpriv->vbus_active;
950 	struct usbhsg_gpriv *gpriv = usbhsg_gadget_to_gpriv(gadget);
951 	struct usbhs_priv *priv = usbhsg_gpriv_to_priv(gpriv);
961 	if (!IS_ERR_OR_NULL(gpriv->transceiver)) {
962 		ret = otg_set_peripheral(gpriv->transceiver->otg,
963 					&gpriv->gadget);
966 				gpriv->gadget.name);
975 	gpriv->driver = driver;
982 	struct usbhsg_gpriv *gpriv = usbhsg_gadget_to_gpriv(gadget);
983 	struct usbhs_priv *priv = usbhsg_gpriv_to_priv(gpriv);
987 	if (!IS_ERR_OR_NULL(gpriv->transceiver))
988 		otg_set_peripheral(gpriv->transceiver->otg, NULL);
990 	gpriv->driver = NULL;
1000 	struct usbhsg_gpriv *gpriv = usbhsg_gadget_to_gpriv(gadget);
1001 	struct usbhs_priv *priv = usbhsg_gpriv_to_priv(gpriv);
1008 	struct usbhsg_gpriv *gpriv = usbhsg_gadget_to_gpriv(gadget);
1009 	struct usbhs_priv *priv = usbhsg_gpriv_to_priv(gpriv);
1014 		usbhsg_status_set(gpriv, USBHSG_STATUS_SOFT_CONNECT);
1016 		usbhsg_status_clr(gpriv, USBHSG_STATUS_SOFT_CONNECT);
1025 	struct usbhsg_gpriv *gpriv = usbhsg_gadget_to_gpriv(gadget);
1028 		usbhsg_status_set(gpriv, USBHSG_STATUS_SELF_POWERED);
1030 		usbhsg_status_clr(gpriv, USBHSG_STATUS_SELF_POWERED);
1039 	struct usbhsg_gpriv *gpriv = usbhsg_gadget_to_gpriv(gadget);
1040 	struct usbhs_priv *priv = usbhsg_gpriv_to_priv(gpriv);
1043 	gpriv->vbus_active = !!is_active;
1066 	struct usbhsg_gpriv *gpriv = usbhsg_priv_to_gpriv(priv);
1069 	if (gpriv->driver &&
1070 	    gpriv->driver->disconnect)
1071 		gpriv->driver->disconnect(&gpriv->gadget);
1078 	struct usbhsg_gpriv *gpriv;
1087 	gpriv = kzalloc(sizeof(struct usbhsg_gpriv), GFP_KERNEL);
1088 	if (!gpriv)
1097 	gpriv->transceiver = devm_usb_get_phy(dev, USB_PHY_TYPE_UNDEFINED);
1099 		 !IS_ERR(gpriv->transceiver) ? "" : "no ");
1112 	usbhs_mod_register(priv, &gpriv->mod, USBHS_GADGET);
1114 	/* init gpriv */
1115 	gpriv->mod.name		= "gadget";
1116 	gpriv->mod.start	= usbhsg_start;
1117 	gpriv->mod.stop		= usbhsg_stop;
1118 	gpriv->uep		= uep;
1119 	gpriv->uep_size		= pipe_size;
1120 	usbhsg_status_init(gpriv);
1125 	gpriv->gadget.dev.parent	= dev;
1126 	gpriv->gadget.name		= "renesas_usbhs_udc";
1127 	gpriv->gadget.ops		= &usbhsg_gadget_ops;
1128 	gpriv->gadget.max_speed		= USB_SPEED_HIGH;
1129 	gpriv->gadget.quirk_avoids_skb_reserve = usbhs_get_dparam(priv,
1132 	INIT_LIST_HEAD(&gpriv->gadget.ep_list);
1137 	usbhsg_for_each_uep_with_dcp(uep, gpriv, i) {
1138 		uep->gpriv	= gpriv;
1149 			gpriv->gadget.ep0 = &uep->ep;
1162 			list_add_tail(&uep->ep.ep_list, &gpriv->gadget.ep_list);
1168 	ret = usb_add_gadget_udc(dev, &gpriv->gadget);
1178 	kfree(gpriv->uep);
1181 	kfree(gpriv);
1188 	struct usbhsg_gpriv *gpriv = usbhsg_priv_to_gpriv(priv);
1190 	usb_del_gadget_udc(&gpriv->gadget);
1192 	kfree(gpriv->uep);
1193 	kfree(gpriv);