static int usbhsh_hub_status_data(struct usb_hcd *hcd, char *buf) { struct usbhsh_hpriv *hpriv = usbhsh_hcd_to_hpriv(hcd); int roothub_id = 1; /* only 1 root hub */ /* * does port stat was changed ? * check USB_PORT_STAT_C_xxx << 16 */ if (usbhsh_port_stat_get(hpriv) & 0xFFFF0000) *buf = (1 << roothub_id); else *buf = 0; return !!(*buf); }
static int usbhsh_hub_status_data(struct usb_hcd *hcd, char *buf) { struct usbhsh_hpriv *hpriv = usbhsh_hcd_to_hpriv(hcd); struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv); struct device *dev = usbhs_priv_to_dev(priv); int roothub_id = 1; /* only 1 root hub */ /* * does port stat was changed ? * check USB_PORT_STAT_C_xxx << 16 */ if (usbhsh_port_stat_get(hpriv) & 0xFFFF0000) *buf = (1 << roothub_id); else *buf = 0; dev_dbg(dev, "%s (%02x)\n", __func__, *buf); return !!(*buf); }
static int __usbhsh_hub_get_status(struct usbhsh_hpriv *hpriv, u16 typeReq, u16 wValue, u16 wIndex, char *buf, u16 wLength) { struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv); struct usb_hub_descriptor *desc = (struct usb_hub_descriptor *)buf; struct device *dev = usbhs_priv_to_dev(priv); int roothub_id = 1; /* only 1 root hub */ switch (typeReq) { case GetHubStatus: dev_dbg(dev, "%s :: GetHubStatus\n", __func__); *buf = 0x00; break; case GetPortStatus: if (wIndex != roothub_id) return -EPIPE; dev_dbg(dev, "%s :: GetPortStatus\n", __func__); *(__le32 *)buf = cpu_to_le32(usbhsh_port_stat_get(hpriv)); break; case GetHubDescriptor: desc->bDescriptorType = USB_DT_HUB; desc->bHubContrCurrent = 0; desc->bNbrPorts = roothub_id; desc->bDescLength = 9; desc->bPwrOn2PwrGood = 0; desc->wHubCharacteristics = cpu_to_le16(HUB_CHAR_INDV_PORT_LPSM | HUB_CHAR_NO_OCPM); desc->u.hs.DeviceRemovable[0] = (roothub_id << 1); desc->u.hs.DeviceRemovable[1] = ~0; dev_dbg(dev, "%s :: GetHubDescriptor\n", __func__); break; } return 0; }
static int usbhsh_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue, u16 wIndex, char *buf, u16 wLength) { struct usbhsh_hpriv *hpriv = usbhsh_hcd_to_hpriv(hcd); struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv); struct device *dev = usbhs_priv_to_dev(priv); int ret = -EPIPE; switch (typeReq) { /* Hub Feature */ case ClearHubFeature: case SetHubFeature: ret = __usbhsh_hub_hub_feature(hpriv, typeReq, wValue, wIndex, buf, wLength); break; /* Port Feature */ case SetPortFeature: case ClearPortFeature: ret = __usbhsh_hub_port_feature(hpriv, typeReq, wValue, wIndex, buf, wLength); break; /* Get status */ case GetHubStatus: case GetPortStatus: case GetHubDescriptor: ret = __usbhsh_hub_get_status(hpriv, typeReq, wValue, wIndex, buf, wLength); break; } dev_dbg(dev, "typeReq = %x, ret = %d, port_stat = %x\n", typeReq, ret, usbhsh_port_stat_get(hpriv)); return ret; }