config.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:8k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. #include <linux/config.h>
  2. #include <linux/types.h>
  3. #include <linux/kernel.h>
  4. #include <linux/mm.h>
  5. #include <linux/tty.h>
  6. #include <linux/console.h>
  7. #include <asm/setup.h>
  8. #include <asm/bootinfo.h>
  9. #include <asm/system.h>
  10. #include <asm/pgtable.h>
  11. #include <asm/apollohw.h>
  12. #include <asm/irq.h>
  13. #include <asm/rtc.h>
  14. #include <asm/machdep.h>
  15. u_long sio01_physaddr;
  16. u_long sio23_physaddr;
  17. u_long rtc_physaddr;
  18. u_long pica_physaddr;
  19. u_long picb_physaddr;
  20. u_long cpuctrl_physaddr;
  21. u_long timer_physaddr;
  22. u_long apollo_model;
  23. extern void dn_sched_init(void (*handler)(int,void *,struct pt_regs *));
  24. extern int dn_keyb_init(void);
  25. extern int dn_dummy_kbdrate(struct kbd_repeat *);
  26. extern void dn_init_IRQ(void);
  27. extern int dn_request_irq(unsigned int irq, void (*handler)(int, void *, struct pt_regs *), unsigned long flags, const char *devname, void *dev_id);
  28. extern void dn_free_irq(unsigned int irq, void *dev_id);
  29. extern void dn_enable_irq(unsigned int);
  30. extern void dn_disable_irq(unsigned int);
  31. extern int dn_get_irq_list(char *);
  32. extern unsigned long dn_gettimeoffset(void);
  33. extern void dn_gettod(int *, int *, int *, int *, int *, int *);
  34. extern int dn_dummy_hwclk(int, struct hwclk_time *);
  35. extern int dn_dummy_set_clock_mmss(unsigned long);
  36. extern void dn_mksound(unsigned int count, unsigned int ticks);
  37. extern void dn_dummy_reset(void);
  38. extern void dn_dummy_waitbut(void);
  39. extern struct fb_info *dn_fb_init(long *);
  40. extern void dn_dummy_debug_init(void);
  41. extern void (*kd_mksound)(unsigned int, unsigned int);
  42. extern void dn_dummy_video_setup(char *,int *);
  43. extern void dn_process_int(int irq, struct pt_regs *fp);
  44. #ifdef CONFIG_HEARTBEAT
  45. static void dn_heartbeat(int on);
  46. #endif
  47. static void dn_timer_int(int irq,void *, struct pt_regs *);
  48. static void (*sched_timer_handler)(int, void *, struct pt_regs *)=NULL;
  49. static void dn_get_model(char *model);
  50. static int dn_cpuctrl=0xff00;
  51. static const char *apollo_models[] = {
  52. "DN3000 (Otter)",
  53. "DN3010 (Otter)",
  54. "DN3500 (Cougar II)",
  55. "DN4000 (Mink)",
  56. "DN4500 (Roadrunner)" };
  57. int apollo_parse_bootinfo(const struct bi_record *record) {
  58. int unknown = 0;
  59. const unsigned long *data = record->data;
  60. switch(record->tag) {
  61. case BI_APOLLO_MODEL: 
  62. apollo_model=*data;
  63. break;
  64. default:
  65.  unknown=1;
  66. }
  67. return unknown;
  68. }
  69. void dn_setup_model(void) {
  70. printk("Apollo hardware found: ");
  71. printk("[%s]n", apollo_models[apollo_model - APOLLO_DN3000]);
  72. switch(apollo_model) {
  73. case APOLLO_UNKNOWN:
  74. panic("Unknown apollo model");
  75. break;
  76. case APOLLO_DN3000:
  77. case APOLLO_DN3010:
  78. sio01_physaddr=SAU8_SIO01_PHYSADDR;
  79. rtc_physaddr=SAU8_RTC_PHYSADDR;
  80. pica_physaddr=SAU8_PICA;
  81. picb_physaddr=SAU8_PICB;
  82. cpuctrl_physaddr=SAU8_CPUCTRL;
  83. timer_physaddr=SAU8_TIMER;
  84. break;
  85. case APOLLO_DN4000:
  86. sio01_physaddr=SAU7_SIO01_PHYSADDR;
  87. sio23_physaddr=SAU7_SIO23_PHYSADDR;
  88. rtc_physaddr=SAU7_RTC_PHYSADDR;
  89. pica_physaddr=SAU7_PICA;
  90. picb_physaddr=SAU7_PICB;
  91. cpuctrl_physaddr=SAU7_CPUCTRL;
  92. timer_physaddr=SAU7_TIMER;
  93. break;
  94. case APOLLO_DN4500:
  95. panic("Apollo model not yet supported");
  96. break;
  97. case APOLLO_DN3500:
  98. sio01_physaddr=SAU7_SIO01_PHYSADDR;
  99. sio23_physaddr=SAU7_SIO23_PHYSADDR;
  100. rtc_physaddr=SAU7_RTC_PHYSADDR;
  101. pica_physaddr=SAU7_PICA;
  102. picb_physaddr=SAU7_PICB;
  103. cpuctrl_physaddr=SAU7_CPUCTRL;
  104. timer_physaddr=SAU7_TIMER;
  105. break;
  106. default:
  107. panic("Undefined apollo model");
  108. break;
  109. }
  110. }
  111. int dn_serial_console_wait_key(struct console *co) {
  112. while(!(sio01.srb_csrb & 1))
  113. barrier();
  114. return sio01.rhrb_thrb;
  115. }
  116. void dn_serial_console_write (struct console *co, const char *str,unsigned int count)
  117. {
  118.    while(count--) {
  119. if (*str == 'n') { 
  120.      sio01.rhrb_thrb = (unsigned char)'r';
  121.         while (!(sio01.srb_csrb & 0x4))
  122.                 ;
  123.   }
  124.     sio01.rhrb_thrb = (unsigned char)*str++;
  125.     while (!(sio01.srb_csrb & 0x4))
  126.             ;
  127.   }
  128. }
  129.  
  130. void dn_serial_print (const char *str)
  131. {
  132.     while (*str) {
  133.         if (*str == 'n') {
  134.             sio01.rhrb_thrb = (unsigned char)'r';
  135.             while (!(sio01.srb_csrb & 0x4))
  136.                 ;
  137.         }
  138.         sio01.rhrb_thrb = (unsigned char)*str++;
  139.         while (!(sio01.srb_csrb & 0x4))
  140.             ;
  141.     }
  142. }
  143. void config_apollo(void) {
  144. int i;
  145. dn_setup_model();
  146. mach_sched_init=dn_sched_init; /* */
  147. mach_keyb_init=dn_keyb_init;
  148. mach_kbdrate=dn_dummy_kbdrate;
  149. mach_init_IRQ=dn_init_IRQ;
  150. mach_default_handler=NULL;
  151. mach_request_irq     = dn_request_irq;
  152. mach_free_irq        = dn_free_irq;
  153. enable_irq      = dn_enable_irq;
  154. disable_irq     = dn_disable_irq;
  155. mach_get_irq_list    = dn_get_irq_list;
  156. mach_gettimeoffset   = dn_gettimeoffset;
  157. mach_gettod      = dn_gettod; /* */
  158. mach_max_dma_address = 0xffffffff;
  159. mach_hwclk           = dn_dummy_hwclk; /* */
  160. mach_set_clock_mmss  = dn_dummy_set_clock_mmss; /* */
  161. mach_process_int     = dn_process_int;
  162. #ifdef CONFIG_BLK_DEV_FD
  163. mach_floppy_init     = dn_dummy_floppy_init;
  164. mach_floppy_setup    = dn_dummy_floppy_setup;
  165. #endif
  166. mach_reset      = dn_dummy_reset;  /* */
  167. #ifdef CONFIG_DUMMY_CONSOLE
  168.         conswitchp           = &dummy_con;
  169. #endif
  170. kd_mksound      = dn_mksound;
  171. #ifdef CONFIG_HEARTBEAT
  172.    mach_heartbeat = dn_heartbeat;
  173. #endif
  174. mach_get_model       = dn_get_model;
  175. cpuctrl=0xaa00;
  176. /* clear DMA translation table */
  177. for(i=0;i<0x400;i++) 
  178. addr_xlat_map[i]=0;
  179. }
  180. void dn_timer_int(int irq, void *dev_id, struct pt_regs *fp) {
  181. volatile unsigned char x;
  182. sched_timer_handler(irq,dev_id,fp);
  183. x=*(volatile unsigned char *)(timer+3);
  184. x=*(volatile unsigned char *)(timer+5);
  185. }
  186. void dn_sched_init(void (*timer_routine)(int, void *, struct pt_regs *)) {
  187. /* program timer 1 */       
  188. *(volatile unsigned char *)(timer+3)=0x01;
  189. *(volatile unsigned char *)(timer+1)=0x40;
  190. *(volatile unsigned char *)(timer+5)=0x09;
  191. *(volatile unsigned char *)(timer+7)=0xc4;
  192. /* enable IRQ of PIC B */
  193. *(volatile unsigned char *)(pica+1)&=(~8);
  194. #if 0
  195. printk("*(0x10803) %02xn",*(volatile unsigned char *)(timer+0x3));
  196. printk("*(0x10803) %02xn",*(volatile unsigned char *)(timer+0x3));
  197. #endif
  198. sched_timer_handler=timer_routine;
  199. request_irq(0,dn_timer_int,0,NULL,NULL);
  200. }
  201. unsigned long dn_gettimeoffset(void) {
  202. return 0xdeadbeef;
  203. }
  204. void dn_gettod(int *yearp, int *monp, int *dayp,
  205.        int *hourp, int *minp, int *secp) {
  206.   *yearp=rtc->year;
  207.   *monp=rtc->month;
  208.   *dayp=rtc->day_of_month;
  209.   *hourp=rtc->hours;
  210.   *minp=rtc->minute;
  211.   *secp=rtc->second;
  212. printk("gettod: %d %d %d %d %d %dn",*yearp,*monp,*dayp,*hourp,*minp,*secp);
  213. }
  214. int dn_dummy_hwclk(int op, struct hwclk_time *t) {
  215.   if(!op) { /* read */
  216.     t->sec=rtc->second;
  217.     t->min=rtc->minute;
  218.     t->hour=rtc->hours;
  219.     t->day=rtc->day_of_month;
  220.     t->wday=rtc->day_of_week;
  221.     t->mon=rtc->month;
  222.     t->year=rtc->year;
  223.   } else {
  224.     rtc->second=t->sec;
  225.     rtc->minute=t->min;
  226.     rtc->hours=t->hour;
  227.     rtc->day_of_month=t->day;
  228.     if(t->wday!=-1)
  229.       rtc->day_of_week=t->wday;
  230.     rtc->month=t->mon;
  231.     rtc->year=t->year;
  232.   }
  233.   return 0;
  234. }
  235. int dn_dummy_set_clock_mmss(unsigned long nowtime) {
  236.   printk("set_clock_mmssn");
  237.   return 0;
  238. }
  239. void dn_dummy_reset(void) {
  240.   dn_serial_print("The end !n");
  241.   for(;;);
  242. }
  243. void dn_dummy_waitbut(void) {
  244.   dn_serial_print("waitbutn");
  245. }
  246. static void dn_get_model(char *model)
  247. {
  248.     strcpy(model, "Apollo ");
  249.     if (apollo_model >= APOLLO_DN3000 && apollo_model <= APOLLO_DN4500)
  250.         strcat(model, apollo_models[apollo_model - APOLLO_DN3000]);
  251. }
  252. #ifdef CONFIG_HEARTBEAT
  253. static void dn_heartbeat(int on) {
  254. if(on) { 
  255. dn_cpuctrl&=~0x100;
  256. cpuctrl=dn_cpuctrl;
  257. }
  258. else {
  259. dn_cpuctrl&=~0x100;
  260. dn_cpuctrl|=0x100;
  261. cpuctrl=dn_cpuctrl;
  262. }
  263. }
  264. #endif