• Home
  • History
  • Annotate
  • Line#
  • Navigate
  • Raw
  • Download
  • only in /netgear-R7000-V1.0.7.12_1.2.5/components/opensource/linux/linux-2.6.36/drivers/char/
1/*
2 * SN Platform system controller communication support
3 *
4 * This file is subject to the terms and conditions of the GNU General Public
5 * License.  See the file "COPYING" in the main directory of this archive
6 * for more details.
7 *
8 * Copyright (C) 2004, 2006 Silicon Graphics, Inc. All rights reserved.
9 */
10
11/*
12 * System controller communication driver
13 *
14 * This driver allows a user process to communicate with the system
15 * controller (a.k.a. "IRouter") network in an SGI SN system.
16 */
17
18#include <linux/interrupt.h>
19#include <linux/sched.h>
20#include <linux/device.h>
21#include <linux/poll.h>
22#include <linux/module.h>
23#include <linux/slab.h>
24#include <linux/smp_lock.h>
25#include <asm/sn/io.h>
26#include <asm/sn/sn_sal.h>
27#include <asm/sn/module.h>
28#include <asm/sn/geo.h>
29#include <asm/sn/nodepda.h>
30#include "snsc.h"
31
32#define SYSCTL_BASENAME	"snsc"
33
34#define SCDRV_BUFSZ	2048
35#define SCDRV_TIMEOUT	1000
36
37static irqreturn_t
38scdrv_interrupt(int irq, void *subch_data)
39{
40	struct subch_data_s *sd = subch_data;
41	unsigned long flags;
42	int status;
43
44	spin_lock_irqsave(&sd->sd_rlock, flags);
45	spin_lock(&sd->sd_wlock);
46	status = ia64_sn_irtr_intr(sd->sd_nasid, sd->sd_subch);
47
48	if (status > 0) {
49		if (status & SAL_IROUTER_INTR_RECV) {
50			wake_up(&sd->sd_rq);
51		}
52		if (status & SAL_IROUTER_INTR_XMIT) {
53			ia64_sn_irtr_intr_disable
54			    (sd->sd_nasid, sd->sd_subch,
55			     SAL_IROUTER_INTR_XMIT);
56			wake_up(&sd->sd_wq);
57		}
58	}
59	spin_unlock(&sd->sd_wlock);
60	spin_unlock_irqrestore(&sd->sd_rlock, flags);
61	return IRQ_HANDLED;
62}
63
64/*
65 * scdrv_open
66 *
67 * Reserve a subchannel for system controller communication.
68 */
69
70static int
71scdrv_open(struct inode *inode, struct file *file)
72{
73	struct sysctl_data_s *scd;
74	struct subch_data_s *sd;
75	int rv;
76
77	/* look up device info for this device file */
78	scd = container_of(inode->i_cdev, struct sysctl_data_s, scd_cdev);
79
80	/* allocate memory for subchannel data */
81	sd = kzalloc(sizeof (struct subch_data_s), GFP_KERNEL);
82	if (sd == NULL) {
83		printk("%s: couldn't allocate subchannel data\n",
84		       __func__);
85		return -ENOMEM;
86	}
87
88	/* initialize subch_data_s fields */
89	sd->sd_nasid = scd->scd_nasid;
90	sd->sd_subch = ia64_sn_irtr_open(scd->scd_nasid);
91
92	if (sd->sd_subch < 0) {
93		kfree(sd);
94		printk("%s: couldn't allocate subchannel\n", __func__);
95		return -EBUSY;
96	}
97
98	spin_lock_init(&sd->sd_rlock);
99	spin_lock_init(&sd->sd_wlock);
100	init_waitqueue_head(&sd->sd_rq);
101	init_waitqueue_head(&sd->sd_wq);
102	sema_init(&sd->sd_rbs, 1);
103	sema_init(&sd->sd_wbs, 1);
104
105	file->private_data = sd;
106
107	/* hook this subchannel up to the system controller interrupt */
108	lock_kernel();
109	rv = request_irq(SGI_UART_VECTOR, scdrv_interrupt,
110			 IRQF_SHARED | IRQF_DISABLED,
111			 SYSCTL_BASENAME, sd);
112	if (rv) {
113		ia64_sn_irtr_close(sd->sd_nasid, sd->sd_subch);
114		kfree(sd);
115		printk("%s: irq request failed (%d)\n", __func__, rv);
116		unlock_kernel();
117		return -EBUSY;
118	}
119	unlock_kernel();
120	return 0;
121}
122
123/*
124 * scdrv_release
125 *
126 * Release a previously-reserved subchannel.
127 */
128
129static int
130scdrv_release(struct inode *inode, struct file *file)
131{
132	struct subch_data_s *sd = (struct subch_data_s *) file->private_data;
133	int rv;
134
135	/* free the interrupt */
136	free_irq(SGI_UART_VECTOR, sd);
137
138	/* ask SAL to close the subchannel */
139	rv = ia64_sn_irtr_close(sd->sd_nasid, sd->sd_subch);
140
141	kfree(sd);
142	return rv;
143}
144
145/*
146 * scdrv_read
147 *
148 * Called to read bytes from the open IRouter pipe.
149 *
150 */
151
152static inline int
153read_status_check(struct subch_data_s *sd, int *len)
154{
155	return ia64_sn_irtr_recv(sd->sd_nasid, sd->sd_subch, sd->sd_rb, len);
156}
157
158static ssize_t
159scdrv_read(struct file *file, char __user *buf, size_t count, loff_t *f_pos)
160{
161	int status;
162	int len;
163	unsigned long flags;
164	struct subch_data_s *sd = (struct subch_data_s *) file->private_data;
165
166	/* try to get control of the read buffer */
167	if (down_trylock(&sd->sd_rbs)) {
168		/* somebody else has it now;
169		 * if we're non-blocking, then exit...
170		 */
171		if (file->f_flags & O_NONBLOCK) {
172			return -EAGAIN;
173		}
174		/* ...or if we want to block, then do so here */
175		if (down_interruptible(&sd->sd_rbs)) {
176			/* something went wrong with wait */
177			return -ERESTARTSYS;
178		}
179	}
180
181	/* anything to read? */
182	len = CHUNKSIZE;
183	spin_lock_irqsave(&sd->sd_rlock, flags);
184	status = read_status_check(sd, &len);
185
186	/* if not, and we're blocking I/O, loop */
187	while (status < 0) {
188		DECLARE_WAITQUEUE(wait, current);
189
190		if (file->f_flags & O_NONBLOCK) {
191			spin_unlock_irqrestore(&sd->sd_rlock, flags);
192			up(&sd->sd_rbs);
193			return -EAGAIN;
194		}
195
196		len = CHUNKSIZE;
197		set_current_state(TASK_INTERRUPTIBLE);
198		add_wait_queue(&sd->sd_rq, &wait);
199		spin_unlock_irqrestore(&sd->sd_rlock, flags);
200
201		schedule_timeout(SCDRV_TIMEOUT);
202
203		remove_wait_queue(&sd->sd_rq, &wait);
204		if (signal_pending(current)) {
205			/* wait was interrupted */
206			up(&sd->sd_rbs);
207			return -ERESTARTSYS;
208		}
209
210		spin_lock_irqsave(&sd->sd_rlock, flags);
211		status = read_status_check(sd, &len);
212	}
213	spin_unlock_irqrestore(&sd->sd_rlock, flags);
214
215	if (len > 0) {
216		/* we read something in the last read_status_check(); copy
217		 * it out to user space
218		 */
219		if (count < len) {
220			pr_debug("%s: only accepting %d of %d bytes\n",
221				 __func__, (int) count, len);
222		}
223		len = min((int) count, len);
224		if (copy_to_user(buf, sd->sd_rb, len))
225			len = -EFAULT;
226	}
227
228	/* release the read buffer and wake anyone who might be
229	 * waiting for it
230	 */
231	up(&sd->sd_rbs);
232
233	/* return the number of characters read in */
234	return len;
235}
236
237/*
238 * scdrv_write
239 *
240 * Writes a chunk of an IRouter packet (or other system controller data)
241 * to the system controller.
242 *
243 */
244static inline int
245write_status_check(struct subch_data_s *sd, int count)
246{
247	return ia64_sn_irtr_send(sd->sd_nasid, sd->sd_subch, sd->sd_wb, count);
248}
249
250static ssize_t
251scdrv_write(struct file *file, const char __user *buf,
252	    size_t count, loff_t *f_pos)
253{
254	unsigned long flags;
255	int status;
256	struct subch_data_s *sd = (struct subch_data_s *) file->private_data;
257
258	/* try to get control of the write buffer */
259	if (down_trylock(&sd->sd_wbs)) {
260		/* somebody else has it now;
261		 * if we're non-blocking, then exit...
262		 */
263		if (file->f_flags & O_NONBLOCK) {
264			return -EAGAIN;
265		}
266		/* ...or if we want to block, then do so here */
267		if (down_interruptible(&sd->sd_wbs)) {
268			/* something went wrong with wait */
269			return -ERESTARTSYS;
270		}
271	}
272
273	count = min((int) count, CHUNKSIZE);
274	if (copy_from_user(sd->sd_wb, buf, count)) {
275		up(&sd->sd_wbs);
276		return -EFAULT;
277	}
278
279	/* try to send the buffer */
280	spin_lock_irqsave(&sd->sd_wlock, flags);
281	status = write_status_check(sd, count);
282
283	/* if we failed, and we want to block, then loop */
284	while (status <= 0) {
285		DECLARE_WAITQUEUE(wait, current);
286
287		if (file->f_flags & O_NONBLOCK) {
288			spin_unlock(&sd->sd_wlock);
289			up(&sd->sd_wbs);
290			return -EAGAIN;
291		}
292
293		set_current_state(TASK_INTERRUPTIBLE);
294		add_wait_queue(&sd->sd_wq, &wait);
295		spin_unlock_irqrestore(&sd->sd_wlock, flags);
296
297		schedule_timeout(SCDRV_TIMEOUT);
298
299		remove_wait_queue(&sd->sd_wq, &wait);
300		if (signal_pending(current)) {
301			/* wait was interrupted */
302			up(&sd->sd_wbs);
303			return -ERESTARTSYS;
304		}
305
306		spin_lock_irqsave(&sd->sd_wlock, flags);
307		status = write_status_check(sd, count);
308	}
309	spin_unlock_irqrestore(&sd->sd_wlock, flags);
310
311	/* release the write buffer and wake anyone who's waiting for it */
312	up(&sd->sd_wbs);
313
314	/* return the number of characters accepted (should be the complete
315	 * "chunk" as requested)
316	 */
317	if ((status >= 0) && (status < count)) {
318		pr_debug("Didn't accept the full chunk; %d of %d\n",
319			 status, (int) count);
320	}
321	return status;
322}
323
324static unsigned int
325scdrv_poll(struct file *file, struct poll_table_struct *wait)
326{
327	unsigned int mask = 0;
328	int status = 0;
329	struct subch_data_s *sd = (struct subch_data_s *) file->private_data;
330	unsigned long flags;
331
332	poll_wait(file, &sd->sd_rq, wait);
333	poll_wait(file, &sd->sd_wq, wait);
334
335	spin_lock_irqsave(&sd->sd_rlock, flags);
336	spin_lock(&sd->sd_wlock);
337	status = ia64_sn_irtr_intr(sd->sd_nasid, sd->sd_subch);
338	spin_unlock(&sd->sd_wlock);
339	spin_unlock_irqrestore(&sd->sd_rlock, flags);
340
341	if (status > 0) {
342		if (status & SAL_IROUTER_INTR_RECV) {
343			mask |= POLLIN | POLLRDNORM;
344		}
345		if (status & SAL_IROUTER_INTR_XMIT) {
346			mask |= POLLOUT | POLLWRNORM;
347		}
348	}
349
350	return mask;
351}
352
353static const struct file_operations scdrv_fops = {
354	.owner =	THIS_MODULE,
355	.read =		scdrv_read,
356	.write =	scdrv_write,
357	.poll =		scdrv_poll,
358	.open =		scdrv_open,
359	.release =	scdrv_release,
360};
361
362static struct class *snsc_class;
363
364/*
365 * scdrv_init
366 *
367 * Called at boot time to initialize the system controller communication
368 * facility.
369 */
370int __init
371scdrv_init(void)
372{
373	geoid_t geoid;
374	cnodeid_t cnode;
375	char devname[32];
376	char *devnamep;
377	struct sysctl_data_s *scd;
378	void *salbuf;
379	dev_t first_dev, dev;
380	nasid_t event_nasid;
381
382	if (!ia64_platform_is("sn2"))
383		return -ENODEV;
384
385	event_nasid = ia64_sn_get_console_nasid();
386
387	if (alloc_chrdev_region(&first_dev, 0, num_cnodes,
388				SYSCTL_BASENAME) < 0) {
389		printk("%s: failed to register SN system controller device\n",
390		       __func__);
391		return -ENODEV;
392	}
393	snsc_class = class_create(THIS_MODULE, SYSCTL_BASENAME);
394
395	for (cnode = 0; cnode < num_cnodes; cnode++) {
396			geoid = cnodeid_get_geoid(cnode);
397			devnamep = devname;
398			format_module_id(devnamep, geo_module(geoid),
399					 MODULE_FORMAT_BRIEF);
400			devnamep = devname + strlen(devname);
401			sprintf(devnamep, "^%d#%d", geo_slot(geoid),
402				geo_slab(geoid));
403
404			/* allocate sysctl device data */
405			scd = kzalloc(sizeof (struct sysctl_data_s),
406				      GFP_KERNEL);
407			if (!scd) {
408				printk("%s: failed to allocate device info"
409				       "for %s/%s\n", __func__,
410				       SYSCTL_BASENAME, devname);
411				continue;
412			}
413
414			/* initialize sysctl device data fields */
415			scd->scd_nasid = cnodeid_to_nasid(cnode);
416			if (!(salbuf = kmalloc(SCDRV_BUFSZ, GFP_KERNEL))) {
417				printk("%s: failed to allocate driver buffer"
418				       "(%s%s)\n", __func__,
419				       SYSCTL_BASENAME, devname);
420				kfree(scd);
421				continue;
422			}
423
424			if (ia64_sn_irtr_init(scd->scd_nasid, salbuf,
425					      SCDRV_BUFSZ) < 0) {
426				printk
427				    ("%s: failed to initialize SAL for"
428				     " system controller communication"
429				     " (%s/%s): outdated PROM?\n",
430				     __func__, SYSCTL_BASENAME, devname);
431				kfree(scd);
432				kfree(salbuf);
433				continue;
434			}
435
436			dev = first_dev + cnode;
437			cdev_init(&scd->scd_cdev, &scdrv_fops);
438			if (cdev_add(&scd->scd_cdev, dev, 1)) {
439				printk("%s: failed to register system"
440				       " controller device (%s%s)\n",
441				       __func__, SYSCTL_BASENAME, devname);
442				kfree(scd);
443				kfree(salbuf);
444				continue;
445			}
446
447			device_create(snsc_class, NULL, dev, NULL,
448				      "%s", devname);
449
450			ia64_sn_irtr_intr_enable(scd->scd_nasid,
451						 0 /*ignored */ ,
452						 SAL_IROUTER_INTR_RECV);
453
454                        /* on the console nasid, prepare to receive
455                         * system controller environmental events
456                         */
457                        if(scd->scd_nasid == event_nasid) {
458                                scdrv_event_init(scd);
459                        }
460	}
461	return 0;
462}
463
464module_init(scdrv_init);
465