usbmisc_imx.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright 2012 Freescale Semiconductor, Inc.
  4. */
  5. #include <linux/module.h>
  6. #include <linux/of_platform.h>
  7. #include <linux/err.h>
  8. #include <linux/io.h>
  9. #include <linux/delay.h>
  10. #include "ci_hdrc_imx.h"
  11. #define MX25_USB_PHY_CTRL_OFFSET 0x08
  12. #define MX25_BM_EXTERNAL_VBUS_DIVIDER BIT(23)
  13. #define MX25_EHCI_INTERFACE_SINGLE_UNI (2 << 0)
  14. #define MX25_EHCI_INTERFACE_DIFF_UNI (0 << 0)
  15. #define MX25_EHCI_INTERFACE_MASK (0xf)
  16. #define MX25_OTG_SIC_SHIFT 29
  17. #define MX25_OTG_SIC_MASK (0x3 << MX25_OTG_SIC_SHIFT)
  18. #define MX25_OTG_PM_BIT BIT(24)
  19. #define MX25_OTG_PP_BIT BIT(11)
  20. #define MX25_OTG_OCPOL_BIT BIT(3)
  21. #define MX25_H1_SIC_SHIFT 21
  22. #define MX25_H1_SIC_MASK (0x3 << MX25_H1_SIC_SHIFT)
  23. #define MX25_H1_PP_BIT BIT(18)
  24. #define MX25_H1_PM_BIT BIT(16)
  25. #define MX25_H1_IPPUE_UP_BIT BIT(7)
  26. #define MX25_H1_IPPUE_DOWN_BIT BIT(6)
  27. #define MX25_H1_TLL_BIT BIT(5)
  28. #define MX25_H1_USBTE_BIT BIT(4)
  29. #define MX25_H1_OCPOL_BIT BIT(2)
  30. #define MX27_H1_PM_BIT BIT(8)
  31. #define MX27_H2_PM_BIT BIT(16)
  32. #define MX27_OTG_PM_BIT BIT(24)
  33. #define MX53_USB_OTG_PHY_CTRL_0_OFFSET 0x08
  34. #define MX53_USB_OTG_PHY_CTRL_1_OFFSET 0x0c
  35. #define MX53_USB_CTRL_1_OFFSET 0x10
  36. #define MX53_USB_CTRL_1_H2_XCVR_CLK_SEL_MASK (0x11 << 2)
  37. #define MX53_USB_CTRL_1_H2_XCVR_CLK_SEL_ULPI BIT(2)
  38. #define MX53_USB_CTRL_1_H3_XCVR_CLK_SEL_MASK (0x11 << 6)
  39. #define MX53_USB_CTRL_1_H3_XCVR_CLK_SEL_ULPI BIT(6)
  40. #define MX53_USB_UH2_CTRL_OFFSET 0x14
  41. #define MX53_USB_UH3_CTRL_OFFSET 0x18
  42. #define MX53_USB_CLKONOFF_CTRL_OFFSET 0x24
  43. #define MX53_USB_CLKONOFF_CTRL_H2_INT60CKOFF BIT(21)
  44. #define MX53_USB_CLKONOFF_CTRL_H3_INT60CKOFF BIT(22)
  45. #define MX53_BM_OVER_CUR_DIS_H1 BIT(5)
  46. #define MX53_BM_OVER_CUR_DIS_OTG BIT(8)
  47. #define MX53_BM_OVER_CUR_DIS_UHx BIT(30)
  48. #define MX53_USB_CTRL_1_UH2_ULPI_EN BIT(26)
  49. #define MX53_USB_CTRL_1_UH3_ULPI_EN BIT(27)
  50. #define MX53_USB_UHx_CTRL_WAKE_UP_EN BIT(7)
  51. #define MX53_USB_UHx_CTRL_ULPI_INT_EN BIT(8)
  52. #define MX53_USB_PHYCTRL1_PLLDIV_MASK 0x3
  53. #define MX53_USB_PLL_DIV_24_MHZ 0x01
  54. #define MX6_BM_NON_BURST_SETTING BIT(1)
  55. #define MX6_BM_OVER_CUR_DIS BIT(7)
  56. #define MX6_BM_OVER_CUR_POLARITY BIT(8)
  57. #define MX6_BM_WAKEUP_ENABLE BIT(10)
  58. #define MX6_BM_ID_WAKEUP BIT(16)
  59. #define MX6_BM_VBUS_WAKEUP BIT(17)
  60. #define MX6SX_BM_DPDM_WAKEUP_EN BIT(29)
  61. #define MX6_BM_WAKEUP_INTR BIT(31)
  62. #define MX6_USB_OTG1_PHY_CTRL 0x18
  63. /* For imx6dql, it is host-only controller, for later imx6, it is otg's */
  64. #define MX6_USB_OTG2_PHY_CTRL 0x1c
  65. #define MX6SX_USB_VBUS_WAKEUP_SOURCE(v) (v << 8)
  66. #define MX6SX_USB_VBUS_WAKEUP_SOURCE_VBUS MX6SX_USB_VBUS_WAKEUP_SOURCE(0)
  67. #define MX6SX_USB_VBUS_WAKEUP_SOURCE_AVALID MX6SX_USB_VBUS_WAKEUP_SOURCE(1)
  68. #define MX6SX_USB_VBUS_WAKEUP_SOURCE_BVALID MX6SX_USB_VBUS_WAKEUP_SOURCE(2)
  69. #define MX6SX_USB_VBUS_WAKEUP_SOURCE_SESS_END MX6SX_USB_VBUS_WAKEUP_SOURCE(3)
  70. #define VF610_OVER_CUR_DIS BIT(7)
  71. #define MX7D_USBNC_USB_CTRL2 0x4
  72. #define MX7D_USB_VBUS_WAKEUP_SOURCE_MASK 0x3
  73. #define MX7D_USB_VBUS_WAKEUP_SOURCE(v) (v << 0)
  74. #define MX7D_USB_VBUS_WAKEUP_SOURCE_VBUS MX7D_USB_VBUS_WAKEUP_SOURCE(0)
  75. #define MX7D_USB_VBUS_WAKEUP_SOURCE_AVALID MX7D_USB_VBUS_WAKEUP_SOURCE(1)
  76. #define MX7D_USB_VBUS_WAKEUP_SOURCE_BVALID MX7D_USB_VBUS_WAKEUP_SOURCE(2)
  77. #define MX7D_USB_VBUS_WAKEUP_SOURCE_SESS_END MX7D_USB_VBUS_WAKEUP_SOURCE(3)
  78. struct usbmisc_ops {
  79. /* It's called once when probe a usb device */
  80. int (*init)(struct imx_usbmisc_data *data);
  81. /* It's called once after adding a usb device */
  82. int (*post)(struct imx_usbmisc_data *data);
  83. /* It's called when we need to enable/disable usb wakeup */
  84. int (*set_wakeup)(struct imx_usbmisc_data *data, bool enabled);
  85. };
  86. struct imx_usbmisc {
  87. void __iomem *base;
  88. spinlock_t lock;
  89. const struct usbmisc_ops *ops;
  90. };
  91. static inline bool is_imx53_usbmisc(struct imx_usbmisc_data *data);
  92. static int usbmisc_imx25_init(struct imx_usbmisc_data *data)
  93. {
  94. struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
  95. unsigned long flags;
  96. u32 val = 0;
  97. if (data->index > 1)
  98. return -EINVAL;
  99. spin_lock_irqsave(&usbmisc->lock, flags);
  100. switch (data->index) {
  101. case 0:
  102. val = readl(usbmisc->base);
  103. val &= ~(MX25_OTG_SIC_MASK | MX25_OTG_PP_BIT);
  104. val |= (MX25_EHCI_INTERFACE_DIFF_UNI & MX25_EHCI_INTERFACE_MASK) << MX25_OTG_SIC_SHIFT;
  105. val |= (MX25_OTG_PM_BIT | MX25_OTG_OCPOL_BIT);
  106. writel(val, usbmisc->base);
  107. break;
  108. case 1:
  109. val = readl(usbmisc->base);
  110. val &= ~(MX25_H1_SIC_MASK | MX25_H1_PP_BIT | MX25_H1_IPPUE_UP_BIT);
  111. val |= (MX25_EHCI_INTERFACE_SINGLE_UNI & MX25_EHCI_INTERFACE_MASK) << MX25_H1_SIC_SHIFT;
  112. val |= (MX25_H1_PM_BIT | MX25_H1_OCPOL_BIT | MX25_H1_TLL_BIT |
  113. MX25_H1_USBTE_BIT | MX25_H1_IPPUE_DOWN_BIT);
  114. writel(val, usbmisc->base);
  115. break;
  116. }
  117. spin_unlock_irqrestore(&usbmisc->lock, flags);
  118. return 0;
  119. }
  120. static int usbmisc_imx25_post(struct imx_usbmisc_data *data)
  121. {
  122. struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
  123. void __iomem *reg;
  124. unsigned long flags;
  125. u32 val;
  126. if (data->index > 2)
  127. return -EINVAL;
  128. if (data->index)
  129. return 0;
  130. spin_lock_irqsave(&usbmisc->lock, flags);
  131. reg = usbmisc->base + MX25_USB_PHY_CTRL_OFFSET;
  132. val = readl(reg);
  133. if (data->evdo)
  134. val |= MX25_BM_EXTERNAL_VBUS_DIVIDER;
  135. else
  136. val &= ~MX25_BM_EXTERNAL_VBUS_DIVIDER;
  137. writel(val, reg);
  138. spin_unlock_irqrestore(&usbmisc->lock, flags);
  139. usleep_range(5000, 10000); /* needed to stabilize voltage */
  140. return 0;
  141. }
  142. static int usbmisc_imx27_init(struct imx_usbmisc_data *data)
  143. {
  144. struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
  145. unsigned long flags;
  146. u32 val;
  147. switch (data->index) {
  148. case 0:
  149. val = MX27_OTG_PM_BIT;
  150. break;
  151. case 1:
  152. val = MX27_H1_PM_BIT;
  153. break;
  154. case 2:
  155. val = MX27_H2_PM_BIT;
  156. break;
  157. default:
  158. return -EINVAL;
  159. }
  160. spin_lock_irqsave(&usbmisc->lock, flags);
  161. if (data->disable_oc)
  162. val = readl(usbmisc->base) | val;
  163. else
  164. val = readl(usbmisc->base) & ~val;
  165. writel(val, usbmisc->base);
  166. spin_unlock_irqrestore(&usbmisc->lock, flags);
  167. return 0;
  168. }
  169. static int usbmisc_imx53_init(struct imx_usbmisc_data *data)
  170. {
  171. struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
  172. void __iomem *reg = NULL;
  173. unsigned long flags;
  174. u32 val = 0;
  175. if (data->index > 3)
  176. return -EINVAL;
  177. /* Select a 24 MHz reference clock for the PHY */
  178. val = readl(usbmisc->base + MX53_USB_OTG_PHY_CTRL_1_OFFSET);
  179. val &= ~MX53_USB_PHYCTRL1_PLLDIV_MASK;
  180. val |= MX53_USB_PLL_DIV_24_MHZ;
  181. writel(val, usbmisc->base + MX53_USB_OTG_PHY_CTRL_1_OFFSET);
  182. spin_lock_irqsave(&usbmisc->lock, flags);
  183. switch (data->index) {
  184. case 0:
  185. if (data->disable_oc) {
  186. reg = usbmisc->base + MX53_USB_OTG_PHY_CTRL_0_OFFSET;
  187. val = readl(reg) | MX53_BM_OVER_CUR_DIS_OTG;
  188. writel(val, reg);
  189. }
  190. break;
  191. case 1:
  192. if (data->disable_oc) {
  193. reg = usbmisc->base + MX53_USB_OTG_PHY_CTRL_0_OFFSET;
  194. val = readl(reg) | MX53_BM_OVER_CUR_DIS_H1;
  195. writel(val, reg);
  196. }
  197. break;
  198. case 2:
  199. if (data->ulpi) {
  200. /* set USBH2 into ULPI-mode. */
  201. reg = usbmisc->base + MX53_USB_CTRL_1_OFFSET;
  202. val = readl(reg) | MX53_USB_CTRL_1_UH2_ULPI_EN;
  203. /* select ULPI clock */
  204. val &= ~MX53_USB_CTRL_1_H2_XCVR_CLK_SEL_MASK;
  205. val |= MX53_USB_CTRL_1_H2_XCVR_CLK_SEL_ULPI;
  206. writel(val, reg);
  207. /* Set interrupt wake up enable */
  208. reg = usbmisc->base + MX53_USB_UH2_CTRL_OFFSET;
  209. val = readl(reg) | MX53_USB_UHx_CTRL_WAKE_UP_EN
  210. | MX53_USB_UHx_CTRL_ULPI_INT_EN;
  211. writel(val, reg);
  212. if (is_imx53_usbmisc(data)) {
  213. /* Disable internal 60Mhz clock */
  214. reg = usbmisc->base +
  215. MX53_USB_CLKONOFF_CTRL_OFFSET;
  216. val = readl(reg) |
  217. MX53_USB_CLKONOFF_CTRL_H2_INT60CKOFF;
  218. writel(val, reg);
  219. }
  220. }
  221. if (data->disable_oc) {
  222. reg = usbmisc->base + MX53_USB_UH2_CTRL_OFFSET;
  223. val = readl(reg) | MX53_BM_OVER_CUR_DIS_UHx;
  224. writel(val, reg);
  225. }
  226. break;
  227. case 3:
  228. if (data->ulpi) {
  229. /* set USBH3 into ULPI-mode. */
  230. reg = usbmisc->base + MX53_USB_CTRL_1_OFFSET;
  231. val = readl(reg) | MX53_USB_CTRL_1_UH3_ULPI_EN;
  232. /* select ULPI clock */
  233. val &= ~MX53_USB_CTRL_1_H3_XCVR_CLK_SEL_MASK;
  234. val |= MX53_USB_CTRL_1_H3_XCVR_CLK_SEL_ULPI;
  235. writel(val, reg);
  236. /* Set interrupt wake up enable */
  237. reg = usbmisc->base + MX53_USB_UH3_CTRL_OFFSET;
  238. val = readl(reg) | MX53_USB_UHx_CTRL_WAKE_UP_EN
  239. | MX53_USB_UHx_CTRL_ULPI_INT_EN;
  240. writel(val, reg);
  241. if (is_imx53_usbmisc(data)) {
  242. /* Disable internal 60Mhz clock */
  243. reg = usbmisc->base +
  244. MX53_USB_CLKONOFF_CTRL_OFFSET;
  245. val = readl(reg) |
  246. MX53_USB_CLKONOFF_CTRL_H3_INT60CKOFF;
  247. writel(val, reg);
  248. }
  249. }
  250. if (data->disable_oc) {
  251. reg = usbmisc->base + MX53_USB_UH3_CTRL_OFFSET;
  252. val = readl(reg) | MX53_BM_OVER_CUR_DIS_UHx;
  253. writel(val, reg);
  254. }
  255. break;
  256. }
  257. spin_unlock_irqrestore(&usbmisc->lock, flags);
  258. return 0;
  259. }
  260. static int usbmisc_imx6q_set_wakeup
  261. (struct imx_usbmisc_data *data, bool enabled)
  262. {
  263. struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
  264. unsigned long flags;
  265. u32 val;
  266. u32 wakeup_setting = (MX6_BM_WAKEUP_ENABLE |
  267. MX6_BM_VBUS_WAKEUP | MX6_BM_ID_WAKEUP);
  268. int ret = 0;
  269. if (data->index > 3)
  270. return -EINVAL;
  271. spin_lock_irqsave(&usbmisc->lock, flags);
  272. val = readl(usbmisc->base + data->index * 4);
  273. if (enabled) {
  274. val |= wakeup_setting;
  275. } else {
  276. if (val & MX6_BM_WAKEUP_INTR)
  277. pr_debug("wakeup int at ci_hdrc.%d\n", data->index);
  278. val &= ~wakeup_setting;
  279. }
  280. writel(val, usbmisc->base + data->index * 4);
  281. spin_unlock_irqrestore(&usbmisc->lock, flags);
  282. return ret;
  283. }
  284. static int usbmisc_imx6q_init(struct imx_usbmisc_data *data)
  285. {
  286. struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
  287. unsigned long flags;
  288. u32 reg;
  289. if (data->index > 3)
  290. return -EINVAL;
  291. spin_lock_irqsave(&usbmisc->lock, flags);
  292. reg = readl(usbmisc->base + data->index * 4);
  293. if (data->disable_oc) {
  294. reg |= MX6_BM_OVER_CUR_DIS;
  295. } else if (data->oc_polarity == 1) {
  296. /* High active */
  297. reg &= ~(MX6_BM_OVER_CUR_DIS | MX6_BM_OVER_CUR_POLARITY);
  298. }
  299. writel(reg, usbmisc->base + data->index * 4);
  300. /* SoC non-burst setting */
  301. reg = readl(usbmisc->base + data->index * 4);
  302. writel(reg | MX6_BM_NON_BURST_SETTING,
  303. usbmisc->base + data->index * 4);
  304. spin_unlock_irqrestore(&usbmisc->lock, flags);
  305. usbmisc_imx6q_set_wakeup(data, false);
  306. return 0;
  307. }
  308. static int usbmisc_imx6sx_init(struct imx_usbmisc_data *data)
  309. {
  310. void __iomem *reg = NULL;
  311. unsigned long flags;
  312. struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
  313. u32 val;
  314. usbmisc_imx6q_init(data);
  315. if (data->index == 0 || data->index == 1) {
  316. reg = usbmisc->base + MX6_USB_OTG1_PHY_CTRL + data->index * 4;
  317. spin_lock_irqsave(&usbmisc->lock, flags);
  318. /* Set vbus wakeup source as bvalid */
  319. val = readl(reg);
  320. writel(val | MX6SX_USB_VBUS_WAKEUP_SOURCE_BVALID, reg);
  321. /*
  322. * Disable dp/dm wakeup in device mode when vbus is
  323. * not there.
  324. */
  325. val = readl(usbmisc->base + data->index * 4);
  326. writel(val & ~MX6SX_BM_DPDM_WAKEUP_EN,
  327. usbmisc->base + data->index * 4);
  328. spin_unlock_irqrestore(&usbmisc->lock, flags);
  329. }
  330. return 0;
  331. }
  332. static int usbmisc_vf610_init(struct imx_usbmisc_data *data)
  333. {
  334. struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
  335. u32 reg;
  336. /*
  337. * Vybrid only has one misc register set, but in two different
  338. * areas. These is reflected in two instances of this driver.
  339. */
  340. if (data->index >= 1)
  341. return -EINVAL;
  342. if (data->disable_oc) {
  343. reg = readl(usbmisc->base);
  344. writel(reg | VF610_OVER_CUR_DIS, usbmisc->base);
  345. }
  346. return 0;
  347. }
  348. static int usbmisc_imx7d_set_wakeup
  349. (struct imx_usbmisc_data *data, bool enabled)
  350. {
  351. struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
  352. unsigned long flags;
  353. u32 val;
  354. u32 wakeup_setting = (MX6_BM_WAKEUP_ENABLE |
  355. MX6_BM_VBUS_WAKEUP | MX6_BM_ID_WAKEUP);
  356. spin_lock_irqsave(&usbmisc->lock, flags);
  357. val = readl(usbmisc->base);
  358. if (enabled) {
  359. writel(val | wakeup_setting, usbmisc->base);
  360. } else {
  361. if (val & MX6_BM_WAKEUP_INTR)
  362. dev_dbg(data->dev, "wakeup int\n");
  363. writel(val & ~wakeup_setting, usbmisc->base);
  364. }
  365. spin_unlock_irqrestore(&usbmisc->lock, flags);
  366. return 0;
  367. }
  368. static int usbmisc_imx7d_init(struct imx_usbmisc_data *data)
  369. {
  370. struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
  371. unsigned long flags;
  372. u32 reg;
  373. if (data->index >= 1)
  374. return -EINVAL;
  375. spin_lock_irqsave(&usbmisc->lock, flags);
  376. reg = readl(usbmisc->base);
  377. if (data->disable_oc) {
  378. reg |= MX6_BM_OVER_CUR_DIS;
  379. } else if (data->oc_polarity == 1) {
  380. /* High active */
  381. reg &= ~(MX6_BM_OVER_CUR_DIS | MX6_BM_OVER_CUR_POLARITY);
  382. }
  383. writel(reg, usbmisc->base);
  384. reg = readl(usbmisc->base + MX7D_USBNC_USB_CTRL2);
  385. reg &= ~MX7D_USB_VBUS_WAKEUP_SOURCE_MASK;
  386. writel(reg | MX7D_USB_VBUS_WAKEUP_SOURCE_BVALID,
  387. usbmisc->base + MX7D_USBNC_USB_CTRL2);
  388. spin_unlock_irqrestore(&usbmisc->lock, flags);
  389. usbmisc_imx7d_set_wakeup(data, false);
  390. return 0;
  391. }
  392. static const struct usbmisc_ops imx25_usbmisc_ops = {
  393. .init = usbmisc_imx25_init,
  394. .post = usbmisc_imx25_post,
  395. };
  396. static const struct usbmisc_ops imx27_usbmisc_ops = {
  397. .init = usbmisc_imx27_init,
  398. };
  399. static const struct usbmisc_ops imx51_usbmisc_ops = {
  400. .init = usbmisc_imx53_init,
  401. };
  402. static const struct usbmisc_ops imx53_usbmisc_ops = {
  403. .init = usbmisc_imx53_init,
  404. };
  405. static const struct usbmisc_ops imx6q_usbmisc_ops = {
  406. .set_wakeup = usbmisc_imx6q_set_wakeup,
  407. .init = usbmisc_imx6q_init,
  408. };
  409. static const struct usbmisc_ops vf610_usbmisc_ops = {
  410. .init = usbmisc_vf610_init,
  411. };
  412. static const struct usbmisc_ops imx6sx_usbmisc_ops = {
  413. .set_wakeup = usbmisc_imx6q_set_wakeup,
  414. .init = usbmisc_imx6sx_init,
  415. };
  416. static const struct usbmisc_ops imx7d_usbmisc_ops = {
  417. .init = usbmisc_imx7d_init,
  418. .set_wakeup = usbmisc_imx7d_set_wakeup,
  419. };
  420. static inline bool is_imx53_usbmisc(struct imx_usbmisc_data *data)
  421. {
  422. struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
  423. return usbmisc->ops == &imx53_usbmisc_ops;
  424. }
  425. int imx_usbmisc_init(struct imx_usbmisc_data *data)
  426. {
  427. struct imx_usbmisc *usbmisc;
  428. if (!data)
  429. return 0;
  430. usbmisc = dev_get_drvdata(data->dev);
  431. if (!usbmisc->ops->init)
  432. return 0;
  433. return usbmisc->ops->init(data);
  434. }
  435. EXPORT_SYMBOL_GPL(imx_usbmisc_init);
  436. int imx_usbmisc_init_post(struct imx_usbmisc_data *data)
  437. {
  438. struct imx_usbmisc *usbmisc;
  439. if (!data)
  440. return 0;
  441. usbmisc = dev_get_drvdata(data->dev);
  442. if (!usbmisc->ops->post)
  443. return 0;
  444. return usbmisc->ops->post(data);
  445. }
  446. EXPORT_SYMBOL_GPL(imx_usbmisc_init_post);
  447. int imx_usbmisc_set_wakeup(struct imx_usbmisc_data *data, bool enabled)
  448. {
  449. struct imx_usbmisc *usbmisc;
  450. if (!data)
  451. return 0;
  452. usbmisc = dev_get_drvdata(data->dev);
  453. if (!usbmisc->ops->set_wakeup)
  454. return 0;
  455. return usbmisc->ops->set_wakeup(data, enabled);
  456. }
  457. EXPORT_SYMBOL_GPL(imx_usbmisc_set_wakeup);
  458. static const struct of_device_id usbmisc_imx_dt_ids[] = {
  459. {
  460. .compatible = "fsl,imx25-usbmisc",
  461. .data = &imx25_usbmisc_ops,
  462. },
  463. {
  464. .compatible = "fsl,imx35-usbmisc",
  465. .data = &imx25_usbmisc_ops,
  466. },
  467. {
  468. .compatible = "fsl,imx27-usbmisc",
  469. .data = &imx27_usbmisc_ops,
  470. },
  471. {
  472. .compatible = "fsl,imx51-usbmisc",
  473. .data = &imx51_usbmisc_ops,
  474. },
  475. {
  476. .compatible = "fsl,imx53-usbmisc",
  477. .data = &imx53_usbmisc_ops,
  478. },
  479. {
  480. .compatible = "fsl,imx6q-usbmisc",
  481. .data = &imx6q_usbmisc_ops,
  482. },
  483. {
  484. .compatible = "fsl,vf610-usbmisc",
  485. .data = &vf610_usbmisc_ops,
  486. },
  487. {
  488. .compatible = "fsl,imx6sx-usbmisc",
  489. .data = &imx6sx_usbmisc_ops,
  490. },
  491. {
  492. .compatible = "fsl,imx6ul-usbmisc",
  493. .data = &imx6sx_usbmisc_ops,
  494. },
  495. {
  496. .compatible = "fsl,imx7d-usbmisc",
  497. .data = &imx7d_usbmisc_ops,
  498. },
  499. { /* sentinel */ }
  500. };
  501. MODULE_DEVICE_TABLE(of, usbmisc_imx_dt_ids);
  502. static int usbmisc_imx_probe(struct platform_device *pdev)
  503. {
  504. struct resource *res;
  505. struct imx_usbmisc *data;
  506. const struct of_device_id *of_id;
  507. of_id = of_match_device(usbmisc_imx_dt_ids, &pdev->dev);
  508. if (!of_id)
  509. return -ENODEV;
  510. data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
  511. if (!data)
  512. return -ENOMEM;
  513. spin_lock_init(&data->lock);
  514. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  515. data->base = devm_ioremap_resource(&pdev->dev, res);
  516. if (IS_ERR(data->base))
  517. return PTR_ERR(data->base);
  518. data->ops = (const struct usbmisc_ops *)of_id->data;
  519. platform_set_drvdata(pdev, data);
  520. return 0;
  521. }
  522. static int usbmisc_imx_remove(struct platform_device *pdev)
  523. {
  524. return 0;
  525. }
  526. static struct platform_driver usbmisc_imx_driver = {
  527. .probe = usbmisc_imx_probe,
  528. .remove = usbmisc_imx_remove,
  529. .driver = {
  530. .name = "usbmisc_imx",
  531. .of_match_table = usbmisc_imx_dt_ids,
  532. },
  533. };
  534. module_platform_driver(usbmisc_imx_driver);
  535. MODULE_ALIAS("platform:usbmisc-imx");
  536. MODULE_LICENSE("GPL v2");
  537. MODULE_DESCRIPTION("driver for imx usb non-core registers");
  538. MODULE_AUTHOR("Richard Zhao <richard.zhao@freescale.com>");