ppp.c
上传用户:hepax88
上传日期:2007-01-03
资源大小:1101k
文件大小:21k
源码类别:

TCP/IP协议栈

开发平台:

Visual C++

  1. /*
  2.  *  PPP.C -- Send and receive datagrams on serial lines with
  3.  *    Point-to-Point Protocol
  4.  *
  5.  * This implementation of PPP is declared to be in the public domain.
  6.  *
  7.  * Based (in part) upon previous implementations by:
  8.  * 1989 -- Drew Daniel Perkins (ddp@andrew.cmu.edu)
  9.  *    Carnegie Mellon University
  10.  * 09-90 -- Katie Stevens (dkstevens@ucdavis.edu)
  11.  *    UC Davis, Computing Services
  12.  *
  13.  * Jan 91 Bill_Simpson@um.cc.umich.edu
  14.  * Computer Systems Consulting Services
  15.  *
  16.  * Feb 91 Glenn McGregor (ghm@merit.edu)
  17.  * Testing and suggestions.
  18.  *
  19.  * May 91 Bill Simpson & Glenn McGregor
  20.  * Update to newest LCP and IPCP draft RFCs.
  21.  * Add quick installation features.
  22.  * Add support for echo and discard message sending.
  23.  *
  24.  * Jul 91 Glenn McGregor & Bill Simpson
  25.  * Improve PAP user interface and fix related bugs.
  26.  * Remove kwaits and "phase machine".
  27.  */
  28. #include "global.h"
  29. #include "mbuf.h"
  30. #include "proc.h"
  31. #include "iface.h"
  32. #include "internet.h"
  33. #include "ip.h"
  34. #include "slhc.h"
  35. #include "n8250.h"
  36. #include "asy.h"
  37. #include "pktdrvr.h"
  38. #include "socket.h"
  39. #include "devparam.h"
  40. #include "ppp.h"
  41. #include "pppfsm.h"
  42. #include "ppplcp.h"
  43. #include "ppppap.h"
  44. #include "pppipcp.h"
  45. #include "trace.h"
  46. /* Routines local to this file */
  47. static void htonppp(struct ppp_hdr *ppp, struct mbuf **data);
  48. static void ppp_log(struct ppp_s *ppp_p, char *comment);
  49. static void ppp_error(struct ppp_s *ppp_p, struct mbuf **bp, char *comment);
  50. static void ppp_skipped(struct ppp_s *ppp_p, struct mbuf **bp, char *comment);
  51. static int ppp_raw(struct iface *ifp, struct mbuf **data);
  52. static void ppp_recv(int dev, void *p1, void *p2);
  53. static int ppp_iostatus(struct iface *ifp, int command, int32 value);
  54. static int ppp_discard(struct iface *ifp, struct mbuf **bpp);
  55. static int ppp_echo(struct iface *ifp, struct mbuf **bpp);
  56. /*
  57.  * FCS lookup table as generated by fcsgen.c
  58.  */
  59. static uint16 fcstab[256] = {
  60.     0x0000, 0x1189, 0x2312, 0x329b, 0x4624, 0x57ad, 0x6536, 0x74bf,
  61.     0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, 0xdbe5, 0xe97e, 0xf8f7,
  62.     0x1081, 0x0108, 0x3393, 0x221a, 0x56a5, 0x472c, 0x75b7, 0x643e,
  63.     0x9cc9, 0x8d40, 0xbfdb, 0xae52, 0xdaed, 0xcb64, 0xf9ff, 0xe876,
  64.     0x2102, 0x308b, 0x0210, 0x1399, 0x6726, 0x76af, 0x4434, 0x55bd,
  65.     0xad4a, 0xbcc3, 0x8e58, 0x9fd1, 0xeb6e, 0xfae7, 0xc87c, 0xd9f5,
  66.     0x3183, 0x200a, 0x1291, 0x0318, 0x77a7, 0x662e, 0x54b5, 0x453c,
  67.     0xbdcb, 0xac42, 0x9ed9, 0x8f50, 0xfbef, 0xea66, 0xd8fd, 0xc974,
  68.     0x4204, 0x538d, 0x6116, 0x709f, 0x0420, 0x15a9, 0x2732, 0x36bb,
  69.     0xce4c, 0xdfc5, 0xed5e, 0xfcd7, 0x8868, 0x99e1, 0xab7a, 0xbaf3,
  70.     0x5285, 0x430c, 0x7197, 0x601e, 0x14a1, 0x0528, 0x37b3, 0x263a,
  71.     0xdecd, 0xcf44, 0xfddf, 0xec56, 0x98e9, 0x8960, 0xbbfb, 0xaa72,
  72.     0x6306, 0x728f, 0x4014, 0x519d, 0x2522, 0x34ab, 0x0630, 0x17b9,
  73.     0xef4e, 0xfec7, 0xcc5c, 0xddd5, 0xa96a, 0xb8e3, 0x8a78, 0x9bf1,
  74.     0x7387, 0x620e, 0x5095, 0x411c, 0x35a3, 0x242a, 0x16b1, 0x0738,
  75.     0xffcf, 0xee46, 0xdcdd, 0xcd54, 0xb9eb, 0xa862, 0x9af9, 0x8b70,
  76.     0x8408, 0x9581, 0xa71a, 0xb693, 0xc22c, 0xd3a5, 0xe13e, 0xf0b7,
  77.     0x0840, 0x19c9, 0x2b52, 0x3adb, 0x4e64, 0x5fed, 0x6d76, 0x7cff,
  78.     0x9489, 0x8500, 0xb79b, 0xa612, 0xd2ad, 0xc324, 0xf1bf, 0xe036,
  79.     0x18c1, 0x0948, 0x3bd3, 0x2a5a, 0x5ee5, 0x4f6c, 0x7df7, 0x6c7e,
  80.     0xa50a, 0xb483, 0x8618, 0x9791, 0xe32e, 0xf2a7, 0xc03c, 0xd1b5,
  81.     0x2942, 0x38cb, 0x0a50, 0x1bd9, 0x6f66, 0x7eef, 0x4c74, 0x5dfd,
  82.     0xb58b, 0xa402, 0x9699, 0x8710, 0xf3af, 0xe226, 0xd0bd, 0xc134,
  83.     0x39c3, 0x284a, 0x1ad1, 0x0b58, 0x7fe7, 0x6e6e, 0x5cf5, 0x4d7c,
  84.     0xc60c, 0xd785, 0xe51e, 0xf497, 0x8028, 0x91a1, 0xa33a, 0xb2b3,
  85.     0x4a44, 0x5bcd, 0x6956, 0x78df, 0x0c60, 0x1de9, 0x2f72, 0x3efb,
  86.     0xd68d, 0xc704, 0xf59f, 0xe416, 0x90a9, 0x8120, 0xb3bb, 0xa232,
  87.     0x5ac5, 0x4b4c, 0x79d7, 0x685e, 0x1ce1, 0x0d68, 0x3ff3, 0x2e7a,
  88.     0xe70e, 0xf687, 0xc41c, 0xd595, 0xa12a, 0xb0a3, 0x8238, 0x93b1,
  89.     0x6b46, 0x7acf, 0x4854, 0x59dd, 0x2d62, 0x3ceb, 0x0e70, 0x1ff9,
  90.     0xf78f, 0xe606, 0xd49d, 0xc514, 0xb1ab, 0xa022, 0x92b9, 0x8330,
  91.     0x7bc7, 0x6a4e, 0x58d5, 0x495c, 0x3de3, 0x2c6a, 0x1ef1, 0x0f78
  92. };
  93. #define pppfcs(fcs, c) ((fcs >> 8) ^ fcstab[(fcs ^ c) & 0x00ff])
  94. #define SP_CHAR 0x20
  95. /****************************************************************************/
  96. /* Convert PPP header in host form to network form */
  97. static void
  98. htonppp(
  99. struct ppp_hdr *ppp,
  100. struct mbuf **bpp
  101. ){
  102. register uint8 *cp;
  103. /* Prepend header onto packet data */
  104. pushdown(bpp, NULL, PPP_HDR_LEN);
  105. /* Load header with proper values */
  106. cp = (*bpp)->data;
  107. *cp++ = ppp->addr;
  108. *cp++ = ppp->control;
  109. cp = put16(cp,ppp->protocol);
  110. }
  111. /************************************************************************/
  112. /* General log routine */
  113. static void
  114. ppp_log( ppp_p, comment )
  115. struct ppp_s *ppp_p;
  116. char *comment;
  117. {
  118. if (ppp_p->trace)
  119. trace_log(ppp_p->iface,"%s PPP %s",
  120. ppp_p->iface->name,
  121. comment);
  122. }
  123. /* Bad packet */
  124. static void
  125. ppp_error(ppp_p, bpp, comment)
  126. struct ppp_s *ppp_p;
  127. struct mbuf **bpp;
  128. char *comment;
  129. {
  130. free_p(bpp);
  131. ppp_log( ppp_p, comment );
  132. }
  133. /* Unknown type input packet */
  134. static void
  135. ppp_skipped(
  136. struct ppp_s *ppp_p,
  137. struct mbuf **bpp,
  138. char *comment
  139. ){
  140. struct ipcp_s *ipcp_p;
  141. if ( (ipcp_p = ppp_p->fsm[IPcp].pdv) != NULL ) {
  142. slhc_toss( ipcp_p->slhcp );
  143. }
  144. ppp_error( ppp_p, bpp, comment );
  145. }
  146. /****************************************************************************/
  147. /* Send IP datagram with Point-to-Point Protocol */
  148. int
  149. ppp_send(bpp,ifp,gateway,tos)
  150. struct mbuf **bpp; /* Buffer to send */
  151. struct iface *ifp; /* Pointer to interface control block */
  152. int32 gateway; /* Ignored (PPP is point-to-point) */
  153. uint8 tos;
  154. {
  155. struct ppp_s *ppp_p;
  156. struct ipcp_s *ipcp_p;
  157. int protocol = PPP_IP_PROTOCOL;
  158. if (ifp == NULL
  159.  || (ppp_p = ifp->edv) == NULL) {
  160. free_p(bpp);
  161. return -1;
  162. }
  163. if (ppp_p->fsm[IPcp].state != fsmOPENED) {
  164. ppp_error( ppp_p, bpp, "not open for IP traffic" );
  165. ppp_p->OutError++;
  166. return -1;
  167. }
  168. ipcp_p = ppp_p->fsm[IPcp].pdv;
  169. if (ipcp_p->remote.work.negotiate & IPCP_N_COMPRESS) {
  170. /* Attempt IP/TCP header compression */
  171. switch ( slhc_compress(ipcp_p->slhcp, bpp,
  172. ipcp_p->remote.work.slot_compress) ) {
  173. case SL_TYPE_IP:
  174. protocol = PPP_IP_PROTOCOL;
  175. break;
  176. case SL_TYPE_COMPRESSED_TCP:
  177. protocol = PPP_COMPR_PROTOCOL;
  178. break;
  179. case SL_TYPE_UNCOMPRESSED_TCP:
  180. protocol = PPP_UNCOMP_PROTOCOL;
  181. break;
  182. default:
  183. ppp_error( ppp_p, bpp, "bad IP packet" );
  184. ppp_p->OutError++;
  185. return -1;
  186. };
  187. }
  188. return (*ifp->output)(ifp,NULL,NULL,protocol,bpp);
  189. }
  190. /* Send a packet with PPP header */
  191. int
  192. ppp_output(
  193. struct iface *ifp, /* Pointer to interface control block */
  194. char *dest, /* Dest addr (ignored; PPP is point-to-point) */
  195. char *source, /* Source addr (ignored; PPP is point-to-point) */
  196. uint16 protocol, /* PPP Protocol Type field */
  197. struct mbuf **data /* Actual data to be sent */
  198. ){
  199. struct ppp_s *ppp_p;
  200. struct ppp_hdr hdr;
  201. if (ifp == NULL
  202.  || (ppp_p = ifp->edv) == NULL) {
  203. free_p(data);
  204. return -1;
  205. }
  206. if (ppp_p->phase == pppDEAD) {
  207. ppp_error( ppp_p, data, "line not up" );
  208. ppp_p->OutError++;
  209. return -1;
  210. }
  211. hdr.addr = HDLC_ALL_ADDR;
  212. hdr.control = HDLC_UI;
  213. hdr.protocol = protocol;
  214. htonppp(&hdr, data);
  215. return (*ifp->raw)(ifp,data);
  216. }
  217. /* Encode a raw packet in PPP framing, put on link output queue */
  218. static int
  219. ppp_raw(
  220. struct iface *ifp,
  221. struct mbuf **bpp
  222. ){
  223. struct ppp_s *ppp_p = ifp->edv;
  224. struct lcp_s *lcp_p = ppp_p->fsm[Lcp].pdv;
  225. int full_lcp, full_ac, full_p;
  226. uint16 calc_fcs = HDLC_FCS_START;
  227. int32 accm = LCP_ACCM_DEFAULT;
  228. struct ppp_hdr ph;
  229. int len = PPP_HDR_LEN;
  230. struct mbuf *vbp;
  231. register uint8 *cp;
  232. register int c;
  233. dump(ifp,IF_TRACE_OUT,*bpp);
  234. ppp_p->OutTxOctetCount += len_p(*bpp) + 2;  /* count FCS bytes */
  235. ifp->rawsndcnt++;
  236. ifp->lastsent = secclock();
  237. /* Get the HDLC/PPP header, without actually pulling mbuf up */
  238. if ( *bpp == NULL || (*bpp)->cnt < PPP_HDR_LEN ) {
  239. ppp_error( ppp_p, bpp, "link header missing" );
  240. ppp_p->OutError++;
  241. return -1;
  242. }
  243. ph.addr = (*bpp)->data[0];
  244. ph.control = (*bpp)->data[1];
  245. ph.protocol = get16(&(*bpp)->data[2]);
  246. if ( ( full_lcp = (ph.protocol == PPP_LCP_PROTOCOL) ) == 0
  247.  && (lcp_p->remote.work.negotiate & LCP_N_ACCM) ) {
  248. accm = lcp_p->remote.work.accm;
  249. }
  250. if ( ( full_p = ( full_lcp
  251. ||  !(lcp_p->remote.work.negotiate & LCP_N_PFC)
  252. ||  ph.protocol >= 0x00ff ) )
  253.     == 0 ) {
  254. --len;
  255. }
  256. /* Discard HDLC address and control fields if possible */
  257. if ( ( full_ac = ( full_lcp
  258. ||  !(lcp_p->remote.work.negotiate & LCP_N_ACFC) ) )
  259.     == 0 ) {
  260. len -= 2;
  261. }
  262. /* Load header with proper values */
  263. (*bpp)->cnt -= PPP_HDR_LEN - len;
  264. cp = ((*bpp)->data += PPP_HDR_LEN - len);
  265. if ( full_ac ) {
  266. *cp++ = ph.addr;
  267. *cp++ = ph.control;
  268. }
  269. if ( full_p )
  270. *cp++ = (ph.protocol >> 8);
  271. *cp++ = (ph.protocol & 0x00ff);
  272. /* Allocate output mbuf that's twice as long as the packet.
  273.  * This is a worst-case guess (consider a packet full of HDLC_FLAGs!)
  274.  */
  275. if ((vbp = alloc_mbuf((uint16)(2*len_p(*bpp) + HDLC_ENVLEN))) == NULL) {
  276. ppp_error( ppp_p, bpp, Nospace );
  277. ppp_p->OutMemory++;
  278. return -1;
  279. }
  280. cp = vbp->data;
  281. /* No need to send an opening flag if the previous packet is still
  282.  * being transmitted.
  283.  */
  284. if ( Asy[ifp->dev].dma.busy == 0 ) {
  285. /* Flush out any line garbage */
  286. *cp++ = HDLC_FLAG;
  287. ppp_p->OutOpenFlag++;
  288. }
  289. /* Copy input to output, escaping special characters */
  290. while ((c = PULLCHAR(bpp)) != -1) {
  291. /* Fold char value into FCS calculated so far */
  292. calc_fcs = pppfcs(calc_fcs, c);
  293. if ( ((c < SP_CHAR) && (accm & (1L << c)))
  294.     || (c == HDLC_ESC_ASYNC)
  295.     || (c == HDLC_FLAG)) {
  296. *cp++ = HDLC_ESC_ASYNC;
  297. *cp++ = (c ^ HDLC_ESC_COMPL);
  298. } else {
  299. *cp++ = c;
  300. }
  301. }
  302. /* Final FCS calculation */
  303. calc_fcs ^= 0xffff;
  304. c = (calc_fcs & 0x00ff); /* Least significant byte first */
  305. if ( ((c < SP_CHAR) && (accm & (1L << c)))
  306.      ||(c == HDLC_ESC_ASYNC)
  307.      ||(c == HDLC_FLAG)) {
  308. *cp++ = HDLC_ESC_ASYNC;
  309. *cp++ = (c ^ HDLC_ESC_COMPL);
  310. } else {
  311. *cp++ = c;
  312. }
  313. c = (calc_fcs >> 8); /* Most significant byte next */
  314. if ( ((c < SP_CHAR) && (accm & (1L << c)))
  315.      ||(c == HDLC_ESC_ASYNC)
  316.      ||(c == HDLC_FLAG)) {
  317. *cp++ = HDLC_ESC_ASYNC;
  318. *cp++ = (c ^ HDLC_ESC_COMPL);
  319. } else {
  320. *cp++ = c;
  321. }
  322. /* Tie off the packet */
  323. *cp++ = HDLC_FLAG;
  324. vbp->cnt = cp - vbp->data;
  325. if (ifp->trace & IF_TRACE_RAW)
  326. raw_dump(ifp,IF_TRACE_OUT,vbp);
  327. return asy_send(ifp->dev,&vbp);
  328. }
  329. /****************************************************************************/
  330. /* Packetize PPP input from device */
  331. /* (process started by ppp_init) */
  332. void
  333. ppp_recv(dev,p1,p2)
  334. int dev;
  335. void *p1;
  336. void *p2;
  337. {
  338. struct iface *ifp = p1;
  339. struct ppp_s *ppp_p = ifp->edv;
  340. int32 accm = LCP_ACCM_DEFAULT;
  341. uint16 calc_fcs = HDLC_FCS_START;
  342. struct mbuf *raw_bp = NULL;
  343. struct mbuf *head_bp = NULL;
  344. struct mbuf *tail_bp = NULL;
  345. uint8 *cp; /* next byte in tail mbuf */
  346. register int mode = FALSE;
  347. register int c;
  348. while ( (c = get_asy(dev)) != -1 ) {
  349. #ifdef PPP_DEBUG_RAW
  350. if (ifp->trace & IF_TRACE_RAW) {
  351. if ( raw_bp != NULL
  352.   || (raw_bp = alloc_mbuf( LCP_MRU_HI * 2 )) != NULL ) {
  353. *raw_bp->data++ = c;
  354. raw_bp->cnt++;
  355. if ( raw_bp->cnt != 1 && c == HDLC_FLAG ) {
  356. raw_bp->data = (uint8 *)(raw_bp + 1);
  357. raw_dump( ifp, IF_TRACE_IN, raw_bp );
  358. raw_bp->cnt = 0;
  359. }
  360. }
  361. }
  362. #endif
  363. if ( c == HDLC_FLAG ) {
  364. if ( mode & PPP_ESCAPED ) {
  365. ppp_skipped( ppp_p, &head_bp,
  366. "deliberate cancellation" );
  367. ppp_p->InFrame++;
  368. } else if ( mode & PPP_TOSS ) {
  369. free_p(& head_bp );
  370. } else if ( head_bp != NULL ) {
  371. if ( calc_fcs != HDLC_FCS_FINAL ) {
  372. ppp_skipped( ppp_p, &head_bp,
  373. "checksum error" );
  374. ppp_p->InChecksum++;
  375. } else {
  376. /* trim off FCS bytes */
  377. trim_mbuf(&head_bp, len_p(head_bp)-2);
  378. net_route(ifp,&head_bp);
  379. /* Especially on slow machines, serial I/O can be quite
  380.  * compute intensive, so release the machine before we
  381.  * do the next packet.  This will allow this packet to
  382.  * go on toward its ultimate destination. [Karn]
  383.  */
  384. kwait(NULL);
  385. }
  386. } else {
  387. ppp_p->InOpenFlag++;
  388. }
  389. /* setup for next buffer */
  390. mode = FALSE;
  391. head_bp = tail_bp = NULL;
  392. calc_fcs = HDLC_FCS_START;
  393. accm = LCP_ACCM_DEFAULT;
  394. /* Use negotiated values if LCP finished */
  395. if (ppp_p->fsm[Lcp].state == fsmOPENED) {
  396. struct lcp_s *lcp_p = ppp_p->fsm[Lcp].pdv;
  397. if (lcp_p->local.work.negotiate & LCP_N_ACCM) {
  398. accm = lcp_p->local.work.accm;
  399. }
  400. }
  401. #ifdef PPP_DEBUG_RAW
  402. if (!(ifp->trace & IF_TRACE_RAW)) {
  403. if ( raw_bp != NULL ) {
  404. free_p(& raw_bp );
  405. raw_bp = NULL;
  406. }
  407. }
  408. #endif
  409. continue;
  410. }
  411. /* We reach here for every byte inside a frame.
  412.  * (The order of the following tests is important.)
  413.  * Discard spurious control characters.
  414.  * Check for escape sequence.
  415.  * (Allow escaped escape.)
  416.  */
  417. if ( c < SP_CHAR && (accm & (1L << c)) ) {
  418. continue;
  419. } else if ( mode & PPP_ESCAPED ) {
  420. mode &= ~PPP_ESCAPED;
  421. c ^= HDLC_ESC_COMPL;
  422. } else if ( c == HDLC_ESC_ASYNC ) {
  423. mode |= PPP_ESCAPED;
  424. continue;
  425. }
  426. /* We reach here with a byte for the buffer.
  427.  * Make sure there is room for it.
  428.  */
  429. if ( tail_bp == NULL ) {
  430. if ((tail_bp = alloc_mbuf(PPP_ALLOC)) == NULL) {
  431. ppp_skipped( ppp_p, &tail_bp, Nospace );
  432. ppp_p->InMemory++;
  433. mode |= PPP_TOSS;
  434. continue;
  435. }
  436. head_bp = tail_bp;
  437. cp = tail_bp->data;
  438. } else if ( tail_bp->cnt >= tail_bp->size ) {
  439. /* Current mbuf is full */
  440. if ( (tail_bp->next = alloc_mbuf(PPP_ALLOC)) == NULL ) {
  441. /* No memory, drop the whole packet */
  442. ppp_skipped( ppp_p, &head_bp, Nospace );
  443. ppp_p->InMemory++;
  444. head_bp = NULL;
  445. mode |= PPP_TOSS;
  446. continue;
  447. }
  448. tail_bp = tail_bp->next;
  449. cp = tail_bp->data;
  450. }
  451. /* Store the byte, increment counts */
  452. *cp++ = c;
  453. tail_bp->cnt++;
  454. calc_fcs = pppfcs(calc_fcs, c);
  455. }
  456. /* clean up afterward */
  457. free_p(&raw_bp);
  458. free_p(&head_bp);
  459. ifp->rxproc = NULL;
  460. }
  461. #ifdef TURBOC_SWITCH_BUG
  462. #pragma option -G-
  463. #endif
  464. /* Process incoming PPP packets */
  465. /* (called from network task) */
  466. void
  467. ppp_proc(ifp,bpp)
  468. struct iface *ifp;
  469. struct mbuf **bpp;
  470. {
  471. struct ppp_s *ppp_p;
  472. struct ipcp_s *ipcp_p;
  473. struct ppp_hdr ph;
  474. uint16 negotiated = FALSE;
  475. if ( ifp == NULL ) {
  476. logmsg(-1, "ppp_proc: missing iface" );
  477. return;
  478. }
  479. if ( *bpp == NULL ) {
  480. trace_log(ifp, "ppp_proc: missing buffer" );
  481. return;
  482. }
  483. ppp_p = ifp->edv;
  484. ppp_p->InRxOctetCount += len_p(*bpp) + 2;   /* count FCS bytes */
  485. /* Use negotiated values if LCP finished */
  486. if (ppp_p->fsm[Lcp].state == fsmOPENED) {
  487. struct lcp_s *lcp_p = ppp_p->fsm[Lcp].pdv;
  488. negotiated = lcp_p->local.work.negotiate;
  489. }
  490. /* HDLC address and control fields may be compressed out */
  491. if ((byte_t)(*bpp)->data[0] != HDLC_ALL_ADDR) {
  492. if (!(negotiated & LCP_N_ACFC)) {
  493. ppp_skipped( ppp_p, bpp, "missing ALL address" );
  494. ppp_p->InFrame++;
  495. return;
  496. }
  497. } else if ((byte_t)(*bpp)->data[1] != HDLC_UI) {
  498. if (!(negotiated & LCP_N_ACFC)
  499.  || !(negotiated & LCP_N_PFC)) {
  500. ppp_skipped( ppp_p, bpp, "missing UI" );
  501. ppp_p->InFrame++;
  502. return;
  503. }
  504. } else {
  505. /* skip address/control fields */
  506. pull16(bpp);
  507. }
  508. /* Initialize the expected header */
  509. ph.addr = HDLC_ALL_ADDR;
  510. ph.control = HDLC_UI;
  511. ph.protocol = PULLCHAR(bpp);
  512. /* First byte of PPP protocol field may be compressed out */
  513. if ( ph.protocol & 0x01 ) {
  514. if (!(negotiated & LCP_N_PFC)) {
  515. ppp_skipped( ppp_p, bpp, "missing upper protocol byte" );
  516. ppp_p->InFrame++;
  517. return;
  518. }
  519. } else {
  520. ph.protocol = (ph.protocol << 8) | PULLCHAR(bpp);
  521. /* Second byte of PPP protocol field must be odd */
  522. if ( !(ph.protocol & 0x01) ) {
  523. ppp_skipped( ppp_p, bpp, "missing lower protocol byte" );
  524. ppp_p->InFrame++;
  525. return;
  526. }
  527. }
  528. switch(ph.protocol) {
  529. case PPP_IP_PROTOCOL: /* Regular IP */
  530. if ( ppp_p->fsm[IPcp].state != fsmOPENED ) {
  531. ppp_error( ppp_p, bpp, "not open for IP traffic" );
  532. ppp_p->InError++;
  533. break;
  534. }
  535. ip_route(ifp,bpp,0);
  536. break;
  537. case PPP_COMPR_PROTOCOL: /* Van Jacobson Compressed TCP/IP */
  538. if ( ppp_p->fsm[IPcp].state != fsmOPENED ) {
  539. ppp_skipped( ppp_p, bpp, "not open for Compressed TCP/IP traffic" );
  540. ppp_p->InError++;
  541. break;
  542. }
  543. ipcp_p = ppp_p->fsm[IPcp].pdv;
  544. if (!(ipcp_p->local.work.negotiate & IPCP_N_COMPRESS)) {
  545. ppp_skipped( ppp_p, bpp, "Compressed TCP/IP not enabled" );
  546. ppp_p->InError++;
  547. break;
  548. }
  549. if ( slhc_uncompress(ipcp_p->slhcp, bpp) <= 0 ) {
  550. ppp_error( ppp_p, bpp, "Compressed TCP/IP packet error" );
  551. ppp_p->InError++;
  552. break;
  553. }
  554. ip_route(ifp,bpp,0);
  555. break;
  556. case PPP_UNCOMP_PROTOCOL: /* Van Jacobson Uncompressed TCP/IP */
  557. if ( ppp_p->fsm[IPcp].state != fsmOPENED ) {
  558. ppp_skipped( ppp_p, bpp, "not open for Uncompressed TCP/IP traffic" );
  559. ppp_p->InError++;
  560. break;
  561. }
  562. ipcp_p = ppp_p->fsm[IPcp].pdv;
  563. if (!(ipcp_p->local.work.negotiate & IPCP_N_COMPRESS)) {
  564. ppp_skipped( ppp_p, bpp, "Uncompressed TCP/IP not enabled" );
  565. ppp_p->InError++;
  566. break;
  567. }
  568. if ( slhc_remember(ipcp_p->slhcp, bpp) <= 0 ) {
  569. ppp_error( ppp_p, bpp, "Uncompressed TCP/IP packet error" );
  570. ppp_p->InError++;
  571. break;
  572. }
  573. ip_route(ifp,bpp,0);
  574. break;
  575. case PPP_LCP_PROTOCOL: /* Link Control Protocol */
  576. ppp_p->InNCP[Lcp]++;
  577. fsm_proc(&(ppp_p->fsm[Lcp]),bpp);
  578. break;
  579. case PPP_PAP_PROTOCOL: /* Password Authenticate Protocol */
  580. if (ppp_p->phase != pppAP
  581.  && ppp_p->phase != pppREADY) {
  582. ppp_error( ppp_p, bpp, "not ready for Authentication" );
  583. ppp_p->InError++;
  584. break;
  585. }
  586. ppp_p->InNCP[Pap]++;
  587. pap_proc(&(ppp_p->fsm[Pap]),bpp);
  588. break;
  589. case PPP_IPCP_PROTOCOL: /* IP Control Protocol */
  590. if (ppp_p->phase != pppREADY) {
  591. ppp_error( ppp_p, bpp, "not ready for IPCP traffic" );
  592. ppp_p->InError++;
  593. break;
  594. }
  595. ppp_p->InNCP[IPcp]++;
  596. fsm_proc(&(ppp_p->fsm[IPcp]),bpp);
  597. break;
  598. default:
  599. if ( ppp_p->trace )
  600. trace_log(ppp_p->iface, "%s PPP Unknown packet protocol: %x;",
  601. ppp_p->iface->name,
  602. ph.protocol);
  603. ppp_p->InUnknown++;
  604. /* Build Protocol Reject packet:
  605.  * put the header back on ...
  606.  */
  607. htonppp(&ph,bpp);
  608. /* ... then pull off the address and control fields ... */
  609. pull16(bpp);
  610. /* ... and send it as an LCP packet */
  611. fsm_send( &(ppp_p->fsm[Lcp]), PROT_REJ, 0, bpp );
  612. break;
  613. };
  614. }
  615. #ifdef TURBOC_SWITCH_BUG
  616. #pragma option -G
  617. #endif
  618. /************************************************************************/
  619. /* Keep track of changes in I-O status */
  620. /* (called through iface iostatus vector) */
  621. static int
  622. ppp_iostatus( ifp, command, value )
  623. struct iface *ifp;
  624. int command;
  625. int32 value;
  626. {
  627. struct ppp_s *ppp_p = ifp->edv;
  628. switch ( command ) {
  629. case PARAM_UP:
  630. ppp_log( ppp_p, "Physical layer up" );
  631. if ( ppp_p->phase == pppDEAD ) {
  632. ppp_p->phase = pppLCP;
  633. }
  634. fsm_start( &(ppp_p->fsm[Lcp]) );
  635. return 0;
  636. case PARAM_DOWN:
  637. ppp_log( ppp_p, "Physical layer down" );
  638. fsm_down( &(ppp_p->fsm[Lcp]) );
  639. ppp_p->phase = pppDEAD;
  640. return 0;
  641. };
  642. return -1;
  643. }
  644. static int
  645. ppp_discard(
  646. struct iface *ifp,
  647. struct mbuf **bpp
  648. ){
  649. struct ppp_s *ppp_p = ifp->edv;
  650. return fsm_send(&(ppp_p->fsm[Lcp]), DISCARD_REQ, 0, bpp);
  651. }
  652. static int
  653. ppp_echo(
  654. struct iface *ifp,
  655. struct mbuf **bpp
  656. ){
  657. struct ppp_s *ppp_p = ifp->edv;
  658. return fsm_send(&(ppp_p->fsm[Lcp]), ECHO_REQ, 0, bpp);
  659. }
  660. /****************************************************************************/
  661. /* Initialize PPP control structures for a Point-to-Point interface */
  662. int
  663. ppp_init(ifp)
  664. struct iface *ifp;
  665. {
  666. struct ppp_s *ppp_p;
  667. char *ifn;
  668. /* Setup for Point-to-Point Protocol */
  669. ifp->ioctl = asy_ioctl;
  670. ppp_p = callocw(1,sizeof(struct ppp_s));
  671. ifp->edv = ppp_p;
  672. ifp->iostatus = ppp_iostatus;
  673. ifp->raw = ppp_raw;
  674. ifp->show = ppp_show;
  675. ifp->echo = ppp_echo;
  676. ifp->discard = ppp_discard;
  677. ppp_p->iface = ifp;
  678. ppp_p->phase = pppDEAD;
  679. lcp_init(ppp_p);
  680. pap_init(ppp_p);
  681. ipcp_init(ppp_p);
  682. ifp->rxproc = newproc( ifn = if_name( ifp, " receive" ),
  683. 320, ppp_recv, ifp->dev, ifp, NULL, 0);
  684. free(ifn);
  685. return 0;
  686. }
  687. int
  688. ppp_free(ifp)
  689. struct iface *ifp;
  690. {
  691. struct ppp_s *ppp_p = ifp->edv;
  692. int fsmi;
  693. alert( ifp->rxproc, 1 );
  694. for ( fsmi = Lcp; fsmi < fsmi_Size; ) {
  695. fsm_free( &(ppp_p->fsm[fsmi++]) );
  696. }
  697. free( ppp_p->peername );
  698. free( ppp_p );
  699. return 0;
  700. }