Blame view

drivers/parisc/led.c 19.8 KB
2874c5fd2   Thomas Gleixner   treewide: Replace...
1
  // SPDX-License-Identifier: GPL-2.0-or-later
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2
3
4
5
6
  /*
   *    Chassis LCD/LED driver for HP-PARISC workstations
   *
   *      (c) Copyright 2000 Red Hat Software
   *      (c) Copyright 2000 Helge Deller <hdeller@redhat.com>
8a1def457   Helge Deller   parisc: blink all...
7
   *      (c) Copyright 2001-2009 Helge Deller <deller@gmx.de>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
8
9
   *      (c) Copyright 2001 Randolph Chung <tausq@debian.org>
   *
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
10
11
12
13
14
15
16
   * TODO:
   *	- speed-up calculations with inlined assembler
   *	- interface to write to second row of LCD from /proc (if technically possible)
   *
   * Changes:
   *      - Audit copy_from_user in led_proc_write.
   *                                Daniele Bellucci <bellucda@tiscali.it>
349949520   Grant Grundler   [PARISC] Use work...
17
18
19
   *	- Switch from using a tasklet to a work queue, so the led_LCD_driver
   *	  	can sleep.
   *	  			  David Pye <dmp@davidmpye.dyndns.org>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
20
   */
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
21
22
23
24
25
26
  #include <linux/module.h>
  #include <linux/stddef.h>	/* for offsetof() */
  #include <linux/init.h>
  #include <linux/types.h>
  #include <linux/ioport.h>
  #include <linux/utsname.h>
c59ede7b7   Randy.Dunlap   [PATCH] move capa...
27
  #include <linux/capability.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
28
29
30
31
32
33
34
35
  #include <linux/delay.h>
  #include <linux/netdevice.h>
  #include <linux/inetdevice.h>
  #include <linux/in.h>
  #include <linux/interrupt.h>
  #include <linux/kernel_stat.h>
  #include <linux/reboot.h>
  #include <linux/proc_fs.h>
217bfb519   Alexey Dobriyan   parisc: convert /...
36
  #include <linux/seq_file.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
37
38
  #include <linux/ctype.h>
  #include <linux/blkdev.h>
349949520   Grant Grundler   [PARISC] Use work...
39
  #include <linux/workqueue.h>
e5ed63991   Herbert Xu   [IPV4]: Replace _...
40
  #include <linux/rcupdate.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
41
42
43
44
45
46
  #include <asm/io.h>
  #include <asm/processor.h>
  #include <asm/hardware.h>
  #include <asm/param.h>		/* HZ */
  #include <asm/led.h>
  #include <asm/pdc.h>
7c0f6ba68   Linus Torvalds   Replace <asm/uacc...
47
  #include <linux/uaccess.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
48
49
  
  /* The control of the LEDs and LCDs on PARISC-machines have to be done 
349949520   Grant Grundler   [PARISC] Use work...
50
51
52
     completely in software. The necessary calculations are done in a work queue
     task which is scheduled regularly, and since the calculations may consume a 
     relatively large amount of CPU time, some of the calculations can be 
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
53
     turned off with the following variables (controlled via procfs) */
8039de10a   Helge Deller   [PARISC] Add __re...
54
  static int led_type __read_mostly = -1;
349949520   Grant Grundler   [PARISC] Use work...
55
  static unsigned char lastleds;	/* LED state from most recent update */
8039de10a   Helge Deller   [PARISC] Add __re...
56
57
58
59
60
  static unsigned int led_heartbeat __read_mostly = 1;
  static unsigned int led_diskio    __read_mostly = 1;
  static unsigned int led_lanrxtx   __read_mostly = 1;
  static char lcd_text[32]          __read_mostly;
  static char lcd_text_default[32]  __read_mostly;
79a042962   Guy Martin   parisc: KittyHawk...
61
  static int  lcd_no_led_support    __read_mostly = 0; /* KittyHawk doesn't support LED on its LCD */
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
62

349949520   Grant Grundler   [PARISC] Use work...
63
64
  
  static struct workqueue_struct *led_wq;
6858f3bf6   David Howells   [PATCH] WorkStruc...
65
66
  static void led_work_func(struct work_struct *);
  static DECLARE_DELAYED_WORK(led_task, led_work_func);
349949520   Grant Grundler   [PARISC] Use work...
67

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
68
69
70
71
72
  #if 0
  #define DPRINTK(x)	printk x
  #else
  #define DPRINTK(x)
  #endif
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
  struct lcd_block {
  	unsigned char command;	/* stores the command byte      */
  	unsigned char on;	/* value for turning LED on     */
  	unsigned char off;	/* value for turning LED off    */
  };
  
  /* Structure returned by PDC_RETURN_CHASSIS_INFO */
  /* NOTE: we use unsigned long:16 two times, since the following member 
     lcd_cmd_reg_addr needs to be 64bit aligned on 64bit PA2.0-machines */
  struct pdc_chassis_lcd_info_ret_block {
  	unsigned long model:16;		/* DISPLAY_MODEL_XXXX */
  	unsigned long lcd_width:16;	/* width of the LCD in chars (DISPLAY_MODEL_LCD only) */
  	unsigned long lcd_cmd_reg_addr;	/* ptr to LCD cmd-register & data ptr for LED */
  	unsigned long lcd_data_reg_addr; /* ptr to LCD data-register (LCD only) */
  	unsigned int min_cmd_delay;	/* delay in uS after cmd-write (LCD only) */
  	unsigned char reset_cmd1;	/* command #1 for writing LCD string (LCD only) */
  	unsigned char reset_cmd2;	/* command #2 for writing LCD string (LCD only) */
  	unsigned char act_enable;	/* 0 = no activity (LCD only) */
  	struct lcd_block heartbeat;
  	struct lcd_block disk_io;
  	struct lcd_block lan_rcv;
  	struct lcd_block lan_tx;
  	char _pad;
  };
  
  
  /* LCD_CMD and LCD_DATA for KittyHawk machines */
  #define KITTYHAWK_LCD_CMD  F_EXTEND(0xf0190000UL) /* 64bit-ready */
  #define KITTYHAWK_LCD_DATA (KITTYHAWK_LCD_CMD+1)
  
  /* lcd_info is pre-initialized to the values needed to program KittyHawk LCD's 
   * HP seems to have used Sharp/Hitachi HD44780 LCDs most of the time. */
  static struct pdc_chassis_lcd_info_ret_block
8039de10a   Helge Deller   [PARISC] Add __re...
106
  lcd_info __attribute__((aligned(8))) __read_mostly =
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
107
108
109
110
111
  {
  	.model =		DISPLAY_MODEL_LCD,
  	.lcd_width =		16,
  	.lcd_cmd_reg_addr =	KITTYHAWK_LCD_CMD,
  	.lcd_data_reg_addr =	KITTYHAWK_LCD_DATA,
79a042962   Guy Martin   parisc: KittyHawk...
112
  	.min_cmd_delay =	80,
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
113
114
115
116
117
118
119
120
121
  	.reset_cmd1 =		0x80,
  	.reset_cmd2 =		0xc0,
  };
  
  
  /* direct access to some of the lcd_info variables */
  #define LCD_CMD_REG	lcd_info.lcd_cmd_reg_addr	 
  #define LCD_DATA_REG	lcd_info.lcd_data_reg_addr	 
  #define LED_DATA_REG	lcd_info.lcd_cmd_reg_addr	/* LASI & ASP only */
349949520   Grant Grundler   [PARISC] Use work...
122
123
124
125
126
127
128
129
  #define LED_HASLCD 1
  #define LED_NOLCD  0
  
  /* The workqueue must be created at init-time */
  static int start_task(void) 
  {	
  	/* Display the default text now */
  	if (led_type == LED_HASLCD) lcd_print( lcd_text_default );
79a042962   Guy Martin   parisc: KittyHawk...
130
131
  	/* KittyHawk has no LED support on its LCD */
  	if (lcd_no_led_support) return 0;
349949520   Grant Grundler   [PARISC] Use work...
132
133
  	/* Create the work queue and queue the LED task */
  	led_wq = create_singlethread_workqueue("led_wq");	
6858f3bf6   David Howells   [PATCH] WorkStruc...
134
  	queue_delayed_work(led_wq, &led_task, 0);
349949520   Grant Grundler   [PARISC] Use work...
135
136
137
138
139
  
  	return 0;
  }
  
  device_initcall(start_task);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
140
141
  
  /* ptr to LCD/LED-specific function */
8039de10a   Helge Deller   [PARISC] Add __re...
142
  static void (*led_func_ptr) (unsigned char) __read_mostly;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
143

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
144
  #ifdef CONFIG_PROC_FS
217bfb519   Alexey Dobriyan   parisc: convert /...
145
  static int led_proc_show(struct seq_file *m, void *v)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
146
  {
217bfb519   Alexey Dobriyan   parisc: convert /...
147
  	switch ((long)m->private)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
148
149
  	{
  	case LED_NOLCD:
217bfb519   Alexey Dobriyan   parisc: convert /...
150
151
152
153
154
155
  		seq_printf(m, "Heartbeat: %d
  ", led_heartbeat);
  		seq_printf(m, "Disk IO: %d
  ", led_diskio);
  		seq_printf(m, "LAN Rx/Tx: %d
  ", led_lanrxtx);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
156
157
  		break;
  	case LED_HASLCD:
217bfb519   Alexey Dobriyan   parisc: convert /...
158
159
  		seq_printf(m, "%s
  ", lcd_text);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
160
161
  		break;
  	default:
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
162
163
  		return 0;
  	}
217bfb519   Alexey Dobriyan   parisc: convert /...
164
165
  	return 0;
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
166

217bfb519   Alexey Dobriyan   parisc: convert /...
167
168
  static int led_proc_open(struct inode *inode, struct file *file)
  {
d9dda78ba   Al Viro   procfs: new helpe...
169
  	return single_open(file, led_proc_show, PDE_DATA(inode));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
170
  }
217bfb519   Alexey Dobriyan   parisc: convert /...
171

2d76978d5   Helge Deller   parisc/led: Fix s...
172
  static ssize_t led_proc_write(struct file *file, const char __user *buf,
217bfb519   Alexey Dobriyan   parisc: convert /...
173
  	size_t count, loff_t *pos)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
174
  {
d9dda78ba   Al Viro   procfs: new helpe...
175
  	void *data = PDE_DATA(file_inode(file));
4b4fd27c0   Helge Deller   PARISC: led.c - f...
176
  	char *cur, lbuf[32];
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
177
178
179
180
  	int d;
  
  	if (!capable(CAP_SYS_ADMIN))
  		return -EACCES;
4b4fd27c0   Helge Deller   PARISC: led.c - f...
181
182
  	if (count >= sizeof(lbuf))
  		count = sizeof(lbuf)-1;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
183
184
185
  
  	if (copy_from_user(lbuf, buf, count))
  		return -EFAULT;
4b4fd27c0   Helge Deller   PARISC: led.c - f...
186
  	lbuf[count] = 0;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
187
188
  
  	cur = lbuf;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
  	switch ((long)data)
  	{
  	case LED_NOLCD:
  		d = *cur++ - '0';
  		if (d != 0 && d != 1) goto parse_error;
  		led_heartbeat = d;
  
  		if (*cur++ != ' ') goto parse_error;
  
  		d = *cur++ - '0';
  		if (d != 0 && d != 1) goto parse_error;
  		led_diskio = d;
  
  		if (*cur++ != ' ') goto parse_error;
  
  		d = *cur++ - '0';
  		if (d != 0 && d != 1) goto parse_error;
  		led_lanrxtx = d;
  
  		break;
  	case LED_HASLCD:
  		if (*cur && cur[strlen(cur)-1] == '
  ')
  			cur[strlen(cur)-1] = 0;
  		if (*cur == 0) 
  			cur = lcd_text_default;
  		lcd_print(cur);
  		break;
  	default:
  		return 0;
  	}
  	
  	return count;
  
  parse_error:
  	if ((long)data == LED_NOLCD)
  		printk(KERN_CRIT "Parse error: expect \"n n n\" (n == 0 or 1) for heartbeat,
  disk io and lan tx/rx indicators
  ");
  	return -EINVAL;
  }
97a32539b   Alexey Dobriyan   proc: convert eve...
230
231
232
233
234
235
  static const struct proc_ops led_proc_ops = {
  	.proc_open	= led_proc_open,
  	.proc_read	= seq_read,
  	.proc_lseek	= seq_lseek,
  	.proc_release	= single_release,
  	.proc_write	= led_proc_write,
217bfb519   Alexey Dobriyan   parisc: convert /...
236
  };
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
237
238
239
240
241
242
  static int __init led_create_procfs(void)
  {
  	struct proc_dir_entry *proc_pdc_root = NULL;
  	struct proc_dir_entry *ent;
  
  	if (led_type == -1) return -1;
2d76978d5   Helge Deller   parisc/led: Fix s...
243
  	proc_pdc_root = proc_mkdir("pdc", NULL);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
244
  	if (!proc_pdc_root) return -1;
79a042962   Guy Martin   parisc: KittyHawk...
245
246
247
248
  
  	if (!lcd_no_led_support)
  	{
  		ent = proc_create_data("led", S_IRUGO|S_IWUSR, proc_pdc_root,
97a32539b   Alexey Dobriyan   proc: convert eve...
249
  					&led_proc_ops, (void *)LED_NOLCD); /* LED */
79a042962   Guy Martin   parisc: KittyHawk...
250
251
  		if (!ent) return -1;
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
252
253
254
  
  	if (led_type == LED_HASLCD)
  	{
217bfb519   Alexey Dobriyan   parisc: convert /...
255
  		ent = proc_create_data("lcd", S_IRUGO|S_IWUSR, proc_pdc_root,
97a32539b   Alexey Dobriyan   proc: convert eve...
256
  					&led_proc_ops, (void *)LED_HASLCD); /* LCD */
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
257
  		if (!ent) return -1;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
  	}
  
  	return 0;
  }
  #endif
  
  /*
     ** 
     ** led_ASP_driver()
     ** 
   */
  #define	LED_DATA	0x01	/* data to shift (0:on 1:off) */
  #define	LED_STROBE	0x02	/* strobe to clock data */
  static void led_ASP_driver(unsigned char leds)
  {
  	int i;
  
  	leds = ~leds;
  	for (i = 0; i < 8; i++) {
  		unsigned char value;
  		value = (leds & 0x80) >> 7;
  		gsc_writeb( value,		 LED_DATA_REG );
  		gsc_writeb( value | LED_STROBE,	 LED_DATA_REG );
  		leds <<= 1;
  	}
  }
  
  
  /*
     ** 
     ** led_LASI_driver()
     ** 
   */
  static void led_LASI_driver(unsigned char leds)
  {
  	leds = ~leds;
  	gsc_writeb( leds, LED_DATA_REG );
  }
  
  
  /*
     ** 
     ** led_LCD_driver()
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
301
302
303
304
     **   
   */
  static void led_LCD_driver(unsigned char leds)
  {
349949520   Grant Grundler   [PARISC] Use work...
305
306
307
308
309
310
311
312
313
314
315
316
317
  	static int i;
  	static unsigned char mask[4] = { LED_HEARTBEAT, LED_DISK_IO,
  		LED_LAN_RCV, LED_LAN_TX };
  	
  	static struct lcd_block * blockp[4] = {
  		&lcd_info.heartbeat,
  		&lcd_info.disk_io,
  		&lcd_info.lan_rcv,
  		&lcd_info.lan_tx
  	};
  
  	/* Convert min_cmd_delay to milliseconds */
  	unsigned int msec_cmd_delay = 1 + (lcd_info.min_cmd_delay / 1000);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
318
  	
349949520   Grant Grundler   [PARISC] Use work...
319
320
321
322
323
324
325
326
327
328
329
  	for (i=0; i<4; ++i) 
  	{
  		if ((leds & mask[i]) != (lastleds & mask[i])) 
  		{
  			gsc_writeb( blockp[i]->command, LCD_CMD_REG );
  			msleep(msec_cmd_delay);
  			
  			gsc_writeb( leds & mask[i] ? blockp[i]->on : 
  					blockp[i]->off, LCD_DATA_REG );
  			msleep(msec_cmd_delay);
  		}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
330
331
332
333
334
335
336
337
  	}
  }
  
  
  /*
     ** 
     ** led_get_net_activity()
     ** 
93b1fae49   Adrian Bunk   spelling: s/troug...
338
     ** calculate if there was TX- or RX-throughput on the network interfaces
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
339
340
341
342
343
344
345
346
     ** (analog to dev_get_info() from net/core/dev.c)
     **   
   */
  static __inline__ int led_get_net_activity(void)
  { 
  #ifndef CONFIG_NET
  	return 0;
  #else
c442ef96b   Kyle McMartin   parisc: squelch w...
347
348
  	static u64 rx_total_last, tx_total_last;
  	u64 rx_total, tx_total;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
349
350
351
352
353
  	struct net_device *dev;
  	int retval;
  
  	rx_total = tx_total = 0;
  	
246c65add   Eric Dumazet   parisc: led: Use ...
354
  	/* we are running as a workqueue task, so we can use an RCU lookup */
e5ed63991   Herbert Xu   [IPV4]: Replace _...
355
  	rcu_read_lock();
246c65add   Eric Dumazet   parisc: led: Use ...
356
  	for_each_netdev_rcu(&init_net, dev) {
c442ef96b   Kyle McMartin   parisc: squelch w...
357
  	    const struct rtnl_link_stats64 *stats;
28172739f   Eric Dumazet   net: fix 64 bit c...
358
  	    struct rtnl_link_stats64 temp;
e5ed63991   Herbert Xu   [IPV4]: Replace _...
359
  	    struct in_device *in_dev = __in_dev_get_rcu(dev);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
360
361
  	    if (!in_dev || !in_dev->ifa_list)
  		continue;
17159b0b4   Joe Perches   [PARISC]: Fix bui...
362
  	    if (ipv4_is_loopback(in_dev->ifa_list->ifa_local))
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
363
  		continue;
28172739f   Eric Dumazet   net: fix 64 bit c...
364
  	    stats = dev_get_stats(dev, &temp);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
365
366
367
  	    rx_total += stats->rx_packets;
  	    tx_total += stats->tx_packets;
  	}
e5ed63991   Herbert Xu   [IPV4]: Replace _...
368
  	rcu_read_unlock();
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
  
  	retval = 0;
  
  	if (rx_total != rx_total_last) {
  		rx_total_last = rx_total;
  		retval |= LED_LAN_RCV;
  	}
  
  	if (tx_total != tx_total_last) {
  		tx_total_last = tx_total;
  		retval |= LED_LAN_TX;
  	}
  
  	return retval;
  #endif
  }
  
  
  /*
     ** 
     ** led_get_diskio_activity()
     ** 
     ** calculate if there was disk-io in the system
     **   
   */
  static __inline__ int led_get_diskio_activity(void)
  {	
  	static unsigned long last_pgpgin, last_pgpgout;
f8891e5e1   Christoph Lameter   [PATCH] Light wei...
397
  	unsigned long events[NR_VM_EVENT_ITEMS];
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
398
  	int changed;
349949520   Grant Grundler   [PARISC] Use work...
399

f8891e5e1   Christoph Lameter   [PATCH] Light wei...
400
  	all_vm_events(events);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
401
402
403
  
  	/* Just use a very simple calculation here. Do not care about overflow,
  	   since we only want to know if there was activity or not. */
f8891e5e1   Christoph Lameter   [PATCH] Light wei...
404
405
406
407
  	changed = (events[PGPGIN] != last_pgpgin) ||
  		  (events[PGPGOUT] != last_pgpgout);
  	last_pgpgin  = events[PGPGIN];
  	last_pgpgout = events[PGPGOUT];
349949520   Grant Grundler   [PARISC] Use work...
408

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
409
410
411
412
413
414
  	return (changed ? LED_DISK_IO : 0);
  }
  
  
  
  /*
349949520   Grant Grundler   [PARISC] Use work...
415
     ** led_work_func()
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
416
     ** 
349949520   Grant Grundler   [PARISC] Use work...
417
     ** manages when and which chassis LCD/LED gets updated
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
418
419
420
421
422
  
      TODO:
      - display load average (older machines like 715/64 have 4 "free" LED's for that)
      - optimizations
   */
349949520   Grant Grundler   [PARISC] Use work...
423
424
  #define HEARTBEAT_LEN (HZ*10/100)
  #define HEARTBEAT_2ND_RANGE_START (HZ*28/100)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
425
  #define HEARTBEAT_2ND_RANGE_END   (HEARTBEAT_2ND_RANGE_START + HEARTBEAT_LEN)
349949520   Grant Grundler   [PARISC] Use work...
426
  #define LED_UPDATE_INTERVAL (1 + (HZ*19/1000))
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
427

6858f3bf6   David Howells   [PATCH] WorkStruc...
428
  static void led_work_func (struct work_struct *unused)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
429
  {
349949520   Grant Grundler   [PARISC] Use work...
430
  	static unsigned long last_jiffies;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
431
  	static unsigned long count_HZ; /* counter in range 0..HZ */
349949520   Grant Grundler   [PARISC] Use work...
432
  	unsigned char currentleds = 0; /* stores current value of the LEDs */
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
433
434
435
436
  
  	/* exit if not initialized */
  	if (!led_func_ptr)
  	    return;
349949520   Grant Grundler   [PARISC] Use work...
437
438
439
440
  	/* increment the heartbeat timekeeper */
  	count_HZ += jiffies - last_jiffies;
  	last_jiffies = jiffies;
  	if (count_HZ >= HZ)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
441
  	    count_HZ = 0;
349949520   Grant Grundler   [PARISC] Use work...
442
  	if (likely(led_heartbeat))
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
443
  	{
349949520   Grant Grundler   [PARISC] Use work...
444
445
446
447
448
449
450
  		/* flash heartbeat-LED like a real heart
  		 * (2 x short then a long delay)
  		 */
  		if (count_HZ < HEARTBEAT_LEN || 
  				(count_HZ >= HEARTBEAT_2ND_RANGE_START &&
  				count_HZ < HEARTBEAT_2ND_RANGE_END)) 
  			currentleds |= LED_HEARTBEAT;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
451
  	}
349949520   Grant Grundler   [PARISC] Use work...
452
453
  	if (likely(led_lanrxtx))  currentleds |= led_get_net_activity();
  	if (likely(led_diskio))   currentleds |= led_get_diskio_activity();
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
454

8a1def457   Helge Deller   parisc: blink all...
455
456
457
458
459
460
461
462
463
464
465
466
467
468
  	/* blink LEDs if we got an Oops (HPMC) */
  	if (unlikely(oops_in_progress)) {
  		if (boot_cpu_data.cpu_type >= pcxl2) {
  			/* newer machines don't have loadavg. LEDs, so we
  			 * let all LEDs blink twice per second instead */
  			currentleds = (count_HZ <= (HZ/2)) ? 0 : 0xff;
  		} else {
  			/* old machines: blink loadavg. LEDs twice per second */
  			if (count_HZ <= (HZ/2))
  				currentleds &= ~(LED4|LED5|LED6|LED7);
  			else
  				currentleds |= (LED4|LED5|LED6|LED7);
  		}
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
469

349949520   Grant Grundler   [PARISC] Use work...
470
471
472
473
474
  	if (currentleds != lastleds)
  	{
  		led_func_ptr(currentleds);	/* Update the LCD/LEDs */
  		lastleds = currentleds;
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
475

349949520   Grant Grundler   [PARISC] Use work...
476
477
  	queue_delayed_work(led_wq, &led_task, LED_UPDATE_INTERVAL);
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
478
479
480
481
482
483
484
485
486
487
488
489
490
491
  
  /*
     ** led_halt()
     ** 
     ** called by the reboot notifier chain at shutdown and stops all
     ** LED/LCD activities.
     ** 
   */
  
  static int led_halt(struct notifier_block *, unsigned long, void *);
  
  static struct notifier_block led_notifier = {
  	.notifier_call = led_halt,
  };
e041c6834   Alan Stern   [PATCH] Notifier ...
492
  static int notifier_disabled = 0;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
493
494
495
496
  
  static int led_halt(struct notifier_block *nb, unsigned long event, void *buf) 
  {
  	char *txt;
e041c6834   Alan Stern   [PATCH] Notifier ...
497
498
499
500
501
  
  	if (notifier_disabled)
  		return NOTIFY_OK;
  
  	notifier_disabled = 1;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
502
503
504
505
506
507
508
509
510
511
  	switch (event) {
  	case SYS_RESTART:	txt = "SYSTEM RESTART";
  				break;
  	case SYS_HALT:		txt = "SYSTEM HALT";
  				break;
  	case SYS_POWER_OFF:	txt = "SYSTEM POWER OFF";
  				break;
  	default:		return NOTIFY_DONE;
  	}
  	
349949520   Grant Grundler   [PARISC] Use work...
512
513
  	/* Cancel the work item and delete the queue */
  	if (led_wq) {
8a1def457   Helge Deller   parisc: blink all...
514
  		cancel_delayed_work_sync(&led_task);
349949520   Grant Grundler   [PARISC] Use work...
515
516
517
518
  		destroy_workqueue(led_wq);
  		led_wq = NULL;
  	}
   
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
519
520
521
522
523
524
  	if (lcd_info.model == DISPLAY_MODEL_LCD)
  		lcd_print(txt);
  	else
  		if (led_func_ptr)
  			led_func_ptr(0xff); /* turn all LEDs ON */
  	
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
  	return NOTIFY_OK;
  }
  
  /*
     ** register_led_driver()
     ** 
     ** registers an external LED or LCD for usage by this driver.
     ** currently only LCD-, LASI- and ASP-style LCD/LED's are supported.
     ** 
   */
  
  int __init register_led_driver(int model, unsigned long cmd_reg, unsigned long data_reg)
  {
  	static int initialized;
  	
  	if (initialized || !data_reg)
  		return 1;
  	
  	lcd_info.model = model;		/* store the values */
  	LCD_CMD_REG = (cmd_reg == LED_CMD_REG_NONE) ? 0 : cmd_reg;
  
  	switch (lcd_info.model) {
  	case DISPLAY_MODEL_LCD:
  		LCD_DATA_REG = data_reg;
  		printk(KERN_INFO "LCD display at %lx,%lx registered
  ", 
  			LCD_CMD_REG , LCD_DATA_REG);
  		led_func_ptr = led_LCD_driver;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
553
554
555
556
  		led_type = LED_HASLCD;
  		break;
  
  	case DISPLAY_MODEL_LASI:
b43874904   Helge Deller   parisc: Skip regi...
557
558
559
  		/* Skip to register LED in QEMU */
  		if (running_on_qemu)
  			return 1;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
  		LED_DATA_REG = data_reg;
  		led_func_ptr = led_LASI_driver;
  		printk(KERN_INFO "LED display at %lx registered
  ", LED_DATA_REG);
  		led_type = LED_NOLCD;
  		break;
  
  	case DISPLAY_MODEL_OLD_ASP:
  		LED_DATA_REG = data_reg;
  		led_func_ptr = led_ASP_driver;
  		printk(KERN_INFO "LED (ASP-style) display at %lx registered
  ", 
  		    LED_DATA_REG);
  		led_type = LED_NOLCD;
  		break;
  
  	default:
  		printk(KERN_ERR "%s: Wrong LCD/LED model %d !
  ",
a8043ecb1   Harvey Harrison   drivers/parisc: r...
579
  		       __func__, lcd_info.model);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
580
581
582
583
584
585
586
  		return 1;
  	}
  	
  	/* mark the LCD/LED driver now as initialized and 
  	 * register to the reboot notifier chain */
  	initialized++;
  	register_reboot_notifier(&led_notifier);
349949520   Grant Grundler   [PARISC] Use work...
587
588
  	/* Ensure the work is queued */
  	if (led_wq) {
6858f3bf6   David Howells   [PATCH] WorkStruc...
589
  		queue_delayed_work(led_wq, &led_task, 0);
349949520   Grant Grundler   [PARISC] Use work...
590
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
  	return 0;
  }
  
  /*
     ** register_led_regions()
     ** 
     ** register_led_regions() registers the LCD/LED regions for /procfs.
     ** At bootup - where the initialisation of the LCD/LED normally happens - 
     ** not all internal structures of request_region() are properly set up,
     ** so that we delay the led-registration until after busdevices_init() 
     ** has been executed.
     **
   */
  
  void __init register_led_regions(void)
  {
  	switch (lcd_info.model) {
  	case DISPLAY_MODEL_LCD:
  		request_mem_region((unsigned long)LCD_CMD_REG,  1, "lcd_cmd");
  		request_mem_region((unsigned long)LCD_DATA_REG, 1, "lcd_data");
  		break;
  	case DISPLAY_MODEL_LASI:
  	case DISPLAY_MODEL_OLD_ASP:
  		request_mem_region((unsigned long)LED_DATA_REG, 1, "led_data");
  		break;
  	}
  }
  
  
  /*
     ** 
     ** lcd_print()
     ** 
     ** Displays the given string on the LCD-Display of newer machines.
349949520   Grant Grundler   [PARISC] Use work...
625
626
     ** lcd_print() disables/enables the timer-based led work queue to
     ** avoid a race condition while writing the CMD/DATA register pair.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
627
628
     **
   */
6e16d9409   Helge Deller   [PARISC] Convert ...
629
  int lcd_print( const char *str )
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
630
631
632
633
634
635
  {
  	int i;
  
  	if (!led_func_ptr || lcd_info.model != DISPLAY_MODEL_LCD)
  	    return 0;
  	
349949520   Grant Grundler   [PARISC] Use work...
636
637
  	/* temporarily disable the led work task */
  	if (led_wq)
8a1def457   Helge Deller   parisc: blink all...
638
  		cancel_delayed_work_sync(&led_task);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
639
640
641
  
  	/* copy display string to buffer for procfs */
  	strlcpy(lcd_text, str, sizeof(lcd_text));
349949520   Grant Grundler   [PARISC] Use work...
642

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
643
644
645
646
647
648
649
650
651
652
653
654
655
  	/* Set LCD Cursor to 1st character */
  	gsc_writeb(lcd_info.reset_cmd1, LCD_CMD_REG);
  	udelay(lcd_info.min_cmd_delay);
  
  	/* Print the string */
  	for (i=0; i < lcd_info.lcd_width; i++) {
  	    if (str && *str)
  		gsc_writeb(*str++, LCD_DATA_REG);
  	    else
  		gsc_writeb(' ', LCD_DATA_REG);
  	    udelay(lcd_info.min_cmd_delay);
  	}
  	
349949520   Grant Grundler   [PARISC] Use work...
656
657
  	/* re-queue the work */
  	if (led_wq) {
6858f3bf6   David Howells   [PATCH] WorkStruc...
658
  		queue_delayed_work(led_wq, &led_task, 0);
349949520   Grant Grundler   [PARISC] Use work...
659
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
  
  	return lcd_info.lcd_width;
  }
  
  /*
     ** led_init()
     ** 
     ** led_init() is called very early in the bootup-process from setup.c 
     ** and asks the PDC for an usable chassis LCD or LED.
     ** If the PDC doesn't return any info, then the LED
     ** is detected by lasi.c or asp.c and registered with the
     ** above functions lasi_led_init() or asp_led_init().
     ** KittyHawk machines have often a buggy PDC, so that
     ** we explicitly check for those machines here.
   */
  
  int __init led_init(void)
  {
  	struct pdc_chassis_info chassis_info;
  	int ret;
  
  	snprintf(lcd_text_default, sizeof(lcd_text_default),
96b644bde   Serge E. Hallyn   [PATCH] namespace...
682
  		"Linux %s", init_utsname()->release);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
683
684
685
686
687
688
689
690
691
692
693
  
  	/* Work around the buggy PDC of KittyHawk-machines */
  	switch (CPU_HVERSION) {
  	case 0x580:		/* KittyHawk DC2-100 (K100) */
  	case 0x581:		/* KittyHawk DC3-120 (K210) */
  	case 0x582:		/* KittyHawk DC3 100 (K400) */
  	case 0x583:		/* KittyHawk DC3 120 (K410) */
  	case 0x58B:		/* KittyHawk DC2 100 (K200) */
  		printk(KERN_INFO "%s: KittyHawk-Machine (hversion 0x%x) found, "
  				"LED detection skipped.
  ", __FILE__, CPU_HVERSION);
79a042962   Guy Martin   parisc: KittyHawk...
694
  		lcd_no_led_support = 1;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767
  		goto found;	/* use the preinitialized values of lcd_info */
  	}
  
  	/* initialize the struct, so that we can check for valid return values */
  	lcd_info.model = DISPLAY_MODEL_NONE;
  	chassis_info.actcnt = chassis_info.maxcnt = 0;
  
  	ret = pdc_chassis_info(&chassis_info, &lcd_info, sizeof(lcd_info));
  	if (ret == PDC_OK) {
  		DPRINTK((KERN_INFO "%s: chassis info: model=%d (%s), "
  			 "lcd_width=%d, cmd_delay=%u,
  "
  			 "%s: sizecnt=%d, actcnt=%ld, maxcnt=%ld
  ",
  		         __FILE__, lcd_info.model,
  			 (lcd_info.model==DISPLAY_MODEL_LCD) ? "LCD" :
  			  (lcd_info.model==DISPLAY_MODEL_LASI) ? "LED" : "unknown",
  			 lcd_info.lcd_width, lcd_info.min_cmd_delay,
  			 __FILE__, sizeof(lcd_info), 
  			 chassis_info.actcnt, chassis_info.maxcnt));
  		DPRINTK((KERN_INFO "%s: cmd=%p, data=%p, reset1=%x, reset2=%x, act_enable=%d
  ",
  			__FILE__, lcd_info.lcd_cmd_reg_addr, 
  			lcd_info.lcd_data_reg_addr, lcd_info.reset_cmd1,  
  			lcd_info.reset_cmd2, lcd_info.act_enable ));
  	
  		/* check the results. Some machines have a buggy PDC */
  		if (chassis_info.actcnt <= 0 || chassis_info.actcnt != chassis_info.maxcnt)
  			goto not_found;
  
  		switch (lcd_info.model) {
  		case DISPLAY_MODEL_LCD:		/* LCD display */
  			if (chassis_info.actcnt < 
  				offsetof(struct pdc_chassis_lcd_info_ret_block, _pad)-1)
  				goto not_found;
  			if (!lcd_info.act_enable) {
  				DPRINTK((KERN_INFO "PDC prohibited usage of the LCD.
  "));
  				goto not_found;
  			}
  			break;
  
  		case DISPLAY_MODEL_NONE:	/* no LED or LCD available */
  			printk(KERN_INFO "PDC reported no LCD or LED.
  ");
  			goto not_found;
  
  		case DISPLAY_MODEL_LASI:	/* Lasi style 8 bit LED display */
  			if (chassis_info.actcnt != 8 && chassis_info.actcnt != 32)
  				goto not_found;
  			break;
  
  		default:
  			printk(KERN_WARNING "PDC reported unknown LCD/LED model %d
  ",
  			       lcd_info.model);
  			goto not_found;
  		} /* switch() */
  
  found:
  		/* register the LCD/LED driver */
  		register_led_driver(lcd_info.model, LCD_CMD_REG, LCD_DATA_REG);
  		return 0;
  
  	} else { /* if() */
  		DPRINTK((KERN_INFO "pdc_chassis_info call failed with retval = %d
  ", ret));
  	}
  
  not_found:
  	lcd_info.model = DISPLAY_MODEL_NONE;
  	return 1;
  }
e041c6834   Alan Stern   [PATCH] Notifier ...
768
769
770
771
772
  static void __exit led_exit(void)
  {
  	unregister_reboot_notifier(&led_notifier);
  	return;
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
773
774
775
  #ifdef CONFIG_PROC_FS
  module_init(led_create_procfs)
  #endif