usb.c 15 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615
  1. /*
  2. * USB block power/access management abstraction.
  3. *
  4. * Au1000+: The OHCI block control register is at the far end of the OHCI memory
  5. * area. Au1550 has OHCI on different base address. No need to handle
  6. * UDC here.
  7. * Au1200: one register to control access and clocks to O/EHCI, UDC and OTG
  8. * as well as the PHY for EHCI and UDC.
  9. *
  10. */
  11. #include <linux/init.h>
  12. #include <linux/io.h>
  13. #include <linux/module.h>
  14. #include <linux/spinlock.h>
  15. #include <linux/syscore_ops.h>
  16. #include <asm/cpu.h>
  17. #include <asm/mach-au1x00/au1000.h>
  18. /* control register offsets */
  19. #define AU1000_OHCICFG 0x7fffc
  20. #define AU1550_OHCICFG 0x07ffc
  21. #define AU1200_USBCFG 0x04
  22. /* Au1000 USB block config bits */
  23. #define USBHEN_RD (1 << 4) /* OHCI reset-done indicator */
  24. #define USBHEN_CE (1 << 3) /* OHCI block clock enable */
  25. #define USBHEN_E (1 << 2) /* OHCI block enable */
  26. #define USBHEN_C (1 << 1) /* OHCI block coherency bit */
  27. #define USBHEN_BE (1 << 0) /* OHCI Big-Endian */
  28. /* Au1200 USB config bits */
  29. #define USBCFG_PFEN (1 << 31) /* prefetch enable (undoc) */
  30. #define USBCFG_RDCOMB (1 << 30) /* read combining (undoc) */
  31. #define USBCFG_UNKNOWN (5 << 20) /* unknown, leave this way */
  32. #define USBCFG_SSD (1 << 23) /* serial short detect en */
  33. #define USBCFG_PPE (1 << 19) /* HS PHY PLL */
  34. #define USBCFG_UCE (1 << 18) /* UDC clock enable */
  35. #define USBCFG_ECE (1 << 17) /* EHCI clock enable */
  36. #define USBCFG_OCE (1 << 16) /* OHCI clock enable */
  37. #define USBCFG_FLA(x) (((x) & 0x3f) << 8)
  38. #define USBCFG_UCAM (1 << 7) /* coherent access (undoc) */
  39. #define USBCFG_GME (1 << 6) /* OTG mem access */
  40. #define USBCFG_DBE (1 << 5) /* UDC busmaster enable */
  41. #define USBCFG_DME (1 << 4) /* UDC mem enable */
  42. #define USBCFG_EBE (1 << 3) /* EHCI busmaster enable */
  43. #define USBCFG_EME (1 << 2) /* EHCI mem enable */
  44. #define USBCFG_OBE (1 << 1) /* OHCI busmaster enable */
  45. #define USBCFG_OME (1 << 0) /* OHCI mem enable */
  46. #define USBCFG_INIT_AU1200 (USBCFG_PFEN | USBCFG_RDCOMB | USBCFG_UNKNOWN |\
  47. USBCFG_SSD | USBCFG_FLA(0x20) | USBCFG_UCAM | \
  48. USBCFG_GME | USBCFG_DBE | USBCFG_DME | \
  49. USBCFG_EBE | USBCFG_EME | USBCFG_OBE | \
  50. USBCFG_OME)
  51. /* Au1300 USB config registers */
  52. #define USB_DWC_CTRL1 0x00
  53. #define USB_DWC_CTRL2 0x04
  54. #define USB_VBUS_TIMER 0x10
  55. #define USB_SBUS_CTRL 0x14
  56. #define USB_MSR_ERR 0x18
  57. #define USB_DWC_CTRL3 0x1C
  58. #define USB_DWC_CTRL4 0x20
  59. #define USB_OTG_STATUS 0x28
  60. #define USB_DWC_CTRL5 0x2C
  61. #define USB_DWC_CTRL6 0x30
  62. #define USB_DWC_CTRL7 0x34
  63. #define USB_PHY_STATUS 0xC0
  64. #define USB_INT_STATUS 0xC4
  65. #define USB_INT_ENABLE 0xC8
  66. #define USB_DWC_CTRL1_OTGD 0x04 /* set to DISable OTG */
  67. #define USB_DWC_CTRL1_HSTRS 0x02 /* set to ENable EHCI */
  68. #define USB_DWC_CTRL1_DCRS 0x01 /* set to ENable UDC */
  69. #define USB_DWC_CTRL2_PHY1RS 0x04 /* set to enable PHY1 */
  70. #define USB_DWC_CTRL2_PHY0RS 0x02 /* set to enable PHY0 */
  71. #define USB_DWC_CTRL2_PHYRS 0x01 /* set to enable PHY */
  72. #define USB_DWC_CTRL3_OHCI1_CKEN (1 << 19)
  73. #define USB_DWC_CTRL3_OHCI0_CKEN (1 << 18)
  74. #define USB_DWC_CTRL3_EHCI0_CKEN (1 << 17)
  75. #define USB_DWC_CTRL3_OTG0_CKEN (1 << 16)
  76. #define USB_SBUS_CTRL_SBCA 0x04 /* coherent access */
  77. #define USB_INTEN_FORCE 0x20
  78. #define USB_INTEN_PHY 0x10
  79. #define USB_INTEN_UDC 0x08
  80. #define USB_INTEN_EHCI 0x04
  81. #define USB_INTEN_OHCI1 0x02
  82. #define USB_INTEN_OHCI0 0x01
  83. static DEFINE_SPINLOCK(alchemy_usb_lock);
  84. static inline void __au1300_usb_phyctl(void __iomem *base, int enable)
  85. {
  86. unsigned long r, s;
  87. r = __raw_readl(base + USB_DWC_CTRL2);
  88. s = __raw_readl(base + USB_DWC_CTRL3);
  89. s &= USB_DWC_CTRL3_OHCI1_CKEN | USB_DWC_CTRL3_OHCI0_CKEN |
  90. USB_DWC_CTRL3_EHCI0_CKEN | USB_DWC_CTRL3_OTG0_CKEN;
  91. if (enable) {
  92. /* simply enable all PHYs */
  93. r |= USB_DWC_CTRL2_PHY1RS | USB_DWC_CTRL2_PHY0RS |
  94. USB_DWC_CTRL2_PHYRS;
  95. __raw_writel(r, base + USB_DWC_CTRL2);
  96. wmb();
  97. } else if (!s) {
  98. /* no USB block active, do disable all PHYs */
  99. r &= ~(USB_DWC_CTRL2_PHY1RS | USB_DWC_CTRL2_PHY0RS |
  100. USB_DWC_CTRL2_PHYRS);
  101. __raw_writel(r, base + USB_DWC_CTRL2);
  102. wmb();
  103. }
  104. }
  105. static inline void __au1300_ohci_control(void __iomem *base, int enable, int id)
  106. {
  107. unsigned long r;
  108. if (enable) {
  109. __raw_writel(1, base + USB_DWC_CTRL7); /* start OHCI clock */
  110. wmb();
  111. r = __raw_readl(base + USB_DWC_CTRL3); /* enable OHCI block */
  112. r |= (id == 0) ? USB_DWC_CTRL3_OHCI0_CKEN
  113. : USB_DWC_CTRL3_OHCI1_CKEN;
  114. __raw_writel(r, base + USB_DWC_CTRL3);
  115. wmb();
  116. __au1300_usb_phyctl(base, enable); /* power up the PHYs */
  117. r = __raw_readl(base + USB_INT_ENABLE);
  118. r |= (id == 0) ? USB_INTEN_OHCI0 : USB_INTEN_OHCI1;
  119. __raw_writel(r, base + USB_INT_ENABLE);
  120. wmb();
  121. /* reset the OHCI start clock bit */
  122. __raw_writel(0, base + USB_DWC_CTRL7);
  123. wmb();
  124. } else {
  125. r = __raw_readl(base + USB_INT_ENABLE);
  126. r &= ~((id == 0) ? USB_INTEN_OHCI0 : USB_INTEN_OHCI1);
  127. __raw_writel(r, base + USB_INT_ENABLE);
  128. wmb();
  129. r = __raw_readl(base + USB_DWC_CTRL3);
  130. r &= ~((id == 0) ? USB_DWC_CTRL3_OHCI0_CKEN
  131. : USB_DWC_CTRL3_OHCI1_CKEN);
  132. __raw_writel(r, base + USB_DWC_CTRL3);
  133. wmb();
  134. __au1300_usb_phyctl(base, enable);
  135. }
  136. }
  137. static inline void __au1300_ehci_control(void __iomem *base, int enable)
  138. {
  139. unsigned long r;
  140. if (enable) {
  141. r = __raw_readl(base + USB_DWC_CTRL3);
  142. r |= USB_DWC_CTRL3_EHCI0_CKEN;
  143. __raw_writel(r, base + USB_DWC_CTRL3);
  144. wmb();
  145. r = __raw_readl(base + USB_DWC_CTRL1);
  146. r |= USB_DWC_CTRL1_HSTRS;
  147. __raw_writel(r, base + USB_DWC_CTRL1);
  148. wmb();
  149. __au1300_usb_phyctl(base, enable);
  150. r = __raw_readl(base + USB_INT_ENABLE);
  151. r |= USB_INTEN_EHCI;
  152. __raw_writel(r, base + USB_INT_ENABLE);
  153. wmb();
  154. } else {
  155. r = __raw_readl(base + USB_INT_ENABLE);
  156. r &= ~USB_INTEN_EHCI;
  157. __raw_writel(r, base + USB_INT_ENABLE);
  158. wmb();
  159. r = __raw_readl(base + USB_DWC_CTRL1);
  160. r &= ~USB_DWC_CTRL1_HSTRS;
  161. __raw_writel(r, base + USB_DWC_CTRL1);
  162. wmb();
  163. r = __raw_readl(base + USB_DWC_CTRL3);
  164. r &= ~USB_DWC_CTRL3_EHCI0_CKEN;
  165. __raw_writel(r, base + USB_DWC_CTRL3);
  166. wmb();
  167. __au1300_usb_phyctl(base, enable);
  168. }
  169. }
  170. static inline void __au1300_udc_control(void __iomem *base, int enable)
  171. {
  172. unsigned long r;
  173. if (enable) {
  174. r = __raw_readl(base + USB_DWC_CTRL1);
  175. r |= USB_DWC_CTRL1_DCRS;
  176. __raw_writel(r, base + USB_DWC_CTRL1);
  177. wmb();
  178. __au1300_usb_phyctl(base, enable);
  179. r = __raw_readl(base + USB_INT_ENABLE);
  180. r |= USB_INTEN_UDC;
  181. __raw_writel(r, base + USB_INT_ENABLE);
  182. wmb();
  183. } else {
  184. r = __raw_readl(base + USB_INT_ENABLE);
  185. r &= ~USB_INTEN_UDC;
  186. __raw_writel(r, base + USB_INT_ENABLE);
  187. wmb();
  188. r = __raw_readl(base + USB_DWC_CTRL1);
  189. r &= ~USB_DWC_CTRL1_DCRS;
  190. __raw_writel(r, base + USB_DWC_CTRL1);
  191. wmb();
  192. __au1300_usb_phyctl(base, enable);
  193. }
  194. }
  195. static inline void __au1300_otg_control(void __iomem *base, int enable)
  196. {
  197. unsigned long r;
  198. if (enable) {
  199. r = __raw_readl(base + USB_DWC_CTRL3);
  200. r |= USB_DWC_CTRL3_OTG0_CKEN;
  201. __raw_writel(r, base + USB_DWC_CTRL3);
  202. wmb();
  203. r = __raw_readl(base + USB_DWC_CTRL1);
  204. r &= ~USB_DWC_CTRL1_OTGD;
  205. __raw_writel(r, base + USB_DWC_CTRL1);
  206. wmb();
  207. __au1300_usb_phyctl(base, enable);
  208. } else {
  209. r = __raw_readl(base + USB_DWC_CTRL1);
  210. r |= USB_DWC_CTRL1_OTGD;
  211. __raw_writel(r, base + USB_DWC_CTRL1);
  212. wmb();
  213. r = __raw_readl(base + USB_DWC_CTRL3);
  214. r &= ~USB_DWC_CTRL3_OTG0_CKEN;
  215. __raw_writel(r, base + USB_DWC_CTRL3);
  216. wmb();
  217. __au1300_usb_phyctl(base, enable);
  218. }
  219. }
  220. static inline int au1300_usb_control(int block, int enable)
  221. {
  222. void __iomem *base =
  223. (void __iomem *)KSEG1ADDR(AU1300_USB_CTL_PHYS_ADDR);
  224. int ret = 0;
  225. switch (block) {
  226. case ALCHEMY_USB_OHCI0:
  227. __au1300_ohci_control(base, enable, 0);
  228. break;
  229. case ALCHEMY_USB_OHCI1:
  230. __au1300_ohci_control(base, enable, 1);
  231. break;
  232. case ALCHEMY_USB_EHCI0:
  233. __au1300_ehci_control(base, enable);
  234. break;
  235. case ALCHEMY_USB_UDC0:
  236. __au1300_udc_control(base, enable);
  237. break;
  238. case ALCHEMY_USB_OTG0:
  239. __au1300_otg_control(base, enable);
  240. break;
  241. default:
  242. ret = -ENODEV;
  243. }
  244. return ret;
  245. }
  246. static inline void au1300_usb_init(void)
  247. {
  248. void __iomem *base =
  249. (void __iomem *)KSEG1ADDR(AU1300_USB_CTL_PHYS_ADDR);
  250. /* set some sane defaults. Note: we don't fiddle with DWC_CTRL4
  251. * here at all: Port 2 routing (EHCI or UDC) must be set either
  252. * by boot firmware or platform init code; I can't autodetect
  253. * a sane setting.
  254. */
  255. __raw_writel(0, base + USB_INT_ENABLE); /* disable all USB irqs */
  256. wmb();
  257. __raw_writel(0, base + USB_DWC_CTRL3); /* disable all clocks */
  258. wmb();
  259. __raw_writel(~0, base + USB_MSR_ERR); /* clear all errors */
  260. wmb();
  261. __raw_writel(~0, base + USB_INT_STATUS); /* clear int status */
  262. wmb();
  263. /* set coherent access bit */
  264. __raw_writel(USB_SBUS_CTRL_SBCA, base + USB_SBUS_CTRL);
  265. wmb();
  266. }
  267. static inline void __au1200_ohci_control(void __iomem *base, int enable)
  268. {
  269. unsigned long r = __raw_readl(base + AU1200_USBCFG);
  270. if (enable) {
  271. __raw_writel(r | USBCFG_OCE, base + AU1200_USBCFG);
  272. wmb();
  273. udelay(2000);
  274. } else {
  275. __raw_writel(r & ~USBCFG_OCE, base + AU1200_USBCFG);
  276. wmb();
  277. udelay(1000);
  278. }
  279. }
  280. static inline void __au1200_ehci_control(void __iomem *base, int enable)
  281. {
  282. unsigned long r = __raw_readl(base + AU1200_USBCFG);
  283. if (enable) {
  284. __raw_writel(r | USBCFG_ECE | USBCFG_PPE, base + AU1200_USBCFG);
  285. wmb();
  286. udelay(1000);
  287. } else {
  288. if (!(r & USBCFG_UCE)) /* UDC also off? */
  289. r &= ~USBCFG_PPE; /* yes: disable HS PHY PLL */
  290. __raw_writel(r & ~USBCFG_ECE, base + AU1200_USBCFG);
  291. wmb();
  292. udelay(1000);
  293. }
  294. }
  295. static inline void __au1200_udc_control(void __iomem *base, int enable)
  296. {
  297. unsigned long r = __raw_readl(base + AU1200_USBCFG);
  298. if (enable) {
  299. __raw_writel(r | USBCFG_UCE | USBCFG_PPE, base + AU1200_USBCFG);
  300. wmb();
  301. } else {
  302. if (!(r & USBCFG_ECE)) /* EHCI also off? */
  303. r &= ~USBCFG_PPE; /* yes: disable HS PHY PLL */
  304. __raw_writel(r & ~USBCFG_UCE, base + AU1200_USBCFG);
  305. wmb();
  306. }
  307. }
  308. static inline int au1200_coherency_bug(void)
  309. {
  310. #if defined(CONFIG_DMA_COHERENT)
  311. /* Au1200 AB USB does not support coherent memory */
  312. if (!(read_c0_prid() & PRID_REV_MASK)) {
  313. printk(KERN_INFO "Au1200 USB: this is chip revision AB !!\n");
  314. printk(KERN_INFO "Au1200 USB: update your board or re-configure"
  315. " the kernel\n");
  316. return -ENODEV;
  317. }
  318. #endif
  319. return 0;
  320. }
  321. static inline int au1200_usb_control(int block, int enable)
  322. {
  323. void __iomem *base =
  324. (void __iomem *)KSEG1ADDR(AU1200_USB_CTL_PHYS_ADDR);
  325. int ret = 0;
  326. switch (block) {
  327. case ALCHEMY_USB_OHCI0:
  328. ret = au1200_coherency_bug();
  329. if (ret && enable)
  330. goto out;
  331. __au1200_ohci_control(base, enable);
  332. break;
  333. case ALCHEMY_USB_UDC0:
  334. __au1200_udc_control(base, enable);
  335. break;
  336. case ALCHEMY_USB_EHCI0:
  337. ret = au1200_coherency_bug();
  338. if (ret && enable)
  339. goto out;
  340. __au1200_ehci_control(base, enable);
  341. break;
  342. default:
  343. ret = -ENODEV;
  344. }
  345. out:
  346. return ret;
  347. }
  348. /* initialize USB block(s) to a known working state */
  349. static inline void au1200_usb_init(void)
  350. {
  351. void __iomem *base =
  352. (void __iomem *)KSEG1ADDR(AU1200_USB_CTL_PHYS_ADDR);
  353. __raw_writel(USBCFG_INIT_AU1200, base + AU1200_USBCFG);
  354. wmb();
  355. udelay(1000);
  356. }
  357. static inline void au1000_usb_init(unsigned long rb, int reg)
  358. {
  359. void __iomem *base = (void __iomem *)KSEG1ADDR(rb + reg);
  360. unsigned long r = __raw_readl(base);
  361. #if defined(__BIG_ENDIAN)
  362. r |= USBHEN_BE;
  363. #endif
  364. r |= USBHEN_C;
  365. __raw_writel(r, base);
  366. wmb();
  367. udelay(1000);
  368. }
  369. static inline void __au1xx0_ohci_control(int enable, unsigned long rb, int creg)
  370. {
  371. void __iomem *base = (void __iomem *)KSEG1ADDR(rb);
  372. unsigned long r = __raw_readl(base + creg);
  373. if (enable) {
  374. __raw_writel(r | USBHEN_CE, base + creg);
  375. wmb();
  376. udelay(1000);
  377. __raw_writel(r | USBHEN_CE | USBHEN_E, base + creg);
  378. wmb();
  379. udelay(1000);
  380. /* wait for reset complete (read reg twice: au1500 erratum) */
  381. while (__raw_readl(base + creg),
  382. !(__raw_readl(base + creg) & USBHEN_RD))
  383. udelay(1000);
  384. } else {
  385. __raw_writel(r & ~(USBHEN_CE | USBHEN_E), base + creg);
  386. wmb();
  387. }
  388. }
  389. static inline int au1000_usb_control(int block, int enable, unsigned long rb,
  390. int creg)
  391. {
  392. int ret = 0;
  393. switch (block) {
  394. case ALCHEMY_USB_OHCI0:
  395. __au1xx0_ohci_control(enable, rb, creg);
  396. break;
  397. default:
  398. ret = -ENODEV;
  399. }
  400. return ret;
  401. }
  402. /*
  403. * alchemy_usb_control - control Alchemy on-chip USB blocks
  404. * @block: USB block to target
  405. * @enable: set 1 to enable a block, 0 to disable
  406. */
  407. int alchemy_usb_control(int block, int enable)
  408. {
  409. unsigned long flags;
  410. int ret;
  411. spin_lock_irqsave(&alchemy_usb_lock, flags);
  412. switch (alchemy_get_cputype()) {
  413. case ALCHEMY_CPU_AU1000:
  414. case ALCHEMY_CPU_AU1500:
  415. case ALCHEMY_CPU_AU1100:
  416. ret = au1000_usb_control(block, enable,
  417. AU1000_USB_OHCI_PHYS_ADDR, AU1000_OHCICFG);
  418. break;
  419. case ALCHEMY_CPU_AU1550:
  420. ret = au1000_usb_control(block, enable,
  421. AU1550_USB_OHCI_PHYS_ADDR, AU1550_OHCICFG);
  422. break;
  423. case ALCHEMY_CPU_AU1200:
  424. ret = au1200_usb_control(block, enable);
  425. break;
  426. case ALCHEMY_CPU_AU1300:
  427. ret = au1300_usb_control(block, enable);
  428. break;
  429. default:
  430. ret = -ENODEV;
  431. }
  432. spin_unlock_irqrestore(&alchemy_usb_lock, flags);
  433. return ret;
  434. }
  435. EXPORT_SYMBOL_GPL(alchemy_usb_control);
  436. static unsigned long alchemy_usb_pmdata[2];
  437. static void au1000_usb_pm(unsigned long br, int creg, int susp)
  438. {
  439. void __iomem *base = (void __iomem *)KSEG1ADDR(br);
  440. if (susp) {
  441. alchemy_usb_pmdata[0] = __raw_readl(base + creg);
  442. /* There appears to be some undocumented reset register.... */
  443. __raw_writel(0, base + 0x04);
  444. wmb();
  445. __raw_writel(0, base + creg);
  446. wmb();
  447. } else {
  448. __raw_writel(alchemy_usb_pmdata[0], base + creg);
  449. wmb();
  450. }
  451. }
  452. static void au1200_usb_pm(int susp)
  453. {
  454. void __iomem *base =
  455. (void __iomem *)KSEG1ADDR(AU1200_USB_OTG_PHYS_ADDR);
  456. if (susp) {
  457. /* save OTG_CAP/MUX registers which indicate port routing */
  458. /* FIXME: write an OTG driver to do that */
  459. alchemy_usb_pmdata[0] = __raw_readl(base + 0x00);
  460. alchemy_usb_pmdata[1] = __raw_readl(base + 0x04);
  461. } else {
  462. /* restore access to all MMIO areas */
  463. au1200_usb_init();
  464. /* restore OTG_CAP/MUX registers */
  465. __raw_writel(alchemy_usb_pmdata[0], base + 0x00);
  466. __raw_writel(alchemy_usb_pmdata[1], base + 0x04);
  467. wmb();
  468. }
  469. }
  470. static void au1300_usb_pm(int susp)
  471. {
  472. void __iomem *base =
  473. (void __iomem *)KSEG1ADDR(AU1300_USB_CTL_PHYS_ADDR);
  474. /* remember Port2 routing */
  475. if (susp) {
  476. alchemy_usb_pmdata[0] = __raw_readl(base + USB_DWC_CTRL4);
  477. } else {
  478. au1300_usb_init();
  479. __raw_writel(alchemy_usb_pmdata[0], base + USB_DWC_CTRL4);
  480. wmb();
  481. }
  482. }
  483. static void alchemy_usb_pm(int susp)
  484. {
  485. switch (alchemy_get_cputype()) {
  486. case ALCHEMY_CPU_AU1000:
  487. case ALCHEMY_CPU_AU1500:
  488. case ALCHEMY_CPU_AU1100:
  489. au1000_usb_pm(AU1000_USB_OHCI_PHYS_ADDR, AU1000_OHCICFG, susp);
  490. break;
  491. case ALCHEMY_CPU_AU1550:
  492. au1000_usb_pm(AU1550_USB_OHCI_PHYS_ADDR, AU1550_OHCICFG, susp);
  493. break;
  494. case ALCHEMY_CPU_AU1200:
  495. au1200_usb_pm(susp);
  496. break;
  497. case ALCHEMY_CPU_AU1300:
  498. au1300_usb_pm(susp);
  499. break;
  500. }
  501. }
  502. static int alchemy_usb_suspend(void)
  503. {
  504. alchemy_usb_pm(1);
  505. return 0;
  506. }
  507. static void alchemy_usb_resume(void)
  508. {
  509. alchemy_usb_pm(0);
  510. }
  511. static struct syscore_ops alchemy_usb_pm_ops = {
  512. .suspend = alchemy_usb_suspend,
  513. .resume = alchemy_usb_resume,
  514. };
  515. static int __init alchemy_usb_init(void)
  516. {
  517. switch (alchemy_get_cputype()) {
  518. case ALCHEMY_CPU_AU1000:
  519. case ALCHEMY_CPU_AU1500:
  520. case ALCHEMY_CPU_AU1100:
  521. au1000_usb_init(AU1000_USB_OHCI_PHYS_ADDR, AU1000_OHCICFG);
  522. break;
  523. case ALCHEMY_CPU_AU1550:
  524. au1000_usb_init(AU1550_USB_OHCI_PHYS_ADDR, AU1550_OHCICFG);
  525. break;
  526. case ALCHEMY_CPU_AU1200:
  527. au1200_usb_init();
  528. break;
  529. case ALCHEMY_CPU_AU1300:
  530. au1300_usb_init();
  531. break;
  532. }
  533. register_syscore_ops(&alchemy_usb_pm_ops);
  534. return 0;
  535. }
  536. arch_initcall(alchemy_usb_init);