irnet_ppp.c 32 KB

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