mirror of
https://github.com/Zeal-Operating-System/ZealOS.git
synced 2024-12-29 00:36:32 +00:00
184 lines
14 KiB
HTML
Executable file
184 lines
14 KiB
HTML
Executable file
<!DOCTYPE HTML>
|
|
<html>
|
|
<head>
|
|
<meta http-equiv="Content-Type" content="text/html;charset=US-ASCII">
|
|
<meta name="generator" content="ZealOS V1.08">
|
|
<style type="text/css">
|
|
body {background-color:#1f1f1f;}
|
|
.cF0{color:#e3e3e3;background-color:#1f1f1f;}
|
|
.cF1{color:#4f84a6;background-color:#1f1f1f;}
|
|
.cF2{color:#73a255;background-color:#1f1f1f;}
|
|
.cF3{color:#297582;background-color:#1f1f1f;}
|
|
.cF4{color:#b34f4b;background-color:#1f1f1f;}
|
|
.cF5{color:#8a52c3;background-color:#1f1f1f;}
|
|
.cF6{color:#b7822f;background-color:#1f1f1f;}
|
|
.cF7{color:#444444;background-color:#1f1f1f;}
|
|
.cF8{color:#6d6d6d;background-color:#1f1f1f;}
|
|
.cF9{color:#94bfde;background-color:#1f1f1f;}
|
|
.cFA{color:#a1ce97;background-color:#1f1f1f;}
|
|
.cFB{color:#6db4be;background-color:#1f1f1f;}
|
|
.cFC{color:#e88e88;background-color:#1f1f1f;}
|
|
.cFD{color:#ca94e8;background-color:#1f1f1f;}
|
|
.cFE{color:#d4b475;background-color:#1f1f1f;}
|
|
.cFF{color:#1f1f1f;background-color:#1f1f1f;}
|
|
</style>
|
|
</head>
|
|
<body>
|
|
<pre style="font-family:monospace;font-size:12pt">
|
|
<a name="l1"></a><span class=cF0>#</span><span class=cF1>define</span><span class=cF0> ICMP_TYPE_ECHO_REPLY </span><span class=cFE>0</span><span class=cF0>
|
|
<a name="l2"></a>#</span><span class=cF1>define</span><span class=cF0> ICMP_TYPE_ECHO_REQUEST </span><span class=cFE>8</span><span class=cF0>
|
|
<a name="l3"></a>#</span><span class=cF1>define</span><span class=cF0> ICMP_CODE_ECHO </span><span class=cFE>0</span><span class=cF0> </span><span class=cF2>// RFC 792: "Echo or Echo Reply Message". 0 is the only code explicitly defined for Echo.</span><span class=cF0>
|
|
<a name="l4"></a>
|
|
<a name="l5"></a></span><span class=cF1>class</span><span class=cF0> CICMPHeader
|
|
<a name="l6"></a>{
|
|
<a name="l7"></a> </span><span class=cF1>U8</span><span class=cF0> type;
|
|
<a name="l8"></a> </span><span class=cF1>U8</span><span class=cF0> code;
|
|
<a name="l9"></a> </span><span class=cF9>U16</span><span class=cF0> checksum;
|
|
<a name="l10"></a>
|
|
<a name="l11"></a> </span><span class=cF9>U16</span><span class=cF0> identifier;
|
|
<a name="l12"></a> </span><span class=cF9>U16</span><span class=cF0> sequence_number;
|
|
<a name="l13"></a>};
|
|
<a name="l14"></a>
|
|
<a name="l15"></a>
|
|
<a name="l16"></a></span><span class=cF2>/*</span><span class=cF0> </span><span class=cF2>global variable containing last reply ICMP header received,</span><span class=cF0>
|
|
<a name="l17"></a> </span><span class=cF2>Ping() checks this to make ping report.</span><span class=cF0>
|
|
<a name="l18"></a></span><span class=cF2>*/</span><span class=cF0>
|
|
<a name="l19"></a>CICMPHeader icmp_reply;
|
|
<a name="l20"></a>
|
|
<a name="l21"></a>
|
|
<a name="l22"></a></span><span class=cF1>U0</span><span class=cF0> ICMPInit()
|
|
<a name="l23"></a>{
|
|
<a name="l24"></a> </span><span class=cF5>MemSet</span><span class=cF0>(&icmp_reply, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>CICMPHeader</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l25"></a>}
|
|
<a name="l26"></a>
|
|
<a name="l27"></a></span><span class=cF9>U16</span><span class=cF0> ICMPChecksum(</span><span class=cF1>U8</span><span class=cF0> *buf, </span><span class=cF9>I64</span><span class=cF0> size)
|
|
<a name="l28"></a>{
|
|
<a name="l29"></a> </span><span class=cF9>U64</span><span class=cF0> i, sum = </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l30"></a>
|
|
<a name="l31"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i < size; i += </span><span class=cFE>2</span><span class=cF0>)
|
|
<a name="l32"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l33"></a> sum += *buf(</span><span class=cF9>U16</span><span class=cF0> *);
|
|
<a name="l34"></a> buf += </span><span class=cFE>2</span><span class=cF0>;
|
|
<a name="l35"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l36"></a>
|
|
<a name="l37"></a> </span><span class=cF1>if</span><span class=cF0> (size - i > </span><span class=cFE>0</span><span class=cF0>)
|
|
<a name="l38"></a> sum += *buf;
|
|
<a name="l39"></a>
|
|
<a name="l40"></a> </span><span class=cF1>while</span><span class=cF0> (sum >> </span><span class=cFE>16</span><span class=cF0> != </span><span class=cFE>0</span><span class=cF0>)
|
|
<a name="l41"></a> sum = sum & </span><span class=cFE>0xFFFF</span><span class=cF0> + sum >> </span><span class=cFE>16</span><span class=cF0>;
|
|
<a name="l42"></a>
|
|
<a name="l43"></a> </span><span class=cF1>return</span><span class=cF0> ~sum(</span><span class=cF9>U16</span><span class=cF0>);
|
|
<a name="l44"></a>
|
|
<a name="l45"></a>}
|
|
<a name="l46"></a>
|
|
<a name="l47"></a>
|
|
<a name="l48"></a></span><span class=cF1>U0</span><span class=cF0> ICMPReplySend(</span><span class=cF9>U32</span><span class=cF0> destination_ip_address,
|
|
<a name="l49"></a> </span><span class=cF9>U16</span><span class=cF0> identifier,
|
|
<a name="l50"></a> </span><span class=cF9>U16</span><span class=cF0> sequence_number,
|
|
<a name="l51"></a> </span><span class=cF9>U16</span><span class=cF0> request_checksum,
|
|
<a name="l52"></a> </span><span class=cF1>U8</span><span class=cF0> *payload,
|
|
<a name="l53"></a> </span><span class=cF9>I64</span><span class=cF0> length)
|
|
<a name="l54"></a>{
|
|
<a name="l55"></a> </span><span class=cF1>U8</span><span class=cF0> *icmp_frame;
|
|
<a name="l56"></a> </span><span class=cF9>I64</span><span class=cF0> de_index;
|
|
<a name="l57"></a> CICMPHeader *header;
|
|
<a name="l58"></a>
|
|
<a name="l59"></a> de_index = IPV4PacketAllocate(&icmp_frame,
|
|
<a name="l60"></a> IP_PROTOCOL_ICMP,
|
|
<a name="l61"></a> IPV4AddressGet,
|
|
<a name="l62"></a> destination_ip_address,
|
|
<a name="l63"></a> </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>CICMPHeader</span><span class=cF7>)</span><span class=cF0> + length);
|
|
<a name="l64"></a> </span><span class=cF1>if</span><span class=cF0> (de_index < </span><span class=cFE>0</span><span class=cF0>)
|
|
<a name="l65"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l66"></a> NetErr(</span><span class=cF6>"ICMP SEND REPLY: Failed to allocate IPV4 packet."</span><span class=cF0>);
|
|
<a name="l67"></a> </span><span class=cF1>return</span><span class=cF0>;
|
|
<a name="l68"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l69"></a>
|
|
<a name="l70"></a> header = icmp_frame;
|
|
<a name="l71"></a>
|
|
<a name="l72"></a> header->type = ICMP_TYPE_ECHO_REPLY;
|
|
<a name="l73"></a> header->code = </span><span class=cFE>0</span><span class=cF0>; </span><span class=cF2>// why is 0 okay?</span><span class=cF0>
|
|
<a name="l74"></a> header->checksum = </span><span class=cF5>EndianU16</span><span class=cF0>(</span><span class=cF5>EndianU16</span><span class=cF7>(</span><span class=cF0>request_checksum</span><span class=cF7>)</span><span class=cF0> + </span><span class=cFE>0x0800</span><span class=cF0>);
|
|
<a name="l75"></a> header->identifier = identifier;
|
|
<a name="l76"></a> header->sequence_number = sequence_number;
|
|
<a name="l77"></a> </span><span class=cF2>// TODO: header checksum is awful. Shrine says hack alert.</span><span class=cF0>
|
|
<a name="l78"></a>
|
|
<a name="l79"></a> </span><span class=cF5>MemCopy</span><span class=cF0>(icmp_frame + </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>CICMPHeader</span><span class=cF7>)</span><span class=cF0>, payload, length);
|
|
<a name="l80"></a>
|
|
<a name="l81"></a> IPV4PacketFinish(de_index);
|
|
<a name="l82"></a>}
|
|
<a name="l83"></a>
|
|
<a name="l84"></a></span><span class=cF1>U0</span><span class=cF0> ICMPRequestSend(</span><span class=cF9>U32</span><span class=cF0> destination_ip_address,
|
|
<a name="l85"></a> </span><span class=cF9>U16</span><span class=cF0> identifier,
|
|
<a name="l86"></a> </span><span class=cF9>U16</span><span class=cF0> sequence_number,
|
|
<a name="l87"></a> </span><span class=cF1>U8</span><span class=cF0> *payload,
|
|
<a name="l88"></a> </span><span class=cF9>I64</span><span class=cF0> length)
|
|
<a name="l89"></a>{
|
|
<a name="l90"></a> </span><span class=cF1>U8</span><span class=cF0> *icmp_frame;
|
|
<a name="l91"></a> </span><span class=cF9>I64</span><span class=cF0> de_index;
|
|
<a name="l92"></a> CICMPHeader *header;
|
|
<a name="l93"></a>
|
|
<a name="l94"></a> de_index = IPV4PacketAllocate(&icmp_frame,
|
|
<a name="l95"></a> IP_PROTOCOL_ICMP,
|
|
<a name="l96"></a> IPV4AddressGet,
|
|
<a name="l97"></a> destination_ip_address,
|
|
<a name="l98"></a> </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>CICMPHeader</span><span class=cF7>)</span><span class=cF0> + length);
|
|
<a name="l99"></a> </span><span class=cF1>if</span><span class=cF0> (de_index < </span><span class=cFE>0</span><span class=cF0>)
|
|
<a name="l100"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l101"></a> NetErr(</span><span class=cF6>"ICMP SEND REQUEST: Failed to allocate IPV4 packet."</span><span class=cF0>);
|
|
<a name="l102"></a> </span><span class=cF1>return</span><span class=cF0>;
|
|
<a name="l103"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l104"></a>
|
|
<a name="l105"></a> header = icmp_frame;
|
|
<a name="l106"></a>
|
|
<a name="l107"></a> header->type = ICMP_TYPE_ECHO_REQUEST;
|
|
<a name="l108"></a> header->code = </span><span class=cFE>0</span><span class=cF0>; </span><span class=cF2>// why is 0 okay?</span><span class=cF0>
|
|
<a name="l109"></a> header->checksum = </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l110"></a> header->identifier = identifier;
|
|
<a name="l111"></a> header->sequence_number = sequence_number;
|
|
<a name="l112"></a>
|
|
<a name="l113"></a> </span><span class=cF5>MemCopy</span><span class=cF0>(icmp_frame + </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>CICMPHeader</span><span class=cF7>)</span><span class=cF0>, payload, length);
|
|
<a name="l114"></a>
|
|
<a name="l115"></a> header->checksum = ICMPChecksum(header, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>CICMPHeader</span><span class=cF7>)</span><span class=cF0> + length);
|
|
<a name="l116"></a>
|
|
<a name="l117"></a> IPV4PacketFinish(de_index);
|
|
<a name="l118"></a>}
|
|
<a name="l119"></a>
|
|
<a name="l120"></a></span><span class=cF9>I64</span><span class=cF0> ICMPHandler(CIPV4Packet *packet)
|
|
<a name="l121"></a>{
|
|
<a name="l122"></a> CICMPHeader *header;
|
|
<a name="l123"></a>
|
|
<a name="l124"></a> </span><span class=cF1>if</span><span class=cF0> (packet->length < </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>CICMPHeader</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l125"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l126"></a> NetErr(</span><span class=cF6>"ICMP HANDLER: Caught wrong IPV4 length."</span><span class=cF0>);
|
|
<a name="l127"></a> </span><span class=cF1>return</span><span class=cF0> -</span><span class=cFE>1</span><span class=cF0>;
|
|
<a name="l128"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l129"></a>
|
|
<a name="l130"></a> header = packet->data;
|
|
<a name="l131"></a>
|
|
<a name="l132"></a> </span><span class=cF1>if</span><span class=cF0> (header->type == ICMP_TYPE_ECHO_REQUEST && header->code == ICMP_CODE_ECHO)
|
|
<a name="l133"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l134"></a> ARPCachePut(packet->source_ip_address, packet->ethernet_frame->source_address);
|
|
<a name="l135"></a>
|
|
<a name="l136"></a> ICMPReplySend(packet->source_ip_address,
|
|
<a name="l137"></a> header->identifier,
|
|
<a name="l138"></a> header->sequence_number,
|
|
<a name="l139"></a> header->checksum,
|
|
<a name="l140"></a> packet->data + </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>CICMPHeader</span><span class=cF7>)</span><span class=cF0>, </span><span class=cF2>// Data payload at IPV4Packet data location after the ICMP header</span><span class=cF0>
|
|
<a name="l141"></a> packet->length - </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>CICMPHeader</span><span class=cF7>)</span><span class=cF0>);</span><span class=cF2>// Payload length is size of packet after dropping header.</span><span class=cF0>
|
|
<a name="l142"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l143"></a> </span><span class=cF1>else</span><span class=cF0> </span><span class=cF1>if</span><span class=cF0> (header->type == ICMP_TYPE_ECHO_REPLY && header->code == ICMP_CODE_ECHO)
|
|
<a name="l144"></a> </span><span class=cF7>{</span><span class=cF0> </span><span class=cF2>// save the reply to the global ICMP reply header</span><span class=cF0>
|
|
<a name="l145"></a> </span><span class=cF5>MemCopy</span><span class=cF0>(&icmp_reply, header, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>CICMPHeader</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l146"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l147"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l148"></a> NetWarn(</span><span class=cF6>"ICMP HANDLER: Unhandled ICMP packet. type, code: 0x%X, 0x%X"</span><span class=cF0>, header->type, header->code);
|
|
<a name="l149"></a>
|
|
<a name="l150"></a> NetLog(</span><span class=cF6>"ICMP HANDLER: Exiting."</span><span class=cF0>);
|
|
<a name="l151"></a>
|
|
<a name="l152"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l153"></a>}
|
|
<a name="l154"></a>
|
|
<a name="l155"></a>ICMPInit;
|
|
</span></pre></body>
|
|
</html>
|