On Sunday 05 June 2016 08:29 PM, Hans de Goede wrote:
> Use the new of_usb_get_dr_mode_by_phy() function to get the dr_mode
> from the musb controller node instead of assuming that having an id_det
> gpio means otg mode, and not having one means host mode.
>
> Implement peripheral-only mode by adding a sun4i_usb_phy0_get_id_det
> helper which looks at the dr_mode, always registering our extcon and
> always monitoring vbus.
>
> If dr_mode is not specified in the dts, do not register phy0 as we then
> do not know how to treat it. This is actually a good thing as this means
> we will not be registering phy0 on devices where the otg controller is
> not enabled in the devicetree.
>
> Signed-off-by: Hans de Goede <hdegoede@xxxxxxxxxx>
Acked-by: Kishon Vijay Abraham I <kishon@xxxxxx>
> ---
> Changes in v2:
> -Adjust for of_usb_get_dr_mode_by_phy now taking an args0 parameter
> Changes in v3:
> -Only toggle the phy vbus-det bit on id-change on systems without vbus-det
> when in otg mode
> ---
> drivers/phy/phy-sun4i-usb.c | 68 ++++++++++++++++++++++++++++++---------------
> 1 file changed, 46 insertions(+), 22 deletions(-)
>
> diff --git a/drivers/phy/phy-sun4i-usb.c b/drivers/phy/phy-sun4i-usb.c
> index bae54f7..e3cbaae 100644
> --- a/drivers/phy/phy-sun4i-usb.c
> +++ b/drivers/phy/phy-sun4i-usb.c
> @@ -40,6 +40,7 @@
> #include <linux/power_supply.h>
> #include <linux/regulator/consumer.h>
> #include <linux/reset.h>
> +#include <linux/usb/of.h>
> #include <linux/workqueue.h>
>
> #define REG_ISCR 0x00
> @@ -109,6 +110,7 @@ struct sun4i_usb_phy_cfg {
> struct sun4i_usb_phy_data {
> void __iomem *base;
> const struct sun4i_usb_phy_cfg *cfg;
> + enum usb_dr_mode dr_mode;
> struct mutex mutex;
> struct sun4i_usb_phy {
> struct phy *phy;
> @@ -119,6 +121,7 @@ struct sun4i_usb_phy_data {
> bool regulator_on;
> int index;
> } phys[MAX_PHYS];
> + int first_phy;
> /* phy0 / otg related variables */
> struct extcon_dev *extcon;
> bool phy0_init;
> @@ -285,16 +288,10 @@ static int sun4i_usb_phy_init(struct phy *_phy)
> sun4i_usb_phy0_update_iscr(_phy, 0, ISCR_DPDM_PULLUP_EN);
> sun4i_usb_phy0_update_iscr(_phy, 0, ISCR_ID_PULLUP_EN);
>
> - if (data->id_det_gpio) {
> - /* OTG mode, force ISCR and cable state updates */
> - data->id_det = -1;
> - data->vbus_det = -1;
> - queue_delayed_work(system_wq, &data->detect, 0);
> - } else {
> - /* Host only mode */
> - sun4i_usb_phy0_set_id_detect(_phy, 0);
> - sun4i_usb_phy0_set_vbus_detect(_phy, 1);
> - }
> + /* Force ISCR and cable state updates */
> + data->id_det = -1;
> + data->vbus_det = -1;
> + queue_delayed_work(system_wq, &data->detect, 0);
> }
>
> return 0;
> @@ -319,6 +316,19 @@ static int sun4i_usb_phy_exit(struct phy *_phy)
> return 0;
> }
>
> +static int sun4i_usb_phy0_get_id_det(struct sun4i_usb_phy_data *data)
> +{
> + switch (data->dr_mode) {
> + case USB_DR_MODE_OTG:
> + return gpiod_get_value_cansleep(data->id_det_gpio);
> + case USB_DR_MODE_HOST:
> + return 0;
> + case USB_DR_MODE_PERIPHERAL:
> + default:
> + return 1;
> + }
> +}
> +
> static int sun4i_usb_phy0_get_vbus_det(struct sun4i_usb_phy_data *data)
> {
> if (data->vbus_det_gpio)
> @@ -414,7 +424,10 @@ static void sun4i_usb_phy0_id_vbus_det_scan(struct work_struct *work)
> struct phy *phy0 = data->phys[0].phy;
> int id_det, vbus_det, id_notify = 0, vbus_notify = 0;
>
> - id_det = gpiod_get_value_cansleep(data->id_det_gpio);
> + if (phy0 == NULL)
> + return;
> +
> + id_det = sun4i_usb_phy0_get_id_det(data);
> vbus_det = sun4i_usb_phy0_get_vbus_det(data);
>
> mutex_lock(&phy0->mutex);
> @@ -430,7 +443,8 @@ static void sun4i_usb_phy0_id_vbus_det_scan(struct work_struct *work)
> * without vbus detection report vbus low for long enough for
> * the musb-ip to end the current device session.
> */
> - if (!sun4i_usb_phy0_have_vbus_det(data) && id_det == 0) {
> + if (data->dr_mode == USB_DR_MODE_OTG &&
> + !sun4i_usb_phy0_have_vbus_det(data) && id_det == 0) {
> sun4i_usb_phy0_set_vbus_detect(phy0, 0);
> msleep(200);
> sun4i_usb_phy0_set_vbus_detect(phy0, 1);
> @@ -456,7 +470,8 @@ static void sun4i_usb_phy0_id_vbus_det_scan(struct work_struct *work)
> * without vbus detection report vbus low for long enough to
> * the musb-ip to end the current host session.
> */
> - if (!sun4i_usb_phy0_have_vbus_det(data) && id_det == 1) {
> + if (data->dr_mode == USB_DR_MODE_OTG &&
> + !sun4i_usb_phy0_have_vbus_det(data) && id_det == 1) {
> mutex_lock(&phy0->mutex);
> sun4i_usb_phy0_set_vbus_detect(phy0, 0);
> msleep(1000);
> @@ -501,7 +516,8 @@ static struct phy *sun4i_usb_phy_xlate(struct device *dev,
> {
> struct sun4i_usb_phy_data *data = dev_get_drvdata(dev);
>
> - if (args->args[0] >= data->cfg->num_phys)
> + if (args->args[0] < data->first_phy ||
> + args->args[0] >= data->cfg->num_phys)
> return ERR_PTR(-ENODEV);
>
> return data->phys[args->args[0]].phy;
> @@ -575,13 +591,17 @@ static int sun4i_usb_phy_probe(struct platform_device *pdev)
> return -EPROBE_DEFER;
> }
>
> - /* vbus_det without id_det makes no sense, and is not supported */
> - if (sun4i_usb_phy0_have_vbus_det(data) && !data->id_det_gpio) {
> - dev_err(dev, "usb0_id_det missing or invalid\n");
> - return -ENODEV;
> - }
> -
> - if (data->id_det_gpio) {
> + data->dr_mode = of_usb_get_dr_mode_by_phy(np, 0);
> + switch (data->dr_mode) {
> + case USB_DR_MODE_OTG:
> + /* otg without id_det makes no sense, and is not supported */
> + if (!data->id_det_gpio) {
> + dev_err(dev, "usb0_id_det missing or invalid\n");
> + return -ENODEV;
> + }
> + /* fall through */
> + case USB_DR_MODE_HOST:
> + case USB_DR_MODE_PERIPHERAL:
> data->extcon = devm_extcon_dev_allocate(dev,
> sun4i_usb_phy0_cable);
> if (IS_ERR(data->extcon))
> @@ -592,9 +612,13 @@ static int sun4i_usb_phy_probe(struct platform_device *pdev)
> dev_err(dev, "failed to register extcon: %d\n", ret);
> return ret;
> }
> + break;
> + default:
> + dev_info(dev, "dr_mode unknown, not registering usb phy0\n");
> + data->first_phy = 1;
> }
>
> - for (i = 0; i < data->cfg->num_phys; i++) {
> + for (i = data->first_phy; i < data->cfg->num_phys; i++) {
> struct sun4i_usb_phy *phy = data->phys + i;
> char name[16];
>
>
--
To unsubscribe from this list: send the line "unsubscribe devicetree" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
