00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041
00042
00043
00044
00045
00046
00047
00048
00049
00050
00051
00052
00053
00072 #include <inet/debug.h>
00073 #include <inet/datatypes.h>
00074 #include <inet/ethernet.h>
00075 #include <inet/ip.h>
00076 #include <inet/tcp_ip.h>
00077 #include <inet/system.h>
00078
00097 INT16 process_icmp_in (struct ip_frame* frame, UINT16 len)
00098 {
00099 UINT8 type;
00100 UINT8 code;
00101 UINT16 checksum;
00102 UINT16 i;
00103 UINT16 j;
00104 UINT8 tbuf[16];
00105
00106
00107
00108 ICMP_DEBUGOUT("Processing ICMP...\n\r");
00109
00110 if( frame->protocol != IP_ICMP ) {
00111 ICMP_DEBUGOUT("ERROR: The protocol is not ICMP\n\r");
00112 return(-1);
00113 }
00114
00115
00116
00117 checksum = 0;
00118 i = len;
00119
00120 NETWORK_RECEIVE_INITIALIZE(frame->buf_index);
00121
00122 while(i>15){
00123
00124 RECEIVE_NETWORK_BUF(tbuf, 16);
00125
00126 checksum = ip_checksum_buf(checksum, tbuf,16);
00127
00128 i -= 16;
00129 }
00130
00131 for(j=0; j < i; j++)
00132 checksum = ip_checksum(checksum, RECEIVE_NETWORK_B(), (UINT8)j);
00133
00134 checksum = ~ checksum;
00135
00136 if(checksum != IP_GOOD_CS) {
00137 ICMP_DEBUGOUT("ERROR: ICMP Checksum failed!\n\r");
00138 return (-1);
00139 }
00140
00141 ICMP_DEBUGOUT("ICMP Checksum OK\n\r");
00142
00143
00144
00145 NETWORK_RECEIVE_INITIALIZE(frame->buf_index);
00146
00147 type = RECEIVE_NETWORK_B();
00148 code = RECEIVE_NETWORK_B();
00149
00150
00151
00152 RECEIVE_NETWORK_B();
00153 RECEIVE_NETWORK_B();
00154
00155 switch(type) {
00156 case ICMP_ECHO_REQUEST:
00157
00158 if(code != 0) {
00159 ICMP_DEBUGOUT("ERROR:Misformed ICMP ECHO Request\n\r");
00160 return(-1);
00161 }
00162
00163 ICMP_DEBUGOUT("ICMP ECHO Request received\n\r");
00164
00165
00166
00167 if(len == (ICMP_ECHOREQ_HLEN + ICMP_TEMPIPSET_DATALEN) )
00168 {
00169
00170
00171 ICMP_DEBUGOUT("PING with 102 bytes of data, getting temp. IP\r\n");
00172 localmachine.localip = frame->dip;
00173 localmachine.defgw = frame->sip;
00174 localmachine.netmask = 0;
00175 }
00176
00177
00178
00179
00180 if(localmachine.localip != frame->dip)
00181 return(-1);
00182
00183
00184
00185 TXBUF[0] = ICMP_ECHO_REPLY;
00186 TXBUF[1] = 0;
00187 TXBUF[2] = 0;
00188 TXBUF[3] = 0;
00189
00190
00191
00192 if(len > NETWORK_TX_BUFFER_SIZE)
00193 len = NETWORK_TX_BUFFER_SIZE;
00194
00195 RECEIVE_NETWORK_BUF(&TXBUF[4], len);
00196
00197
00198
00199 checksum = 0;
00200
00201 checksum = ip_checksum_buf(checksum, &TXBUF[0], len);
00202
00203 checksum = ~ checksum;
00204
00205
00206
00207 TXBUF[2] = (UINT8)(checksum>>8);
00208 TXBUF[3] = (UINT8)checksum;
00209
00210
00211
00212 process_ip_out(frame->sip, IP_ICMP, 0, 100, &TXBUF[0], len);
00213
00214 ICMP_DEBUGOUT("ICMP Reply sent\n\r");
00215
00216 return(0);
00217
00218
00219 break;
00220
00221 case ICMP_ECHO_REPLY:
00222
00223 break;
00224
00225 default:
00226
00227 ICMP_DEBUGOUT("Unregognized ICMP message\n\r");
00228 return(-1);
00229 }
00230
00231 }
00232
00233
00234
00235
00236