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
37 static irqreturn_t
38 scdrv_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
70 static int
71 scdrv_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
129 static int
130 scdrv_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
152 static inline int
153 read_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
158 static ssize_t
159 scdrv_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 */
244 static inline int
245 write_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
250 static ssize_t
251 scdrv_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
324 static unsigned int
325 scdrv_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
353 static 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
362 static struct class *snsc_class;
363
364 /*
365 * scdrv_init
366 *
367 * Called at boot time to initialize the system controller communication
368 * facility.
369 */
370 int __init
371 scdrv_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
464 module_init(scdrv_init);
465
|
This page was automatically generated by the
LXR engine.
|