开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
netwinder-hw.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：11k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

netwinder-hw.c：源码内容
  1. /*
  2.  * linux/arch/arm/mach-footbridge/netwinder-hw.c
  3.  *
  4.  * Netwinder machine fixup
  5.  *
  6.  * Copyright (C) 1998, 1999 Russell King, Phil Blundell
  7.  */
  8. #include <linux/config.h>
  9. #include <linux/module.h>
  10. #include <linux/sched.h>
  11. #include <linux/ioport.h>
  12. #include <linux/kernel.h>
  13. #include <linux/delay.h>
  14. #include <linux/init.h>
  16. #include <asm/io.h>
  17. #include <asm/leds.h>
  18. #include <asm/mach-types.h>
  20. #define IRDA_IO_BASE 0x180
  21. #define GP1_IO_BASE 0x338
  22. #define GP2_IO_BASE 0x33a
  25. #ifdef CONFIG_LEDS
  26. #define DEFAULT_LEDS 0
  27. #else
  28. #define DEFAULT_LEDS GPIO_GREEN_LED
  29. #endif
  31. /*
  32.  * Winbond WB83977F accessibility stuff
  33.  */
  34. static inline void wb977_open(void)
  35. {
  36. outb(0x87, 0x370);
  37. outb(0x87, 0x370);
  38. }
  40. static inline void wb977_close(void)
  41. {
  42. outb(0xaa, 0x370);
  43. }
  45. static inline void wb977_wb(int reg, int val)
  46. {
  47. outb(reg, 0x370);
  48. outb(val, 0x371);
  49. }
  51. static inline void wb977_ww(int reg, int val)
  52. {
  53. outb(reg, 0x370);
  54. outb(val >> 8, 0x371);
  55. outb(reg + 1, 0x370);
  56. outb(val, 0x371);
  57. }
  59. #define wb977_device_select(dev) wb977_wb(0x07, dev)
  60. #define wb977_device_disable() wb977_wb(0x30, 0x00)
  61. #define wb977_device_enable() wb977_wb(0x30, 0x01)
  63. /*
  64.  * This is a lock for accessing ports GP1_IO_BASE and GP2_IO_BASE
  65.  */
  66. spinlock_t gpio_lock = SPIN_LOCK_UNLOCKED;
  68. static unsigned int current_gpio_op;
  69. static unsigned int current_gpio_io;
  70. static unsigned int current_cpld;
  72. void gpio_modify_op(int mask, int set)
  73. {
  74. unsigned int new_gpio, changed;
  76. new_gpio = (current_gpio_op & ~mask) | set;
  77. changed = new_gpio ^ current_gpio_op;
  78. current_gpio_op = new_gpio;
  80. if (changed & 0xff)
  81. outb(new_gpio, GP1_IO_BASE);
  82. if (changed & 0xff00)
  83. outb(new_gpio >> 8, GP2_IO_BASE);
  84. }
  86. static inline void __gpio_modify_io(int mask, int in)
  87. {
  88. unsigned int new_gpio, changed;
  89. int port;
  91. new_gpio = (current_gpio_io & ~mask) | in;
  92. changed = new_gpio ^ current_gpio_io;
  93. current_gpio_io = new_gpio;
  95. changed >>= 1;
  96. new_gpio >>= 1;
  98. wb977_device_select(7);
  100. for (port = 0xe1; changed && port < 0xe8; changed >>= 1) {
  101. wb977_wb(port, new_gpio & 1);
  103. port += 1;
  104. new_gpio >>= 1;
  105. }
  107. wb977_device_select(8);
  109. for (port = 0xe8; changed && port < 0xec; changed >>= 1) {
  110. wb977_wb(port, new_gpio & 1);
  112. port += 1;
  113. new_gpio >>= 1;
  114. }
  115. }
  117. void gpio_modify_io(int mask, int in)
  118. {
  119. /* Open up the SuperIO chip */
  120. wb977_open();
  122. __gpio_modify_io(mask, in);
  124. /* Close up the EFER gate */
  125. wb977_close();
  126. }
  128. int gpio_read(void)
  129. {
  130. return inb(GP1_IO_BASE) | inb(GP2_IO_BASE) << 8;
  131. }
  133. /*
  134.  * Initialise the Winbond W83977F global registers
  135.  */
  136. static inline void wb977_init_global(void)
  137. {
  138. /*
  139.  * Enable R/W config registers
  140.  */
  141. wb977_wb(0x26, 0x40);
  143. /*
  144.  * Power down FDC (not used)
  145.  */
  146. wb977_wb(0x22, 0xfe);
  148. /*
  149.  * GP12, GP11, CIRRX, IRRXH, GP10
  150.  */
  151. wb977_wb(0x2a, 0xc1);
  153. /*
  154.  * GP23, GP22, GP21, GP20, GP13
  155.  */
  156. wb977_wb(0x2b, 0x6b);
  158. /*
  159.  * GP17, GP16, GP15, GP14
  160.  */
  161. wb977_wb(0x2c, 0x55);
  162. }
  164. /*
  165.  * Initialise the Winbond W83977F printer port
  166.  */
  167. static inline void wb977_init_printer(void)
  168. {
  169. wb977_device_select(1);
  171. /*
  172.  * mode 1 == EPP
  173.  */
  174. wb977_wb(0xf0, 0x01);
  175. }
  177. /*
  178.  * Initialise the Winbond W83977F keyboard controller
  179.  */
  180. static inline void wb977_init_keyboard(void)
  181. {
  182. wb977_device_select(5);
  184. /*
  185.  * Keyboard controller address
  186.  */
  187. wb977_ww(0x60, 0x0060);
  188. wb977_ww(0x62, 0x0064);
  190. /*
  191.  * Keyboard IRQ 1, active high, edge trigger
  192.  */
  193. wb977_wb(0x70, 1);
  194. wb977_wb(0x71, 0x02);
  196. /*
  197.  * Mouse IRQ 5, active high, edge trigger
  198.  */
  199. wb977_wb(0x72, 5);
  200. wb977_wb(0x73, 0x02);
  202. /*
  203.  * KBC 8MHz
  204.  */
  205. wb977_wb(0xf0, 0x40);
  207. /*
  208.  * Enable device
  209.  */
  210. wb977_device_enable();
  211. }
  213. /*
  214.  * Initialise the Winbond W83977F Infra-Red device
  215.  */
  216. static inline void wb977_init_irda(void)
  217. {
  218. wb977_device_select(6);
  220. /*
  221.  * IR base address
  222.  */
  223. wb977_ww(0x60, IRDA_IO_BASE);
  225. /*
  226.  * IRDA IRQ 6, active high, edge trigger
  227.  */
  228. wb977_wb(0x70, 6);
  229. wb977_wb(0x71, 0x02);
  231. /*
  232.  * RX DMA - ISA DMA 0
  233.  */
  234. wb977_wb(0x74, 0x00);
  236. /*
  237.  * TX DMA - Disable Tx DMA
  238.  */
  239. wb977_wb(0x75, 0x04);
  241. /*
  242.  * Append CRC, Enable bank selection
  243.  */
  244. wb977_wb(0xf0, 0x03);
  246. /*
  247.  * Enable device
  248.  */
  249. wb977_device_enable();
  250. }
  252. /*
  253.  * Initialise Winbond W83977F general purpose IO
  254.  */
  255. static inline void wb977_init_gpio(void)
  256. {
  257. unsigned long flags;
  259. /*
  260.  * Set up initial I/O definitions
  261.  */
  262. current_gpio_io = -1;
  263. __gpio_modify_io(-1, GPIO_DONE | GPIO_WDTIMER);
  265. wb977_device_select(7);
  267. /*
  268.  * Group1 base address
  269.  */
  270. wb977_ww(0x60, GP1_IO_BASE);
  271. wb977_ww(0x62, 0);
  272. wb977_ww(0x64, 0);
  274. /*
  275.  * GP10 (Orage button) IRQ 10, active high, edge trigger
  276.  */
  277. wb977_wb(0x70, 10);
  278. wb977_wb(0x71, 0x02);
  280. /*
  281.  * GP10: Debounce filter enabled, IRQ, input
  282.  */
  283. wb977_wb(0xe0, 0x19);
  285. /*
  286.  * Enable Group1
  287.  */
  288. wb977_device_enable();
  290. wb977_device_select(8);
  292. /*
  293.  * Group2 base address
  294.  */
  295. wb977_ww(0x60, GP2_IO_BASE);
  297. /*
  298.  * Clear watchdog timer regs
  299.  *  - timer disable
  300.  */
  301. wb977_wb(0xf2, 0x00);
  303. /*
  304.  *  - disable LED, no mouse nor keyboard IRQ
  305.  */
  306. wb977_wb(0xf3, 0x00);
  308. /*
  309.  *  - timer counting, disable power LED, disable timeouot
  310.  */
  311. wb977_wb(0xf4, 0x00);
  313. /*
  314.  * Enable group2
  315.  */
  316. wb977_device_enable();
  318. /*
  319.  * Set Group1/Group2 outputs
  320.  */
  321. spin_lock_irqsave(&gpio_lock, flags);
  322. gpio_modify_op(-1, GPIO_RED_LED | GPIO_FAN);
  323. spin_unlock_irqrestore(&gpio_loc, flags);
  324. }
  326. /*
  327.  * Initialise the Winbond W83977F chip.
  328.  */
  329. static void __init wb977_init(void)
  330. {
  331. request_region(0x370, 2, "W83977AF configuration");
  333. /*
  334.  * Open up the SuperIO chip
  335.  */
  336. wb977_open();
  338. /*
  339.  * Initialise the global registers
  340.  */
  341. wb977_init_global();
  343. /*
  344.  * Initialise the various devices in
  345.  * the multi-IO chip.
  346.  */
  347. wb977_init_printer();
  348. wb977_init_keyboard();
  349. wb977_init_irda();
  350. wb977_init_gpio();
  352. /*
  353.  * Close up the EFER gate
  354.  */
  355. wb977_close();
  356. }
  358. void cpld_modify(int mask, int set)
  359. {
  360. int msk;
  362. current_cpld = (current_cpld & ~mask) | set;
  364. gpio_modify_io(GPIO_DATA | GPIO_IOCLK | GPIO_IOLOAD, 0);
  365. gpio_modify_op(GPIO_IOLOAD, 0);
  367. for (msk = 8; msk; msk >>= 1) {
  368. int bit = current_cpld & msk;
  370. gpio_modify_op(GPIO_DATA | GPIO_IOCLK, bit ? GPIO_DATA : 0);
  371. gpio_modify_op(GPIO_IOCLK, GPIO_IOCLK);
  372. }
  374. gpio_modify_op(GPIO_IOCLK|GPIO_DATA, 0);
  375. gpio_modify_op(GPIO_IOLOAD|GPIO_DSCLK, GPIO_IOLOAD|GPIO_DSCLK);
  376. gpio_modify_op(GPIO_IOLOAD, 0);
  377. }
  379. static void __init cpld_init(void)
  380. {
  381. unsigned long flags;
  383. spin_lock_irqsave(&gpio_lock, flags);
  384. cpld_modify(-1, CPLD_UNMUTE | CPLD_7111_DISABLE);
  385. spin_unlock_irqrestore(&gpio_lock, flags);
  386. }
  388. static unsigned char rwa_unlock[] __initdata =
  389. { 0x00, 0x00, 0x6a, 0xb5, 0xda, 0xed, 0xf6, 0xfb, 0x7d, 0xbe, 0xdf, 0x6f, 0x37, 0x1b,
  390.   0x0d, 0x86, 0xc3, 0x61, 0xb0, 0x58, 0x2c, 0x16, 0x8b, 0x45, 0xa2, 0xd1, 0xe8, 0x74,
  391.   0x3a, 0x9d, 0xce, 0xe7, 0x73, 0x39 };
  393. #ifndef DEBUG
  394. #define dprintk(x...)
  395. #else
  396. #define dprintk(x...) printk(x)
  397. #endif
  399. #define WRITE_RWA(r,v) do { outb((r), 0x279); udelay(10); outb((v), 0xa79); } while (0)
  401. static inline void rwa010_unlock(void)
  402. {
  403. int i;
  405. WRITE_RWA(2, 2);
  406. mdelay(10);
  408. for (i = 0; i < sizeof(rwa_unlock); i++) {
  409. outb(rwa_unlock[i], 0x279);
  410. udelay(10);
  411. }
  412. }
  414. static inline void rwa010_read_ident(void)
  415. {
  416. unsigned char si[9];
  417. int i, j;
  419. WRITE_RWA(3, 0);
  420. WRITE_RWA(0, 128);
  422. outb(1, 0x279);
  424. mdelay(1);
  426. dprintk("Identifier: ");
  427. for (i = 0; i < 9; i++) {
  428. si[i] = 0;
  429. for (j = 0; j < 8; j++) {
  430. int bit;
  431. udelay(250);
  432. inb(0x203);
  433. udelay(250);
  434. bit = inb(0x203);
  435. dprintk("%02X ", bit);
  436. bit = (bit == 0xaa) ? 1 : 0;
  437. si[i] |= bit << j;
  438. }
  439. dprintk("(%02X) ", si[i]);
  440. }
  441. dprintk("n");
  442. }
  444. static inline void rwa010_global_init(void)
  445. {
  446. WRITE_RWA(6, 2); // Assign a card no = 2
  448. dprintk("Card no = %dn", inb(0x203));
  450. /* disable the modem section of the chip */
  451. WRITE_RWA(7, 3);
  452. WRITE_RWA(0x30, 0);
  454. /* disable the cdrom section of the chip */
  455. WRITE_RWA(7, 4);
  456. WRITE_RWA(0x30, 0);
  458. /* disable the MPU-401 section of the chip */
  459. WRITE_RWA(7, 2);
  460. WRITE_RWA(0x30, 0);
  461. }
  463. static inline void rwa010_game_port_init(void)
  464. {
  465. int i;
  467. WRITE_RWA(7, 5);
  469. dprintk("Slider base: ");
  470. WRITE_RWA(0x61, 1);
  471. i = inb(0x203);
  473. WRITE_RWA(0x60, 2);
  474. dprintk("%02X%02X (201)n", inb(0x203), i);
  476. WRITE_RWA(0x30, 1);
  477. }
  479. static inline void rwa010_waveartist_init(int base, int irq, int dma)
  480. {
  481. int i;
  483. WRITE_RWA(7, 0);
  485. dprintk("WaveArtist base: ");
  486. WRITE_RWA(0x61, base);
  487. i = inb(0x203);
  489. WRITE_RWA(0x60, base >> 8);
  490. dprintk("%02X%02X (%X),", inb(0x203), i, base);
  492. WRITE_RWA(0x70, irq);
  493. dprintk(" irq: %d (%d),", inb(0x203), irq);
  495. WRITE_RWA(0x74, dma);
  496. dprintk(" dma: %d (%d)n", inb(0x203), dma);
  498. WRITE_RWA(0x30, 1);
  499. }
  501. static inline void rwa010_soundblaster_init(int sb_base, int al_base, int irq, int dma)
  502. {
  503. int i;
  505. WRITE_RWA(7, 1);
  507. dprintk("SoundBlaster base: ");
  508. WRITE_RWA(0x61, sb_base);
  509. i = inb(0x203);
  511. WRITE_RWA(0x60, sb_base >> 8);
  512. dprintk("%02X%02X (%X),", inb(0x203), i, sb_base);
  514. dprintk(" irq: ");
  515. WRITE_RWA(0x70, irq);
  516. dprintk("%d (%d),", inb(0x203), irq);
  518. dprintk(" 8-bit DMA: ");
  519. WRITE_RWA(0x74, dma);
  520. dprintk("%d (%d)n", inb(0x203), dma);
  522. dprintk("AdLib base: ");
  523. WRITE_RWA(0x63, al_base);
  524. i = inb(0x203);
  526. WRITE_RWA(0x62, al_base >> 8);
  527. dprintk("%02X%02X (%X)n", inb(0x203), i, al_base);
  529. WRITE_RWA(0x30, 1);
  530. }
  532. static void rwa010_soundblaster_reset(void)
  533. {
  534. int i;
  536. outb(1, 0x226);
  537. udelay(3);
  538. outb(0, 0x226);
  540. for (i = 0; i < 5; i++) {
  541. if (inb(0x22e) & 0x80)
  542. break;
  543. mdelay(1);
  544. }
  545. if (i == 5)
  546. printk("SoundBlaster: DSP reset failedn");
  548. dprintk("SoundBlaster DSP reset: %02X (AA)n", inb(0x22a));
  550. for (i = 0; i < 5; i++) {
  551. if ((inb(0x22c) & 0x80) == 0)
  552. break;
  553. mdelay(1);
  554. }
  556. if (i == 5)
  557. printk("SoundBlaster: DSP not readyn");
  558. else {
  559. outb(0xe1, 0x22c);
  561. dprintk("SoundBlaster DSP id: ");
  562. i = inb(0x22a);
  563. udelay(1);
  564. i |= inb(0x22a) << 8;
  565. dprintk("%04Xn", i);
  567. for (i = 0; i < 5; i++) {
  568. if ((inb(0x22c) & 0x80) == 0)
  569. break;
  570. mdelay(1);
  571. }
  573. if (i == 5)
  574. printk("SoundBlaster: could not turn speaker offn");
  576. outb(0xd3, 0x22c);
  577. }
  579. /* turn on OPL3 */
  580. outb(5, 0x38a);
  581. outb(1, 0x38b);
  582. }
  584. static void __init rwa010_init(void)
  585. {
  586. rwa010_unlock();
  587. rwa010_read_ident();
  588. rwa010_global_init();
  589. rwa010_game_port_init();
  590. rwa010_waveartist_init(0x250, 3, 7);
  591. rwa010_soundblaster_init(0x220, 0x388, 3, 1);
  592. rwa010_soundblaster_reset();
  593. }
  595. EXPORT_SYMBOL(gpio_lock);
  596. EXPORT_SYMBOL(gpio_modify_op);
  597. EXPORT_SYMBOL(gpio_modify_io);
  598. EXPORT_SYMBOL(cpld_modify);
  600. /*
  601.  * Initialise any other hardware after we've got the PCI bus
  602.  * initialised.  We may need the PCI bus to talk to this other
  603.  * hardware.
  604.  */
  605. static int __init nw_hw_init(void)
  606. {
  607. if (machine_is_netwinder()) {
  608. unsigned long flags;
  610. wb977_init();
  611. cpld_init();
  612. rwa010_init();
  614. spin_lock_irqsave(&gpio_lock, flags);
  615. gpio_modify_op(GPIO_RED_LED|GPIO_GREEN_LED, DEFAULT_LEDS);
  616. spin_unlock_irqrestore(&gpio_lock, flags);
  617. }
  618. return 0;
  619. }
  621. __initcall(nw_hw_init);