Ignore:
File:
1 edited

Legend:

Unmodified
Added
Removed
  • uspace/srv/net/inetsrv/icmp.c

    r13be2583 ra1a101d  
    4040#include <mem.h>
    4141#include <stdlib.h>
    42 #include <types/inetping.h>
    43 #include <net/socket_codes.h>
     42
    4443#include "icmp.h"
    4544#include "icmp_std.h"
     
    106105        reply->checksum = host2uint16_t_be(checksum);
    107106
    108         rdgram.iplink = 0;
    109107        rdgram.src = dgram->dest;
    110108        rdgram.dest = dgram->src;
     
    122120static int icmp_recv_echo_reply(inet_dgram_t *dgram)
    123121{
     122        icmp_echo_t *reply;
     123        inetping_sdu_t sdu;
     124        uint16_t ident;
     125
    124126        log_msg(LOG_DEFAULT, LVL_DEBUG, "icmp_recv_echo_reply()");
    125        
     127
    126128        if (dgram->size < sizeof(icmp_echo_t))
    127129                return EINVAL;
    128        
    129         icmp_echo_t *reply = (icmp_echo_t *) dgram->data;
    130        
    131         inetping_sdu_t sdu;
    132        
    133         uint16_t family = inet_addr_get(&dgram->src, &sdu.src, NULL);
    134         if (family != AF_INET)
    135                 return EINVAL;
    136        
    137         family = inet_addr_get(&dgram->dest, &sdu.dest, NULL);
    138         if (family != AF_INET)
    139                 return EINVAL;
    140        
     130
     131        reply = (icmp_echo_t *)dgram->data;
     132
     133        sdu.src = dgram->src;
     134        sdu.dest = dgram->dest;
    141135        sdu.seq_no = uint16_t_be2host(reply->seq_no);
    142136        sdu.data = reply + sizeof(icmp_echo_t);
    143137        sdu.size = dgram->size - sizeof(icmp_echo_t);
    144        
    145         uint16_t ident = uint16_t_be2host(reply->ident);
     138        ident = uint16_t_be2host(reply->ident);
    146139
    147140        return inetping_recv(ident, &sdu);
     
    150143int icmp_ping_send(uint16_t ident, inetping_sdu_t *sdu)
    151144{
    152         size_t rsize = sizeof(icmp_echo_t) + sdu->size;
    153         void *rdata = calloc(rsize, 1);
     145        inet_dgram_t dgram;
     146        icmp_echo_t *request;
     147        void *rdata;
     148        size_t rsize;
     149        uint16_t checksum;
     150        int rc;
     151
     152        rsize = sizeof(icmp_echo_t) + sdu->size;
     153        rdata = calloc(rsize, 1);
    154154        if (rdata == NULL)
    155155                return ENOMEM;
    156        
    157         icmp_echo_t *request = (icmp_echo_t *) rdata;
    158        
     156
     157        request = (icmp_echo_t *)rdata;
     158
    159159        request->type = ICMP_ECHO_REQUEST;
    160160        request->code = 0;
     
    162162        request->ident = host2uint16_t_be(ident);
    163163        request->seq_no = host2uint16_t_be(sdu->seq_no);
    164        
     164
    165165        memcpy(rdata + sizeof(icmp_echo_t), sdu->data, sdu->size);
    166        
    167         uint16_t checksum = inet_checksum_calc(INET_CHECKSUM_INIT, rdata, rsize);
     166
     167        checksum = inet_checksum_calc(INET_CHECKSUM_INIT, rdata, rsize);
    168168        request->checksum = host2uint16_t_be(checksum);
    169        
    170         inet_dgram_t dgram;
    171        
    172         inet_addr_set(sdu->src, &dgram.src);
    173         inet_addr_set(sdu->dest, &dgram.dest);
    174        
    175         dgram.iplink = 0;
     169
     170        dgram.src = sdu->src;
     171        dgram.dest = sdu->dest;
    176172        dgram.tos = ICMP_TOS;
    177173        dgram.data = rdata;
    178174        dgram.size = rsize;
    179        
    180         int rc = inet_route_packet(&dgram, IP_PROTO_ICMP, INET_TTL_MAX, 0);
    181        
     175
     176        rc = inet_route_packet(&dgram, IP_PROTO_ICMP, INET_TTL_MAX, 0);
     177
    182178        free(rdata);
    183179        return rc;
Note: See TracChangeset for help on using the changeset viewer.