2 * diag_led.c - replacement diag module
4 * Copyright (C) 2004 Mike Baker,
5 * Imre Kaloz <kaloz@dune.hu>
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License
9 * as published by the Free Software Foundation; either version 2
10 * of the License, or (at your option) any later version.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
26 * 2004/03/28 initial release
27 * 2004/08/26 asus & buffalo support added
28 * 2005/03/14 asus wl-500g deluxe and buffalo v2 support added
29 * 2005/04/13 added licensing informations
30 * 2005/04/18 base reset polarity off initial readings
31 * 2006/02/07 motorola wa840g/we800g support added
34 #include <linux/module.h>
35 #include <linux/init.h>
36 #include <linux/kernel.h>
37 #include <linux/sysctl.h>
44 extern char * nvram_get(const char *name
);
48 #define DIAG_GPIO (1<<1)
49 #define DMZ_GPIO (1<<7)
51 static void set_gpio(uint32 mask
, uint32 value
) {
52 sb_gpiocontrol(sbh
,mask
, 0, GPIO_DRV_PRIORITY
);
53 sb_gpioouten(sbh
,mask
,mask
,GPIO_DRV_PRIORITY
);
54 sb_gpioout(sbh
,mask
,value
,GPIO_DRV_PRIORITY
);
57 static void v2_set_diag(u8 state
) {
58 set_gpio(DIAG_GPIO
,state
);
60 static void v2_set_dmz(u8 state
) {
61 set_gpio(DMZ_GPIO
,state
);
68 static void v1_set_diag(u8 state
) {
70 *(volatile u8
*)(KSEG1ADDR(BCM4710_EUART
)+LED_DIAG
)=0xFF;
72 *(volatile u8
*)(KSEG1ADDR(BCM4710_EUART
)+LED_DIAG
);
75 static void v1_set_dmz(u8 state
) {
77 *(volatile u8
*)(KSEG1ADDR(BCM4710_EUART
)+LED_DMZ
)=0xFF;
79 *(volatile u8
*)(KSEG1ADDR(BCM4710_EUART
)+LED_DMZ
);
84 static void ignore(u8 ignored
) {};
90 void (*set_diag
)(u8 state
);
91 void (*set_dmz
)(u8 state
);
93 static unsigned int diag
= 0;
95 static void diag_change()
97 set_diag(0xFF); // off
101 set_diag(0x00); // on
106 static int proc_diag(ctl_table
*table
, int write
, struct file
*filp
,
107 void *buffer
, size_t *lenp
)
110 r
= proc_dointvec(table
, write
, filp
, buffer
, lenp
);
118 static unsigned char reset_gpio
= 0;
119 static unsigned char reset_polarity
= 0;
120 static unsigned int reset
= 0;
122 static int proc_reset(ctl_table
*table
, int write
, struct file
*filp
,
123 void *buffer
, size_t *lenp
)
127 sb_gpiocontrol(sbh
,reset_gpio
,reset_gpio
,GPIO_DRV_PRIORITY
);
128 sb_gpioouten(sbh
,reset_gpio
,0,GPIO_DRV_PRIORITY
);
129 reset
=!(sb_gpioin(sbh
)&reset_gpio
);
131 if (reset_polarity
) reset
=!reset
;
136 return proc_dointvec(table
, write
, filp
, buffer
, lenp
);
140 static struct ctl_table_header
*diag_sysctl_header
;
142 static ctl_table sys_diag
[] = {
147 maxlen
: sizeof(diag
),
149 proc_handler
: proc_diag
155 maxlen
: sizeof(reset
),
157 proc_handler
: proc_reset
162 static int __init
diag_init()
169 board_type
= sb_boardtype(sbh
);
170 printk(KERN_INFO
"diag boardtype: %08x\n",board_type
);
175 buf
=nvram_get("pmon_ver") ?: "";
176 if (((board_type
& 0xf00) == 0x400) && (strncmp(buf
, "CFE", 3) != 0)) {
177 buf
=nvram_get("boardtype")?:"";
178 if (!strcmp(buf
,"bcm94710dev")) {
179 buf
=nvram_get("boardnum")?:"";
180 if (!strcmp(buf
,"42")) {
182 set_diag
=v1_set_diag
;
186 if (!strcmp(buf
,"asusX")) {
190 if (!strcmp(buf
,"2")) {
191 //wa840g v1 / we800g v1
195 if (!strcmp(buf
,"bcm94710ap")) {
196 buf
=nvram_get("boardnum")?:"";
197 if (!strcmp(buf
,"42")) {
202 if (!strcmp(buf
,"44")) {
209 buf
=nvram_get("boardnum")?:"";
210 if (!strcmp(buf
,"42")) {
212 set_diag
=v2_set_diag
;
216 if (!strcmp(buf
,"44")) {
220 if (!strcmp(buf
,"00")) {
224 if (!strcmp(buf
,"45")) {
231 sb_gpiocontrol(sbh
,reset_gpio
,reset_gpio
,GPIO_DRV_PRIORITY
);
232 sb_gpioouten(sbh
,reset_gpio
,0,GPIO_DRV_PRIORITY
);
233 reset_polarity
=!(sb_gpioin(sbh
)&reset_gpio
);
235 diag_sysctl_header
= register_sysctl_table(sys_diag
, 0);
241 static void __exit
diag_exit()
243 unregister_sysctl_table(diag_sysctl_header
);
247 MODULE_AUTHOR("openwrt.org");
248 MODULE_LICENSE("GPL");
250 module_init(diag_init
);
251 module_exit(diag_exit
);
This page took 0.059843 seconds and 5 git commands to generate.