phy: exynos5-usbdrd: subscribe to orientation notifier if required

gs101's SS phy needs to be configured differently based on the
connector orientation, as the SS link can only be established if the
mux is configured correctly.

The code to handle programming of the mux is in place already, this commit
now adds the missing pieces to subscribe to the Type-C orientation
switch event.

Note that for this all to work we rely on the USB controller
re-initialising us. It should invoke our .exit() upon cable unplug, and
during cable plug we'll receive the orientation event after which we
expect our .init() to be called.

Above reinitialisation happens if the DWC3 controller can enter runtime
suspend automatically. For the DWC3 driver, this is an opt-in:
    echo auto > /sys/devices/.../11110000.usb/power/control
Once done, things work as long as the UDC is not bound as otherwise it
stays busy because it doesn't cancel / stop outstanding TRBs. For now
we have to manually unbind the UDC in that case:
     echo "" > sys/kernel/config/usb_gadget/.../UDC

Note that if the orientation-switch property is missing from the DT,
the code will behave as before this commit (meaning for gs101 it will
work in SS mode in one orientation only). Other platforms are not
affected either way.

Signed-off-by: André Draszik <andre.draszik@linaro.org>
Tested-by: Will McVicker <willmcvicker@google.com>
Reviewed-by: Peter Griffin <peter.griffin@linaro.org>
Tested-by: Peter Griffin <peter.griffin@linaro.org>
Link: https://lore.kernel.org/r/20241206-gs101-phy-lanes-orientation-phy-v4-6-f5961268b149@linaro.org
Signed-off-by: Vinod Koul <vkoul@kernel.org>

diff --git a/drivers/phy/samsung/Kconfig b/drivers/phy/samsung/Kconfig
index e2330b0894d6d9cd83551d0c8ae01170b2a54177..7fba571c0e2b855deb9620b46d1b6863d6c06be9 100644 (file)
--- a/drivers/phy/samsung/Kconfig
+++ b/drivers/phy/samsung/Kconfig
@@ -81,6 +81,7 @@ config PHY_EXYNOS5_USBDRD
        tristate "Exynos5 SoC series USB DRD PHY driver"
        depends on (ARCH_EXYNOS && OF) || COMPILE_TEST
        depends on HAS_IOMEM
+       depends on TYPEC || (TYPEC=n && COMPILE_TEST)
        depends on USB_DWC3_EXYNOS
        select GENERIC_PHY
        select MFD_SYSCON

diff --git a/drivers/phy/samsung/phy-exynos5-usbdrd.c b/drivers/phy/samsung/phy-exynos5-usbdrd.c
index 61e0de4b3d4b266c5a3b63622550cd98258561ab..8fc15847cfd8a5456c3397517f0704c902fcf49c 100644 (file)
--- a/drivers/phy/samsung/phy-exynos5-usbdrd.c
+++ b/drivers/phy/samsung/phy-exynos5-usbdrd.c
@@ -24,6 +24,7 @@
 #include <linux/regulator/consumer.h>
 #include <linux/soc/samsung/exynos-regs-pmu.h>
 #include <linux/usb/typec.h>
+#include <linux/usb/typec_mux.h>
 
 /* Exynos USB PHY registers */
 #define EXYNOS5_FSEL_9MHZ6             0x0
@@ -394,6 +395,7 @@ struct exynos5_usbdrd_phy_drvdata {
  * @extrefclk: frequency select settings when using 'separate
  *            reference clocks' for SS and HS operations
  * @regulators: regulators for phy
+ * @sw: TypeC orientation switch handle
  * @orientation: TypeC connector orientation - normal or flipped
  */
 struct exynos5_usbdrd_phy {
@@ -415,6 +417,7 @@ struct exynos5_usbdrd_phy {
        u32 extrefclk;
        struct regulator_bulk_data *regulators;
 
+       struct typec_switch_dev *sw;
        enum typec_orientation orientation;
 };
 
@@ -1397,6 +1400,55 @@ static int exynos5_usbdrd_phy_clk_handle(struct exynos5_usbdrd_phy *phy_drd)
        return 0;
 }
 
+static int exynos5_usbdrd_orien_sw_set(struct typec_switch_dev *sw,
+                                      enum typec_orientation orientation)
+{
+       struct exynos5_usbdrd_phy *phy_drd = typec_switch_get_drvdata(sw);
+
+       scoped_guard(mutex, &phy_drd->phy_mutex)
+               phy_drd->orientation = orientation;
+
+       return 0;
+}
+
+static void exynos5_usbdrd_orien_switch_unregister(void *data)
+{
+       struct exynos5_usbdrd_phy *phy_drd = data;
+
+       typec_switch_unregister(phy_drd->sw);
+}
+
+static int exynos5_usbdrd_setup_notifiers(struct exynos5_usbdrd_phy *phy_drd)
+{
+       int ret;
+
+       if (!IS_ENABLED(CONFIG_TYPEC))
+               return 0;
+
+       if (device_property_present(phy_drd->dev, "orientation-switch")) {
+               struct typec_switch_desc sw_desc = { };
+
+               sw_desc.drvdata = phy_drd;
+               sw_desc.fwnode = dev_fwnode(phy_drd->dev);
+               sw_desc.set = exynos5_usbdrd_orien_sw_set;
+
+               phy_drd->sw = typec_switch_register(phy_drd->dev, &sw_desc);
+               if (IS_ERR(phy_drd->sw))
+                       return dev_err_probe(phy_drd->dev,
+                                            PTR_ERR(phy_drd->sw),
+                                            "Failed to register TypeC orientation switch\n");
+
+               ret = devm_add_action_or_reset(phy_drd->dev,
+                                              exynos5_usbdrd_orien_switch_unregister,
+                                              phy_drd);
+               if (ret)
+                       return dev_err_probe(phy_drd->dev, ret,
+                                            "Failed to register TypeC orientation devm action\n");
+       }
+
+       return 0;
+}
+
 static const struct exynos5_usbdrd_phy_config phy_cfg_exynos5[] = {
        {
                .id             = EXYNOS5_DRDPHY_UTMI,
@@ -1786,6 +1838,10 @@ static int exynos5_usbdrd_phy_probe(struct platform_device *pdev)
        if (ret)
                return dev_err_probe(dev, ret, "failed to get regulators\n");
 
+       ret = exynos5_usbdrd_setup_notifiers(phy_drd);
+       if (ret)
+               return ret;
+
        dev_vdbg(dev, "Creating usbdrd_phy phy\n");
 
        for (i = 0; i < EXYNOS5_DRDPHYS_NUM; i++) {