Changes in uspace/srv/net/inetsrv/icmp.c [9749e47:695b6ff] in mainline
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
uspace/srv/net/inetsrv/icmp.c
r9749e47 r695b6ff 40 40 #include <mem.h> 41 41 #include <stdlib.h> 42 #include < types/inetping.h>42 #include <net/socket_codes.h> 43 43 #include "icmp.h" 44 44 #include "icmp_std.h" … … 122 122 { 123 123 log_msg(LOG_DEFAULT, LVL_DEBUG, "icmp_recv_echo_reply()"); 124 124 125 125 if (dgram->size < sizeof(icmp_echo_t)) 126 126 return EINVAL; 127 127 128 128 icmp_echo_t *reply = (icmp_echo_t *) dgram->data; 129 129 130 130 inetping_sdu_t sdu; 131 132 sdu.src = dgram->src; 133 sdu.dest = dgram->dest; 131 132 uint16_t family = inet_addr_get(&dgram->src, &sdu.src, NULL); 133 if (family != AF_INET) 134 return EINVAL; 135 136 family = inet_addr_get(&dgram->dest, &sdu.dest, NULL); 137 if (family != AF_INET) 138 return EINVAL; 139 134 140 sdu.seq_no = uint16_t_be2host(reply->seq_no); 135 141 sdu.data = reply + sizeof(icmp_echo_t); 136 142 sdu.size = dgram->size - sizeof(icmp_echo_t); 137 143 138 144 uint16_t ident = uint16_t_be2host(reply->ident); 139 145 … … 147 153 if (rdata == NULL) 148 154 return ENOMEM; 149 155 150 156 icmp_echo_t *request = (icmp_echo_t *) rdata; 151 157 152 158 request->type = ICMP_ECHO_REQUEST; 153 159 request->code = 0; … … 155 161 request->ident = host2uint16_t_be(ident); 156 162 request->seq_no = host2uint16_t_be(sdu->seq_no); 157 163 158 164 memcpy(rdata + sizeof(icmp_echo_t), sdu->data, sdu->size); 159 165 160 166 uint16_t checksum = inet_checksum_calc(INET_CHECKSUM_INIT, rdata, rsize); 161 167 request->checksum = host2uint16_t_be(checksum); 162 168 163 169 inet_dgram_t dgram; 164 165 dgram.src = sdu->src; 166 dgram.dest = sdu->dest; 170 171 inet_addr_set(sdu->src, &dgram.src); 172 inet_addr_set(sdu->dest, &dgram.dest); 173 167 174 dgram.iplink = 0; 168 175 dgram.tos = ICMP_TOS; 169 176 dgram.data = rdata; 170 177 dgram.size = rsize; 171 178 172 179 int rc = inet_route_packet(&dgram, IP_PROTO_ICMP, INET_TTL_MAX, 0); 173 180 174 181 free(rdata); 175 182 return rc;
Note:
See TracChangeset
for help on using the changeset viewer.