RealTimeCompLab2 / Mbed 2 deprecated webserverBlinky

RealtimeCompLab2

Dependencies:   mbed

Fork of PPP-Blinky by Nicolas Nackel

main.cpp@15:b0154c910143, 2017-01-01 (annotated)

Committer:
nixnax
Date:
Sun Jan 01 13:25:23 2017 +0000
Revision:
15:b0154c910143
Parent:
14:c65831c25aaa
Child:
16:cb0b80c24ba2
Toggle LED in processFrame

Who changed what in which revision?

UserRevisionLine numberNew contents of line
nixnax 0:2cf4880c312a 1 #include "mbed.h"
nixnax 0:2cf4880c312a 2
nixnax 12:db0dc91f0231 3 // Copyright 2016 Nicolas Nackel. Permission is hereby granted, free of charge, to any person obtaining a copy of this software and associated documentation files (the "Software"), to deal in the Software without restriction, including without limitation the rights to use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is furnished to do so, subject to the following conditions: The above copyright notice and this permission notice shall be included in all copies or substantial portions of the Software. THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
nixnax 12:db0dc91f0231 4
nixnax 0:2cf4880c312a 5 // Proof-of-concept for TCP/IP using Windows 7/8/10 Dial Up Networking over MBED USB Virtual COM Port
nixnax 0:2cf4880c312a 6
nixnax 4:a469050d5b80 7 // Toggles LED1 every time the PC sends an IP packet over the PPP link
nixnax 4:a469050d5b80 8
nixnax 4:a469050d5b80 9 // Note - turn off all authentication, passwords, compression etc. Simplest link possible.
nixnax 0:2cf4880c312a 10
nixnax 9:0992486d4a30 11 // Handy links
nixnax 6:fba4c2e817b8 12 // http://atari.kensclassics.org/wcomlog.htm
nixnax 6:fba4c2e817b8 13 // https://technet.microsoft.com/en-us/library/cc957992.aspx
nixnax 6:fba4c2e817b8 14 // http://www.sunshine2k.de/coding/javascript/crc/crc_js.html
nixnax 9:0992486d4a30 15 // https://en.wikibooks.org/wiki/Serial_Programming/IP_Over_Serial_Connections
nixnax 6:fba4c2e817b8 16
nixnax 6:fba4c2e817b8 17 Serial pc(USBTX, USBRX); // The USB com port - Set this up as a Dial-Up Modem on your pc
nixnax 15:b0154c910143 18 Serial xx(PC_10, PC_11); // debug((((( port - use an additional USB serial port to monitor this
nixnax 0:2cf4880c312a 19
nixnax 15:b0154c910143 20 #define debug(x) xx.printf x
nixnax 9:0992486d4a30 21
nixnax 4:a469050d5b80 22 DigitalOut led1(LED1);
nixnax 4:a469050d5b80 23
nixnax 4:a469050d5b80 24 #define FRAME_7E (0x7e)
nixnax 13:d882b8a042b4 25 #define BUFLEN (1<<13)
nixnax 15:b0154c910143 26 volatile char rxbuf[BUFLEN];
nixnax 4:a469050d5b80 27 char frbuf[3000]; // buffer for ppp frame
nixnax 0:2cf4880c312a 28
nixnax 4:a469050d5b80 29 struct {
nixnax 4:a469050d5b80 30 int online;
nixnax 4:a469050d5b80 31 struct {
nixnax 15:b0154c910143 32 volatile char * buf;
nixnax 15:b0154c910143 33 volatile int head;
nixnax 4:a469050d5b80 34 int tail;
nixnax 9:0992486d4a30 35 int total;
nixnax 4:a469050d5b80 36 } rx; // serial port buffer
nixnax 4:a469050d5b80 37 struct {
nixnax 6:fba4c2e817b8 38 int id;
nixnax 4:a469050d5b80 39 int len;
nixnax 4:a469050d5b80 40 int crc;
nixnax 4:a469050d5b80 41 char * buf;
nixnax 4:a469050d5b80 42 } pkt; // ppp buffer
nixnax 4:a469050d5b80 43 } ppp;
nixnax 0:2cf4880c312a 44
nixnax 9:0992486d4a30 45 void pppInitStruct(){ ppp.online=0; ppp.rx.buf=rxbuf; ppp.rx.tail=0; ppp.rx.head=0; ppp.rx.total=0; ppp.pkt.buf=frbuf; ppp.pkt.len=0;}
nixnax 4:a469050d5b80 46
nixnax 4:a469050d5b80 47 int crcG; // frame check sequence (CRC) holder
nixnax 4:a469050d5b80 48 void crcDo(int x){for (int i=0;i<8;i++){crcG=((crcG&1)^(x&1))?(crcG>>1)^0x8408:crcG>>1;x>>=1;}} // crc calculator
nixnax 4:a469050d5b80 49 void crcReset(){crcG=0xffff;} // crc restart
nixnax 9:0992486d4a30 50 int crcBuf(char * buf, int size){crcReset();for(int i=0;i<size;i++)crcDo(*buf++);return crcG;} // crc on a block of memory
nixnax 0:2cf4880c312a 51
nixnax 0:2cf4880c312a 52 void rxHandler() // serial port receive interrupt handler
nixnax 0:2cf4880c312a 53 {
nixnax 15:b0154c910143 54 int next = (ppp.rx.head+1)&(BUFLEN-1);
nixnax 15:b0154c910143 55 if (next != ppp.rx.tail) {
nixnax 15:b0154c910143 56 ppp.rx.buf[ppp.rx.head]=pc.getc(); // insert in buffer
nixnax 15:b0154c910143 57 __disable_irq();
nixnax 15:b0154c910143 58 ppp.rx.head=next;
nixnax 15:b0154c910143 59 //ppp.rx.total++;
nixnax 15:b0154c910143 60 __enable_irq();
nixnax 15:b0154c910143 61 }
nixnax 0:2cf4880c312a 62 }
nixnax 0:2cf4880c312a 63
nixnax 14:c65831c25aaa 64 int ledState=0;
nixnax 14:c65831c25aaa 65 void led1Toggle(){
nixnax 14:c65831c25aaa 66 ledState = ledState? 0 : 1;
nixnax 14:c65831c25aaa 67 led1 = ledState;
nixnax 14:c65831c25aaa 68 }
nixnax 14:c65831c25aaa 69
nixnax 0:2cf4880c312a 70 int pc_readable() // check if buffer has data
nixnax 0:2cf4880c312a 71 {
nixnax 4:a469050d5b80 72 return (ppp.rx.head==ppp.rx.tail) ? 0 : 1 ;
nixnax 0:2cf4880c312a 73 }
nixnax 0:2cf4880c312a 74
nixnax 0:2cf4880c312a 75 int pc_getBuf() // get one character from the buffer
nixnax 0:2cf4880c312a 76 {
nixnax 15:b0154c910143 77 if (ppp.rx.head!=ppp.rx.tail) {
nixnax 4:a469050d5b80 78 int x = ppp.rx.buf[ ppp.rx.tail ];
nixnax 4:a469050d5b80 79 ppp.rx.tail=(ppp.rx.tail+1)&(BUFLEN-1);
nixnax 0:2cf4880c312a 80 return x;
nixnax 0:2cf4880c312a 81 }
nixnax 0:2cf4880c312a 82 return -1;
nixnax 0:2cf4880c312a 83 }
nixnax 0:2cf4880c312a 84
nixnax 4:a469050d5b80 85 void scanForConnectString(); // scan for connect attempts from pc
nixnax 1:9e03798d4367 86
nixnax 9:0992486d4a30 87 void processFrame(int start, int end) { // process received frame
nixnax 14:c65831c25aaa 88 led1Toggle(); // change led1 state when frames are received
nixnax 15:b0154c910143 89 if(start==end) { pc.putc(0x7e); return; }
nixnax 9:0992486d4a30 90 crcReset();
nixnax 9:0992486d4a30 91 char * dest = ppp.pkt.buf;
nixnax 9:0992486d4a30 92 ppp.pkt.len=0;
nixnax 9:0992486d4a30 93 int unstuff=0;
nixnax 9:0992486d4a30 94 for (int i=start; i<end; i++) {
nixnax 9:0992486d4a30 95 if (unstuff==0) {
nixnax 9:0992486d4a30 96 if (rxbuf[i]==0x7d) unstuff=1;
nixnax 9:0992486d4a30 97 else { *dest++ = rxbuf[i]; ppp.pkt.len++; crcDo(rxbuf[i]);}
nixnax 12:db0dc91f0231 98 } else { // unstuff
nixnax 9:0992486d4a30 99 *dest++ = rxbuf[i]^0x20; ppp.pkt.len++; crcDo((int)rxbuf[i]^0x20);
nixnax 9:0992486d4a30 100 unstuff=0;
nixnax 9:0992486d4a30 101 }
nixnax 9:0992486d4a30 102 }
nixnax 9:0992486d4a30 103 ppp.pkt.crc = crcG & 0xffff;
nixnax 9:0992486d4a30 104 if (ppp.pkt.crc == 0xf0b8) { // check for good CRC
nixnax 9:0992486d4a30 105 void determinePacketType(); // declare early
nixnax 9:0992486d4a30 106 determinePacketType();
nixnax 12:db0dc91f0231 107 } else { // crc error
nixnax 15:b0154c910143 108 debug(("CRC is %x Len is %d\n",ppp.pkt.crc,ppp.pkt.len));
nixnax 15:b0154c910143 109 for(int i=0;i<ppp.pkt.len;i++) debug(("%02x ", ppp.pkt.buf[i]));
nixnax 15:b0154c910143 110 debug(("\n"));
nixnax 9:0992486d4a30 111 }
nixnax 9:0992486d4a30 112 }
nixnax 9:0992486d4a30 113
nixnax 11:f58998c24f0b 114 void dumpFrame() {
nixnax 15:b0154c910143 115 for(int i=0;i<ppp.pkt.len/2;i++) debug(("%02x ", ppp.pkt.buf[i]));
nixnax 15:b0154c910143 116 debug((" C %02x %02x L=%d\n", ppp.pkt.crc&0xff, (ppp.pkt.crc>>8)&0xff, ppp.pkt.len));
nixnax 11:f58998c24f0b 117 }
nixnax 9:0992486d4a30 118
nixnax 9:0992486d4a30 119 void sendFrame(){
nixnax 9:0992486d4a30 120 int crc = crcBuf(ppp.pkt.buf, ppp.pkt.len-2); // get crc
nixnax 12:db0dc91f0231 121 ppp.pkt.buf[ ppp.pkt.len-2 ] = (~crc>>0); // fcs lo (crc)
nixnax 12:db0dc91f0231 122 ppp.pkt.buf[ ppp.pkt.len-1 ] = (~crc>>8); // fcs hi (crc)
nixnax 12:db0dc91f0231 123 pc.putc(0x7e); // frame start flag
nixnax 9:0992486d4a30 124 for(int i=0;i<ppp.pkt.len;i++) {
nixnax 9:0992486d4a30 125 unsigned int cc = (unsigned int)ppp.pkt.buf[i];
nixnax 9:0992486d4a30 126 if (cc>32) pc.putc(cc); else {pc.putc(0x7d); pc.putc(cc+32);}
nixnax 9:0992486d4a30 127 }
nixnax 12:db0dc91f0231 128 pc.putc(0x7e); // frame end flag
nixnax 9:0992486d4a30 129 }
nixnax 9:0992486d4a30 130
nixnax 9:0992486d4a30 131 void ipRequestHandler(){
nixnax 15:b0154c910143 132 debug(("IPCP Conf "));
nixnax 9:0992486d4a30 133 if ( ppp.pkt.buf[7] != 4 ) {
nixnax 15:b0154c910143 134 debug(("Rej\n")); // reject if any options are requested
nixnax 9:0992486d4a30 135 ppp.pkt.buf[4]=4;
nixnax 9:0992486d4a30 136 sendFrame();
nixnax 9:0992486d4a30 137 } else {
nixnax 15:b0154c910143 138 debug(("Ack\n"));
nixnax 9:0992486d4a30 139 ppp.pkt.buf[4]=2; // ack the minimum
nixnax 9:0992486d4a30 140 sendFrame(); // acknowledge
nixnax 15:b0154c910143 141 debug(("IPCP Ask\n"));
nixnax 9:0992486d4a30 142 // send our own request now
nixnax 12:db0dc91f0231 143 ppp.pkt.buf[4]=1; // request no options
nixnax 9:0992486d4a30 144 ppp.pkt.buf[5]++; // next sequence
nixnax 9:0992486d4a30 145 sendFrame(); // this is our request
nixnax 9:0992486d4a30 146 }
nixnax 9:0992486d4a30 147 }
nixnax 9:0992486d4a30 148
nixnax 15:b0154c910143 149 void ipAckHandler(){ debug(("IPCP Grant\n")); }
nixnax 9:0992486d4a30 150
nixnax 15:b0154c910143 151 void ipNackHandler(){ debug(("IPCP Nack\n")); }
nixnax 9:0992486d4a30 152
nixnax 15:b0154c910143 153 void ipDefaultHandler(){ debug(("IPCP Other\n")); }
nixnax 9:0992486d4a30 154
nixnax 9:0992486d4a30 155 void IPCPframe() {
nixnax 9:0992486d4a30 156 int code = ppp.pkt.buf[4]; // packet type is here
nixnax 9:0992486d4a30 157 switch (code) {
nixnax 9:0992486d4a30 158 case 1: ipRequestHandler(); break;
nixnax 9:0992486d4a30 159 case 2: ipAckHandler(); break;
nixnax 9:0992486d4a30 160 case 3: ipNackHandler(); break;
nixnax 9:0992486d4a30 161 default: ipDefaultHandler();
nixnax 9:0992486d4a30 162 }
nixnax 9:0992486d4a30 163 }
nixnax 9:0992486d4a30 164
nixnax 10:74f8233f72c0 165 void UDPpacket() {
nixnax 12:db0dc91f0231 166 char * udpPkt = ppp.pkt.buf+4; // udp packet start
nixnax 12:db0dc91f0231 167 //char * pktLen = udpPkt+2; // total packet length
nixnax 12:db0dc91f0231 168 int headerSize = (( udpPkt[0]&0xf)*4);
nixnax 12:db0dc91f0231 169 char * udpBlock = udpPkt + headerSize; // udp info start
nixnax 12:db0dc91f0231 170 char * udpSrc = udpBlock; // source port
nixnax 12:db0dc91f0231 171 char * udpDst = udpBlock+2; // destination port
nixnax 12:db0dc91f0231 172 char * udpLen = udpBlock+4; // udp data length
nixnax 12:db0dc91f0231 173 char * udpInf = udpBlock+8; // actual start of info
nixnax 12:db0dc91f0231 174 //char * udpSum = udpBlock+6; // udp checksum
nixnax 12:db0dc91f0231 175 //int packetLength = (pktLen[0]<<8) | pktLen[1]; // udp total packet length
nixnax 12:db0dc91f0231 176 int srcPort = (udpSrc[0]<<8) | udpSrc[1];
nixnax 12:db0dc91f0231 177 int dstPort = (udpDst[0]<<8) | udpDst[1];
nixnax 12:db0dc91f0231 178 char * srcIP = udpPkt+12; // udp src addr
nixnax 12:db0dc91f0231 179 char * dstIP = udpPkt+16; // udp dst addr
nixnax 12:db0dc91f0231 180 #define UDP_HEADER_SIZE 8
nixnax 12:db0dc91f0231 181 int udpLength = ((udpLen[0]<<8) | udpLen[1]) - UDP_HEADER_SIZE; // size of the actual udp data
nixnax 15:b0154c910143 182 debug(("UDP %d.%d.%d.%d:%d ", srcIP[0],srcIP[1],srcIP[2],srcIP[3],srcPort));
nixnax 15:b0154c910143 183 debug(("%d.%d.%d.%d:%d ", dstIP[1],dstIP[1],dstIP[1],dstIP[1],dstPort));
nixnax 15:b0154c910143 184 debug(("Len %d ", udpLength));
nixnax 13:d882b8a042b4 185 int printSize = udpLength; if (printSize > 20) printSize = 20; // print only first 20 characters
nixnax 15:b0154c910143 186 for (int i=0; i<printSize; i++) { char ch = udpInf[i]; if (ch>31 && ch<127) { debug(("%c", ch)); } else { debug(("?")); } }
nixnax 15:b0154c910143 187 debug(("\n"));
nixnax 12:db0dc91f0231 188 }
nixnax 11:f58998c24f0b 189
nixnax 11:f58998c24f0b 190 int dataCheckSum(char * ptr, int len) {
nixnax 11:f58998c24f0b 191 int sum=0;
nixnax 11:f58998c24f0b 192 for (int i=0;i<len/2;i++) {
nixnax 11:f58998c24f0b 193 int hi = *ptr; ptr++;
nixnax 11:f58998c24f0b 194 int lo = *ptr; ptr++;
nixnax 11:f58998c24f0b 195 int val = ( lo & 0xff ) | ( (hi<<8) & 0xff00 );
nixnax 11:f58998c24f0b 196 sum = sum + val;
nixnax 11:f58998c24f0b 197 }
nixnax 11:f58998c24f0b 198 sum = sum + (sum>>16);
nixnax 12:db0dc91f0231 199 return ~sum;
nixnax 11:f58998c24f0b 200 }
nixnax 11:f58998c24f0b 201
nixnax 11:f58998c24f0b 202 void headerCheckSum() {
nixnax 11:f58998c24f0b 203 int len =(ppp.pkt.buf[4]&0xf)*4; // length of header in bytes
nixnax 11:f58998c24f0b 204 char * ptr = ppp.pkt.buf+4; // start of ip packet
nixnax 11:f58998c24f0b 205 int sum=0;
nixnax 11:f58998c24f0b 206
nixnax 11:f58998c24f0b 207 for (int i=0;i<len/2;i++) {
nixnax 11:f58998c24f0b 208 int hi = *ptr; ptr++;
nixnax 11:f58998c24f0b 209 int lo = *ptr; ptr++;
nixnax 11:f58998c24f0b 210 int val = ( lo & 0xff ) | ( (hi<<8) & 0xff00 );
nixnax 11:f58998c24f0b 211 sum = sum + val;
nixnax 11:f58998c24f0b 212 }
nixnax 11:f58998c24f0b 213 sum = sum + (sum>>16);
nixnax 11:f58998c24f0b 214 sum = ~sum;
nixnax 11:f58998c24f0b 215 ppp.pkt.buf[14]= (sum>>8);
nixnax 11:f58998c24f0b 216 ppp.pkt.buf[15]= (sum );
nixnax 9:0992486d4a30 217 }
nixnax 9:0992486d4a30 218
nixnax 11:f58998c24f0b 219 void ICMPpacket() { // internet control message protocol
nixnax 12:db0dc91f0231 220 char * ipPkt = ppp.pkt.buf+4; // ip packet start
nixnax 12:db0dc91f0231 221 char * pktLen = ipPkt+2;
nixnax 12:db0dc91f0231 222 int packetLength = (pktLen[0]<<8) | pktLen[1]; // icmp packet length
nixnax 12:db0dc91f0231 223 int headerSize = (( ipPkt[0]&0xf)*4);
nixnax 12:db0dc91f0231 224 char * icmpType = ipPkt + headerSize; // icmp data start
nixnax 13:d882b8a042b4 225 char * icmpSum = icmpType+2; // icmp checksum
nixnax 13:d882b8a042b4 226
nixnax 12:db0dc91f0231 227 #define ICMP_TYPE_PING_REQUEST 8
nixnax 12:db0dc91f0231 228 if ( icmpType[0] == ICMP_TYPE_PING_REQUEST ) {
nixnax 12:db0dc91f0231 229 char * ipTTL = ipPkt+8; // time to live
nixnax 12:db0dc91f0231 230 ipTTL[0]--; // decrement time to live
nixnax 12:db0dc91f0231 231 char * srcAdr = ipPkt+12;
nixnax 12:db0dc91f0231 232 char * dstAdr = ipPkt+16;
nixnax 15:b0154c910143 233 debug(("ICMP PING %d.%d.%d.%d %d.%d.%d.%d Head %04d Tail=%04d ", srcAdr[0],srcAdr[1],srcAdr[2],srcAdr[3],dstAdr[0],dstAdr[1],dstAdr[2],dstAdr[3],ppp.rx.head,ppp.rx.tail));
nixnax 11:f58998c24f0b 234 char src[4]; char dst[4];
nixnax 12:db0dc91f0231 235 memcpy(src, srcAdr,4);
nixnax 12:db0dc91f0231 236 memcpy(dst, dstAdr,4);
nixnax 12:db0dc91f0231 237 memcpy(srcAdr, dst,4);
nixnax 12:db0dc91f0231 238 memcpy(dstAdr, src,4); // swap src & dest ip
nixnax 12:db0dc91f0231 239 char * chkSum = ipPkt+10;
nixnax 12:db0dc91f0231 240 chkSum[0]=0; chkSum[1]=0;
nixnax 12:db0dc91f0231 241 headerCheckSum(); // new ip header checksum
nixnax 12:db0dc91f0231 242 #define ICMP_TYPE_ECHO_REPLY 0
nixnax 12:db0dc91f0231 243 icmpType[0]=ICMP_TYPE_ECHO_REPLY; // icmp echo replay
nixnax 12:db0dc91f0231 244 icmpSum[0]=0; icmpSum[1]=0; // zero the checksum for recalculation
nixnax 12:db0dc91f0231 245 int dataLength = packetLength - headerSize; // length of ICMP data portion
nixnax 13:d882b8a042b4 246 int sum = dataCheckSum( icmpType, dataLength); // this checksum on icmp data portion
nixnax 12:db0dc91f0231 247 icmpSum[0]=sum>>8; icmpSum[1]=sum; // new checksum for ICMP data portion
nixnax 13:d882b8a042b4 248
nixnax 13:d882b8a042b4 249 int printSize = dataLength-8; // exclude size of icmp header
nixnax 13:d882b8a042b4 250 char * icmpData = icmpType+8; // the actual data is after the header
nixnax 15:b0154c910143 251 if (printSize > 10) printSize = 10; // print only first 20 characters
nixnax 15:b0154c910143 252 for (int i=0; i<printSize; i++) { char ch = icmpData[i]; if (ch>31 && ch<127) { debug(("%c",ch)); } else { debug(("%c",'?')); }}
nixnax 15:b0154c910143 253 debug(("%c",'\n'));
nixnax 15:b0154c910143 254
nixnax 15:b0154c910143 255 sendFrame(); // reply to the ping
nixnax 15:b0154c910143 256
nixnax 12:db0dc91f0231 257 } else {
nixnax 15:b0154c910143 258 debug(("ICMP type=%d \n", icmpType[0]));
nixnax 11:f58998c24f0b 259 }
nixnax 11:f58998c24f0b 260 }
nixnax 11:f58998c24f0b 261
nixnax 11:f58998c24f0b 262 void IGMPpacket() { // internet group management protocol
nixnax 15:b0154c910143 263 debug(("IGMP type=%d \n", ppp.pkt.buf[28]));
nixnax 11:f58998c24f0b 264 }
nixnax 11:f58998c24f0b 265
nixnax 11:f58998c24f0b 266 void TCPpacket() {
nixnax 15:b0154c910143 267 debug(("TCP\n"));
nixnax 10:74f8233f72c0 268 /*
nixnax 11:f58998c24f0b 269 switch (protocol) {
nixnax 11:f58998c24f0b 270 case 2: TCPsyn(); break;
nixnax 11:f58998c24f0b 271 case 17: TCPack(); break;
nixnax 11:f58998c24f0b 272 case 6: TCPpacket(); break;
nixnax 15:b0154c910143 273 default: debug(((( "Other \n");
nixnax 11:f58998c24f0b 274 }
nixnax 10:74f8233f72c0 275 */
nixnax 10:74f8233f72c0 276 }
nixnax 10:74f8233f72c0 277
nixnax 11:f58998c24f0b 278 void otherProtocol() {
nixnax 15:b0154c910143 279 debug(("Other IP protocol"));
nixnax 11:f58998c24f0b 280 }
nixnax 11:f58998c24f0b 281
nixnax 10:74f8233f72c0 282 void IPframe() {
nixnax 10:74f8233f72c0 283 int protocol = ppp.pkt.buf[13];
nixnax 10:74f8233f72c0 284 switch (protocol) {
nixnax 11:f58998c24f0b 285 case 1: ICMPpacket(); break;
nixnax 11:f58998c24f0b 286 case 2: IGMPpacket(); break;
nixnax 11:f58998c24f0b 287 case 17: UDPpacket(); break;
nixnax 11:f58998c24f0b 288 case 6: TCPpacket(); break;
nixnax 11:f58998c24f0b 289 default: otherProtocol();
nixnax 10:74f8233f72c0 290 }
nixnax 15:b0154c910143 291 //debug((("IP frame proto %3d len %4d %d.%d.%d.%d %d.%d.%d.%d\n", ppp.pkt.buf[13],(ppp.pkt.buf[6]<<8)+ppp.pkt.buf[7],ppp.pkt.buf[16],ppp.pkt.buf[17],ppp.pkt.buf[18],ppp.pkt.buf[19],ppp.pkt.buf[20],ppp.pkt.buf[21],ppp.pkt.buf[22],ppp.pkt.buf[23] );
nixnax 10:74f8233f72c0 292 }
nixnax 9:0992486d4a30 293
nixnax 9:0992486d4a30 294 void LCPconfReq() {
nixnax 15:b0154c910143 295 debug(("LCP Config "));
nixnax 9:0992486d4a30 296 if (ppp.pkt.buf[7] != 4) {
nixnax 11:f58998c24f0b 297 ppp.pkt.buf[4]=4; // allow only no options
nixnax 15:b0154c910143 298 debug(("Reject\n"));
nixnax 9:0992486d4a30 299 sendFrame();
nixnax 9:0992486d4a30 300 } else {
nixnax 9:0992486d4a30 301 ppp.pkt.buf[4]=2; // ack zero conf
nixnax 15:b0154c910143 302 debug(("Ack\n"));
nixnax 9:0992486d4a30 303 sendFrame();
nixnax 15:b0154c910143 304 debug(("LCP Ask\n"));
nixnax 11:f58998c24f0b 305 ppp.pkt.buf[4]=1; // request no options
nixnax 9:0992486d4a30 306 sendFrame();
nixnax 9:0992486d4a30 307 }
nixnax 9:0992486d4a30 308 }
nixnax 9:0992486d4a30 309
nixnax 9:0992486d4a30 310 void LCPconfAck() {
nixnax 15:b0154c910143 311 debug(("LCP Ack\n"));
nixnax 9:0992486d4a30 312 }
nixnax 9:0992486d4a30 313
nixnax 9:0992486d4a30 314 void LCPend(){
nixnax 15:b0154c910143 315 debug(("LCP End\n"));
nixnax 12:db0dc91f0231 316 ppp.online=0; // start hunting for connect string again
nixnax 9:0992486d4a30 317 ppp.pkt.buf[4]=6;
nixnax 12:db0dc91f0231 318 sendFrame(); // acknowledge
nixnax 9:0992486d4a30 319 }
nixnax 9:0992486d4a30 320
nixnax 9:0992486d4a30 321 void LCPother(){
nixnax 15:b0154c910143 322 debug(("LCP Other\n"));
nixnax 12:db0dc91f0231 323 dumpFrame();
nixnax 9:0992486d4a30 324 }
nixnax 9:0992486d4a30 325
nixnax 9:0992486d4a30 326 void LCPframe(){
nixnax 9:0992486d4a30 327 int code = ppp.pkt.buf[4];
nixnax 9:0992486d4a30 328 switch (code) {
nixnax 12:db0dc91f0231 329 case 1: LCPconfReq(); break; // config request
nixnax 12:db0dc91f0231 330 case 2: LCPconfAck(); break; // config ack
nixnax 12:db0dc91f0231 331 case 5: LCPend(); break; // end connection
nixnax 12:db0dc91f0231 332 default: LCPother();
nixnax 9:0992486d4a30 333 }
nixnax 9:0992486d4a30 334 }
nixnax 9:0992486d4a30 335
nixnax 12:db0dc91f0231 336 void discardedFrame() {
nixnax 15:b0154c910143 337 debug(("Dropping frame %02x %02x %02x %02x\n", ppp.pkt.buf[0],ppp.pkt.buf[1],ppp.pkt.buf[2],ppp.pkt.buf[3]));
nixnax 9:0992486d4a30 338 }
nixnax 9:0992486d4a30 339
nixnax 9:0992486d4a30 340 void determinePacketType() {
nixnax 15:b0154c910143 341 if ( ppp.pkt.buf[0] != 0xff ) { debug(("byte0 != ff\n")); return;}
nixnax 15:b0154c910143 342 if ( ppp.pkt.buf[1] != 3 ) { debug(("byte1 != 3\n")); return;}
nixnax 15:b0154c910143 343 if ( ppp.pkt.buf[3] != 0x21 ) { debug(("byte2 != 21\n")); return;}
nixnax 9:0992486d4a30 344 int packetType = ppp.pkt.buf[2];
nixnax 9:0992486d4a30 345 switch (packetType) {
nixnax 12:db0dc91f0231 346 case 0xc0: LCPframe(); break; // link control
nixnax 12:db0dc91f0231 347 case 0x80: IPCPframe(); break; // IP control
nixnax 12:db0dc91f0231 348 case 0x00: IPframe(); break; // IP itself
nixnax 12:db0dc91f0231 349 default: discardedFrame();
nixnax 9:0992486d4a30 350 }
nixnax 9:0992486d4a30 351 }
nixnax 9:0992486d4a30 352
nixnax 9:0992486d4a30 353 void scanForConnectString() {
nixnax 9:0992486d4a30 354 if ( ppp.online==0 ) {
nixnax 15:b0154c910143 355 char * clientFound = strstr( (char *)rxbuf, "CLIENTCLIENT" ); // look for PC string
nixnax 9:0992486d4a30 356 if( clientFound ) {
nixnax 9:0992486d4a30 357 strcpy( clientFound, "FOUND!FOUND!" ); // overwrite so we don't get fixated
nixnax 9:0992486d4a30 358 pc.printf("CLIENTSERVER"); // respond to PC
nixnax 9:0992486d4a30 359 ppp.online=1; // we can stop looking for the string
nixnax 15:b0154c910143 360 debug(("Connect string found\n"));
nixnax 9:0992486d4a30 361 }
nixnax 9:0992486d4a30 362 }
nixnax 9:0992486d4a30 363 }
nixnax 9:0992486d4a30 364
nixnax 0:2cf4880c312a 365 int main()
nixnax 0:2cf4880c312a 366 {
nixnax 14:c65831c25aaa 367 pc.baud(115200); // USB virtual serial port
nixnax 15:b0154c910143 368 xx.baud(115200); // second serial port for debug(((((((( messages
nixnax 9:0992486d4a30 369 xx.puts("\x1b[2J\x1b[HReady\n"); // VT100 code for clear screen & home
nixnax 4:a469050d5b80 370
nixnax 9:0992486d4a30 371 pppInitStruct(); // initialize all the PPP properties
nixnax 4:a469050d5b80 372
nixnax 9:0992486d4a30 373 pc.attach(&rxHandler,Serial::RxIrq); // start the receive handler
nixnax 4:a469050d5b80 374
nixnax 9:0992486d4a30 375 int frameStartIndex, frameEndIndex; int frameBusy=0;
nixnax 4:a469050d5b80 376
nixnax 0:2cf4880c312a 377 while(1) {
nixnax 9:0992486d4a30 378 if ( ppp.online==0 ) scanForConnectString(); // try to connect
nixnax 0:2cf4880c312a 379 while ( pc_readable() ) {
nixnax 1:9e03798d4367 380 int rx = pc_getBuf();
nixnax 4:a469050d5b80 381 if (frameBusy) {
nixnax 4:a469050d5b80 382 if (rx==FRAME_7E) {
nixnax 4:a469050d5b80 383 frameBusy=0; // done gathering frame
nixnax 4:a469050d5b80 384 frameEndIndex=ppp.rx.tail-1; // remember where frame ends
nixnax 4:a469050d5b80 385 processFrame(frameStartIndex, frameEndIndex);
nixnax 4:a469050d5b80 386 }
nixnax 4:a469050d5b80 387 }
nixnax 4:a469050d5b80 388 else {
nixnax 4:a469050d5b80 389 if (rx==FRAME_7E) {
nixnax 4:a469050d5b80 390 frameBusy=1; // start gathering frame
nixnax 9:0992486d4a30 391 frameStartIndex=ppp.rx.tail; // remember where frame started
nixnax 4:a469050d5b80 392 }
nixnax 0:2cf4880c312a 393 }
nixnax 4:a469050d5b80 394 }
nixnax 7:ab147f5e97ac 395 }
nixnax 7:ab147f5e97ac 396 }