25 #ifndef __DECODE_IPV4_H__
26 #define __DECODE_IPV4_H__
28 #define IPV4_HEADER_LEN 20
29 #define IPV4_OPTMAX 40
30 #define IPV4_MAXPACKET_LEN 65535
33 #define IPV4_OPT_EOL 0x00
34 #define IPV4_OPT_NOP 0x01
35 #define IPV4_OPT_RR 0x07
36 #define IPV4_OPT_QS 0x19
37 #define IPV4_OPT_TS 0x44
38 #define IPV4_OPT_SEC 0x82
39 #define IPV4_OPT_LSRR 0x83
40 #define IPV4_OPT_ESEC 0x85
41 #define IPV4_OPT_CIPSO 0x86
42 #define IPV4_OPT_SID 0x88
43 #define IPV4_OPT_SSRR 0x89
44 #define IPV4_OPT_RTRALT 0x94
47 #define IPV4_OPT_SID_LEN 4
48 #define IPV4_OPT_RTRALT_LEN 4
51 #define IPV4_OPT_SEC_MIN 3
52 #define IPV4_OPT_ROUTE_MIN 3
53 #define IPV4_OPT_QS_MIN 8
54 #define IPV4_OPT_TS_MIN 5
55 #define IPV4_OPT_CIPSO_MIN 10
58 #define IPV4_OPTS ip4vars.ip_opts
59 #define IPV4_OPTS_CNT ip4vars.ip_opt_cnt
91 #define s_ip_src ip4_hdrun1.ip4_un1.ip_src
92 #define s_ip_dst ip4_hdrun1.ip4_un1.ip_dst
93 #define s_ip_addrs ip4_hdrun1.ip_addrs
95 #define IPV4_GET_RAW_VER(ip4h) (((ip4h)->ip_verhl & 0xf0) >> 4)
96 #define IPV4_GET_RAW_HLEN(ip4h) ((ip4h)->ip_verhl & 0x0f)
97 #define IPV4_GET_RAW_IPTOS(ip4h) ((ip4h)->ip_tos)
98 #define IPV4_GET_RAW_IPLEN(ip4h) ((ip4h)->ip_len)
99 #define IPV4_GET_RAW_IPID(ip4h) ((ip4h)->ip_id)
100 #define IPV4_GET_RAW_IPOFFSET(ip4h) ((ip4h)->ip_off)
101 #define IPV4_GET_RAW_IPTTL(ip4h) ((ip4h)->ip_ttl)
102 #define IPV4_GET_RAW_IPPROTO(ip4h) ((ip4h)->ip_proto)
103 #define IPV4_GET_RAW_IPSRC(ip4h) ((ip4h)->s_ip_src)
104 #define IPV4_GET_RAW_IPDST(ip4h) ((ip4h)->s_ip_dst)
107 #define IPV4_GET_RAW_IPSRC_U32(ip4h) (uint32_t)((ip4h)->s_ip_src.s_addr)
109 #define IPV4_GET_RAW_IPDST_U32(ip4h) (uint32_t)((ip4h)->s_ip_dst.s_addr)
112 #define IPV4_SET_RAW_VER(ip4h, value) ((ip4h)->ip_verhl = (((ip4h)->ip_verhl & 0x0f) | (value << 4)))
113 #define IPV4_SET_RAW_HLEN(ip4h, value) ((ip4h)->ip_verhl = (((ip4h)->ip_verhl & 0xf0) | (value & 0x0f)))
114 #define IPV4_SET_RAW_IPTOS(ip4h, value) ((ip4h)->ip_tos = value)
115 #define IPV4_SET_RAW_IPLEN(ip4h, value) ((ip4h)->ip_len = value)
116 #define IPV4_SET_RAW_IPPROTO(ip4h, value) ((ip4h)->ip_proto = value)
122 #define IPV4_GET_VER(p) \
123 IPV4_GET_RAW_VER((p)->ip4h)
124 #define IPV4_GET_HLEN(p) ((uint8_t)(IPV4_GET_RAW_HLEN((p)->ip4h) << 2))
125 #define IPV4_GET_IPTOS(p) \
126 IPV4_GET_RAW_IPTOS((p)->ip4h)
127 #define IPV4_GET_IPLEN(p) \
128 (SCNtohs(IPV4_GET_RAW_IPLEN((p)->ip4h)))
129 #define IPV4_GET_IPID(p) \
130 (SCNtohs(IPV4_GET_RAW_IPID((p)->ip4h)))
132 #define _IPV4_GET_IPOFFSET(p) \
133 (SCNtohs(IPV4_GET_RAW_IPOFFSET((p)->ip4h)))
135 #define IPV4_GET_IPOFFSET(p) \
136 (_IPV4_GET_IPOFFSET(p) & 0x1fff)
138 #define IPV4_GET_RF(p) \
139 (uint8_t)((_IPV4_GET_IPOFFSET((p)) & 0x8000) >> 15)
141 #define IPV4_GET_DF(p) \
142 (uint8_t)((_IPV4_GET_IPOFFSET((p)) & 0x4000) >> 14)
144 #define IPV4_GET_MF(p) \
145 (uint8_t)((_IPV4_GET_IPOFFSET((p)) & 0x2000) >> 13)
146 #define IPV4_GET_IPTTL(p) \
147 IPV4_GET_RAW_IPTTL(p->ip4h)
148 #define IPV4_GET_IPPROTO(p) \
149 IPV4_GET_RAW_IPPROTO((p)->ip4h)
151 #define CLEAR_IPV4_PACKET(p) do { \
153 (p)->level3_comp_csum = -1; \
154 memset(&p->ip4vars, 0x00, sizeof(p->ip4vars)); \
196 static inline uint16_t IPV4Checksum(
const uint16_t *pkt, uint16_t hlen, uint16_t init)
198 uint32_t csum = init;
200 csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[6] + pkt[7] +
208 }
else if (hlen == 4) {
209 csum += pkt[0] + pkt[1];
210 }
else if (hlen == 8) {
211 csum += pkt[0] + pkt[1] + pkt[2] + pkt[3];
212 }
else if (hlen == 12) {
213 csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[5];
214 }
else if (hlen == 16) {
215 csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[5] + pkt[6] +
217 }
else if (hlen == 20) {
218 csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[5] + pkt[6] +
219 pkt[7] + pkt[8] + pkt[9];
220 }
else if (hlen == 24) {
221 csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[5] + pkt[6] +
222 pkt[7] + pkt[8] + pkt[9] + pkt[10] + pkt[11];
223 }
else if (hlen == 28) {
224 csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[5] + pkt[6] +
225 pkt[7] + pkt[8] + pkt[9] + pkt[10] + pkt[11] + pkt[12] + pkt[13];
226 }
else if (hlen == 32) {
227 csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[5] + pkt[6] +
228 pkt[7] + pkt[8] + pkt[9] + pkt[10] + pkt[11] + pkt[12] + pkt[13] +
230 }
else if (hlen == 36) {
231 csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[5] + pkt[6] +
232 pkt[7] + pkt[8] + pkt[9] + pkt[10] + pkt[11] + pkt[12] + pkt[13] +
233 pkt[14] + pkt[15] + pkt[16] + pkt[17];
234 }
else if (hlen == 40) {
235 csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[5] + pkt[6] +
236 pkt[7] + pkt[8] + pkt[9] + pkt[10] + pkt[11] + pkt[12] + pkt[13] +
237 pkt[14] + pkt[15] + pkt[16] + pkt[17] + pkt[18] + pkt[19];
240 csum = (csum >> 16) + (csum & 0x0000FFFF);
241 csum += (csum >> 16);
243 return (uint16_t) ~csum;