Initial revision
[openwrt/svn-archive/archive.git] / obsolete-buildroot / sources / openwrt-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 #define BIT_DMZ 0x01
57 #define BIT_DIAG 0x04
58
59 void (*set_diag)(u8 state);
60 void (*set_dmz)(u8 state);
61
62 static unsigned int diag = 0;
63 static struct timer_list timer;
64
65 static void diag_change()
66 {
67 printk(KERN_INFO "led -> %02x\n",diag);
68
69 set_diag(0xFF); // off
70 set_dmz(0xFF); // off
71
72 if(diag & BIT_DIAG)
73 set_diag(0x00); // on
74 if(diag & BIT_DMZ)
75 set_dmz(0x00); // on
76 }
77
78 static int proc_diag(ctl_table *table, int write, struct file *filp,
79 void *buffer, size_t *lenp)
80 {
81 int r;
82 r = proc_dointvec(table, write, filp, buffer, lenp);
83 if (write && !r) {
84 diag_change();
85 }
86 return r;
87 }
88
89 // - - - - -
90 static struct ctl_table_header *diag_sysctl_header;
91
92 static ctl_table sys_diag[] = {
93 {
94 ctl_name: 2000,
95 procname: "diag",
96 data: &diag,
97 maxlen: sizeof(diag),
98 mode: 0644,
99 proc_handler: proc_diag
100 },
101 { 0 }
102 };
103
104 static int __init diag_init()
105 {
106 u32 board_type;
107 sbh = sb_kattach();
108 sb_gpiosetcore(sbh);
109
110 board_type = sb_boardtype(sbh);
111 printk(KERN_INFO "diag board_type: %08x\n",board_type);
112
113 if (board_type & 0x400) {
114 board_type=1;
115 set_diag=v1_set_diag;
116 set_dmz=v1_set_dmz;
117 } else {
118 board_type=2;
119 set_diag=v2_set_diag;
120 set_dmz=v2_set_dmz;
121 }
122 printk(KERN_INFO "using v%d hardware\n",board_type);
123
124 diag_sysctl_header = register_sysctl_table(sys_diag, 0);
125 diag_change();
126
127 return 0;
128 }
129
130 static void __exit diag_exit()
131 {
132 unregister_sysctl_table(diag_sysctl_header);
133 del_timer(&timer);
134 }
135
136 module_init(diag_init);
137 module_exit(diag_exit);