m8xx_pcmcia.c 32 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338
  1. /*
  2. * m8xx_pcmcia.c - Linux PCMCIA socket driver for the mpc8xx series.
  3. *
  4. * (C) 1999-2000 Magnus Damm <damm@bitsmart.com>
  5. * (C) 2001-2002 Montavista Software, Inc.
  6. * <mlocke@mvista.com>
  7. *
  8. * Support for two slots by Cyclades Corporation
  9. * <oliver.kurth@cyclades.de>
  10. * Further fixes, v2.6 kernel port
  11. * <marcelo.tosatti@cyclades.com>
  12. *
  13. * Some fixes, additions (C) 2005-2007 Montavista Software, Inc.
  14. * <vbordug@ru.mvista.com>
  15. *
  16. * "The ExCA standard specifies that socket controllers should provide
  17. * two IO and five memory windows per socket, which can be independently
  18. * configured and positioned in the host address space and mapped to
  19. * arbitrary segments of card address space. " - David A Hinds. 1999
  20. *
  21. * This controller does _not_ meet the ExCA standard.
  22. *
  23. * m8xx pcmcia controller brief info:
  24. * + 8 windows (attrib, mem, i/o)
  25. * + up to two slots (SLOT_A and SLOT_B)
  26. * + inputpins, outputpins, event and mask registers.
  27. * - no offset register. sigh.
  28. *
  29. * Because of the lacking offset register we must map the whole card.
  30. * We assign each memory window PCMCIA_MEM_WIN_SIZE address space.
  31. * Make sure there is (PCMCIA_MEM_WIN_SIZE * PCMCIA_MEM_WIN_NO
  32. * * PCMCIA_SOCKETS_NO) bytes at PCMCIA_MEM_WIN_BASE.
  33. * The i/o windows are dynamically allocated at PCMCIA_IO_WIN_BASE.
  34. * They are maximum 64KByte each...
  35. */
  36. #include <linux/module.h>
  37. #include <linux/init.h>
  38. #include <linux/types.h>
  39. #include <linux/fcntl.h>
  40. #include <linux/string.h>
  41. #include <linux/kernel.h>
  42. #include <linux/errno.h>
  43. #include <linux/slab.h>
  44. #include <linux/timer.h>
  45. #include <linux/ioport.h>
  46. #include <linux/delay.h>
  47. #include <linux/interrupt.h>
  48. #include <linux/fsl_devices.h>
  49. #include <linux/bitops.h>
  50. #include <asm/io.h>
  51. #include <asm/system.h>
  52. #include <asm/time.h>
  53. #include <asm/mpc8xx.h>
  54. #include <asm/8xx_immap.h>
  55. #include <asm/irq.h>
  56. #include <asm/fs_pd.h>
  57. #include <asm/of_device.h>
  58. #include <asm/of_platform.h>
  59. #include <pcmcia/version.h>
  60. #include <pcmcia/cs_types.h>
  61. #include <pcmcia/cs.h>
  62. #include <pcmcia/ss.h>
  63. #ifdef PCMCIA_DEBUG
  64. static int pc_debug = PCMCIA_DEBUG;
  65. module_param(pc_debug, int, 0);
  66. #define dprintk(args...) printk(KERN_DEBUG "m8xx_pcmcia: " args);
  67. #else
  68. #define dprintk(args...)
  69. #endif
  70. #define pcmcia_info(args...) printk(KERN_INFO "m8xx_pcmcia: "args)
  71. #define pcmcia_error(args...) printk(KERN_ERR "m8xx_pcmcia: "args)
  72. static const char *version = "Version 0.06, Aug 2005";
  73. MODULE_LICENSE("Dual MPL/GPL");
  74. #if !defined(CONFIG_PCMCIA_SLOT_A) && !defined(CONFIG_PCMCIA_SLOT_B)
  75. /* The RPX series use SLOT_B */
  76. #if defined(CONFIG_RPXCLASSIC) || defined(CONFIG_RPXLITE)
  77. #define CONFIG_PCMCIA_SLOT_B
  78. #define CONFIG_BD_IS_MHZ
  79. #endif
  80. /* The ADS board use SLOT_A */
  81. #ifdef CONFIG_ADS
  82. #define CONFIG_PCMCIA_SLOT_A
  83. #define CONFIG_BD_IS_MHZ
  84. #endif
  85. /* The FADS series are a mess */
  86. #ifdef CONFIG_FADS
  87. #if defined(CONFIG_MPC860T) || defined(CONFIG_MPC860) || defined(CONFIG_MPC821)
  88. #define CONFIG_PCMCIA_SLOT_A
  89. #else
  90. #define CONFIG_PCMCIA_SLOT_B
  91. #endif
  92. #endif
  93. #if defined(CONFIG_MPC885ADS)
  94. #define CONFIG_PCMCIA_SLOT_A
  95. #define PCMCIA_GLITCHY_CD
  96. #endif
  97. /* Cyclades ACS uses both slots */
  98. #ifdef CONFIG_PRxK
  99. #define CONFIG_PCMCIA_SLOT_A
  100. #define CONFIG_PCMCIA_SLOT_B
  101. #endif
  102. #endif /* !defined(CONFIG_PCMCIA_SLOT_A) && !defined(CONFIG_PCMCIA_SLOT_B) */
  103. #if defined(CONFIG_PCMCIA_SLOT_A) && defined(CONFIG_PCMCIA_SLOT_B)
  104. #define PCMCIA_SOCKETS_NO 2
  105. /* We have only 8 windows, dualsocket support will be limited. */
  106. #define PCMCIA_MEM_WIN_NO 2
  107. #define PCMCIA_IO_WIN_NO 2
  108. #define PCMCIA_SLOT_MSG "SLOT_A and SLOT_B"
  109. #elif defined(CONFIG_PCMCIA_SLOT_A) || defined(CONFIG_PCMCIA_SLOT_B)
  110. #define PCMCIA_SOCKETS_NO 1
  111. /* full support for one slot */
  112. #define PCMCIA_MEM_WIN_NO 5
  113. #define PCMCIA_IO_WIN_NO 2
  114. /* define _slot_ to be able to optimize macros */
  115. #ifdef CONFIG_PCMCIA_SLOT_A
  116. #define _slot_ 0
  117. #define PCMCIA_SLOT_MSG "SLOT_A"
  118. #else
  119. #define _slot_ 1
  120. #define PCMCIA_SLOT_MSG "SLOT_B"
  121. #endif
  122. #else
  123. #error m8xx_pcmcia: Bad configuration!
  124. #endif
  125. /* ------------------------------------------------------------------------- */
  126. #define PCMCIA_MEM_WIN_BASE 0xe0000000 /* base address for memory window 0 */
  127. #define PCMCIA_MEM_WIN_SIZE 0x04000000 /* each memory window is 64 MByte */
  128. #define PCMCIA_IO_WIN_BASE _IO_BASE /* base address for io window 0 */
  129. /* ------------------------------------------------------------------------- */
  130. static int pcmcia_schlvl;
  131. static DEFINE_SPINLOCK(events_lock);
  132. #define PCMCIA_SOCKET_KEY_5V 1
  133. #define PCMCIA_SOCKET_KEY_LV 2
  134. /* look up table for pgcrx registers */
  135. static u32 *m8xx_pgcrx[2];
  136. /*
  137. * This structure is used to address each window in the PCMCIA controller.
  138. *
  139. * Keep in mind that we assume that pcmcia_win[n+1] is mapped directly
  140. * after pcmcia_win[n]...
  141. */
  142. struct pcmcia_win {
  143. u32 br;
  144. u32 or;
  145. };
  146. /*
  147. * For some reason the hardware guys decided to make both slots share
  148. * some registers.
  149. *
  150. * Could someone invent object oriented hardware ?
  151. *
  152. * The macros are used to get the right bit from the registers.
  153. * SLOT_A : slot = 0
  154. * SLOT_B : slot = 1
  155. */
  156. #define M8XX_PCMCIA_VS1(slot) (0x80000000 >> (slot << 4))
  157. #define M8XX_PCMCIA_VS2(slot) (0x40000000 >> (slot << 4))
  158. #define M8XX_PCMCIA_VS_MASK(slot) (0xc0000000 >> (slot << 4))
  159. #define M8XX_PCMCIA_VS_SHIFT(slot) (30 - (slot << 4))
  160. #define M8XX_PCMCIA_WP(slot) (0x20000000 >> (slot << 4))
  161. #define M8XX_PCMCIA_CD2(slot) (0x10000000 >> (slot << 4))
  162. #define M8XX_PCMCIA_CD1(slot) (0x08000000 >> (slot << 4))
  163. #define M8XX_PCMCIA_BVD2(slot) (0x04000000 >> (slot << 4))
  164. #define M8XX_PCMCIA_BVD1(slot) (0x02000000 >> (slot << 4))
  165. #define M8XX_PCMCIA_RDY(slot) (0x01000000 >> (slot << 4))
  166. #define M8XX_PCMCIA_RDY_L(slot) (0x00800000 >> (slot << 4))
  167. #define M8XX_PCMCIA_RDY_H(slot) (0x00400000 >> (slot << 4))
  168. #define M8XX_PCMCIA_RDY_R(slot) (0x00200000 >> (slot << 4))
  169. #define M8XX_PCMCIA_RDY_F(slot) (0x00100000 >> (slot << 4))
  170. #define M8XX_PCMCIA_MASK(slot) (0xFFFF0000 >> (slot << 4))
  171. #define M8XX_PCMCIA_POR_VALID 0x00000001
  172. #define M8XX_PCMCIA_POR_WRPROT 0x00000002
  173. #define M8XX_PCMCIA_POR_ATTRMEM 0x00000010
  174. #define M8XX_PCMCIA_POR_IO 0x00000018
  175. #define M8XX_PCMCIA_POR_16BIT 0x00000040
  176. #define M8XX_PGCRX(slot) m8xx_pgcrx[slot]
  177. #define M8XX_PGCRX_CXOE 0x00000080
  178. #define M8XX_PGCRX_CXRESET 0x00000040
  179. /* we keep one lookup table per socket to check flags */
  180. #define PCMCIA_EVENTS_MAX 5 /* 4 max at a time + termination */
  181. struct event_table {
  182. u32 regbit;
  183. u32 eventbit;
  184. };
  185. static const char driver_name[] = "m8xx-pcmcia";
  186. struct socket_info {
  187. void (*handler) (void *info, u32 events);
  188. void *info;
  189. u32 slot;
  190. pcmconf8xx_t *pcmcia;
  191. u32 bus_freq;
  192. int hwirq;
  193. socket_state_t state;
  194. struct pccard_mem_map mem_win[PCMCIA_MEM_WIN_NO];
  195. struct pccard_io_map io_win[PCMCIA_IO_WIN_NO];
  196. struct event_table events[PCMCIA_EVENTS_MAX];
  197. struct pcmcia_socket socket;
  198. };
  199. static struct socket_info socket[PCMCIA_SOCKETS_NO];
  200. /*
  201. * Search this table to see if the windowsize is
  202. * supported...
  203. */
  204. #define M8XX_SIZES_NO 32
  205. static const u32 m8xx_size_to_gray[M8XX_SIZES_NO] = {
  206. 0x00000001, 0x00000002, 0x00000008, 0x00000004,
  207. 0x00000080, 0x00000040, 0x00000010, 0x00000020,
  208. 0x00008000, 0x00004000, 0x00001000, 0x00002000,
  209. 0x00000100, 0x00000200, 0x00000800, 0x00000400,
  210. 0x0fffffff, 0xffffffff, 0xffffffff, 0xffffffff,
  211. 0x01000000, 0x02000000, 0xffffffff, 0x04000000,
  212. 0x00010000, 0x00020000, 0x00080000, 0x00040000,
  213. 0x00800000, 0x00400000, 0x00100000, 0x00200000
  214. };
  215. /* ------------------------------------------------------------------------- */
  216. static irqreturn_t m8xx_interrupt(int irq, void *dev);
  217. #define PCMCIA_BMT_LIMIT (15*4) /* Bus Monitor Timeout value */
  218. /* ------------------------------------------------------------------------- */
  219. /* board specific stuff: */
  220. /* voltage_set(), hardware_enable() and hardware_disable() */
  221. /* ------------------------------------------------------------------------- */
  222. /* RPX Boards from Embedded Planet */
  223. #if defined(CONFIG_RPXCLASSIC) || defined(CONFIG_RPXLITE)
  224. /* The RPX boards seems to have it's bus monitor timeout set to 6*8 clocks.
  225. * SYPCR is write once only, therefore must the slowest memory be faster
  226. * than the bus monitor or we will get a machine check due to the bus timeout.
  227. */
  228. #define PCMCIA_BOARD_MSG "RPX CLASSIC or RPX LITE"
  229. #undef PCMCIA_BMT_LIMIT
  230. #define PCMCIA_BMT_LIMIT (6*8)
  231. static int voltage_set(int slot, int vcc, int vpp)
  232. {
  233. u32 reg = 0;
  234. switch (vcc) {
  235. case 0:
  236. break;
  237. case 33:
  238. reg |= BCSR1_PCVCTL4;
  239. break;
  240. case 50:
  241. reg |= BCSR1_PCVCTL5;
  242. break;
  243. default:
  244. return 1;
  245. }
  246. switch (vpp) {
  247. case 0:
  248. break;
  249. case 33:
  250. case 50:
  251. if (vcc == vpp)
  252. reg |= BCSR1_PCVCTL6;
  253. else
  254. return 1;
  255. break;
  256. case 120:
  257. reg |= BCSR1_PCVCTL7;
  258. default:
  259. return 1;
  260. }
  261. if (!((vcc == 50) || (vcc == 0)))
  262. return 1;
  263. /* first, turn off all power */
  264. out_be32(((u32 *) RPX_CSR_ADDR),
  265. in_be32(((u32 *) RPX_CSR_ADDR)) & ~(BCSR1_PCVCTL4 |
  266. BCSR1_PCVCTL5 |
  267. BCSR1_PCVCTL6 |
  268. BCSR1_PCVCTL7));
  269. /* enable new powersettings */
  270. out_be32(((u32 *) RPX_CSR_ADDR), in_be32(((u32 *) RPX_CSR_ADDR)) | reg);
  271. return 0;
  272. }
  273. #define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
  274. #define hardware_enable(_slot_) /* No hardware to enable */
  275. #define hardware_disable(_slot_) /* No hardware to disable */
  276. #endif /* CONFIG_RPXCLASSIC */
  277. /* FADS Boards from Motorola */
  278. #if defined(CONFIG_FADS)
  279. #define PCMCIA_BOARD_MSG "FADS"
  280. static int voltage_set(int slot, int vcc, int vpp)
  281. {
  282. u32 reg = 0;
  283. switch (vcc) {
  284. case 0:
  285. break;
  286. case 33:
  287. reg |= BCSR1_PCCVCC0;
  288. break;
  289. case 50:
  290. reg |= BCSR1_PCCVCC1;
  291. break;
  292. default:
  293. return 1;
  294. }
  295. switch (vpp) {
  296. case 0:
  297. break;
  298. case 33:
  299. case 50:
  300. if (vcc == vpp)
  301. reg |= BCSR1_PCCVPP1;
  302. else
  303. return 1;
  304. break;
  305. case 120:
  306. if ((vcc == 33) || (vcc == 50))
  307. reg |= BCSR1_PCCVPP0;
  308. else
  309. return 1;
  310. default:
  311. return 1;
  312. }
  313. /* first, turn off all power */
  314. out_be32((u32 *) BCSR1,
  315. in_be32((u32 *) BCSR1) & ~(BCSR1_PCCVCC_MASK |
  316. BCSR1_PCCVPP_MASK));
  317. /* enable new powersettings */
  318. out_be32((u32 *) BCSR1, in_be32((u32 *) BCSR1) | reg);
  319. return 0;
  320. }
  321. #define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
  322. static void hardware_enable(int slot)
  323. {
  324. out_be32((u32 *) BCSR1, in_be32((u32 *) BCSR1) & ~BCSR1_PCCEN);
  325. }
  326. static void hardware_disable(int slot)
  327. {
  328. out_be32((u32 *) BCSR1, in_be32((u32 *) BCSR1) | BCSR1_PCCEN);
  329. }
  330. #endif
  331. /* MPC885ADS Boards */
  332. #if defined(CONFIG_MPC885ADS)
  333. #define PCMCIA_BOARD_MSG "MPC885ADS"
  334. #define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
  335. static inline void hardware_enable(int slot)
  336. {
  337. m8xx_pcmcia_ops.hw_ctrl(slot, 1);
  338. }
  339. static inline void hardware_disable(int slot)
  340. {
  341. m8xx_pcmcia_ops.hw_ctrl(slot, 0);
  342. }
  343. static inline int voltage_set(int slot, int vcc, int vpp)
  344. {
  345. return m8xx_pcmcia_ops.voltage_set(slot, vcc, vpp);
  346. }
  347. #endif
  348. /* ------------------------------------------------------------------------- */
  349. /* Motorola MBX860 */
  350. #if defined(CONFIG_MBX)
  351. #define PCMCIA_BOARD_MSG "MBX"
  352. static int voltage_set(int slot, int vcc, int vpp)
  353. {
  354. u8 reg = 0;
  355. switch (vcc) {
  356. case 0:
  357. break;
  358. case 33:
  359. reg |= CSR2_VCC_33;
  360. break;
  361. case 50:
  362. reg |= CSR2_VCC_50;
  363. break;
  364. default:
  365. return 1;
  366. }
  367. switch (vpp) {
  368. case 0:
  369. break;
  370. case 33:
  371. case 50:
  372. if (vcc == vpp)
  373. reg |= CSR2_VPP_VCC;
  374. else
  375. return 1;
  376. break;
  377. case 120:
  378. if ((vcc == 33) || (vcc == 50))
  379. reg |= CSR2_VPP_12;
  380. else
  381. return 1;
  382. default:
  383. return 1;
  384. }
  385. /* first, turn off all power */
  386. out_8((u8 *) MBX_CSR2_ADDR,
  387. in_8((u8 *) MBX_CSR2_ADDR) & ~(CSR2_VCC_MASK | CSR2_VPP_MASK));
  388. /* enable new powersettings */
  389. out_8((u8 *) MBX_CSR2_ADDR, in_8((u8 *) MBX_CSR2_ADDR) | reg);
  390. return 0;
  391. }
  392. #define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
  393. #define hardware_enable(_slot_) /* No hardware to enable */
  394. #define hardware_disable(_slot_) /* No hardware to disable */
  395. #endif /* CONFIG_MBX */
  396. #if defined(CONFIG_PRxK)
  397. #include <asm/cpld.h>
  398. extern volatile fpga_pc_regs *fpga_pc;
  399. #define PCMCIA_BOARD_MSG "MPC855T"
  400. static int voltage_set(int slot, int vcc, int vpp)
  401. {
  402. u8 reg = 0;
  403. u8 regread;
  404. cpld_regs *ccpld = get_cpld();
  405. switch (vcc) {
  406. case 0:
  407. break;
  408. case 33:
  409. reg |= PCMCIA_VCC_33;
  410. break;
  411. case 50:
  412. reg |= PCMCIA_VCC_50;
  413. break;
  414. default:
  415. return 1;
  416. }
  417. switch (vpp) {
  418. case 0:
  419. break;
  420. case 33:
  421. case 50:
  422. if (vcc == vpp)
  423. reg |= PCMCIA_VPP_VCC;
  424. else
  425. return 1;
  426. break;
  427. case 120:
  428. if ((vcc == 33) || (vcc == 50))
  429. reg |= PCMCIA_VPP_12;
  430. else
  431. return 1;
  432. default:
  433. return 1;
  434. }
  435. reg = reg >> (slot << 2);
  436. regread = in_8(&ccpld->fpga_pc_ctl);
  437. if (reg !=
  438. (regread & ((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >> (slot << 2)))) {
  439. /* enable new powersettings */
  440. regread =
  441. regread & ~((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >>
  442. (slot << 2));
  443. out_8(&ccpld->fpga_pc_ctl, reg | regread);
  444. msleep(100);
  445. }
  446. return 0;
  447. }
  448. #define socket_get(_slot_) PCMCIA_SOCKET_KEY_LV
  449. #define hardware_enable(_slot_) /* No hardware to enable */
  450. #define hardware_disable(_slot_) /* No hardware to disable */
  451. #endif /* CONFIG_PRxK */
  452. static u32 pending_events[PCMCIA_SOCKETS_NO];
  453. static DEFINE_SPINLOCK(pending_event_lock);
  454. static irqreturn_t m8xx_interrupt(int irq, void *dev)
  455. {
  456. struct socket_info *s;
  457. struct event_table *e;
  458. unsigned int i, events, pscr, pipr, per;
  459. pcmconf8xx_t *pcmcia = socket[0].pcmcia;
  460. dprintk("Interrupt!\n");
  461. /* get interrupt sources */
  462. pscr = in_be32(&pcmcia->pcmc_pscr);
  463. pipr = in_be32(&pcmcia->pcmc_pipr);
  464. per = in_be32(&pcmcia->pcmc_per);
  465. for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
  466. s = &socket[i];
  467. e = &s->events[0];
  468. events = 0;
  469. while (e->regbit) {
  470. if (pscr & e->regbit)
  471. events |= e->eventbit;
  472. e++;
  473. }
  474. /*
  475. * report only if both card detect signals are the same
  476. * not too nice done,
  477. * we depend on that CD2 is the bit to the left of CD1...
  478. */
  479. if (events & SS_DETECT)
  480. if (((pipr & M8XX_PCMCIA_CD2(i)) >> 1) ^
  481. (pipr & M8XX_PCMCIA_CD1(i))) {
  482. events &= ~SS_DETECT;
  483. }
  484. #ifdef PCMCIA_GLITCHY_CD
  485. /*
  486. * I've experienced CD problems with my ADS board.
  487. * We make an extra check to see if there was a
  488. * real change of Card detection.
  489. */
  490. if ((events & SS_DETECT) &&
  491. ((pipr &
  492. (M8XX_PCMCIA_CD2(i) | M8XX_PCMCIA_CD1(i))) == 0) &&
  493. (s->state.Vcc | s->state.Vpp)) {
  494. events &= ~SS_DETECT;
  495. /*printk( "CD glitch workaround - CD = 0x%08x!\n",
  496. (pipr & (M8XX_PCMCIA_CD2(i)
  497. | M8XX_PCMCIA_CD1(i)))); */
  498. }
  499. #endif
  500. /* call the handler */
  501. dprintk("slot %u: events = 0x%02x, pscr = 0x%08x, "
  502. "pipr = 0x%08x\n", i, events, pscr, pipr);
  503. if (events) {
  504. spin_lock(&pending_event_lock);
  505. pending_events[i] |= events;
  506. spin_unlock(&pending_event_lock);
  507. /*
  508. * Turn off RDY_L bits in the PER mask on
  509. * CD interrupt receival.
  510. *
  511. * They can generate bad interrupts on the
  512. * ACS4,8,16,32. - marcelo
  513. */
  514. per &= ~M8XX_PCMCIA_RDY_L(0);
  515. per &= ~M8XX_PCMCIA_RDY_L(1);
  516. out_be32(&pcmcia->pcmc_per, per);
  517. if (events)
  518. pcmcia_parse_events(&socket[i].socket, events);
  519. }
  520. }
  521. /* clear the interrupt sources */
  522. out_be32(&pcmcia->pcmc_pscr, pscr);
  523. dprintk("Interrupt done.\n");
  524. return IRQ_HANDLED;
  525. }
  526. static u32 m8xx_get_graycode(u32 size)
  527. {
  528. u32 k;
  529. for (k = 0; k < M8XX_SIZES_NO; k++)
  530. if (m8xx_size_to_gray[k] == size)
  531. break;
  532. if ((k == M8XX_SIZES_NO) || (m8xx_size_to_gray[k] == -1))
  533. k = -1;
  534. return k;
  535. }
  536. static u32 m8xx_get_speed(u32 ns, u32 is_io, u32 bus_freq)
  537. {
  538. u32 reg, clocks, psst, psl, psht;
  539. if (!ns) {
  540. /*
  541. * We get called with IO maps setup to 0ns
  542. * if not specified by the user.
  543. * They should be 255ns.
  544. */
  545. if (is_io)
  546. ns = 255;
  547. else
  548. ns = 100; /* fast memory if 0 */
  549. }
  550. /*
  551. * In PSST, PSL, PSHT fields we tell the controller
  552. * timing parameters in CLKOUT clock cycles.
  553. * CLKOUT is the same as GCLK2_50.
  554. */
  555. /* how we want to adjust the timing - in percent */
  556. #define ADJ 180 /* 80 % longer accesstime - to be sure */
  557. clocks = ((bus_freq / 1000) * ns) / 1000;
  558. clocks = (clocks * ADJ) / (100 * 1000);
  559. if (clocks >= PCMCIA_BMT_LIMIT) {
  560. printk("Max access time limit reached\n");
  561. clocks = PCMCIA_BMT_LIMIT - 1;
  562. }
  563. psst = clocks / 7; /* setup time */
  564. psht = clocks / 7; /* hold time */
  565. psl = (clocks * 5) / 7; /* strobe length */
  566. psst += clocks - (psst + psht + psl);
  567. reg = psst << 12;
  568. reg |= psl << 7;
  569. reg |= psht << 16;
  570. return reg;
  571. }
  572. static int m8xx_get_status(struct pcmcia_socket *sock, unsigned int *value)
  573. {
  574. int lsock = container_of(sock, struct socket_info, socket)->slot;
  575. struct socket_info *s = &socket[lsock];
  576. unsigned int pipr, reg;
  577. pcmconf8xx_t *pcmcia = s->pcmcia;
  578. pipr = in_be32(&pcmcia->pcmc_pipr);
  579. *value = ((pipr & (M8XX_PCMCIA_CD1(lsock)
  580. | M8XX_PCMCIA_CD2(lsock))) == 0) ? SS_DETECT : 0;
  581. *value |= (pipr & M8XX_PCMCIA_WP(lsock)) ? SS_WRPROT : 0;
  582. if (s->state.flags & SS_IOCARD)
  583. *value |= (pipr & M8XX_PCMCIA_BVD1(lsock)) ? SS_STSCHG : 0;
  584. else {
  585. *value |= (pipr & M8XX_PCMCIA_RDY(lsock)) ? SS_READY : 0;
  586. *value |= (pipr & M8XX_PCMCIA_BVD1(lsock)) ? SS_BATDEAD : 0;
  587. *value |= (pipr & M8XX_PCMCIA_BVD2(lsock)) ? SS_BATWARN : 0;
  588. }
  589. if (s->state.Vcc | s->state.Vpp)
  590. *value |= SS_POWERON;
  591. /*
  592. * Voltage detection:
  593. * This driver only supports 16-Bit pc-cards.
  594. * Cardbus is not handled here.
  595. *
  596. * To determine what voltage to use we must read the VS1 and VS2 pin.
  597. * Depending on what socket type is present,
  598. * different combinations mean different things.
  599. *
  600. * Card Key Socket Key VS1 VS2 Card Vcc for CIS parse
  601. *
  602. * 5V 5V, LV* NC NC 5V only 5V (if available)
  603. *
  604. * 5V 5V, LV* GND NC 5 or 3.3V as low as possible
  605. *
  606. * 5V 5V, LV* GND GND 5, 3.3, x.xV as low as possible
  607. *
  608. * LV* 5V - - shall not fit into socket
  609. *
  610. * LV* LV* GND NC 3.3V only 3.3V
  611. *
  612. * LV* LV* NC GND x.xV x.xV (if avail.)
  613. *
  614. * LV* LV* GND GND 3.3 or x.xV as low as possible
  615. *
  616. * *LV means Low Voltage
  617. *
  618. *
  619. * That gives us the following table:
  620. *
  621. * Socket VS1 VS2 Voltage
  622. *
  623. * 5V NC NC 5V
  624. * 5V NC GND none (should not be possible)
  625. * 5V GND NC >= 3.3V
  626. * 5V GND GND >= x.xV
  627. *
  628. * LV NC NC 5V (if available)
  629. * LV NC GND x.xV (if available)
  630. * LV GND NC 3.3V
  631. * LV GND GND >= x.xV
  632. *
  633. * So, how do I determine if I have a 5V or a LV
  634. * socket on my board? Look at the socket!
  635. *
  636. *
  637. * Socket with 5V key:
  638. * ++--------------------------------------------+
  639. * || |
  640. * || ||
  641. * || ||
  642. * | |
  643. * +---------------------------------------------+
  644. *
  645. * Socket with LV key:
  646. * ++--------------------------------------------+
  647. * || |
  648. * | ||
  649. * | ||
  650. * | |
  651. * +---------------------------------------------+
  652. *
  653. *
  654. * With other words - LV only cards does not fit
  655. * into the 5V socket!
  656. */
  657. /* read out VS1 and VS2 */
  658. reg = (pipr & M8XX_PCMCIA_VS_MASK(lsock))
  659. >> M8XX_PCMCIA_VS_SHIFT(lsock);
  660. if (socket_get(lsock) == PCMCIA_SOCKET_KEY_LV) {
  661. switch (reg) {
  662. case 1:
  663. *value |= SS_3VCARD;
  664. break; /* GND, NC - 3.3V only */
  665. case 2:
  666. *value |= SS_XVCARD;
  667. break; /* NC. GND - x.xV only */
  668. };
  669. }
  670. dprintk("GetStatus(%d) = %#2.2x\n", lsock, *value);
  671. return 0;
  672. }
  673. static int m8xx_set_socket(struct pcmcia_socket *sock, socket_state_t * state)
  674. {
  675. int lsock = container_of(sock, struct socket_info, socket)->slot;
  676. struct socket_info *s = &socket[lsock];
  677. struct event_table *e;
  678. unsigned int reg;
  679. unsigned long flags;
  680. pcmconf8xx_t *pcmcia = socket[0].pcmcia;
  681. dprintk("SetSocket(%d, flags %#3.3x, Vcc %d, Vpp %d, "
  682. "io_irq %d, csc_mask %#2.2x)\n", lsock, state->flags,
  683. state->Vcc, state->Vpp, state->io_irq, state->csc_mask);
  684. /* First, set voltage - bail out if invalid */
  685. if (voltage_set(lsock, state->Vcc, state->Vpp))
  686. return -EINVAL;
  687. /* Take care of reset... */
  688. if (state->flags & SS_RESET)
  689. out_be32(M8XX_PGCRX(lsock), in_be32(M8XX_PGCRX(lsock)) | M8XX_PGCRX_CXRESET); /* active high */
  690. else
  691. out_be32(M8XX_PGCRX(lsock),
  692. in_be32(M8XX_PGCRX(lsock)) & ~M8XX_PGCRX_CXRESET);
  693. /* ... and output enable. */
  694. /* The CxOE signal is connected to a 74541 on the ADS.
  695. I guess most other boards used the ADS as a reference.
  696. I tried to control the CxOE signal with SS_OUTPUT_ENA,
  697. but the reset signal seems connected via the 541.
  698. If the CxOE is left high are some signals tristated and
  699. no pullups are present -> the cards act wierd.
  700. So right now the buffers are enabled if the power is on. */
  701. if (state->Vcc || state->Vpp)
  702. out_be32(M8XX_PGCRX(lsock), in_be32(M8XX_PGCRX(lsock)) & ~M8XX_PGCRX_CXOE); /* active low */
  703. else
  704. out_be32(M8XX_PGCRX(lsock),
  705. in_be32(M8XX_PGCRX(lsock)) | M8XX_PGCRX_CXOE);
  706. /*
  707. * We'd better turn off interrupts before
  708. * we mess with the events-table..
  709. */
  710. spin_lock_irqsave(&events_lock, flags);
  711. /*
  712. * Play around with the interrupt mask to be able to
  713. * give the events the generic pcmcia driver wants us to.
  714. */
  715. e = &s->events[0];
  716. reg = 0;
  717. if (state->csc_mask & SS_DETECT) {
  718. e->eventbit = SS_DETECT;
  719. reg |= e->regbit = (M8XX_PCMCIA_CD2(lsock)
  720. | M8XX_PCMCIA_CD1(lsock));
  721. e++;
  722. }
  723. if (state->flags & SS_IOCARD) {
  724. /*
  725. * I/O card
  726. */
  727. if (state->csc_mask & SS_STSCHG) {
  728. e->eventbit = SS_STSCHG;
  729. reg |= e->regbit = M8XX_PCMCIA_BVD1(lsock);
  730. e++;
  731. }
  732. /*
  733. * If io_irq is non-zero we should enable irq.
  734. */
  735. if (state->io_irq) {
  736. out_be32(M8XX_PGCRX(lsock),
  737. in_be32(M8XX_PGCRX(lsock)) |
  738. mk_int_int_mask(s->hwirq) << 24);
  739. /*
  740. * Strange thing here:
  741. * The manual does not tell us which interrupt
  742. * the sources generate.
  743. * Anyhow, I found out that RDY_L generates IREQLVL.
  744. *
  745. * We use level triggerd interrupts, and they don't
  746. * have to be cleared in PSCR in the interrupt handler.
  747. */
  748. reg |= M8XX_PCMCIA_RDY_L(lsock);
  749. } else
  750. out_be32(M8XX_PGCRX(lsock),
  751. in_be32(M8XX_PGCRX(lsock)) & 0x00ffffff);
  752. } else {
  753. /*
  754. * Memory card
  755. */
  756. if (state->csc_mask & SS_BATDEAD) {
  757. e->eventbit = SS_BATDEAD;
  758. reg |= e->regbit = M8XX_PCMCIA_BVD1(lsock);
  759. e++;
  760. }
  761. if (state->csc_mask & SS_BATWARN) {
  762. e->eventbit = SS_BATWARN;
  763. reg |= e->regbit = M8XX_PCMCIA_BVD2(lsock);
  764. e++;
  765. }
  766. /* What should I trigger on - low/high,raise,fall? */
  767. if (state->csc_mask & SS_READY) {
  768. e->eventbit = SS_READY;
  769. reg |= e->regbit = 0; //??
  770. e++;
  771. }
  772. }
  773. e->regbit = 0; /* terminate list */
  774. /*
  775. * Clear the status changed .
  776. * Port A and Port B share the same port.
  777. * Writing ones will clear the bits.
  778. */
  779. out_be32(&pcmcia->pcmc_pscr, reg);
  780. /*
  781. * Write the mask.
  782. * Port A and Port B share the same port.
  783. * Need for read-modify-write.
  784. * Ones will enable the interrupt.
  785. */
  786. reg |=
  787. in_be32(&pcmcia->
  788. pcmc_per) & (M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1));
  789. out_be32(&pcmcia->pcmc_per, reg);
  790. spin_unlock_irqrestore(&events_lock, flags);
  791. /* copy the struct and modify the copy */
  792. s->state = *state;
  793. return 0;
  794. }
  795. static int m8xx_set_io_map(struct pcmcia_socket *sock, struct pccard_io_map *io)
  796. {
  797. int lsock = container_of(sock, struct socket_info, socket)->slot;
  798. struct socket_info *s = &socket[lsock];
  799. struct pcmcia_win *w;
  800. unsigned int reg, winnr;
  801. pcmconf8xx_t *pcmcia = s->pcmcia;
  802. #define M8XX_SIZE (io->stop - io->start + 1)
  803. #define M8XX_BASE (PCMCIA_IO_WIN_BASE + io->start)
  804. dprintk("SetIOMap(%d, %d, %#2.2x, %d ns, "
  805. "%#4.4x-%#4.4x)\n", lsock, io->map, io->flags,
  806. io->speed, io->start, io->stop);
  807. if ((io->map >= PCMCIA_IO_WIN_NO) || (io->start > 0xffff)
  808. || (io->stop > 0xffff) || (io->stop < io->start))
  809. return -EINVAL;
  810. if ((reg = m8xx_get_graycode(M8XX_SIZE)) == -1)
  811. return -EINVAL;
  812. if (io->flags & MAP_ACTIVE) {
  813. dprintk("io->flags & MAP_ACTIVE\n");
  814. winnr = (PCMCIA_MEM_WIN_NO * PCMCIA_SOCKETS_NO)
  815. + (lsock * PCMCIA_IO_WIN_NO) + io->map;
  816. /* setup registers */
  817. w = (void *)&pcmcia->pcmc_pbr0;
  818. w += winnr;
  819. out_be32(&w->or, 0); /* turn off window first */
  820. out_be32(&w->br, M8XX_BASE);
  821. reg <<= 27;
  822. reg |= M8XX_PCMCIA_POR_IO | (lsock << 2);
  823. reg |= m8xx_get_speed(io->speed, 1, s->bus_freq);
  824. if (io->flags & MAP_WRPROT)
  825. reg |= M8XX_PCMCIA_POR_WRPROT;
  826. /*if(io->flags & (MAP_16BIT | MAP_AUTOSZ)) */
  827. if (io->flags & MAP_16BIT)
  828. reg |= M8XX_PCMCIA_POR_16BIT;
  829. if (io->flags & MAP_ACTIVE)
  830. reg |= M8XX_PCMCIA_POR_VALID;
  831. out_be32(&w->or, reg);
  832. dprintk("Socket %u: Mapped io window %u at %#8.8x, "
  833. "OR = %#8.8x.\n", lsock, io->map, w->br, w->or);
  834. } else {
  835. /* shutdown IO window */
  836. winnr = (PCMCIA_MEM_WIN_NO * PCMCIA_SOCKETS_NO)
  837. + (lsock * PCMCIA_IO_WIN_NO) + io->map;
  838. /* setup registers */
  839. w = (void *)&pcmcia->pcmc_pbr0;
  840. w += winnr;
  841. out_be32(&w->or, 0); /* turn off window */
  842. out_be32(&w->br, 0); /* turn off base address */
  843. dprintk("Socket %u: Unmapped io window %u at %#8.8x, "
  844. "OR = %#8.8x.\n", lsock, io->map, w->br, w->or);
  845. }
  846. /* copy the struct and modify the copy */
  847. s->io_win[io->map] = *io;
  848. s->io_win[io->map].flags &= (MAP_WRPROT | MAP_16BIT | MAP_ACTIVE);
  849. dprintk("SetIOMap exit\n");
  850. return 0;
  851. }
  852. static int m8xx_set_mem_map(struct pcmcia_socket *sock,
  853. struct pccard_mem_map *mem)
  854. {
  855. int lsock = container_of(sock, struct socket_info, socket)->slot;
  856. struct socket_info *s = &socket[lsock];
  857. struct pcmcia_win *w;
  858. struct pccard_mem_map *old;
  859. unsigned int reg, winnr;
  860. pcmconf8xx_t *pcmcia = s->pcmcia;
  861. dprintk("SetMemMap(%d, %d, %#2.2x, %d ns, "
  862. "%#5.5lx, %#5.5x)\n", lsock, mem->map, mem->flags,
  863. mem->speed, mem->static_start, mem->card_start);
  864. if ((mem->map >= PCMCIA_MEM_WIN_NO)
  865. // || ((mem->s) >= PCMCIA_MEM_WIN_SIZE)
  866. || (mem->card_start >= 0x04000000)
  867. || (mem->static_start & 0xfff) /* 4KByte resolution */
  868. ||(mem->card_start & 0xfff))
  869. return -EINVAL;
  870. if ((reg = m8xx_get_graycode(PCMCIA_MEM_WIN_SIZE)) == -1) {
  871. printk("Cannot set size to 0x%08x.\n", PCMCIA_MEM_WIN_SIZE);
  872. return -EINVAL;
  873. }
  874. reg <<= 27;
  875. winnr = (lsock * PCMCIA_MEM_WIN_NO) + mem->map;
  876. /* Setup the window in the pcmcia controller */
  877. w = (void *)&pcmcia->pcmc_pbr0;
  878. w += winnr;
  879. reg |= lsock << 2;
  880. reg |= m8xx_get_speed(mem->speed, 0, s->bus_freq);
  881. if (mem->flags & MAP_ATTRIB)
  882. reg |= M8XX_PCMCIA_POR_ATTRMEM;
  883. if (mem->flags & MAP_WRPROT)
  884. reg |= M8XX_PCMCIA_POR_WRPROT;
  885. if (mem->flags & MAP_16BIT)
  886. reg |= M8XX_PCMCIA_POR_16BIT;
  887. if (mem->flags & MAP_ACTIVE)
  888. reg |= M8XX_PCMCIA_POR_VALID;
  889. out_be32(&w->or, reg);
  890. dprintk("Socket %u: Mapped memory window %u at %#8.8x, "
  891. "OR = %#8.8x.\n", lsock, mem->map, w->br, w->or);
  892. if (mem->flags & MAP_ACTIVE) {
  893. /* get the new base address */
  894. mem->static_start = PCMCIA_MEM_WIN_BASE +
  895. (PCMCIA_MEM_WIN_SIZE * winnr)
  896. + mem->card_start;
  897. }
  898. dprintk("SetMemMap(%d, %d, %#2.2x, %d ns, "
  899. "%#5.5lx, %#5.5x)\n", lsock, mem->map, mem->flags,
  900. mem->speed, mem->static_start, mem->card_start);
  901. /* copy the struct and modify the copy */
  902. old = &s->mem_win[mem->map];
  903. *old = *mem;
  904. old->flags &= (MAP_ATTRIB | MAP_WRPROT | MAP_16BIT | MAP_ACTIVE);
  905. return 0;
  906. }
  907. static int m8xx_sock_init(struct pcmcia_socket *sock)
  908. {
  909. int i;
  910. pccard_io_map io = { 0, 0, 0, 0, 1 };
  911. pccard_mem_map mem = { 0, 0, 0, 0, 0, 0 };
  912. dprintk("sock_init(%d)\n", s);
  913. m8xx_set_socket(sock, &dead_socket);
  914. for (i = 0; i < PCMCIA_IO_WIN_NO; i++) {
  915. io.map = i;
  916. m8xx_set_io_map(sock, &io);
  917. }
  918. for (i = 0; i < PCMCIA_MEM_WIN_NO; i++) {
  919. mem.map = i;
  920. m8xx_set_mem_map(sock, &mem);
  921. }
  922. return 0;
  923. }
  924. static int m8xx_sock_suspend(struct pcmcia_socket *sock)
  925. {
  926. return m8xx_set_socket(sock, &dead_socket);
  927. }
  928. static struct pccard_operations m8xx_services = {
  929. .init = m8xx_sock_init,
  930. .suspend = m8xx_sock_suspend,
  931. .get_status = m8xx_get_status,
  932. .set_socket = m8xx_set_socket,
  933. .set_io_map = m8xx_set_io_map,
  934. .set_mem_map = m8xx_set_mem_map,
  935. };
  936. static int __init m8xx_probe(struct of_device *ofdev,
  937. const struct of_device_id *match)
  938. {
  939. struct pcmcia_win *w;
  940. unsigned int i, m, hwirq;
  941. pcmconf8xx_t *pcmcia;
  942. int status;
  943. struct device_node *np = ofdev->node;
  944. pcmcia_info("%s\n", version);
  945. pcmcia = of_iomap(np, 0);
  946. if (pcmcia == NULL)
  947. return -EINVAL;
  948. pcmcia_schlvl = irq_of_parse_and_map(np, 0);
  949. hwirq = irq_map[pcmcia_schlvl].hwirq;
  950. if (pcmcia_schlvl < 0)
  951. return -EINVAL;
  952. m8xx_pgcrx[0] = &pcmcia->pcmc_pgcra;
  953. m8xx_pgcrx[1] = &pcmcia->pcmc_pgcrb;
  954. pcmcia_info(PCMCIA_BOARD_MSG " using " PCMCIA_SLOT_MSG
  955. " with IRQ %u (%d). \n", pcmcia_schlvl, hwirq);
  956. /* Configure Status change interrupt */
  957. if (request_irq(pcmcia_schlvl, m8xx_interrupt, IRQF_SHARED,
  958. driver_name, socket)) {
  959. pcmcia_error("Cannot allocate IRQ %u for SCHLVL!\n",
  960. pcmcia_schlvl);
  961. return -1;
  962. }
  963. w = (void *)&pcmcia->pcmc_pbr0;
  964. out_be32(&pcmcia->pcmc_pscr, M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1));
  965. clrbits32(&pcmcia->pcmc_per, M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1));
  966. /* connect interrupt and disable CxOE */
  967. out_be32(M8XX_PGCRX(0),
  968. M8XX_PGCRX_CXOE | (mk_int_int_mask(hwirq) << 16));
  969. out_be32(M8XX_PGCRX(1),
  970. M8XX_PGCRX_CXOE | (mk_int_int_mask(hwirq) << 16));
  971. /* intialize the fixed memory windows */
  972. for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
  973. for (m = 0; m < PCMCIA_MEM_WIN_NO; m++) {
  974. out_be32(&w->br, PCMCIA_MEM_WIN_BASE +
  975. (PCMCIA_MEM_WIN_SIZE
  976. * (m + i * PCMCIA_MEM_WIN_NO)));
  977. out_be32(&w->or, 0); /* set to not valid */
  978. w++;
  979. }
  980. }
  981. /* turn off voltage */
  982. voltage_set(0, 0, 0);
  983. voltage_set(1, 0, 0);
  984. /* Enable external hardware */
  985. hardware_enable(0);
  986. hardware_enable(1);
  987. for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
  988. socket[i].slot = i;
  989. socket[i].socket.owner = THIS_MODULE;
  990. socket[i].socket.features =
  991. SS_CAP_PCCARD | SS_CAP_MEM_ALIGN | SS_CAP_STATIC_MAP;
  992. socket[i].socket.irq_mask = 0x000;
  993. socket[i].socket.map_size = 0x1000;
  994. socket[i].socket.io_offset = 0;
  995. socket[i].socket.pci_irq = pcmcia_schlvl;
  996. socket[i].socket.ops = &m8xx_services;
  997. socket[i].socket.resource_ops = &pccard_nonstatic_ops;
  998. socket[i].socket.cb_dev = NULL;
  999. socket[i].socket.dev.parent = &ofdev->dev;
  1000. socket[i].pcmcia = pcmcia;
  1001. socket[i].bus_freq = ppc_proc_freq;
  1002. socket[i].hwirq = hwirq;
  1003. }
  1004. for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
  1005. status = pcmcia_register_socket(&socket[i].socket);
  1006. if (status < 0)
  1007. pcmcia_error("Socket register failed\n");
  1008. }
  1009. return 0;
  1010. }
  1011. static int m8xx_remove(struct of_device *ofdev)
  1012. {
  1013. u32 m, i;
  1014. struct pcmcia_win *w;
  1015. pcmconf8xx_t *pcmcia = socket[0].pcmcia;
  1016. for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
  1017. w = (void *)&pcmcia->pcmc_pbr0;
  1018. out_be32(&pcmcia->pcmc_pscr, M8XX_PCMCIA_MASK(i));
  1019. out_be32(&pcmcia->pcmc_per,
  1020. in_be32(&pcmcia->pcmc_per) & ~M8XX_PCMCIA_MASK(i));
  1021. /* turn off interrupt and disable CxOE */
  1022. out_be32(M8XX_PGCRX(i), M8XX_PGCRX_CXOE);
  1023. /* turn off memory windows */
  1024. for (m = 0; m < PCMCIA_MEM_WIN_NO; m++) {
  1025. out_be32(&w->or, 0); /* set to not valid */
  1026. w++;
  1027. }
  1028. /* turn off voltage */
  1029. voltage_set(i, 0, 0);
  1030. /* disable external hardware */
  1031. hardware_disable(i);
  1032. }
  1033. for (i = 0; i < PCMCIA_SOCKETS_NO; i++)
  1034. pcmcia_unregister_socket(&socket[i].socket);
  1035. free_irq(pcmcia_schlvl, NULL);
  1036. return 0;
  1037. }
  1038. #ifdef CONFIG_PM
  1039. static int m8xx_suspend(struct platform_device *pdev, pm_message_t state)
  1040. {
  1041. return pcmcia_socket_dev_suspend(&pdev->dev, state);
  1042. }
  1043. static int m8xx_resume(struct platform_device *pdev)
  1044. {
  1045. return pcmcia_socket_dev_resume(&pdev->dev);
  1046. }
  1047. #else
  1048. #define m8xx_suspend NULL
  1049. #define m8xx_resume NULL
  1050. #endif
  1051. static struct of_device_id m8xx_pcmcia_match[] = {
  1052. {
  1053. .type = "pcmcia",
  1054. .compatible = "fsl,pq-pcmcia",
  1055. },
  1056. {},
  1057. };
  1058. MODULE_DEVICE_TABLE(of, m8xx_pcmcia_match);
  1059. static struct of_platform_driver m8xx_pcmcia_driver = {
  1060. .name = driver_name,
  1061. .match_table = m8xx_pcmcia_match,
  1062. .probe = m8xx_probe,
  1063. .remove = m8xx_remove,
  1064. .suspend = m8xx_suspend,
  1065. .resume = m8xx_resume,
  1066. };
  1067. static int __init m8xx_init(void)
  1068. {
  1069. return of_register_platform_driver(&m8xx_pcmcia_driver);
  1070. }
  1071. static void __exit m8xx_exit(void)
  1072. {
  1073. of_unregister_platform_driver(&m8xx_pcmcia_driver);
  1074. }
  1075. module_init(m8xx_init);
  1076. module_exit(m8xx_exit);