// ---------------------------------------------------------------------------- // // Copyright (c) Microsoft Corporation. All rights reserved. // // ---------------------------------------------------------------------------- /// // Microsoft Research, Cambridge // using NetStack.Common; using System; #if !SINGULARITY using System.Net; #endif using System.Net.IP; using Drivers.Net; namespace NetStack.Protocols { /// // declaration of the ICMP header (RFC 792) // public class IcmpFormat { // size of common ICMP header public const int Size = 8; // ICMP Types public enum IcmpType { ECHO_REPLY=0, DESTINATION_UNREACHABLE=3, SOURCE_QUENCH=4, REDIRECT_MESSAGE=5, ECHO_REQUEST=8, TIME_EXCEEDED=11, PARAMETER_PROBLEM=12, TIMESTAMP_REQUEST=13, TIMESTAMP_REPLY=14, INFO_REQUEST=15, INFO_REPLY=16, ADD_MASK_REQUEST=17, ADD_MASK_REPLY=18 } // Destination Unreachable Codes public enum Type3Code { NET_UNREACHABLE=0, HOST_UNREACHABLE=1, PROT_UNREACHABLE=2 // and some more, let's add as needed } // the common ICMP header public struct IcmpHeader { public byte type; public byte code; public ushort chksum; public ushort id; public ushort seq; } // write common ICMP header // (ignores the checksum field, notice that the checksum is // calculated for the whole packet!) public static int WriteIcmpHeader(byte[]! pkt,int offset,ref IcmpHeader hdr) { int o = offset; pkt[o++] = hdr.type; pkt[o++] = hdr.code; pkt[o++] = 0; pkt[o++] = 0; pkt[o++] = (byte)(hdr.id>>8); pkt[o++] = (byte)hdr.id; pkt[o++] = (byte)(hdr.seq>>8); pkt[o++] = (byte)hdr.seq; return o; } // construct an ICMP header from a packet public static bool ReadIcmpHeader(IBuffer! buf, out IcmpHeader hdr) { bool b; b = buf.Read8(out hdr.type); b &= buf.Read8(out hdr.code); b &= buf.ReadNet16(out hdr.chksum); b &= buf.ReadNet16(out hdr.id); b &= buf.ReadNet16(out hdr.seq); return b; } // Timestamp or Timestamp Reply Message public struct TimeStamps { public IcmpHeader header; public uint origTimeStamp; public uint rcvTimeStamp; public uint txTimeStamp; } // various ICMP messages // IcmpEchoRequest public struct IcmpEchoRequest { public IcmpHeader header; public byte[] data; // get the size of the message (depends on the received data) public int GetSize() { return (IcmpFormat.Size+data.Length); } // ctor public IcmpEchoRequest(ref IcmpHeader hdr,byte[]! msgData) { header=hdr; // set the data data = new byte[msgData.Length]; Array.Copy(msgData,0,data,0,msgData.Length); } public IcmpEchoRequest(ushort id,ushort seq,byte[]! msgData) { header.type = (byte)IcmpFormat.IcmpType.ECHO_REQUEST; header.code = 0; header.chksum = 0; header.seq = seq; header.id = id; // set the data data = new byte[msgData.Length]; Array.Copy(msgData,0,data,0,msgData.Length); } // write an ICMP echo request public static int WriteIcmpEchoRequest(byte[]! pkt,int offset,ref IcmpEchoRequest request) { int o = offset; // write the common header o = WriteIcmpHeader(pkt,offset,ref request.header); // dump the data (endian doesn't matter, since it is a user data) Array.Copy(request.data,0,pkt,o,request.data.Length); // calc the checksum ushort chk = IPFormat.Checksum(pkt, offset, request.GetSize()); pkt[offset+2] = (byte) (((ushort)chk) >> 8); pkt[offset+3] = (byte) (((ushort)chk) & 0xff); request.header.chksum = chk; return o; } // write an ICMP echo reply for an ICMP Echo request public static int WriteIcmpEchoReply(byte[]! pkt,int offset,ref IcmpEchoRequest request) { int o = offset; // change the request header code to 0 request.header.type = (byte)IcmpFormat.IcmpType.ECHO_REPLY; // write the common header o = WriteIcmpHeader(pkt,offset,ref request.header); // fix it again request.header.type = (byte)IcmpFormat.IcmpType.ECHO_REQUEST; // dump the data (endian doesn't matter, since it is a user data) Array.Copy(request.data,0,pkt,o,request.data.Length); // calc the checksum ushort chk = IPFormat.Checksum(pkt,offset,request.GetSize()); pkt[offset + 2] = (byte) (((ushort)chk) >> 8); pkt[offset + 3] = (byte) (((ushort)chk) & 0xff); request.header.chksum = chk; return o; } } // a fast method that uses that modified the ECHO request // packet to an ECHO reply. // return true if success public static void CreateFastEchoReply(byte[]! pkt,int icmpPacketSize) { // 1. switch the source IP and destination IP // 2. change ICMP code to IcmpFormat.IcmpType.ECHO_REPLY // 3. should use ARP table to find out the mac address of the target // (if it is on the local network) // CURRENTLY: just switch MAC addresses as well. // 4. recompute ICMP and IP checksums int ipStart = EthernetFormat.Size; int icmpStart = ipStart + IPFormat.Size; pkt[icmpStart] = (byte)IcmpFormat.IcmpType.ECHO_REPLY; // zero checksum pkt[icmpStart + 2] = 0; pkt[icmpStart + 3] = 0; ushort chk = IPFormat.Checksum(pkt, icmpStart, icmpPacketSize); pkt[icmpStart + 2] = (byte)(chk>>8); pkt[icmpStart + 3] = (byte)chk; // switch IPs byte[] tmp = new byte[6]; Array.Copy(pkt, ipStart + 16, tmp, 0, 4); // dest->tmp Array.Copy(pkt, ipStart + 12, pkt, ipStart + 16, 4); // src->dest Array.Copy(tmp, 0, pkt, ipStart + 12, 4); // tmp->src // zero the checksum pkt[ipStart + 10] = 0; pkt[ipStart + 11] = 0; // calculate checksum chk = IPFormat.Checksum(pkt, ipStart, IPFormat.Size); pkt[ipStart + 10] = (byte) (((ushort)chk) >> 8); pkt[ipStart + 11] = (byte) (((ushort)chk) & 0xff); // TBC: currently just switch mac addresses Array.Copy(pkt, 6, tmp, 0, 6); // src -> temp Array.Copy(pkt, 0, pkt, 6, 6); // dest -> src Array.Copy(tmp, 0, pkt, 0, 6); // tmp -> dest } } }