Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * IrNET protocol module : Synchronous PPP over an IrDA socket. | |
3 | * | |
4 | * Jean II - HPL `00 - <jt@hpl.hp.com> | |
5 | * | |
6 | * This file implement the PPP interface and /dev/irnet character device. | |
7 | * The PPP interface hook to the ppp_generic module, handle all our | |
8 | * relationship to the PPP code in the kernel (and by extension to pppd), | |
9 | * and exchange PPP frames with this module (send/receive). | |
10 | * The /dev/irnet device is used primarily for 2 functions : | |
11 | * 1) as a stub for pppd (the ppp daemon), so that we can appropriately | |
12 | * generate PPP sessions (we pretend we are a tty). | |
13 | * 2) as a control channel (write commands, read events) | |
14 | */ | |
15 | ||
d43c36dc | 16 | #include <linux/sched.h> |
5a0e3ad6 | 17 | #include <linux/slab.h> |
1da177e4 LT |
18 | #include "irnet_ppp.h" /* Private header */ |
19 | /* Please put other headers in irnet.h - Thanks */ | |
20 | ||
21 | /* Generic PPP callbacks (to call us) */ | |
d7100da0 | 22 | static const struct ppp_channel_ops irnet_ppp_ops = { |
1da177e4 LT |
23 | .start_xmit = ppp_irnet_send, |
24 | .ioctl = ppp_irnet_ioctl | |
25 | }; | |
26 | ||
27 | /************************* CONTROL CHANNEL *************************/ | |
28 | /* | |
29 | * When a pppd instance is not active on /dev/irnet, it acts as a control | |
30 | * channel. | |
31 | * Writing allow to set up the IrDA destination of the IrNET channel, | |
32 | * and any application may be read events happening in IrNET... | |
33 | */ | |
34 | ||
35 | /*------------------------------------------------------------------*/ | |
36 | /* | |
37 | * Write is used to send a command to configure a IrNET channel | |
38 | * before it is open by pppd. The syntax is : "command argument" | |
39 | * Currently there is only two defined commands : | |
40 | * o name : set the requested IrDA nickname of the IrNET peer. | |
41 | * o addr : set the requested IrDA address of the IrNET peer. | |
42 | * Note : the code is crude, but effective... | |
43 | */ | |
44 | static inline ssize_t | |
45 | irnet_ctrl_write(irnet_socket * ap, | |
46 | const char __user *buf, | |
47 | size_t count) | |
48 | { | |
49 | char command[IRNET_MAX_COMMAND]; | |
50 | char * start; /* Current command being processed */ | |
51 | char * next; /* Next command to process */ | |
52 | int length; /* Length of current command */ | |
53 | ||
54 | DENTER(CTRL_TRACE, "(ap=0x%p, count=%Zd)\n", ap, count); | |
55 | ||
56 | /* Check for overflow... */ | |
57 | DABORT(count >= IRNET_MAX_COMMAND, -ENOMEM, | |
58 | CTRL_ERROR, "Too much data !!!\n"); | |
59 | ||
60 | /* Get the data in the driver */ | |
61 | if(copy_from_user(command, buf, count)) | |
62 | { | |
63 | DERROR(CTRL_ERROR, "Invalid user space pointer.\n"); | |
64 | return -EFAULT; | |
65 | } | |
66 | ||
67 | /* Safe terminate the string */ | |
68 | command[count] = '\0'; | |
69 | DEBUG(CTRL_INFO, "Command line received is ``%s'' (%Zd).\n", | |
70 | command, count); | |
71 | ||
72 | /* Check every commands in the command line */ | |
73 | next = command; | |
74 | while(next != NULL) | |
75 | { | |
76 | /* Look at the next command */ | |
77 | start = next; | |
78 | ||
e7d2860b AGR |
79 | /* Scrap whitespaces before the command */ |
80 | start = skip_spaces(start); | |
1da177e4 LT |
81 | |
82 | /* ',' is our command separator */ | |
83 | next = strchr(start, ','); | |
84 | if(next) | |
85 | { | |
86 | *next = '\0'; /* Terminate command */ | |
87 | length = next - start; /* Length */ | |
88 | next++; /* Skip the '\0' */ | |
89 | } | |
90 | else | |
91 | length = strlen(start); | |
92 | ||
93 | DEBUG(CTRL_INFO, "Found command ``%s'' (%d).\n", start, length); | |
94 | ||
95 | /* Check if we recognised one of the known command | |
96 | * We can't use "switch" with strings, so hack with "continue" */ | |
6819bc2e | 97 | |
1da177e4 LT |
98 | /* First command : name -> Requested IrDA nickname */ |
99 | if(!strncmp(start, "name", 4)) | |
100 | { | |
101 | /* Copy the name only if is included and not "any" */ | |
102 | if((length > 5) && (strcmp(start + 5, "any"))) | |
103 | { | |
104 | /* Strip out trailing whitespaces */ | |
105 | while(isspace(start[length - 1])) | |
106 | length--; | |
107 | ||
d50e7e36 DR |
108 | DABORT(length < 5 || length > NICKNAME_MAX_LEN + 5, |
109 | -EINVAL, CTRL_ERROR, "Invalid nickname.\n"); | |
110 | ||
1da177e4 LT |
111 | /* Copy the name for later reuse */ |
112 | memcpy(ap->rname, start + 5, length - 5); | |
113 | ap->rname[length - 5] = '\0'; | |
114 | } | |
115 | else | |
116 | ap->rname[0] = '\0'; | |
117 | DEBUG(CTRL_INFO, "Got rname = ``%s''\n", ap->rname); | |
118 | ||
119 | /* Restart the loop */ | |
120 | continue; | |
121 | } | |
122 | ||
123 | /* Second command : addr, daddr -> Requested IrDA destination address | |
124 | * Also process : saddr -> Requested IrDA source address */ | |
125 | if((!strncmp(start, "addr", 4)) || | |
126 | (!strncmp(start, "daddr", 5)) || | |
127 | (!strncmp(start, "saddr", 5))) | |
128 | { | |
129 | __u32 addr = DEV_ADDR_ANY; | |
130 | ||
131 | /* Copy the address only if is included and not "any" */ | |
132 | if((length > 5) && (strcmp(start + 5, "any"))) | |
133 | { | |
134 | char * begp = start + 5; | |
135 | char * endp; | |
136 | ||
137 | /* Scrap whitespaces before the command */ | |
e7d2860b | 138 | begp = skip_spaces(begp); |
1da177e4 LT |
139 | |
140 | /* Convert argument to a number (last arg is the base) */ | |
141 | addr = simple_strtoul(begp, &endp, 16); | |
142 | /* Has it worked ? (endp should be start + length) */ | |
143 | DABORT(endp <= (start + 5), -EINVAL, | |
144 | CTRL_ERROR, "Invalid address.\n"); | |
145 | } | |
146 | /* Which type of address ? */ | |
147 | if(start[0] == 's') | |
148 | { | |
149 | /* Save it */ | |
150 | ap->rsaddr = addr; | |
151 | DEBUG(CTRL_INFO, "Got rsaddr = %08x\n", ap->rsaddr); | |
152 | } | |
153 | else | |
154 | { | |
155 | /* Save it */ | |
156 | ap->rdaddr = addr; | |
157 | DEBUG(CTRL_INFO, "Got rdaddr = %08x\n", ap->rdaddr); | |
158 | } | |
159 | ||
160 | /* Restart the loop */ | |
161 | continue; | |
162 | } | |
163 | ||
164 | /* Other possible command : connect N (number of retries) */ | |
165 | ||
166 | /* No command matched -> Failed... */ | |
167 | DABORT(1, -EINVAL, CTRL_ERROR, "Not a recognised IrNET command.\n"); | |
168 | } | |
169 | ||
170 | /* Success : we have parsed all commands successfully */ | |
a02cec21 | 171 | return count; |
1da177e4 LT |
172 | } |
173 | ||
174 | #ifdef INITIAL_DISCOVERY | |
175 | /*------------------------------------------------------------------*/ | |
176 | /* | |
177 | * Function irnet_get_discovery_log (self) | |
178 | * | |
179 | * Query the content on the discovery log if not done | |
180 | * | |
181 | * This function query the current content of the discovery log | |
182 | * at the startup of the event channel and save it in the internal struct. | |
183 | */ | |
184 | static void | |
185 | irnet_get_discovery_log(irnet_socket * ap) | |
186 | { | |
187 | __u16 mask = irlmp_service_to_hint(S_LAN); | |
188 | ||
189 | /* Ask IrLMP for the current discovery log */ | |
190 | ap->discoveries = irlmp_get_discoveries(&ap->disco_number, mask, | |
191 | DISCOVERY_DEFAULT_SLOTS); | |
192 | ||
193 | /* Check if the we got some results */ | |
194 | if(ap->discoveries == NULL) | |
195 | ap->disco_number = -1; | |
196 | ||
197 | DEBUG(CTRL_INFO, "Got the log (0x%p), size is %d\n", | |
198 | ap->discoveries, ap->disco_number); | |
199 | } | |
200 | ||
201 | /*------------------------------------------------------------------*/ | |
202 | /* | |
203 | * Function irnet_read_discovery_log (self, event) | |
204 | * | |
205 | * Read the content on the discovery log | |
206 | * | |
207 | * This function dump the current content of the discovery log | |
208 | * at the startup of the event channel. | |
209 | * Return 1 if wrote an event on the control channel... | |
210 | * | |
211 | * State of the ap->disco_XXX variables : | |
212 | * Socket creation : discoveries = NULL ; disco_index = 0 ; disco_number = 0 | |
213 | * While reading : discoveries = ptr ; disco_index = X ; disco_number = Y | |
214 | * After reading : discoveries = NULL ; disco_index = Y ; disco_number = -1 | |
215 | */ | |
216 | static inline int | |
4bf613c6 | 217 | irnet_read_discovery_log(irnet_socket *ap, char *event, int buf_size) |
1da177e4 LT |
218 | { |
219 | int done_event = 0; | |
220 | ||
221 | DENTER(CTRL_TRACE, "(ap=0x%p, event=0x%p)\n", | |
222 | ap, event); | |
223 | ||
224 | /* Test if we have some work to do or we have already finished */ | |
225 | if(ap->disco_number == -1) | |
226 | { | |
227 | DEBUG(CTRL_INFO, "Already done\n"); | |
228 | return 0; | |
229 | } | |
230 | ||
231 | /* Test if it's the first time and therefore we need to get the log */ | |
232 | if(ap->discoveries == NULL) | |
233 | irnet_get_discovery_log(ap); | |
234 | ||
235 | /* Check if we have more item to dump */ | |
236 | if(ap->disco_index < ap->disco_number) | |
237 | { | |
238 | /* Write an event */ | |
4bf613c6 DC |
239 | snprintf(event, buf_size, |
240 | "Found %08x (%s) behind %08x {hints %02X-%02X}\n", | |
241 | ap->discoveries[ap->disco_index].daddr, | |
242 | ap->discoveries[ap->disco_index].info, | |
243 | ap->discoveries[ap->disco_index].saddr, | |
244 | ap->discoveries[ap->disco_index].hints[0], | |
245 | ap->discoveries[ap->disco_index].hints[1]); | |
1da177e4 LT |
246 | DEBUG(CTRL_INFO, "Writing discovery %d : %s\n", |
247 | ap->disco_index, ap->discoveries[ap->disco_index].info); | |
248 | ||
249 | /* We have an event */ | |
250 | done_event = 1; | |
251 | /* Next discovery */ | |
252 | ap->disco_index++; | |
253 | } | |
254 | ||
255 | /* Check if we have done the last item */ | |
256 | if(ap->disco_index >= ap->disco_number) | |
257 | { | |
258 | /* No more items : remove the log and signal termination */ | |
259 | DEBUG(CTRL_INFO, "Cleaning up log (0x%p)\n", | |
260 | ap->discoveries); | |
261 | if(ap->discoveries != NULL) | |
262 | { | |
263 | /* Cleanup our copy of the discovery log */ | |
264 | kfree(ap->discoveries); | |
265 | ap->discoveries = NULL; | |
266 | } | |
267 | ap->disco_number = -1; | |
268 | } | |
269 | ||
270 | return done_event; | |
271 | } | |
272 | #endif /* INITIAL_DISCOVERY */ | |
273 | ||
274 | /*------------------------------------------------------------------*/ | |
275 | /* | |
276 | * Read is used to get IrNET events | |
277 | */ | |
278 | static inline ssize_t | |
279 | irnet_ctrl_read(irnet_socket * ap, | |
280 | struct file * file, | |
281 | char __user * buf, | |
282 | size_t count) | |
283 | { | |
284 | DECLARE_WAITQUEUE(wait, current); | |
4bf613c6 | 285 | char event[75]; |
1da177e4 LT |
286 | ssize_t ret = 0; |
287 | ||
288 | DENTER(CTRL_TRACE, "(ap=0x%p, count=%Zd)\n", ap, count); | |
289 | ||
1da177e4 LT |
290 | #ifdef INITIAL_DISCOVERY |
291 | /* Check if we have read the log */ | |
4bf613c6 | 292 | if (irnet_read_discovery_log(ap, event, sizeof(event))) |
1da177e4 | 293 | { |
4bf613c6 DC |
294 | count = min(strlen(event), count); |
295 | if (copy_to_user(buf, event, count)) | |
1da177e4 LT |
296 | { |
297 | DERROR(CTRL_ERROR, "Invalid user space pointer.\n"); | |
298 | return -EFAULT; | |
299 | } | |
300 | ||
301 | DEXIT(CTRL_TRACE, "\n"); | |
4bf613c6 | 302 | return count; |
1da177e4 LT |
303 | } |
304 | #endif /* INITIAL_DISCOVERY */ | |
305 | ||
306 | /* Put ourselves on the wait queue to be woken up */ | |
307 | add_wait_queue(&irnet_events.rwait, &wait); | |
a948f8ce | 308 | set_current_state(TASK_INTERRUPTIBLE); |
1da177e4 LT |
309 | for(;;) |
310 | { | |
311 | /* If there is unread events */ | |
312 | ret = 0; | |
313 | if(ap->event_index != irnet_events.index) | |
314 | break; | |
315 | ret = -EAGAIN; | |
316 | if(file->f_flags & O_NONBLOCK) | |
317 | break; | |
318 | ret = -ERESTARTSYS; | |
319 | if(signal_pending(current)) | |
320 | break; | |
321 | /* Yield and wait to be woken up */ | |
322 | schedule(); | |
323 | } | |
a948f8ce | 324 | __set_current_state(TASK_RUNNING); |
1da177e4 LT |
325 | remove_wait_queue(&irnet_events.rwait, &wait); |
326 | ||
327 | /* Did we got it ? */ | |
328 | if(ret != 0) | |
329 | { | |
330 | /* No, return the error code */ | |
331 | DEXIT(CTRL_TRACE, " - ret %Zd\n", ret); | |
332 | return ret; | |
333 | } | |
334 | ||
335 | /* Which event is it ? */ | |
336 | switch(irnet_events.log[ap->event_index].event) | |
337 | { | |
338 | case IRNET_DISCOVER: | |
4bf613c6 DC |
339 | snprintf(event, sizeof(event), |
340 | "Discovered %08x (%s) behind %08x {hints %02X-%02X}\n", | |
341 | irnet_events.log[ap->event_index].daddr, | |
342 | irnet_events.log[ap->event_index].name, | |
343 | irnet_events.log[ap->event_index].saddr, | |
344 | irnet_events.log[ap->event_index].hints.byte[0], | |
345 | irnet_events.log[ap->event_index].hints.byte[1]); | |
1da177e4 LT |
346 | break; |
347 | case IRNET_EXPIRE: | |
4bf613c6 DC |
348 | snprintf(event, sizeof(event), |
349 | "Expired %08x (%s) behind %08x {hints %02X-%02X}\n", | |
350 | irnet_events.log[ap->event_index].daddr, | |
351 | irnet_events.log[ap->event_index].name, | |
352 | irnet_events.log[ap->event_index].saddr, | |
353 | irnet_events.log[ap->event_index].hints.byte[0], | |
354 | irnet_events.log[ap->event_index].hints.byte[1]); | |
1da177e4 LT |
355 | break; |
356 | case IRNET_CONNECT_TO: | |
4bf613c6 DC |
357 | snprintf(event, sizeof(event), "Connected to %08x (%s) on ppp%d\n", |
358 | irnet_events.log[ap->event_index].daddr, | |
359 | irnet_events.log[ap->event_index].name, | |
360 | irnet_events.log[ap->event_index].unit); | |
1da177e4 LT |
361 | break; |
362 | case IRNET_CONNECT_FROM: | |
4bf613c6 DC |
363 | snprintf(event, sizeof(event), "Connection from %08x (%s) on ppp%d\n", |
364 | irnet_events.log[ap->event_index].daddr, | |
365 | irnet_events.log[ap->event_index].name, | |
366 | irnet_events.log[ap->event_index].unit); | |
1da177e4 LT |
367 | break; |
368 | case IRNET_REQUEST_FROM: | |
4bf613c6 DC |
369 | snprintf(event, sizeof(event), "Request from %08x (%s) behind %08x\n", |
370 | irnet_events.log[ap->event_index].daddr, | |
371 | irnet_events.log[ap->event_index].name, | |
372 | irnet_events.log[ap->event_index].saddr); | |
1da177e4 LT |
373 | break; |
374 | case IRNET_NOANSWER_FROM: | |
4bf613c6 DC |
375 | snprintf(event, sizeof(event), "No-answer from %08x (%s) on ppp%d\n", |
376 | irnet_events.log[ap->event_index].daddr, | |
377 | irnet_events.log[ap->event_index].name, | |
378 | irnet_events.log[ap->event_index].unit); | |
1da177e4 LT |
379 | break; |
380 | case IRNET_BLOCKED_LINK: | |
4bf613c6 DC |
381 | snprintf(event, sizeof(event), "Blocked link with %08x (%s) on ppp%d\n", |
382 | irnet_events.log[ap->event_index].daddr, | |
383 | irnet_events.log[ap->event_index].name, | |
384 | irnet_events.log[ap->event_index].unit); | |
1da177e4 LT |
385 | break; |
386 | case IRNET_DISCONNECT_FROM: | |
4bf613c6 DC |
387 | snprintf(event, sizeof(event), "Disconnection from %08x (%s) on ppp%d\n", |
388 | irnet_events.log[ap->event_index].daddr, | |
389 | irnet_events.log[ap->event_index].name, | |
390 | irnet_events.log[ap->event_index].unit); | |
1da177e4 LT |
391 | break; |
392 | case IRNET_DISCONNECT_TO: | |
4bf613c6 DC |
393 | snprintf(event, sizeof(event), "Disconnected to %08x (%s)\n", |
394 | irnet_events.log[ap->event_index].daddr, | |
395 | irnet_events.log[ap->event_index].name); | |
1da177e4 LT |
396 | break; |
397 | default: | |
4bf613c6 | 398 | snprintf(event, sizeof(event), "Bug\n"); |
1da177e4 LT |
399 | } |
400 | /* Increment our event index */ | |
401 | ap->event_index = (ap->event_index + 1) % IRNET_MAX_EVENTS; | |
402 | ||
403 | DEBUG(CTRL_INFO, "Event is :%s", event); | |
404 | ||
4bf613c6 DC |
405 | count = min(strlen(event), count); |
406 | if (copy_to_user(buf, event, count)) | |
1da177e4 LT |
407 | { |
408 | DERROR(CTRL_ERROR, "Invalid user space pointer.\n"); | |
409 | return -EFAULT; | |
410 | } | |
411 | ||
412 | DEXIT(CTRL_TRACE, "\n"); | |
4bf613c6 | 413 | return count; |
1da177e4 LT |
414 | } |
415 | ||
416 | /*------------------------------------------------------------------*/ | |
417 | /* | |
418 | * Poll : called when someone do a select on /dev/irnet. | |
419 | * Just check if there are new events... | |
420 | */ | |
421 | static inline unsigned int | |
422 | irnet_ctrl_poll(irnet_socket * ap, | |
423 | struct file * file, | |
424 | poll_table * wait) | |
425 | { | |
426 | unsigned int mask; | |
427 | ||
428 | DENTER(CTRL_TRACE, "(ap=0x%p)\n", ap); | |
429 | ||
430 | poll_wait(file, &irnet_events.rwait, wait); | |
431 | mask = POLLOUT | POLLWRNORM; | |
432 | /* If there is unread events */ | |
433 | if(ap->event_index != irnet_events.index) | |
434 | mask |= POLLIN | POLLRDNORM; | |
435 | #ifdef INITIAL_DISCOVERY | |
436 | if(ap->disco_number != -1) | |
437 | { | |
438 | /* Test if it's the first time and therefore we need to get the log */ | |
439 | if(ap->discoveries == NULL) | |
440 | irnet_get_discovery_log(ap); | |
441 | /* Recheck */ | |
442 | if(ap->disco_number != -1) | |
443 | mask |= POLLIN | POLLRDNORM; | |
444 | } | |
445 | #endif /* INITIAL_DISCOVERY */ | |
446 | ||
447 | DEXIT(CTRL_TRACE, " - mask=0x%X\n", mask); | |
448 | return mask; | |
449 | } | |
450 | ||
451 | ||
452 | /*********************** FILESYSTEM CALLBACKS ***********************/ | |
453 | /* | |
454 | * Implement the usual open, read, write functions that will be called | |
455 | * by the file system when some action is performed on /dev/irnet. | |
456 | * Most of those actions will in fact be performed by "pppd" or | |
457 | * the control channel, we just act as a redirector... | |
458 | */ | |
459 | ||
460 | /*------------------------------------------------------------------*/ | |
461 | /* | |
462 | * Open : when somebody open /dev/irnet | |
463 | * We basically create a new instance of irnet and initialise it. | |
464 | */ | |
465 | static int | |
466 | dev_irnet_open(struct inode * inode, | |
467 | struct file * file) | |
468 | { | |
469 | struct irnet_socket * ap; | |
470 | int err; | |
471 | ||
472 | DENTER(FS_TRACE, "(file=0x%p)\n", file); | |
473 | ||
474 | #ifdef SECURE_DEVIRNET | |
475 | /* This could (should?) be enforced by the permissions on /dev/irnet. */ | |
476 | if(!capable(CAP_NET_ADMIN)) | |
477 | return -EPERM; | |
478 | #endif /* SECURE_DEVIRNET */ | |
479 | ||
480 | /* Allocate a private structure for this IrNET instance */ | |
0da974f4 | 481 | ap = kzalloc(sizeof(*ap), GFP_KERNEL); |
1da177e4 LT |
482 | DABORT(ap == NULL, -ENOMEM, FS_ERROR, "Can't allocate struct irnet...\n"); |
483 | ||
484 | /* initialize the irnet structure */ | |
1da177e4 LT |
485 | ap->file = file; |
486 | ||
487 | /* PPP channel setup */ | |
488 | ap->ppp_open = 0; | |
489 | ap->chan.private = ap; | |
490 | ap->chan.ops = &irnet_ppp_ops; | |
491 | ap->chan.mtu = (2048 - TTP_MAX_HEADER - 2 - PPP_HDRLEN); | |
492 | ap->chan.hdrlen = 2 + TTP_MAX_HEADER; /* for A/C + Max IrDA hdr */ | |
493 | /* PPP parameters */ | |
494 | ap->mru = (2048 - TTP_MAX_HEADER - 2 - PPP_HDRLEN); | |
495 | ap->xaccm[0] = ~0U; | |
496 | ap->xaccm[3] = 0x60000000U; | |
497 | ap->raccm = ~0U; | |
498 | ||
499 | /* Setup the IrDA part... */ | |
500 | err = irda_irnet_create(ap); | |
501 | if(err) | |
502 | { | |
503 | DERROR(FS_ERROR, "Can't setup IrDA link...\n"); | |
504 | kfree(ap); | |
f8cba16c | 505 | |
1da177e4 LT |
506 | return err; |
507 | } | |
508 | ||
509 | /* For the control channel */ | |
510 | ap->event_index = irnet_events.index; /* Cancel all past events */ | |
511 | ||
f8cba16c SO |
512 | mutex_init(&ap->lock); |
513 | ||
1da177e4 LT |
514 | /* Put our stuff where we will be able to find it later */ |
515 | file->private_data = ap; | |
516 | ||
517 | DEXIT(FS_TRACE, " - ap=0x%p\n", ap); | |
f8cba16c | 518 | |
1da177e4 LT |
519 | return 0; |
520 | } | |
521 | ||
522 | ||
523 | /*------------------------------------------------------------------*/ | |
524 | /* | |
525 | * Close : when somebody close /dev/irnet | |
526 | * Destroy the instance of /dev/irnet | |
527 | */ | |
528 | static int | |
529 | dev_irnet_close(struct inode * inode, | |
530 | struct file * file) | |
531 | { | |
55a40e24 | 532 | irnet_socket * ap = file->private_data; |
1da177e4 LT |
533 | |
534 | DENTER(FS_TRACE, "(file=0x%p, ap=0x%p)\n", | |
535 | file, ap); | |
536 | DABORT(ap == NULL, 0, FS_ERROR, "ap is NULL !!!\n"); | |
537 | ||
538 | /* Detach ourselves */ | |
539 | file->private_data = NULL; | |
540 | ||
541 | /* Close IrDA stuff */ | |
542 | irda_irnet_destroy(ap); | |
543 | ||
544 | /* Disconnect from the generic PPP layer if not already done */ | |
545 | if(ap->ppp_open) | |
546 | { | |
547 | DERROR(FS_ERROR, "Channel still registered - deregistering !\n"); | |
548 | ap->ppp_open = 0; | |
549 | ppp_unregister_channel(&ap->chan); | |
550 | } | |
551 | ||
552 | kfree(ap); | |
553 | ||
554 | DEXIT(FS_TRACE, "\n"); | |
555 | return 0; | |
556 | } | |
557 | ||
558 | /*------------------------------------------------------------------*/ | |
559 | /* | |
560 | * Write does nothing. | |
561 | * (we receive packet from ppp_generic through ppp_irnet_send()) | |
562 | */ | |
563 | static ssize_t | |
564 | dev_irnet_write(struct file * file, | |
565 | const char __user *buf, | |
566 | size_t count, | |
567 | loff_t * ppos) | |
568 | { | |
55a40e24 | 569 | irnet_socket * ap = file->private_data; |
1da177e4 LT |
570 | |
571 | DPASS(FS_TRACE, "(file=0x%p, ap=0x%p, count=%Zd)\n", | |
572 | file, ap, count); | |
573 | DABORT(ap == NULL, -ENXIO, FS_ERROR, "ap is NULL !!!\n"); | |
574 | ||
575 | /* If we are connected to ppp_generic, let it handle the job */ | |
576 | if(ap->ppp_open) | |
577 | return -EAGAIN; | |
578 | else | |
579 | return irnet_ctrl_write(ap, buf, count); | |
580 | } | |
581 | ||
582 | /*------------------------------------------------------------------*/ | |
583 | /* | |
584 | * Read doesn't do much either. | |
585 | * (pppd poll us, but ultimately reads through /dev/ppp) | |
586 | */ | |
587 | static ssize_t | |
588 | dev_irnet_read(struct file * file, | |
589 | char __user * buf, | |
590 | size_t count, | |
591 | loff_t * ppos) | |
592 | { | |
55a40e24 | 593 | irnet_socket * ap = file->private_data; |
1da177e4 LT |
594 | |
595 | DPASS(FS_TRACE, "(file=0x%p, ap=0x%p, count=%Zd)\n", | |
596 | file, ap, count); | |
597 | DABORT(ap == NULL, -ENXIO, FS_ERROR, "ap is NULL !!!\n"); | |
598 | ||
599 | /* If we are connected to ppp_generic, let it handle the job */ | |
600 | if(ap->ppp_open) | |
601 | return -EAGAIN; | |
602 | else | |
603 | return irnet_ctrl_read(ap, file, buf, count); | |
604 | } | |
605 | ||
606 | /*------------------------------------------------------------------*/ | |
607 | /* | |
608 | * Poll : called when someone do a select on /dev/irnet | |
609 | */ | |
610 | static unsigned int | |
611 | dev_irnet_poll(struct file * file, | |
612 | poll_table * wait) | |
613 | { | |
55a40e24 | 614 | irnet_socket * ap = file->private_data; |
1da177e4 LT |
615 | unsigned int mask; |
616 | ||
617 | DENTER(FS_TRACE, "(file=0x%p, ap=0x%p)\n", | |
618 | file, ap); | |
619 | ||
620 | mask = POLLOUT | POLLWRNORM; | |
621 | DABORT(ap == NULL, mask, FS_ERROR, "ap is NULL !!!\n"); | |
622 | ||
623 | /* If we are connected to ppp_generic, let it handle the job */ | |
624 | if(!ap->ppp_open) | |
625 | mask |= irnet_ctrl_poll(ap, file, wait); | |
626 | ||
627 | DEXIT(FS_TRACE, " - mask=0x%X\n", mask); | |
a02cec21 | 628 | return mask; |
1da177e4 LT |
629 | } |
630 | ||
631 | /*------------------------------------------------------------------*/ | |
632 | /* | |
633 | * IOCtl : Called when someone does some ioctls on /dev/irnet | |
634 | * This is the way pppd configure us and control us while the PPP | |
635 | * instance is active. | |
636 | */ | |
54064600 AC |
637 | static long |
638 | dev_irnet_ioctl( | |
1da177e4 LT |
639 | struct file * file, |
640 | unsigned int cmd, | |
641 | unsigned long arg) | |
642 | { | |
55a40e24 | 643 | irnet_socket * ap = file->private_data; |
1da177e4 LT |
644 | int err; |
645 | int val; | |
646 | void __user *argp = (void __user *)arg; | |
647 | ||
648 | DENTER(FS_TRACE, "(file=0x%p, ap=0x%p, cmd=0x%X)\n", | |
649 | file, ap, cmd); | |
650 | ||
651 | /* Basic checks... */ | |
652 | DASSERT(ap != NULL, -ENXIO, PPP_ERROR, "ap is NULL...\n"); | |
653 | #ifdef SECURE_DEVIRNET | |
654 | if(!capable(CAP_NET_ADMIN)) | |
655 | return -EPERM; | |
656 | #endif /* SECURE_DEVIRNET */ | |
657 | ||
658 | err = -EFAULT; | |
659 | switch(cmd) | |
660 | { | |
661 | /* Set discipline (should be N_SYNC_PPP or N_TTY) */ | |
662 | case TIOCSETD: | |
663 | if(get_user(val, (int __user *)argp)) | |
664 | break; | |
665 | if((val == N_SYNC_PPP) || (val == N_PPP)) | |
666 | { | |
667 | DEBUG(FS_INFO, "Entering PPP discipline.\n"); | |
b42e1796 | 668 | /* PPP channel setup (ap->chan in configured in dev_irnet_open())*/ |
f8cba16c SO |
669 | if (mutex_lock_interruptible(&ap->lock)) |
670 | return -EINTR; | |
671 | ||
1da177e4 LT |
672 | err = ppp_register_channel(&ap->chan); |
673 | if(err == 0) | |
674 | { | |
675 | /* Our ppp side is active */ | |
676 | ap->ppp_open = 1; | |
677 | ||
678 | DEBUG(FS_INFO, "Trying to establish a connection.\n"); | |
679 | /* Setup the IrDA link now - may fail... */ | |
680 | irda_irnet_connect(ap); | |
681 | } | |
682 | else | |
683 | DERROR(FS_ERROR, "Can't setup PPP channel...\n"); | |
f8cba16c SO |
684 | |
685 | mutex_unlock(&ap->lock); | |
1da177e4 LT |
686 | } |
687 | else | |
688 | { | |
689 | /* In theory, should be N_TTY */ | |
690 | DEBUG(FS_INFO, "Exiting PPP discipline.\n"); | |
691 | /* Disconnect from the generic PPP layer */ | |
f8cba16c SO |
692 | if (mutex_lock_interruptible(&ap->lock)) |
693 | return -EINTR; | |
694 | ||
1da177e4 LT |
695 | if(ap->ppp_open) |
696 | { | |
697 | ap->ppp_open = 0; | |
698 | ppp_unregister_channel(&ap->chan); | |
699 | } | |
700 | else | |
701 | DERROR(FS_ERROR, "Channel not registered !\n"); | |
702 | err = 0; | |
f8cba16c SO |
703 | |
704 | mutex_unlock(&ap->lock); | |
1da177e4 LT |
705 | } |
706 | break; | |
707 | ||
708 | /* Query PPP channel and unit number */ | |
709 | case PPPIOCGCHAN: | |
f8cba16c SO |
710 | if (mutex_lock_interruptible(&ap->lock)) |
711 | return -EINTR; | |
712 | ||
54064600 AC |
713 | if(ap->ppp_open && !put_user(ppp_channel_index(&ap->chan), |
714 | (int __user *)argp)) | |
715 | err = 0; | |
f8cba16c SO |
716 | |
717 | mutex_unlock(&ap->lock); | |
1da177e4 LT |
718 | break; |
719 | case PPPIOCGUNIT: | |
f8cba16c SO |
720 | if (mutex_lock_interruptible(&ap->lock)) |
721 | return -EINTR; | |
722 | ||
54064600 AC |
723 | if(ap->ppp_open && !put_user(ppp_unit_number(&ap->chan), |
724 | (int __user *)argp)) | |
454debe4 | 725 | err = 0; |
f8cba16c SO |
726 | |
727 | mutex_unlock(&ap->lock); | |
1da177e4 LT |
728 | break; |
729 | ||
730 | /* All these ioctls can be passed both directly and from ppp_generic, | |
731 | * so we just deal with them in one place... | |
732 | */ | |
733 | case PPPIOCGFLAGS: | |
734 | case PPPIOCSFLAGS: | |
735 | case PPPIOCGASYNCMAP: | |
736 | case PPPIOCSASYNCMAP: | |
737 | case PPPIOCGRASYNCMAP: | |
738 | case PPPIOCSRASYNCMAP: | |
739 | case PPPIOCGXASYNCMAP: | |
740 | case PPPIOCSXASYNCMAP: | |
741 | case PPPIOCGMRU: | |
742 | case PPPIOCSMRU: | |
743 | DEBUG(FS_INFO, "Standard PPP ioctl.\n"); | |
744 | if(!capable(CAP_NET_ADMIN)) | |
745 | err = -EPERM; | |
54064600 | 746 | else { |
f8cba16c SO |
747 | if (mutex_lock_interruptible(&ap->lock)) |
748 | return -EINTR; | |
749 | ||
1da177e4 | 750 | err = ppp_irnet_ioctl(&ap->chan, cmd, arg); |
f8cba16c SO |
751 | |
752 | mutex_unlock(&ap->lock); | |
54064600 | 753 | } |
1da177e4 LT |
754 | break; |
755 | ||
756 | /* TTY IOCTLs : Pretend that we are a tty, to keep pppd happy */ | |
757 | /* Get termios */ | |
758 | case TCGETS: | |
759 | DEBUG(FS_INFO, "Get termios.\n"); | |
f8cba16c SO |
760 | if (mutex_lock_interruptible(&ap->lock)) |
761 | return -EINTR; | |
762 | ||
49259d34 | 763 | #ifndef TCGETS2 |
54064600 AC |
764 | if(!kernel_termios_to_user_termios((struct termios __user *)argp, &ap->termios)) |
765 | err = 0; | |
49259d34 DM |
766 | #else |
767 | if(kernel_termios_to_user_termios_1((struct termios __user *)argp, &ap->termios)) | |
54064600 | 768 | err = 0; |
49259d34 | 769 | #endif |
f8cba16c SO |
770 | |
771 | mutex_unlock(&ap->lock); | |
1da177e4 LT |
772 | break; |
773 | /* Set termios */ | |
774 | case TCSETSF: | |
775 | DEBUG(FS_INFO, "Set termios.\n"); | |
f8cba16c SO |
776 | if (mutex_lock_interruptible(&ap->lock)) |
777 | return -EINTR; | |
778 | ||
49259d34 | 779 | #ifndef TCGETS2 |
54064600 AC |
780 | if(!user_termios_to_kernel_termios(&ap->termios, (struct termios __user *)argp)) |
781 | err = 0; | |
49259d34 | 782 | #else |
54064600 AC |
783 | if(!user_termios_to_kernel_termios_1(&ap->termios, (struct termios __user *)argp)) |
784 | err = 0; | |
49259d34 | 785 | #endif |
f8cba16c SO |
786 | |
787 | mutex_unlock(&ap->lock); | |
1da177e4 LT |
788 | break; |
789 | ||
790 | /* Set DTR/RTS */ | |
6819bc2e | 791 | case TIOCMBIS: |
1da177e4 LT |
792 | case TIOCMBIC: |
793 | /* Set exclusive/non-exclusive mode */ | |
794 | case TIOCEXCL: | |
795 | case TIOCNXCL: | |
796 | DEBUG(FS_INFO, "TTY compatibility.\n"); | |
797 | err = 0; | |
798 | break; | |
799 | ||
800 | case TCGETA: | |
801 | DEBUG(FS_INFO, "TCGETA\n"); | |
802 | break; | |
803 | ||
804 | case TCFLSH: | |
805 | DEBUG(FS_INFO, "TCFLSH\n"); | |
806 | /* Note : this will flush buffers in PPP, so it *must* be done | |
807 | * We should also worry that we don't accept junk here and that | |
808 | * we get rid of our own buffers */ | |
809 | #ifdef FLUSH_TO_PPP | |
f8cba16c SO |
810 | if (mutex_lock_interruptible(&ap->lock)) |
811 | return -EINTR; | |
1da177e4 | 812 | ppp_output_wakeup(&ap->chan); |
f8cba16c | 813 | mutex_unlock(&ap->lock); |
1da177e4 LT |
814 | #endif /* FLUSH_TO_PPP */ |
815 | err = 0; | |
816 | break; | |
817 | ||
818 | case FIONREAD: | |
819 | DEBUG(FS_INFO, "FIONREAD\n"); | |
820 | val = 0; | |
821 | if(put_user(val, (int __user *)argp)) | |
822 | break; | |
823 | err = 0; | |
824 | break; | |
825 | ||
826 | default: | |
827 | DERROR(FS_ERROR, "Unsupported ioctl (0x%X)\n", cmd); | |
54064600 | 828 | err = -ENOTTY; |
1da177e4 LT |
829 | } |
830 | ||
831 | DEXIT(FS_TRACE, " - err = 0x%X\n", err); | |
832 | return err; | |
833 | } | |
834 | ||
835 | /************************** PPP CALLBACKS **************************/ | |
836 | /* | |
837 | * This are the functions that the generic PPP driver in the kernel | |
838 | * will call to communicate to us. | |
839 | */ | |
840 | ||
841 | /*------------------------------------------------------------------*/ | |
842 | /* | |
843 | * Prepare the ppp frame for transmission over the IrDA socket. | |
844 | * We make sure that the header space is enough, and we change ppp header | |
845 | * according to flags passed by pppd. | |
846 | * This is not a callback, but just a helper function used in ppp_irnet_send() | |
847 | */ | |
848 | static inline struct sk_buff * | |
849 | irnet_prepare_skb(irnet_socket * ap, | |
850 | struct sk_buff * skb) | |
851 | { | |
852 | unsigned char * data; | |
853 | int proto; /* PPP protocol */ | |
854 | int islcp; /* Protocol == LCP */ | |
855 | int needaddr; /* Need PPP address */ | |
856 | ||
857 | DENTER(PPP_TRACE, "(ap=0x%p, skb=0x%p)\n", | |
858 | ap, skb); | |
859 | ||
860 | /* Extract PPP protocol from the frame */ | |
861 | data = skb->data; | |
862 | proto = (data[0] << 8) + data[1]; | |
863 | ||
864 | /* LCP packets with codes between 1 (configure-request) | |
865 | * and 7 (code-reject) must be sent as though no options | |
866 | * have been negotiated. */ | |
867 | islcp = (proto == PPP_LCP) && (1 <= data[2]) && (data[2] <= 7); | |
868 | ||
869 | /* compress protocol field if option enabled */ | |
870 | if((data[0] == 0) && (ap->flags & SC_COMP_PROT) && (!islcp)) | |
871 | skb_pull(skb,1); | |
872 | ||
873 | /* Check if we need address/control fields */ | |
874 | needaddr = 2*((ap->flags & SC_COMP_AC) == 0 || islcp); | |
875 | ||
876 | /* Is the skb headroom large enough to contain all IrDA-headers? */ | |
877 | if((skb_headroom(skb) < (ap->max_header_size + needaddr)) || | |
878 | (skb_shared(skb))) | |
879 | { | |
880 | struct sk_buff * new_skb; | |
881 | ||
882 | DEBUG(PPP_INFO, "Reallocating skb\n"); | |
883 | ||
884 | /* Create a new skb */ | |
885 | new_skb = skb_realloc_headroom(skb, ap->max_header_size + needaddr); | |
886 | ||
887 | /* We have to free the original skb anyway */ | |
888 | dev_kfree_skb(skb); | |
889 | ||
890 | /* Did the realloc succeed ? */ | |
891 | DABORT(new_skb == NULL, NULL, PPP_ERROR, "Could not realloc skb\n"); | |
892 | ||
893 | /* Use the new skb instead */ | |
894 | skb = new_skb; | |
895 | } | |
896 | ||
897 | /* prepend address/control fields if necessary */ | |
898 | if(needaddr) | |
899 | { | |
900 | skb_push(skb, 2); | |
901 | skb->data[0] = PPP_ALLSTATIONS; | |
902 | skb->data[1] = PPP_UI; | |
903 | } | |
904 | ||
905 | DEXIT(PPP_TRACE, "\n"); | |
906 | ||
907 | return skb; | |
908 | } | |
909 | ||
910 | /*------------------------------------------------------------------*/ | |
911 | /* | |
912 | * Send a packet to the peer over the IrTTP connection. | |
913 | * Returns 1 iff the packet was accepted. | |
914 | * Returns 0 iff packet was not consumed. | |
915 | * If the packet was not accepted, we will call ppp_output_wakeup | |
916 | * at some later time to reactivate flow control in ppp_generic. | |
917 | */ | |
918 | static int | |
919 | ppp_irnet_send(struct ppp_channel * chan, | |
920 | struct sk_buff * skb) | |
921 | { | |
922 | irnet_socket * self = (struct irnet_socket *) chan->private; | |
923 | int ret; | |
924 | ||
925 | DENTER(PPP_TRACE, "(channel=0x%p, ap/self=0x%p)\n", | |
926 | chan, self); | |
927 | ||
928 | /* Check if things are somewhat valid... */ | |
929 | DASSERT(self != NULL, 0, PPP_ERROR, "Self is NULL !!!\n"); | |
930 | ||
931 | /* Check if we are connected */ | |
932 | if(!(test_bit(0, &self->ttp_open))) | |
933 | { | |
934 | #ifdef CONNECT_IN_SEND | |
935 | /* Let's try to connect one more time... */ | |
936 | /* Note : we won't be connected after this call, but we should be | |
937 | * ready for next packet... */ | |
938 | /* If we are already connecting, this will fail */ | |
939 | irda_irnet_connect(self); | |
940 | #endif /* CONNECT_IN_SEND */ | |
941 | ||
942 | DEBUG(PPP_INFO, "IrTTP not ready ! (%ld-%ld)\n", | |
943 | self->ttp_open, self->ttp_connect); | |
944 | ||
945 | /* Note : we can either drop the packet or block the packet. | |
946 | * | |
947 | * Blocking the packet allow us a better connection time, | |
948 | * because by calling ppp_output_wakeup() we can have | |
949 | * ppp_generic resending the LCP request immediately to us, | |
950 | * rather than waiting for one of pppd periodic transmission of | |
951 | * LCP request. | |
952 | * | |
953 | * On the other hand, if we block all packet, all those periodic | |
954 | * transmissions of pppd accumulate in ppp_generic, creating a | |
955 | * backlog of LCP request. When we eventually connect later on, | |
956 | * we have to transmit all this backlog before we can connect | |
957 | * proper (if we don't timeout before). | |
958 | * | |
959 | * The current strategy is as follow : | |
960 | * While we are attempting to connect, we block packets to get | |
961 | * a better connection time. | |
962 | * If we fail to connect, we drain the queue and start dropping packets | |
963 | */ | |
964 | #ifdef BLOCK_WHEN_CONNECT | |
965 | /* If we are attempting to connect */ | |
966 | if(test_bit(0, &self->ttp_connect)) | |
967 | { | |
968 | /* Blocking packet, ppp_generic will retry later */ | |
969 | return 0; | |
970 | } | |
971 | #endif /* BLOCK_WHEN_CONNECT */ | |
972 | ||
973 | /* Dropping packet, pppd will retry later */ | |
974 | dev_kfree_skb(skb); | |
975 | return 1; | |
976 | } | |
977 | ||
978 | /* Check if the queue can accept any packet, otherwise block */ | |
979 | if(self->tx_flow != FLOW_START) | |
980 | DRETURN(0, PPP_INFO, "IrTTP queue full (%d skbs)...\n", | |
981 | skb_queue_len(&self->tsap->tx_queue)); | |
982 | ||
983 | /* Prepare ppp frame for transmission */ | |
984 | skb = irnet_prepare_skb(self, skb); | |
985 | DABORT(skb == NULL, 1, PPP_ERROR, "Prepare skb for Tx failed.\n"); | |
986 | ||
987 | /* Send the packet to IrTTP */ | |
988 | ret = irttp_data_request(self->tsap, skb); | |
989 | if(ret < 0) | |
990 | { | |
6819bc2e | 991 | /* |
1da177e4 LT |
992 | * > IrTTPs tx queue is full, so we just have to |
993 | * > drop the frame! You might think that we should | |
994 | * > just return -1 and don't deallocate the frame, | |
995 | * > but that is dangerous since it's possible that | |
996 | * > we have replaced the original skb with a new | |
997 | * > one with larger headroom, and that would really | |
998 | * > confuse do_dev_queue_xmit() in dev.c! I have | |
6819bc2e | 999 | * > tried :-) DB |
1da177e4 LT |
1000 | * Correction : we verify the flow control above (self->tx_flow), |
1001 | * so we come here only if IrTTP doesn't like the packet (empty, | |
1002 | * too large, IrTTP not connected). In those rare cases, it's ok | |
1003 | * to drop it, we don't want to see it here again... | |
1004 | * Jean II | |
1005 | */ | |
1006 | DERROR(PPP_ERROR, "IrTTP doesn't like this packet !!! (0x%X)\n", ret); | |
1007 | /* irttp_data_request already free the packet */ | |
1008 | } | |
1009 | ||
1010 | DEXIT(PPP_TRACE, "\n"); | |
1011 | return 1; /* Packet has been consumed */ | |
1012 | } | |
1013 | ||
1014 | /*------------------------------------------------------------------*/ | |
1015 | /* | |
1016 | * Take care of the ioctls that ppp_generic doesn't want to deal with... | |
1017 | * Note : we are also called from dev_irnet_ioctl(). | |
1018 | */ | |
1019 | static int | |
1020 | ppp_irnet_ioctl(struct ppp_channel * chan, | |
1021 | unsigned int cmd, | |
1022 | unsigned long arg) | |
1023 | { | |
1024 | irnet_socket * ap = (struct irnet_socket *) chan->private; | |
1025 | int err; | |
1026 | int val; | |
1027 | u32 accm[8]; | |
1028 | void __user *argp = (void __user *)arg; | |
1029 | ||
1030 | DENTER(PPP_TRACE, "(channel=0x%p, ap=0x%p, cmd=0x%X)\n", | |
1031 | chan, ap, cmd); | |
1032 | ||
1033 | /* Basic checks... */ | |
1034 | DASSERT(ap != NULL, -ENXIO, PPP_ERROR, "ap is NULL...\n"); | |
1035 | ||
1036 | err = -EFAULT; | |
1037 | switch(cmd) | |
1038 | { | |
1039 | /* PPP flags */ | |
1040 | case PPPIOCGFLAGS: | |
1041 | val = ap->flags | ap->rbits; | |
1042 | if(put_user(val, (int __user *) argp)) | |
1043 | break; | |
1044 | err = 0; | |
1045 | break; | |
1046 | case PPPIOCSFLAGS: | |
1047 | if(get_user(val, (int __user *) argp)) | |
1048 | break; | |
1049 | ap->flags = val & ~SC_RCV_BITS; | |
1050 | ap->rbits = val & SC_RCV_BITS; | |
1051 | err = 0; | |
1052 | break; | |
1053 | ||
1054 | /* Async map stuff - all dummy to please pppd */ | |
1055 | case PPPIOCGASYNCMAP: | |
1056 | if(put_user(ap->xaccm[0], (u32 __user *) argp)) | |
1057 | break; | |
1058 | err = 0; | |
1059 | break; | |
1060 | case PPPIOCSASYNCMAP: | |
1061 | if(get_user(ap->xaccm[0], (u32 __user *) argp)) | |
1062 | break; | |
1063 | err = 0; | |
1064 | break; | |
1065 | case PPPIOCGRASYNCMAP: | |
1066 | if(put_user(ap->raccm, (u32 __user *) argp)) | |
1067 | break; | |
1068 | err = 0; | |
1069 | break; | |
1070 | case PPPIOCSRASYNCMAP: | |
1071 | if(get_user(ap->raccm, (u32 __user *) argp)) | |
1072 | break; | |
1073 | err = 0; | |
1074 | break; | |
1075 | case PPPIOCGXASYNCMAP: | |
1076 | if(copy_to_user(argp, ap->xaccm, sizeof(ap->xaccm))) | |
1077 | break; | |
1078 | err = 0; | |
1079 | break; | |
1080 | case PPPIOCSXASYNCMAP: | |
1081 | if(copy_from_user(accm, argp, sizeof(accm))) | |
1082 | break; | |
1083 | accm[2] &= ~0x40000000U; /* can't escape 0x5e */ | |
1084 | accm[3] |= 0x60000000U; /* must escape 0x7d, 0x7e */ | |
1085 | memcpy(ap->xaccm, accm, sizeof(ap->xaccm)); | |
1086 | err = 0; | |
1087 | break; | |
1088 | ||
1089 | /* Max PPP frame size */ | |
1090 | case PPPIOCGMRU: | |
1091 | if(put_user(ap->mru, (int __user *) argp)) | |
1092 | break; | |
1093 | err = 0; | |
1094 | break; | |
1095 | case PPPIOCSMRU: | |
1096 | if(get_user(val, (int __user *) argp)) | |
1097 | break; | |
1098 | if(val < PPP_MRU) | |
1099 | val = PPP_MRU; | |
1100 | ap->mru = val; | |
1101 | err = 0; | |
1102 | break; | |
1103 | ||
1104 | default: | |
1105 | DEBUG(PPP_INFO, "Unsupported ioctl (0x%X)\n", cmd); | |
1106 | err = -ENOIOCTLCMD; | |
1107 | } | |
1108 | ||
1109 | DEXIT(PPP_TRACE, " - err = 0x%X\n", err); | |
1110 | return err; | |
1111 | } | |
1112 | ||
1113 | /************************** INITIALISATION **************************/ | |
1114 | /* | |
1115 | * Module initialisation and all that jazz... | |
1116 | */ | |
1117 | ||
1118 | /*------------------------------------------------------------------*/ | |
1119 | /* | |
1120 | * Hook our device callbacks in the filesystem, to connect our code | |
1121 | * to /dev/irnet | |
1122 | */ | |
1123 | static inline int __init | |
1124 | ppp_irnet_init(void) | |
1125 | { | |
1126 | int err = 0; | |
1127 | ||
1128 | DENTER(MODULE_TRACE, "()\n"); | |
1129 | ||
1130 | /* Allocate ourselves as a minor in the misc range */ | |
1131 | err = misc_register(&irnet_misc_device); | |
1132 | ||
1133 | DEXIT(MODULE_TRACE, "\n"); | |
1134 | return err; | |
1135 | } | |
1136 | ||
1137 | /*------------------------------------------------------------------*/ | |
1138 | /* | |
1139 | * Cleanup at exit... | |
1140 | */ | |
1141 | static inline void __exit | |
1142 | ppp_irnet_cleanup(void) | |
1143 | { | |
1144 | DENTER(MODULE_TRACE, "()\n"); | |
1145 | ||
1146 | /* De-allocate /dev/irnet minor in misc range */ | |
1147 | misc_deregister(&irnet_misc_device); | |
1148 | ||
1149 | DEXIT(MODULE_TRACE, "\n"); | |
1150 | } | |
1151 | ||
1152 | /*------------------------------------------------------------------*/ | |
1153 | /* | |
1154 | * Module main entry point | |
1155 | */ | |
bf73d1c5 | 1156 | static int __init |
1da177e4 LT |
1157 | irnet_init(void) |
1158 | { | |
1159 | int err; | |
1160 | ||
1161 | /* Initialise both parts... */ | |
1162 | err = irda_irnet_init(); | |
1163 | if(!err) | |
1164 | err = ppp_irnet_init(); | |
1165 | return err; | |
1166 | } | |
1167 | ||
1168 | /*------------------------------------------------------------------*/ | |
1169 | /* | |
1170 | * Module exit | |
1171 | */ | |
1172 | static void __exit | |
1173 | irnet_cleanup(void) | |
1174 | { | |
1175 | irda_irnet_cleanup(); | |
1176 | ppp_irnet_cleanup(); | |
1177 | } | |
1178 | ||
1179 | /*------------------------------------------------------------------*/ | |
1180 | /* | |
1181 | * Module magic | |
1182 | */ | |
1183 | module_init(irnet_init); | |
1184 | module_exit(irnet_cleanup); | |
1185 | MODULE_AUTHOR("Jean Tourrilhes <jt@hpl.hp.com>"); | |
6819bc2e | 1186 | MODULE_DESCRIPTION("IrNET : Synchronous PPP over IrDA"); |
1da177e4 LT |
1187 | MODULE_LICENSE("GPL"); |
1188 | MODULE_ALIAS_CHARDEV(10, 187); |