public bool SendIP(IPPacket ipPkt) { //TODO Optimise Checksum for implace checksumming if (ipPkt.VerifyCheckSum() == false) { Log_Error("IP packet with bad CSUM"); return(false); } if (ipPkt.Payload.VerifyCheckSum(ipPkt.SourceIP, ipPkt.DestinationIP) == false) { Log_Error("IP packet with bad Payload CSUM"); return(false); } ConnectionKey Key = new ConnectionKey { IP0 = ipPkt.DestinationIP[0], IP1 = ipPkt.DestinationIP[1], IP2 = ipPkt.DestinationIP[2], IP3 = ipPkt.DestinationIP[3], Protocol = ipPkt.Protocol }; switch (ipPkt.Protocol) //(Prase Payload) { case (byte)IPType.ICMP: return(SendICMP(Key, ipPkt)); case (byte)IPType.IGMP: return(SendIGMP(Key, ipPkt)); case (byte)IPType.TCP: return(SendTCP(Key, ipPkt)); case (byte)IPType.UDP: return(SendUDP(Key, ipPkt)); default: //Log_Error("Unkown Protocol"); throw new NotImplementedException("Unkown IPv4 Protocol " + ipPkt.Protocol.ToString("X2")); //return false; } }
//sends the packet and deletes it when done (if successful).rv :true success public override bool send(netHeader.NetPacket pkt) { bool result = false; PacketReader.EthernetFrame ef = new PacketReader.EthernetFrame(pkt); switch (ef.Protocol) { case (int)EtherFrameType.NULL: //Adapter Reset //TODO close all open connections break; case (int)EtherFrameType.IPv4: //Console.Error.WriteLine("IPv4"); IPPacket ippkt = ((IPPacket)ef.Payload); if (ippkt.VerifyCheckSum() == false) { Console.Error.WriteLine("IP packet with bad CSUM"); } if (ippkt.Payload.VerifyCheckSum(ippkt.SourceIP, ippkt.DestinationIP) == false) { Console.Error.WriteLine("IP packet with bad Payload CSUM"); } string Key = (ippkt.DestinationIP[0]) + "." + (ippkt.DestinationIP[1]) + "." + (ippkt.DestinationIP[2]) + "." + ((UInt64)ippkt.DestinationIP[3]) + "-" + (ippkt.Protocol); switch (ippkt.Protocol) //(Prase Payload) { case (byte)IPType.ICMP: Console.Error.WriteLine("ICMP"); lock (sentry) { if (Connections.ContainsKey(Key)) { if (Connections[Key].isOpen() == false) { throw new Exception("Attempt to send on Closed Connection"); } Console.Error.WriteLine("Found Open Connection"); result = Connections[Key].send(ippkt.Payload); } else { Console.Error.WriteLine("Creating New Connection with key " + Key); ICMPSession s = new ICMPSession(); s.DestIP = ippkt.DestinationIP; s.SourceIP = UDP_DHCPsession.PS2_IP; result = s.send(ippkt.Payload); Connections.Add(Key, s); } } break; case (byte)IPType.TCP: //Console.Error.WriteLine("TCP"); TCP tcp = (TCP)ippkt.Payload; Key += "-" + ((UInt64)tcp.SourcePort) + ":" + ((UInt64)tcp.DestinationPort); lock (sentry) { if (Connections.ContainsKey(Key)) { if (Connections[Key].isOpen() == false) { throw new Exception("Attempt to send on Closed TCP Connection of Key : " + Key + ""); } //Console.Error.WriteLine("Found Open Connection"); result = Connections[Key].send(ippkt.Payload); } else { //Console.Error.WriteLine("Creating New Connection with key " + Key); Console.Error.WriteLine("Creating New TCP Connection with Dest Port " + tcp.DestinationPort); TCPSession s = new TCPSession(); s.DestIP = ippkt.DestinationIP; s.SourceIP = UDP_DHCPsession.PS2_IP; result = s.send(ippkt.Payload); Connections.Add(Key, s); } } break; case (byte)IPType.UDP: //Console.Error.WriteLine("UDP"); UDP udp = (UDP)ippkt.Payload; Key += "-" + ((UInt64)udp.SourcePort) + ":" + ((UInt64)udp.DestinationPort); if (udp.DestinationPort == 67) { //DHCP result = DCHP_server.send(ippkt.Payload); break; } lock (sentry) { if (Connections.ContainsKey(Key)) { if (Connections[Key].isOpen() == false) { throw new Exception("Attempt to send on Closed Connection"); } //Console.Error.WriteLine("Found Open Connection"); result = Connections[Key].send(ippkt.Payload); } else { //Console.Error.WriteLine("Creating New Connection with key " + Key); Console.Error.WriteLine("Creating New UDP Connection with Dest Port " + udp.DestinationPort); UDPSession s = new UDPSession(); s.DestIP = ippkt.DestinationIP; s.SourceIP = UDP_DHCPsession.PS2_IP; result = s.send(ippkt.Payload); Connections.Add(Key, s); } } break; default: Console.Error.WriteLine("Unkown Protocol"); //throw new NotImplementedException(); break; } //Console.Error.WriteLine("Key = " + Key); break; #region "ARP" case (int)EtherFrameType.ARP: Console.Error.WriteLine("ARP (Ignoring)"); ARPPacket arppkt = ((ARPPacket)ef.Payload); ////Detect ARP Packet Types //if (Utils.memcmp(arppkt.SenderProtocolAddress, 0, new byte[] { 0, 0, 0, 0 }, 0, 4)) //{ // Console.WriteLine("ARP Probe"); //(Who has my IP?) // break; //} //if (Utils.memcmp(arppkt.SenderProtocolAddress, 0, arppkt.TargetProtocolAddress, 0, 4)) //{ // if (Utils.memcmp(arppkt.TargetHardwareAddress, 0, new byte[] { 0, 0, 0, 0, 0, 0 }, 0, 6) & arppkt.OP == 1) // { // Console.WriteLine("ARP Announcement Type 1"); // break; // } // if (Utils.memcmp(arppkt.SenderHardwareAddress, 0, arppkt.TargetHardwareAddress, 0, 6) & arppkt.OP == 2) // { // Console.WriteLine("ARP Announcement Type 2"); // break; // } //} ////if (arppkt.OP == 1) //ARP request ////{ //// //This didn't work for whatever reason. //// if (Utils.memcmp(arppkt.TargetProtocolAddress,0,UDP_DHCPsession.GATEWAY_IP,0,4)) //// //it's trying to resolve the virtual gateway's mac addr //// { //// Console.Error.WriteLine("ARP Attempt to Resolve Gateway Mac"); //// arppkt.TargetHardwareAddress = arppkt.SenderHardwareAddress; //// arppkt.SenderHardwareAddress = gateway_mac; //// arppkt.TargetProtocolAddress = arppkt.SenderProtocolAddress; //// arppkt.SenderProtocolAddress = UDP_DHCPsession.GATEWAY_IP; //// arppkt.OP = 2; //// EthernetFrame retARP = new EthernetFrame(arppkt); //// retARP.DestinationMAC = ps2_mac; //// retARP.SourceMAC = gateway_mac; //// retARP.Protocol = (Int16)EtherFrameType.ARP; //// vRecBuffer.Add(retARP.CreatePacket()); //// break; //// } ////} //Console.Error.WriteLine("Unhandled ARP packet"); result = true; break; #endregion case (int)0x0081: Console.Error.WriteLine("VLAN-tagged frame (IEEE 802.1Q)"); throw new NotImplementedException(); //break; default: Console.Error.WriteLine("Unkown EtherframeType " + ef.Protocol.ToString("X4")); break; } return(result); }