obsolete-buildroot/sources/openwrt/kernel/diag.c

   1 // replacement diag module
   2 // (c) 2004 openwrt
   3 // mbm at alt dot org
   4 //
   5 // initial release 2004/03/28
   6
   7 #include <linux/module.h>
   8 #include <linux/init.h>
   9 #include <linux/kernel.h>
  10 #include <linux/timer.h>
  11 #include <linux/sysctl.h>
  12 #include <asm/io.h>
  13 #include <typedefs.h>
  14 #include <bcm4710.h>
  15 #include <sbutils.h>
  16
  17 static void *sbh;
  18
  19 // v2.x - - - - -
  20 #define DIAG_GPIO (1<<1)
  21 #define DMZ_GPIO  (1<<7)
  22
  23 static void set_gpio(uint32 mask, uint32 value) {
  24         sb_gpiocontrol(sbh,mask,0);
  25         sb_gpioouten(sbh,mask,mask);
  26         sb_gpioout(sbh,mask,value);
  27 }
  28
  29 static void v2_set_diag(u8 state) {
  30         set_gpio(DIAG_GPIO,state);
  31 }
  32 static void v2_set_dmz(u8 state) {
  33         set_gpio(DMZ_GPIO,state);
  34 }
  35
  36 // v1.x - - - - -
  37 #define LED_DIAG   0x13
  38 #define LED_DMZ    0x12
  39
  40 static void v1_set_diag(u8 state) {
  41         if (!state) {
  42                 *(volatile u8*)(KSEG1ADDR(BCM4710_EUART)+LED_DIAG)=0xFF;
  43         } else {
  44                 *(volatile u8*)(KSEG1ADDR(BCM4710_EUART)+LED_DIAG);
  45         }
  46 }
  47 static void v1_set_dmz(u8 state) {
  48         if (!state) {
  49                 *(volatile u8*)(KSEG1ADDR(BCM4710_EUART)+LED_DMZ)=0xFF;
  50         } else {
  51                 *(volatile u8*)(KSEG1ADDR(BCM4710_EUART)+LED_DMZ);
  52         }
  53 }
  54
  55 // - - - - -
  56 static void ignore(u8 ignored) {};
  57
  58 // - - - - -
  59 #define BIT_DMZ         0x01
  60 #define BIT_DIAG        0x04
  61
  62 void (*set_diag)(u8 state);
  63 void (*set_dmz)(u8 state);
  64
  65 static unsigned int diag = 0;
  66 static struct timer_list timer;
  67
  68 static void diag_change()
  69 {
  70         printk(KERN_INFO "led -> %02x\n",diag);
  71
  72         set_diag(0xFF); // off
  73         set_dmz(0xFF); // off
  74
  75         if(diag & BIT_DIAG)
  76                 set_diag(0x00); // on
  77         if(diag & BIT_DMZ)
  78                 set_dmz(0x00); // on
  79 }
  80
  81 static int proc_diag(ctl_table *table, int write, struct file *filp,
  82                 void *buffer, size_t *lenp)
  83 {
  84         int r;
  85         r = proc_dointvec(table, write, filp, buffer, lenp);
  86         if (write && !r) {
  87                 diag_change();
  88         }
  89         return r;
  90 }
  91
  92 // - - - - -
  93 static struct ctl_table_header *diag_sysctl_header;
  94
  95 static ctl_table sys_diag[] = {
  96          {
  97            ctl_name: 2000,
  98            procname: "diag",
  99            data: &diag,
 100            maxlen: sizeof(diag),
 101            mode: 0644,
 102            proc_handler: proc_diag
 103          },
 104          { 0 }
 105 };
 106
 107 static int __init diag_init()
 108 {
 109         u32 board_type;
 110         sbh = sb_kattach();
 111         sb_gpiosetcore(sbh);
 112
 113         board_type = sb_boardtype(sbh);
 114         printk(KERN_INFO "diag board_type: %08x\n",board_type);
 115
 116         if (board_type & 0x400) {
 117                 set_diag=v1_set_diag;
 118                 set_dmz=v1_set_dmz;
 119                 if (board_type==0x41d) {
 120                         printk(KERN_INFO "buffalo hack.\n");
 121                         set_diag=ignore;
 122                         set_dmz=v2_set_dmz;
 123                 }
 124                 board_type=1;
 125         } else {
 126                 board_type=2;
 127                 set_diag=v2_set_diag;
 128                 set_dmz=v2_set_dmz;
 129         }
 130         printk(KERN_INFO "using v%d hardware\n",board_type);
 131
 132         diag_sysctl_header = register_sysctl_table(sys_diag, 0);
 133         diag_change();
 134
 135         return 0;
 136 }
 137
 138 static void __exit diag_exit()
 139 {
 140         unregister_sysctl_table(diag_sysctl_header);
 141         del_timer(&timer);
 142 }
 143
 144 module_init(diag_init);
 145 module_exit(diag_exit);