#ifndef RAW_IP_PACKET_H #define RAW_IP_PACKET_H #if defined(FREE_BSD) || defined(FREE_BSD5) #include // n_long in netinet/ip.h #endif #include // for htons #include // for struct ip #include #define IPv4 (2) enum { pcktSize = 68 }; //60(max) ip + 8 udp or tcp (part of tcp or udp header to ports) //----------------------------------------------------------------------------- struct RAW_PACKET { RAW_PACKET() : rawPacket(), dataLen(-1) { memset(rawPacket.pckt, 0, pcktSize); } uint16_t GetIPVersion() const; uint8_t GetHeaderLen() const; uint8_t GetProto() const; uint32_t GetLen() const; uint32_t GetSrcIP() const; uint32_t GetDstIP() const; uint16_t GetSrcPort() const; uint16_t GetDstPort() const; bool operator==(const RAW_PACKET & rvalue) const; bool operator!=(const RAW_PACKET & rvalue) const { return !(*this == rvalue); } bool operator<(const RAW_PACKET & rvalue) const; union { uint8_t pckt[pcktSize]; // Packet header as a raw data struct { struct ip ipHeader; // Only for packets without options field uint16_t sPort; uint16_t dPort; } header; } rawPacket; int32_t dataLen; // IP packet length. Set to -1 to use length field from the header }; //----------------------------------------------------------------------------- inline uint16_t RAW_PACKET::GetIPVersion() const { return rawPacket.header.ipHeader.ip_v; } //----------------------------------------------------------------------------- inline uint8_t RAW_PACKET::GetHeaderLen() const { return rawPacket.header.ipHeader.ip_hl * 4; } //----------------------------------------------------------------------------- inline uint8_t RAW_PACKET::GetProto() const { return rawPacket.header.ipHeader.ip_p; } //----------------------------------------------------------------------------- inline uint32_t RAW_PACKET::GetLen() const { if (dataLen != -1) return dataLen; return ntohs(rawPacket.header.ipHeader.ip_len); } //----------------------------------------------------------------------------- inline uint32_t RAW_PACKET::GetSrcIP() const { return rawPacket.header.ipHeader.ip_src.s_addr; } //----------------------------------------------------------------------------- inline uint32_t RAW_PACKET::GetDstIP() const { return rawPacket.header.ipHeader.ip_dst.s_addr; } //----------------------------------------------------------------------------- inline uint16_t RAW_PACKET::GetSrcPort() const { if (rawPacket.header.ipHeader.ip_p == 1) // for icmp proto return port 0 return 0; const uint8_t * pos = rawPacket.pckt + rawPacket.header.ipHeader.ip_hl * 4; return ntohs(*reinterpret_cast(pos)); } //----------------------------------------------------------------------------- inline uint16_t RAW_PACKET::GetDstPort() const { if (rawPacket.header.ipHeader.ip_p == 1) // for icmp proto return port 0 return 0; const uint8_t * pos = rawPacket.pckt + rawPacket.header.ipHeader.ip_hl * 4 + 2; return ntohs(*reinterpret_cast(pos)); } //----------------------------------------------------------------------------- inline bool RAW_PACKET::operator==(const RAW_PACKET & rvalue) const { if (rawPacket.header.ipHeader.ip_src.s_addr != rvalue.rawPacket.header.ipHeader.ip_src.s_addr) return false; if (rawPacket.header.ipHeader.ip_dst.s_addr != rvalue.rawPacket.header.ipHeader.ip_dst.s_addr) return false; if (rawPacket.header.ipHeader.ip_p != 1 && rvalue.rawPacket.header.ipHeader.ip_p != 1) { const uint8_t * pos = rawPacket.pckt + rawPacket.header.ipHeader.ip_hl * 4; const uint8_t * rpos = rvalue.rawPacket.pckt + rvalue.rawPacket.header.ipHeader.ip_hl * 4; if (*reinterpret_cast(pos) != *reinterpret_cast(rpos)) return false; pos += 2; rpos += 2; if (*reinterpret_cast(pos) != *reinterpret_cast(rpos)) return false; } if (rawPacket.header.ipHeader.ip_p != rvalue.rawPacket.header.ipHeader.ip_p) return false; return true; } //----------------------------------------------------------------------------- inline bool RAW_PACKET::operator<(const RAW_PACKET & rvalue) const { if (rawPacket.header.ipHeader.ip_src.s_addr < rvalue.rawPacket.header.ipHeader.ip_src.s_addr) return true; if (rawPacket.header.ipHeader.ip_src.s_addr > rvalue.rawPacket.header.ipHeader.ip_src.s_addr) return false; if (rawPacket.header.ipHeader.ip_dst.s_addr < rvalue.rawPacket.header.ipHeader.ip_dst.s_addr) return true; if (rawPacket.header.ipHeader.ip_dst.s_addr > rvalue.rawPacket.header.ipHeader.ip_dst.s_addr) return false; if (rawPacket.header.ipHeader.ip_p != 1 && rvalue.rawPacket.header.ipHeader.ip_p != 1) { const uint8_t * pos = rawPacket.pckt + rawPacket.header.ipHeader.ip_hl * 4; const uint8_t * rpos = rvalue.rawPacket.pckt + rvalue.rawPacket.header.ipHeader.ip_hl * 4; if (*reinterpret_cast(pos) < *reinterpret_cast(rpos)) return true; if (*reinterpret_cast(pos) > *reinterpret_cast(rpos)) return false; pos += 2; rpos += 2; if (*reinterpret_cast(pos) < *reinterpret_cast(rpos)) return true; if (*reinterpret_cast(pos) > *reinterpret_cast(rpos)) return false; } if (rawPacket.header.ipHeader.ip_p < rvalue.rawPacket.header.ipHeader.ip_p) return true; return false; } //----------------------------------------------------------------------------- #endif