1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (C) 2025 Inochi Amaoto <inochiama@outlook.com> 4 */ 5 6 #include <linux/clk.h> 7 #include <linux/bitfield.h> 8 #include <linux/debugfs.h> 9 #include <linux/kernel.h> 10 #include <linux/mfd/syscon.h> 11 #include <linux/module.h> 12 #include <linux/of.h> 13 #include <linux/of_address.h> 14 #include <linux/of_gpio.h> 15 #include <linux/platform_device.h> 16 #include <linux/phy/phy.h> 17 #include <linux/regmap.h> 18 #include <linux/spinlock.h> 19 20 #define REG_USB_PHY_CTRL 0x048 21 22 #define PHY_VBUS_POWER_EN BIT(0) 23 #define PHY_VBUS_POWER BIT(1) 24 #define PHY_ID_OVERWRITE_EN BIT(6) 25 #define PHY_ID_OVERWRITE_MODE BIT(7) 26 #define PHY_ID_OVERWRITE_MODE_HOST FIELD_PREP(BIT(7), 0) 27 #define PHY_ID_OVERWRITE_MODE_DEVICE FIELD_PREP(BIT(7), 1) 28 29 #define PHY_APP_CLK_RATE 125000000 30 #define PHY_LPM_CLK_RATE 12000000 31 #define PHY_STB_CLK_RATE 333334 32 33 struct cv1800_usb_phy { 34 struct phy *phy; 35 struct regmap *syscon; 36 spinlock_t lock; 37 struct clk *usb_app_clk; 38 struct clk *usb_lpm_clk; 39 struct clk *usb_stb_clk; 40 bool support_otg; 41 }; 42 43 static int cv1800_usb_phy_set_mode(struct phy *_phy, 44 enum phy_mode mode, int submode) 45 { 46 struct cv1800_usb_phy *phy = phy_get_drvdata(_phy); 47 unsigned int regval = 0; 48 int ret; 49 50 dev_info(&phy->phy->dev, "set mode %d", (int)mode); 51 52 switch (mode) { 53 case PHY_MODE_USB_DEVICE: 54 regval = PHY_ID_OVERWRITE_EN | PHY_ID_OVERWRITE_MODE_DEVICE; 55 regmap_clear_bits(phy->syscon, REG_USB_PHY_CTRL, PHY_VBUS_POWER); 56 break; 57 case PHY_MODE_USB_HOST: 58 regval = PHY_ID_OVERWRITE_EN | PHY_ID_OVERWRITE_MODE_HOST; 59 regmap_set_bits(phy->syscon, REG_USB_PHY_CTRL, PHY_VBUS_POWER); 60 break; 61 case PHY_MODE_USB_OTG: 62 if (!phy->support_otg) 63 return 0; 64 65 ret = regmap_read(phy->syscon, REG_USB_PHY_CTRL, ®val); 66 if (ret) 67 return ret; 68 69 regval = FIELD_GET(PHY_ID_OVERWRITE_MODE, regval); 70 break; 71 default: 72 return -EINVAL; 73 } 74 75 return regmap_update_bits(phy->syscon, REG_USB_PHY_CTRL, 76 PHY_ID_OVERWRITE_EN | PHY_ID_OVERWRITE_MODE, 77 regval); 78 } 79 80 static int cv1800_usb_phy_set_clock(struct cv1800_usb_phy *phy) 81 { 82 int ret; 83 84 ret = clk_set_rate(phy->usb_app_clk, PHY_APP_CLK_RATE); 85 if (ret) 86 return ret; 87 88 ret = clk_set_rate(phy->usb_lpm_clk, PHY_LPM_CLK_RATE); 89 if (ret) 90 return ret; 91 92 return clk_set_rate(phy->usb_stb_clk, PHY_STB_CLK_RATE); 93 } 94 95 static const struct phy_ops cv1800_usb_phy_ops = { 96 .set_mode = cv1800_usb_phy_set_mode, 97 .owner = THIS_MODULE, 98 }; 99 100 static int cv1800_usb_phy_probe(struct platform_device *pdev) 101 { 102 struct device *dev = &pdev->dev; 103 struct device *parent = dev->parent; 104 struct cv1800_usb_phy *phy; 105 struct phy_provider *phy_provider; 106 int ret; 107 108 if (!parent) 109 return -ENODEV; 110 111 phy = devm_kmalloc(dev, sizeof(*phy), GFP_KERNEL); 112 if (!phy) 113 return -ENOMEM; 114 115 phy->syscon = syscon_node_to_regmap(parent->of_node); 116 if (IS_ERR_OR_NULL(phy->syscon)) 117 return -ENODEV; 118 119 phy->support_otg = false; 120 121 spin_lock_init(&phy->lock); 122 123 phy->usb_app_clk = devm_clk_get_enabled(dev, "app"); 124 if (IS_ERR(phy->usb_app_clk)) 125 return dev_err_probe(dev, PTR_ERR(phy->usb_app_clk), 126 "Failed to get app clock\n"); 127 128 phy->usb_lpm_clk = devm_clk_get_enabled(dev, "lpm"); 129 if (IS_ERR(phy->usb_lpm_clk)) 130 return dev_err_probe(dev, PTR_ERR(phy->usb_lpm_clk), 131 "Failed to get lpm clock\n"); 132 133 phy->usb_stb_clk = devm_clk_get_enabled(dev, "stb"); 134 if (IS_ERR(phy->usb_stb_clk)) 135 return dev_err_probe(dev, PTR_ERR(phy->usb_stb_clk), 136 "Failed to get stb clock\n"); 137 138 phy->phy = devm_phy_create(dev, NULL, &cv1800_usb_phy_ops); 139 if (IS_ERR(phy->phy)) 140 return dev_err_probe(dev, PTR_ERR(phy->phy), 141 "Failed to create phy\n"); 142 143 ret = cv1800_usb_phy_set_clock(phy); 144 if (ret) 145 return ret; 146 147 phy_set_drvdata(phy->phy, phy); 148 phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate); 149 150 return PTR_ERR_OR_ZERO(phy_provider); 151 } 152 153 static const struct of_device_id cv1800_usb_phy_ids[] = { 154 { .compatible = "sophgo,cv1800b-usb2-phy" }, 155 { }, 156 }; 157 MODULE_DEVICE_TABLE(of, cv1800_usb_phy_ids); 158 159 static struct platform_driver cv1800_usb_phy_driver = { 160 .probe = cv1800_usb_phy_probe, 161 .driver = { 162 .name = "cv1800-usb2-phy", 163 .of_match_table = cv1800_usb_phy_ids, 164 }, 165 }; 166 module_platform_driver(cv1800_usb_phy_driver); 167 168 MODULE_AUTHOR("Inochi Amaoto <inochiama@outlook.com>"); 169 MODULE_DESCRIPTION("CV1800/SG2000 SoC USB 2.0 PHY driver"); 170 MODULE_LICENSE("GPL"); 171