phy-rtk-usb3.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * phy-rtk-usb3.c RTK usb3.0 phy driver
  4. *
  5. * copyright (c) 2023 realtek semiconductor corporation
  6. *
  7. */
  8. #include <linux/module.h>
  9. #include <linux/of.h>
  10. #include <linux/of_address.h>
  11. #include <linux/platform_device.h>
  12. #include <linux/uaccess.h>
  13. #include <linux/debugfs.h>
  14. #include <linux/nvmem-consumer.h>
  15. #include <linux/regmap.h>
  16. #include <linux/sys_soc.h>
  17. #include <linux/mfd/syscon.h>
  18. #include <linux/phy/phy.h>
  19. #include <linux/usb.h>
  20. #define USB_MDIO_CTRL_PHY_BUSY BIT(7)
  21. #define USB_MDIO_CTRL_PHY_WRITE BIT(0)
  22. #define USB_MDIO_CTRL_PHY_ADDR_SHIFT 8
  23. #define USB_MDIO_CTRL_PHY_DATA_SHIFT 16
  24. #define MAX_USB_PHY_DATA_SIZE 0x30
  25. #define PHY_ADDR_0X09 0x09
  26. #define PHY_ADDR_0X0B 0x0b
  27. #define PHY_ADDR_0X0D 0x0d
  28. #define PHY_ADDR_0X10 0x10
  29. #define PHY_ADDR_0X1F 0x1f
  30. #define PHY_ADDR_0X20 0x20
  31. #define PHY_ADDR_0X21 0x21
  32. #define PHY_ADDR_0X30 0x30
  33. #define REG_0X09_FORCE_CALIBRATION BIT(9)
  34. #define REG_0X0B_RX_OFFSET_RANGE_MASK 0xc
  35. #define REG_0X0D_RX_DEBUG_TEST_EN BIT(6)
  36. #define REG_0X10_DEBUG_MODE_SETTING 0x3c0
  37. #define REG_0X10_DEBUG_MODE_SETTING_MASK 0x3f8
  38. #define REG_0X1F_RX_OFFSET_CODE_MASK 0x1e
  39. #define USB_U3_TX_LFPS_SWING_TRIM_SHIFT 4
  40. #define USB_U3_TX_LFPS_SWING_TRIM_MASK 0xf
  41. #define AMPLITUDE_CONTROL_COARSE_MASK 0xff
  42. #define AMPLITUDE_CONTROL_FINE_MASK 0xffff
  43. #define AMPLITUDE_CONTROL_COARSE_DEFAULT 0xff
  44. #define AMPLITUDE_CONTROL_FINE_DEFAULT 0xffff
  45. #define PHY_ADDR_MAP_ARRAY_INDEX(addr) (addr)
  46. #define ARRAY_INDEX_MAP_PHY_ADDR(index) (index)
  47. struct phy_reg {
  48. void __iomem *reg_mdio_ctl;
  49. };
  50. struct phy_data {
  51. u8 addr;
  52. u16 data;
  53. };
  54. struct phy_cfg {
  55. int param_size;
  56. struct phy_data param[MAX_USB_PHY_DATA_SIZE];
  57. bool check_efuse;
  58. bool do_toggle;
  59. bool do_toggle_once;
  60. bool use_default_parameter;
  61. bool check_rx_front_end_offset;
  62. };
  63. struct phy_parameter {
  64. struct phy_reg phy_reg;
  65. /* Get from efuse */
  66. u8 efuse_usb_u3_tx_lfps_swing_trim;
  67. /* Get from dts */
  68. u32 amplitude_control_coarse;
  69. u32 amplitude_control_fine;
  70. };
  71. struct rtk_phy {
  72. struct device *dev;
  73. struct phy_cfg *phy_cfg;
  74. int num_phy;
  75. struct phy_parameter *phy_parameter;
  76. struct dentry *debug_dir;
  77. };
  78. #define PHY_IO_TIMEOUT_USEC (50000)
  79. #define PHY_IO_DELAY_US (100)
  80. static inline int utmi_wait_register(void __iomem *reg, u32 mask, u32 result)
  81. {
  82. int ret;
  83. unsigned int val;
  84. ret = read_poll_timeout(readl, val, ((val & mask) == result),
  85. PHY_IO_DELAY_US, PHY_IO_TIMEOUT_USEC, false, reg);
  86. if (ret) {
  87. pr_err("%s can't program USB phy\n", __func__);
  88. return -ETIMEDOUT;
  89. }
  90. return 0;
  91. }
  92. static int rtk_phy3_wait_vbusy(struct phy_reg *phy_reg)
  93. {
  94. return utmi_wait_register(phy_reg->reg_mdio_ctl, USB_MDIO_CTRL_PHY_BUSY, 0);
  95. }
  96. static u16 rtk_phy_read(struct phy_reg *phy_reg, char addr)
  97. {
  98. unsigned int tmp;
  99. u32 value;
  100. tmp = (addr << USB_MDIO_CTRL_PHY_ADDR_SHIFT);
  101. writel(tmp, phy_reg->reg_mdio_ctl);
  102. rtk_phy3_wait_vbusy(phy_reg);
  103. value = readl(phy_reg->reg_mdio_ctl);
  104. value = value >> USB_MDIO_CTRL_PHY_DATA_SHIFT;
  105. return (u16)value;
  106. }
  107. static int rtk_phy_write(struct phy_reg *phy_reg, char addr, u16 data)
  108. {
  109. unsigned int val;
  110. val = USB_MDIO_CTRL_PHY_WRITE |
  111. (addr << USB_MDIO_CTRL_PHY_ADDR_SHIFT) |
  112. (data << USB_MDIO_CTRL_PHY_DATA_SHIFT);
  113. writel(val, phy_reg->reg_mdio_ctl);
  114. rtk_phy3_wait_vbusy(phy_reg);
  115. return 0;
  116. }
  117. static void do_rtk_usb3_phy_toggle(struct rtk_phy *rtk_phy, int index, bool connect)
  118. {
  119. struct phy_cfg *phy_cfg = rtk_phy->phy_cfg;
  120. struct phy_reg *phy_reg;
  121. struct phy_parameter *phy_parameter;
  122. struct phy_data *phy_data;
  123. u8 addr;
  124. u16 data;
  125. int i;
  126. phy_parameter = &((struct phy_parameter *)rtk_phy->phy_parameter)[index];
  127. phy_reg = &phy_parameter->phy_reg;
  128. if (!phy_cfg->do_toggle)
  129. return;
  130. i = PHY_ADDR_MAP_ARRAY_INDEX(PHY_ADDR_0X09);
  131. phy_data = phy_cfg->param + i;
  132. addr = phy_data->addr;
  133. data = phy_data->data;
  134. if (!addr && !data) {
  135. addr = PHY_ADDR_0X09;
  136. data = rtk_phy_read(phy_reg, addr);
  137. phy_data->addr = addr;
  138. phy_data->data = data;
  139. }
  140. rtk_phy_write(phy_reg, addr, data & (~REG_0X09_FORCE_CALIBRATION));
  141. mdelay(1);
  142. rtk_phy_write(phy_reg, addr, data | REG_0X09_FORCE_CALIBRATION);
  143. }
  144. static int do_rtk_phy_init(struct rtk_phy *rtk_phy, int index)
  145. {
  146. struct phy_cfg *phy_cfg;
  147. struct phy_reg *phy_reg;
  148. struct phy_parameter *phy_parameter;
  149. int i = 0;
  150. phy_cfg = rtk_phy->phy_cfg;
  151. phy_parameter = &((struct phy_parameter *)rtk_phy->phy_parameter)[index];
  152. phy_reg = &phy_parameter->phy_reg;
  153. if (phy_cfg->use_default_parameter)
  154. goto do_toggle;
  155. for (i = 0; i < phy_cfg->param_size; i++) {
  156. struct phy_data *phy_data = phy_cfg->param + i;
  157. u8 addr = phy_data->addr;
  158. u16 data = phy_data->data;
  159. if (!addr && !data)
  160. continue;
  161. rtk_phy_write(phy_reg, addr, data);
  162. }
  163. do_toggle:
  164. if (phy_cfg->do_toggle_once)
  165. phy_cfg->do_toggle = true;
  166. do_rtk_usb3_phy_toggle(rtk_phy, index, false);
  167. if (phy_cfg->do_toggle_once) {
  168. u16 check_value = 0;
  169. int count = 10;
  170. u16 value_0x0d, value_0x10;
  171. /* Enable Debug mode by set 0x0D and 0x10 */
  172. value_0x0d = rtk_phy_read(phy_reg, PHY_ADDR_0X0D);
  173. value_0x10 = rtk_phy_read(phy_reg, PHY_ADDR_0X10);
  174. rtk_phy_write(phy_reg, PHY_ADDR_0X0D,
  175. value_0x0d | REG_0X0D_RX_DEBUG_TEST_EN);
  176. rtk_phy_write(phy_reg, PHY_ADDR_0X10,
  177. (value_0x10 & ~REG_0X10_DEBUG_MODE_SETTING_MASK) |
  178. REG_0X10_DEBUG_MODE_SETTING);
  179. check_value = rtk_phy_read(phy_reg, PHY_ADDR_0X30);
  180. while (!(check_value & BIT(15))) {
  181. check_value = rtk_phy_read(phy_reg, PHY_ADDR_0X30);
  182. mdelay(1);
  183. if (count-- < 0)
  184. break;
  185. }
  186. if (!(check_value & BIT(15)))
  187. dev_info(rtk_phy->dev, "toggle fail addr=0x%02x, data=0x%04x\n",
  188. PHY_ADDR_0X30, check_value);
  189. /* Disable Debug mode by set 0x0D and 0x10 to default*/
  190. rtk_phy_write(phy_reg, PHY_ADDR_0X0D, value_0x0d);
  191. rtk_phy_write(phy_reg, PHY_ADDR_0X10, value_0x10);
  192. phy_cfg->do_toggle = false;
  193. }
  194. if (phy_cfg->check_rx_front_end_offset) {
  195. u16 rx_offset_code, rx_offset_range;
  196. u16 code_mask = REG_0X1F_RX_OFFSET_CODE_MASK;
  197. u16 range_mask = REG_0X0B_RX_OFFSET_RANGE_MASK;
  198. bool do_update = false;
  199. rx_offset_code = rtk_phy_read(phy_reg, PHY_ADDR_0X1F);
  200. if (((rx_offset_code & code_mask) == 0x0) ||
  201. ((rx_offset_code & code_mask) == code_mask))
  202. do_update = true;
  203. rx_offset_range = rtk_phy_read(phy_reg, PHY_ADDR_0X0B);
  204. if (((rx_offset_range & range_mask) == range_mask) && do_update) {
  205. dev_warn(rtk_phy->dev, "Don't update rx_offset_range (rx_offset_code=0x%x, rx_offset_range=0x%x)\n",
  206. rx_offset_code, rx_offset_range);
  207. do_update = false;
  208. }
  209. if (do_update) {
  210. u16 tmp1, tmp2;
  211. tmp1 = rx_offset_range & (~range_mask);
  212. tmp2 = rx_offset_range & range_mask;
  213. tmp2 += (1 << 2);
  214. rx_offset_range = tmp1 | (tmp2 & range_mask);
  215. rtk_phy_write(phy_reg, PHY_ADDR_0X0B, rx_offset_range);
  216. goto do_toggle;
  217. }
  218. }
  219. return 0;
  220. }
  221. static int rtk_phy_init(struct phy *phy)
  222. {
  223. struct rtk_phy *rtk_phy = phy_get_drvdata(phy);
  224. int ret = 0;
  225. int i;
  226. unsigned long phy_init_time = jiffies;
  227. for (i = 0; i < rtk_phy->num_phy; i++)
  228. ret = do_rtk_phy_init(rtk_phy, i);
  229. dev_dbg(rtk_phy->dev, "Initialized RTK USB 3.0 PHY (take %dms)\n",
  230. jiffies_to_msecs(jiffies - phy_init_time));
  231. return ret;
  232. }
  233. static int rtk_phy_exit(struct phy *phy)
  234. {
  235. return 0;
  236. }
  237. static void rtk_phy_toggle(struct rtk_phy *rtk_phy, bool connect, int port)
  238. {
  239. int index = port;
  240. if (index > rtk_phy->num_phy) {
  241. dev_err(rtk_phy->dev, "%s: The port=%d is not in usb phy (num_phy=%d)\n",
  242. __func__, index, rtk_phy->num_phy);
  243. return;
  244. }
  245. do_rtk_usb3_phy_toggle(rtk_phy, index, connect);
  246. }
  247. static int rtk_phy_connect(struct phy *phy, int port)
  248. {
  249. struct rtk_phy *rtk_phy = phy_get_drvdata(phy);
  250. dev_dbg(rtk_phy->dev, "%s port=%d\n", __func__, port);
  251. rtk_phy_toggle(rtk_phy, true, port);
  252. return 0;
  253. }
  254. static int rtk_phy_disconnect(struct phy *phy, int port)
  255. {
  256. struct rtk_phy *rtk_phy = phy_get_drvdata(phy);
  257. dev_dbg(rtk_phy->dev, "%s port=%d\n", __func__, port);
  258. rtk_phy_toggle(rtk_phy, false, port);
  259. return 0;
  260. }
  261. static const struct phy_ops ops = {
  262. .init = rtk_phy_init,
  263. .exit = rtk_phy_exit,
  264. .connect = rtk_phy_connect,
  265. .disconnect = rtk_phy_disconnect,
  266. .owner = THIS_MODULE,
  267. };
  268. #ifdef CONFIG_DEBUG_FS
  269. static struct dentry *create_phy_debug_root(void)
  270. {
  271. struct dentry *phy_debug_root;
  272. phy_debug_root = debugfs_lookup("phy", usb_debug_root);
  273. if (!phy_debug_root)
  274. phy_debug_root = debugfs_create_dir("phy", usb_debug_root);
  275. return phy_debug_root;
  276. }
  277. static int rtk_usb3_parameter_show(struct seq_file *s, void *unused)
  278. {
  279. struct rtk_phy *rtk_phy = s->private;
  280. struct phy_cfg *phy_cfg;
  281. int i, index;
  282. phy_cfg = rtk_phy->phy_cfg;
  283. seq_puts(s, "Property:\n");
  284. seq_printf(s, " check_efuse: %s\n",
  285. phy_cfg->check_efuse ? "Enable" : "Disable");
  286. seq_printf(s, " do_toggle: %s\n",
  287. phy_cfg->do_toggle ? "Enable" : "Disable");
  288. seq_printf(s, " do_toggle_once: %s\n",
  289. phy_cfg->do_toggle_once ? "Enable" : "Disable");
  290. seq_printf(s, " use_default_parameter: %s\n",
  291. phy_cfg->use_default_parameter ? "Enable" : "Disable");
  292. for (index = 0; index < rtk_phy->num_phy; index++) {
  293. struct phy_reg *phy_reg;
  294. struct phy_parameter *phy_parameter;
  295. phy_parameter = &((struct phy_parameter *)rtk_phy->phy_parameter)[index];
  296. phy_reg = &phy_parameter->phy_reg;
  297. seq_printf(s, "PHY %d:\n", index);
  298. for (i = 0; i < phy_cfg->param_size; i++) {
  299. struct phy_data *phy_data = phy_cfg->param + i;
  300. u8 addr = ARRAY_INDEX_MAP_PHY_ADDR(i);
  301. u16 data = phy_data->data;
  302. if (!phy_data->addr && !data)
  303. seq_printf(s, " addr = 0x%02x, data = none ==> read value = 0x%04x\n",
  304. addr, rtk_phy_read(phy_reg, addr));
  305. else
  306. seq_printf(s, " addr = 0x%02x, data = 0x%04x ==> read value = 0x%04x\n",
  307. addr, data, rtk_phy_read(phy_reg, addr));
  308. }
  309. seq_puts(s, "PHY Property:\n");
  310. seq_printf(s, " efuse_usb_u3_tx_lfps_swing_trim: 0x%x\n",
  311. (int)phy_parameter->efuse_usb_u3_tx_lfps_swing_trim);
  312. seq_printf(s, " amplitude_control_coarse: 0x%x\n",
  313. (int)phy_parameter->amplitude_control_coarse);
  314. seq_printf(s, " amplitude_control_fine: 0x%x\n",
  315. (int)phy_parameter->amplitude_control_fine);
  316. }
  317. return 0;
  318. }
  319. DEFINE_SHOW_ATTRIBUTE(rtk_usb3_parameter);
  320. static inline void create_debug_files(struct rtk_phy *rtk_phy)
  321. {
  322. struct dentry *phy_debug_root = NULL;
  323. phy_debug_root = create_phy_debug_root();
  324. if (!phy_debug_root)
  325. return;
  326. rtk_phy->debug_dir = debugfs_create_dir(dev_name(rtk_phy->dev), phy_debug_root);
  327. debugfs_create_file("parameter", 0444, rtk_phy->debug_dir, rtk_phy,
  328. &rtk_usb3_parameter_fops);
  329. }
  330. static inline void remove_debug_files(struct rtk_phy *rtk_phy)
  331. {
  332. debugfs_remove_recursive(rtk_phy->debug_dir);
  333. }
  334. #else
  335. static inline void create_debug_files(struct rtk_phy *rtk_phy) { }
  336. static inline void remove_debug_files(struct rtk_phy *rtk_phy) { }
  337. #endif /* CONFIG_DEBUG_FS */
  338. static int get_phy_data_by_efuse(struct rtk_phy *rtk_phy,
  339. struct phy_parameter *phy_parameter, int index)
  340. {
  341. struct phy_cfg *phy_cfg = rtk_phy->phy_cfg;
  342. u8 value = 0;
  343. struct nvmem_cell *cell;
  344. if (!phy_cfg->check_efuse)
  345. goto out;
  346. cell = nvmem_cell_get(rtk_phy->dev, "usb_u3_tx_lfps_swing_trim");
  347. if (IS_ERR(cell)) {
  348. dev_dbg(rtk_phy->dev, "%s no usb_u3_tx_lfps_swing_trim: %ld\n",
  349. __func__, PTR_ERR(cell));
  350. } else {
  351. unsigned char *buf;
  352. size_t buf_size;
  353. buf = nvmem_cell_read(cell, &buf_size);
  354. if (!IS_ERR(buf)) {
  355. value = buf[0] & USB_U3_TX_LFPS_SWING_TRIM_MASK;
  356. kfree(buf);
  357. }
  358. nvmem_cell_put(cell);
  359. }
  360. if (value > 0 && value < 0x8)
  361. phy_parameter->efuse_usb_u3_tx_lfps_swing_trim = 0x8;
  362. else
  363. phy_parameter->efuse_usb_u3_tx_lfps_swing_trim = (u8)value;
  364. out:
  365. return 0;
  366. }
  367. static void update_amplitude_control_value(struct rtk_phy *rtk_phy,
  368. struct phy_parameter *phy_parameter)
  369. {
  370. struct phy_cfg *phy_cfg;
  371. struct phy_reg *phy_reg;
  372. phy_reg = &phy_parameter->phy_reg;
  373. phy_cfg = rtk_phy->phy_cfg;
  374. if (phy_parameter->amplitude_control_coarse != AMPLITUDE_CONTROL_COARSE_DEFAULT) {
  375. u16 val_mask = AMPLITUDE_CONTROL_COARSE_MASK;
  376. u16 data;
  377. if (!phy_cfg->param[PHY_ADDR_0X20].addr && !phy_cfg->param[PHY_ADDR_0X20].data) {
  378. phy_cfg->param[PHY_ADDR_0X20].addr = PHY_ADDR_0X20;
  379. data = rtk_phy_read(phy_reg, PHY_ADDR_0X20);
  380. } else {
  381. data = phy_cfg->param[PHY_ADDR_0X20].data;
  382. }
  383. data &= (~val_mask);
  384. data |= (phy_parameter->amplitude_control_coarse & val_mask);
  385. phy_cfg->param[PHY_ADDR_0X20].data = data;
  386. }
  387. if (phy_parameter->efuse_usb_u3_tx_lfps_swing_trim) {
  388. u8 efuse_val = phy_parameter->efuse_usb_u3_tx_lfps_swing_trim;
  389. u16 val_mask = USB_U3_TX_LFPS_SWING_TRIM_MASK;
  390. int val_shift = USB_U3_TX_LFPS_SWING_TRIM_SHIFT;
  391. u16 data;
  392. if (!phy_cfg->param[PHY_ADDR_0X20].addr && !phy_cfg->param[PHY_ADDR_0X20].data) {
  393. phy_cfg->param[PHY_ADDR_0X20].addr = PHY_ADDR_0X20;
  394. data = rtk_phy_read(phy_reg, PHY_ADDR_0X20);
  395. } else {
  396. data = phy_cfg->param[PHY_ADDR_0X20].data;
  397. }
  398. data &= ~(val_mask << val_shift);
  399. data |= ((efuse_val & val_mask) << val_shift);
  400. phy_cfg->param[PHY_ADDR_0X20].data = data;
  401. }
  402. if (phy_parameter->amplitude_control_fine != AMPLITUDE_CONTROL_FINE_DEFAULT) {
  403. u16 val_mask = AMPLITUDE_CONTROL_FINE_MASK;
  404. if (!phy_cfg->param[PHY_ADDR_0X21].addr && !phy_cfg->param[PHY_ADDR_0X21].data)
  405. phy_cfg->param[PHY_ADDR_0X21].addr = PHY_ADDR_0X21;
  406. phy_cfg->param[PHY_ADDR_0X21].data =
  407. phy_parameter->amplitude_control_fine & val_mask;
  408. }
  409. }
  410. static int parse_phy_data(struct rtk_phy *rtk_phy)
  411. {
  412. struct device *dev = rtk_phy->dev;
  413. struct phy_parameter *phy_parameter;
  414. int ret = 0;
  415. int index;
  416. rtk_phy->phy_parameter = devm_kzalloc(dev, sizeof(struct phy_parameter) *
  417. rtk_phy->num_phy, GFP_KERNEL);
  418. if (!rtk_phy->phy_parameter)
  419. return -ENOMEM;
  420. for (index = 0; index < rtk_phy->num_phy; index++) {
  421. phy_parameter = &((struct phy_parameter *)rtk_phy->phy_parameter)[index];
  422. phy_parameter->phy_reg.reg_mdio_ctl = of_iomap(dev->of_node, 0) + index;
  423. /* Amplitude control address 0x20 bit 0 to bit 7 */
  424. if (of_property_read_u32(dev->of_node, "realtek,amplitude-control-coarse-tuning",
  425. &phy_parameter->amplitude_control_coarse))
  426. phy_parameter->amplitude_control_coarse = AMPLITUDE_CONTROL_COARSE_DEFAULT;
  427. /* Amplitude control address 0x21 bit 0 to bit 16 */
  428. if (of_property_read_u32(dev->of_node, "realtek,amplitude-control-fine-tuning",
  429. &phy_parameter->amplitude_control_fine))
  430. phy_parameter->amplitude_control_fine = AMPLITUDE_CONTROL_FINE_DEFAULT;
  431. get_phy_data_by_efuse(rtk_phy, phy_parameter, index);
  432. update_amplitude_control_value(rtk_phy, phy_parameter);
  433. }
  434. return ret;
  435. }
  436. static int rtk_usb3phy_probe(struct platform_device *pdev)
  437. {
  438. struct rtk_phy *rtk_phy;
  439. struct device *dev = &pdev->dev;
  440. struct phy *generic_phy;
  441. struct phy_provider *phy_provider;
  442. const struct phy_cfg *phy_cfg;
  443. int ret;
  444. phy_cfg = of_device_get_match_data(dev);
  445. if (!phy_cfg) {
  446. dev_err(dev, "phy config are not assigned!\n");
  447. return -EINVAL;
  448. }
  449. rtk_phy = devm_kzalloc(dev, sizeof(*rtk_phy), GFP_KERNEL);
  450. if (!rtk_phy)
  451. return -ENOMEM;
  452. rtk_phy->dev = &pdev->dev;
  453. rtk_phy->phy_cfg = devm_kzalloc(dev, sizeof(*phy_cfg), GFP_KERNEL);
  454. if (!rtk_phy->phy_cfg)
  455. return -ENOMEM;
  456. memcpy(rtk_phy->phy_cfg, phy_cfg, sizeof(*phy_cfg));
  457. rtk_phy->num_phy = 1;
  458. ret = parse_phy_data(rtk_phy);
  459. if (ret)
  460. goto err;
  461. platform_set_drvdata(pdev, rtk_phy);
  462. generic_phy = devm_phy_create(rtk_phy->dev, NULL, &ops);
  463. if (IS_ERR(generic_phy))
  464. return PTR_ERR(generic_phy);
  465. phy_set_drvdata(generic_phy, rtk_phy);
  466. phy_provider = devm_of_phy_provider_register(rtk_phy->dev, of_phy_simple_xlate);
  467. if (IS_ERR(phy_provider))
  468. return PTR_ERR(phy_provider);
  469. create_debug_files(rtk_phy);
  470. err:
  471. return ret;
  472. }
  473. static void rtk_usb3phy_remove(struct platform_device *pdev)
  474. {
  475. struct rtk_phy *rtk_phy = platform_get_drvdata(pdev);
  476. remove_debug_files(rtk_phy);
  477. }
  478. static const struct phy_cfg rtd1295_phy_cfg = {
  479. .param_size = MAX_USB_PHY_DATA_SIZE,
  480. .param = { [0] = {0x01, 0x4008}, [1] = {0x01, 0xe046},
  481. [2] = {0x02, 0x6046}, [3] = {0x03, 0x2779},
  482. [4] = {0x04, 0x72f5}, [5] = {0x05, 0x2ad3},
  483. [6] = {0x06, 0x000e}, [7] = {0x07, 0x2e00},
  484. [8] = {0x08, 0x3591}, [9] = {0x09, 0x525c},
  485. [10] = {0x0a, 0xa600}, [11] = {0x0b, 0xa904},
  486. [12] = {0x0c, 0xc000}, [13] = {0x0d, 0xef1c},
  487. [14] = {0x0e, 0x2000}, [15] = {0x0f, 0x0000},
  488. [16] = {0x10, 0x000c}, [17] = {0x11, 0x4c00},
  489. [18] = {0x12, 0xfc00}, [19] = {0x13, 0x0c81},
  490. [20] = {0x14, 0xde01}, [21] = {0x15, 0x0000},
  491. [22] = {0x16, 0x0000}, [23] = {0x17, 0x0000},
  492. [24] = {0x18, 0x0000}, [25] = {0x19, 0x4004},
  493. [26] = {0x1a, 0x1260}, [27] = {0x1b, 0xff00},
  494. [28] = {0x1c, 0xcb00}, [29] = {0x1d, 0xa03f},
  495. [30] = {0x1e, 0xc2e0}, [31] = {0x1f, 0x2807},
  496. [32] = {0x20, 0x947a}, [33] = {0x21, 0x88aa},
  497. [34] = {0x22, 0x0057}, [35] = {0x23, 0xab66},
  498. [36] = {0x24, 0x0800}, [37] = {0x25, 0x0000},
  499. [38] = {0x26, 0x040a}, [39] = {0x27, 0x01d6},
  500. [40] = {0x28, 0xf8c2}, [41] = {0x29, 0x3080},
  501. [42] = {0x2a, 0x3082}, [43] = {0x2b, 0x2078},
  502. [44] = {0x2c, 0xffff}, [45] = {0x2d, 0xffff},
  503. [46] = {0x2e, 0x0000}, [47] = {0x2f, 0x0040}, },
  504. .check_efuse = false,
  505. .do_toggle = true,
  506. .do_toggle_once = false,
  507. .use_default_parameter = false,
  508. .check_rx_front_end_offset = false,
  509. };
  510. static const struct phy_cfg rtd1619_phy_cfg = {
  511. .param_size = MAX_USB_PHY_DATA_SIZE,
  512. .param = { [8] = {0x08, 0x3591},
  513. [38] = {0x26, 0x840b},
  514. [40] = {0x28, 0xf842}, },
  515. .check_efuse = false,
  516. .do_toggle = true,
  517. .do_toggle_once = false,
  518. .use_default_parameter = false,
  519. .check_rx_front_end_offset = false,
  520. };
  521. static const struct phy_cfg rtd1319_phy_cfg = {
  522. .param_size = MAX_USB_PHY_DATA_SIZE,
  523. .param = { [1] = {0x01, 0xac86},
  524. [6] = {0x06, 0x0003},
  525. [9] = {0x09, 0x924c},
  526. [10] = {0x0a, 0xa608},
  527. [11] = {0x0b, 0xb905},
  528. [14] = {0x0e, 0x2010},
  529. [32] = {0x20, 0x705a},
  530. [33] = {0x21, 0xf645},
  531. [34] = {0x22, 0x0013},
  532. [35] = {0x23, 0xcb66},
  533. [41] = {0x29, 0xff00}, },
  534. .check_efuse = true,
  535. .do_toggle = true,
  536. .do_toggle_once = false,
  537. .use_default_parameter = false,
  538. .check_rx_front_end_offset = false,
  539. };
  540. static const struct phy_cfg rtd1619b_phy_cfg = {
  541. .param_size = MAX_USB_PHY_DATA_SIZE,
  542. .param = { [1] = {0x01, 0xac8c},
  543. [6] = {0x06, 0x0017},
  544. [9] = {0x09, 0x724c},
  545. [10] = {0x0a, 0xb610},
  546. [11] = {0x0b, 0xb90d},
  547. [13] = {0x0d, 0xef2a},
  548. [15] = {0x0f, 0x9050},
  549. [16] = {0x10, 0x000c},
  550. [32] = {0x20, 0x70ff},
  551. [34] = {0x22, 0x0013},
  552. [35] = {0x23, 0xdb66},
  553. [38] = {0x26, 0x8609},
  554. [41] = {0x29, 0xff13},
  555. [42] = {0x2a, 0x3070}, },
  556. .check_efuse = true,
  557. .do_toggle = false,
  558. .do_toggle_once = true,
  559. .use_default_parameter = false,
  560. .check_rx_front_end_offset = false,
  561. };
  562. static const struct phy_cfg rtd1319d_phy_cfg = {
  563. .param_size = MAX_USB_PHY_DATA_SIZE,
  564. .param = { [1] = {0x01, 0xac89},
  565. [4] = {0x04, 0xf2f5},
  566. [6] = {0x06, 0x0017},
  567. [9] = {0x09, 0x424c},
  568. [10] = {0x0a, 0x9610},
  569. [11] = {0x0b, 0x9901},
  570. [12] = {0x0c, 0xf000},
  571. [13] = {0x0d, 0xef2a},
  572. [14] = {0x0e, 0x1000},
  573. [15] = {0x0f, 0x9050},
  574. [32] = {0x20, 0x7077},
  575. [35] = {0x23, 0x0b62},
  576. [37] = {0x25, 0x10ec},
  577. [42] = {0x2a, 0x3070}, },
  578. .check_efuse = true,
  579. .do_toggle = false,
  580. .do_toggle_once = true,
  581. .use_default_parameter = false,
  582. .check_rx_front_end_offset = true,
  583. };
  584. static const struct of_device_id usbphy_rtk_dt_match[] = {
  585. { .compatible = "realtek,rtd1295-usb3phy", .data = &rtd1295_phy_cfg },
  586. { .compatible = "realtek,rtd1319-usb3phy", .data = &rtd1319_phy_cfg },
  587. { .compatible = "realtek,rtd1319d-usb3phy", .data = &rtd1319d_phy_cfg },
  588. { .compatible = "realtek,rtd1619-usb3phy", .data = &rtd1619_phy_cfg },
  589. { .compatible = "realtek,rtd1619b-usb3phy", .data = &rtd1619b_phy_cfg },
  590. {},
  591. };
  592. MODULE_DEVICE_TABLE(of, usbphy_rtk_dt_match);
  593. static struct platform_driver rtk_usb3phy_driver = {
  594. .probe = rtk_usb3phy_probe,
  595. .remove_new = rtk_usb3phy_remove,
  596. .driver = {
  597. .name = "rtk-usb3phy",
  598. .of_match_table = usbphy_rtk_dt_match,
  599. },
  600. };
  601. module_platform_driver(rtk_usb3phy_driver);
  602. MODULE_LICENSE("GPL");
  603. MODULE_AUTHOR("Stanley Chang <stanley_chang@realtek.com>");
  604. MODULE_DESCRIPTION("Realtek usb 3.0 phy driver");