Set gadget's otg features according to controller's capability and usb
property in device tree.
Signed-off-by: Li Jun <redacted>
---
drivers/usb/chipidea/core.c | 18 ++++++++++++++++++
drivers/usb/chipidea/udc.c | 20 +++++++++++++++++++-
include/linux/usb/chipidea.h | 4 ++++
3 files changed, 41 insertions(+), 1 deletion(-)
diff --git a/drivers/usb/chipidea/core.c b/drivers/usb/chipidea/core.c
index 74fea4f..45bd44e 100644
--- a/drivers/usb/chipidea/core.c
+++ b/drivers/usb/chipidea/core.c
@@ -588,6 +588,24 @@ static int ci_get_platdata(struct device *dev,
of_usb_host_tpl_support(dev->of_node);
}
+ if (platdata->dr_mode == USB_DR_MODE_OTG) {
+ if (!platdata->otg_rev) {
+ platdata->otg_rev =
+ of_usb_get_otg_rev(dev->of_node);
+ }
+ if (platdata->otg_rev) {
+ if (!platdata->srp_support)
+ platdata->srp_support =
+ !of_usb_otg_srp_disabled(dev->of_node);
+ if (!platdata->hnp_support)
+ platdata->hnp_support =
+ !of_usb_otg_hnp_disabled(dev->of_node);
+ if (!platdata->adp_support)
+ platdata->adp_support =
+ !of_usb_otg_adp_disabled(dev->of_node);
+ }
+ }
+
if (of_usb_get_maximum_speed(dev->of_node) == USB_SPEED_FULL)
platdata->flags |= CI_HDRC_FORCE_FULLSPEED;
diff --git a/drivers/usb/chipidea/udc.c b/drivers/usb/chipidea/udc.c
index 764f668..5d2c6e8 100644
--- a/drivers/usb/chipidea/udc.c
+++ b/drivers/usb/chipidea/udc.c
@@ -1821,6 +1821,24 @@ static irqreturn_t udc_irq(struct ci_hdrc *ci)
}
/**
+ * udc_update_otg_config: update gadget otg config
+ * * @ci: chipidea controller
+ */
+static void udc_update_otg_config(struct ci_hdrc *ci)
+{
+ if (!ci->is_otg)
+ return;
+
+ ci->gadget.otg_rev = ci->platdata->otg_rev;
+ ci->gadget.srp_support = ci->platdata->srp_support;
+ ci->gadget.hnp_support = ci->platdata->hnp_support;
+ ci->gadget.adp_support = ci->platdata->adp_support;
+ if (ci->gadget.srp_support || ci->gadget.hnp_support ||
+ ci->gadget.adp_support)
+ ci->gadget.is_otg = 1;
+}
+
+/**
* udc_start: initialize gadget role
* @ci: chipidea controller
*/@@ -1834,9 +1852,9 @@ static int udc_start(struct ci_hdrc *ci)
ci->gadget.ops = &usb_gadget_ops;
ci->gadget.speed = USB_SPEED_UNKNOWN;
ci->gadget.max_speed = USB_SPEED_HIGH;
- ci->gadget.is_otg = ci->is_otg ? 1 : 0;
ci->gadget.name = ci->platdata->name;
+ udc_update_otg_config(ci);
INIT_LIST_HEAD(&ci->gadget.ep_list);
/* alloc resources */
diff --git a/include/linux/usb/chipidea.h b/include/linux/usb/chipidea.h
index ab94f78..6765b28 100644
--- a/include/linux/usb/chipidea.h
+++ b/include/linux/usb/chipidea.h
@@ -34,7 +34,11 @@ struct ci_hdrc_platform_data {
#define CI_HDRC_CONTROLLER_STOPPED_EVENT 1
void (*notify_event) (struct ci_hdrc *ci, unsigned event);
struct regulator *reg_vbus;
+ u16 otg_rev;
bool tpl_support;
+ bool srp_support;
+ bool hnp_support;
+ bool adp_support;
};
/* Default offset of capability registers */--
1.9.1
--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to majordomo-u79uwXL29TY76Z2rM5mHXA@public.gmane.org
More majordomo info at http://vger.kernel.org/majordomo-info.html