Ignore:
File:
1 edited

Legend:

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

    r02a09ed ra1a101d  
    4343#include <stdlib.h>
    4444#include <sys/types.h>
    45 #include <net/socket_codes.h>
     45
    4646#include "icmp.h"
    4747#include "icmp_std.h"
     
    5555static uint16_t inetping_ident = 0;
    5656
     57static inetping_client_t *inetping_client_find(uint16_t);
     58
    5759static int inetping_send(inetping_client_t *client, inetping_sdu_t *sdu)
    5860{
     
    6062}
    6163
    62 static int inetping_get_srcaddr(inetping_client_t *client, addr32_t remote,
    63     addr32_t *local)
    64 {
    65         inet_addr_t remote_addr;
    66         inet_addr_set(remote, &remote_addr);
    67        
    68         inet_addr_t local_addr;
    69         int rc = inet_get_srcaddr(&remote_addr, ICMP_TOS, &local_addr);
    70         if (rc != EOK)
    71                 return rc;
    72        
    73         uint16_t family = inet_addr_get(&local_addr, local, NULL);
    74         if (family != AF_INET)
    75                 return EINVAL;
    76        
    77         return EOK;
    78 }
    79 
    80 static inetping_client_t *inetping_client_find(uint16_t ident)
    81 {
    82         fibril_mutex_lock(&client_list_lock);
    83        
    84         list_foreach(client_list, link) {
    85                 inetping_client_t *client = list_get_instance(link,
    86                     inetping_client_t, client_list);
    87                
    88                 if (client->ident == ident) {
    89                         fibril_mutex_unlock(&client_list_lock);
    90                         return client;
    91                 }
    92         }
    93        
    94         fibril_mutex_unlock(&client_list_lock);
    95         return NULL;
     64static int inetping_get_srcaddr(inetping_client_t *client, inet_addr_t *remote,
     65    inet_addr_t *local)
     66{
     67        return inet_get_srcaddr(remote, ICMP_TOS, local);
    9668}
    9769
    9870int inetping_recv(uint16_t ident, inetping_sdu_t *sdu)
    9971{
    100         inetping_client_t *client = inetping_client_find(ident);
     72        inetping_client_t *client;
     73        async_exch_t *exch;
     74        ipc_call_t answer;
     75
     76        client = inetping_client_find(ident);
    10177        if (client == NULL) {
    10278                log_msg(LOG_DEFAULT, LVL_DEBUG, "Unknown ICMP ident. Dropping.");
    10379                return ENOENT;
    10480        }
    105        
    106         async_exch_t *exch = async_exchange_begin(client->sess);
    107        
    108         ipc_call_t answer;
    109         aid_t req = async_send_3(exch, INETPING_EV_RECV, (sysarg_t) sdu->src,
    110             (sysarg_t) sdu->dest, sdu->seq_no, &answer);
     81
     82        exch = async_exchange_begin(client->sess);
     83
     84        aid_t req = async_send_3(exch, INETPING_EV_RECV, sdu->src.ipv4,
     85            sdu->dest.ipv4, sdu->seq_no, &answer);
    11186        int rc = async_data_write_start(exch, sdu->data, sdu->size);
    112        
    11387        async_exchange_end(exch);
    114        
     88
    11589        if (rc != EOK) {
    11690                async_forget(req);
    11791                return rc;
    11892        }
    119        
     93
    12094        sysarg_t retval;
    12195        async_wait_for(req, &retval);
    122        
    123         return (int) retval;
     96        if (retval != EOK) {
     97                return retval;
     98        }
     99
     100        return EOK;
    124101}
    125102
     
    139116        }
    140117
    141         sdu.src = IPC_GET_ARG1(*call);
    142         sdu.dest = IPC_GET_ARG2(*call);
     118        sdu.src.ipv4 = IPC_GET_ARG1(*call);
     119        sdu.dest.ipv4 = IPC_GET_ARG2(*call);
    143120        sdu.seq_no = IPC_GET_ARG3(*call);
    144121
     
    152129    ipc_callid_t callid, ipc_call_t *call)
    153130{
     131        inet_addr_t remote;
     132        inet_addr_t local;
     133        int rc;
     134
    154135        log_msg(LOG_DEFAULT, LVL_DEBUG, "inetping_get_srcaddr_srv()");
    155        
    156         uint32_t remote = IPC_GET_ARG1(*call);
    157         uint32_t local = 0;
    158        
    159         int rc = inetping_get_srcaddr(client, remote, &local);
    160         async_answer_1(callid, rc, (sysarg_t) local);
     136
     137        remote.ipv4 = IPC_GET_ARG1(*call);
     138        local.ipv4 = 0;
     139
     140        rc = inetping_get_srcaddr(client, &remote, &local);
     141        async_answer_1(callid, rc, local.ipv4);
    161142}
    162143
     
    166147        if (sess == NULL)
    167148                return ENOMEM;
    168        
     149
    169150        client->sess = sess;
    170151        link_initialize(&client->client_list);
    171        
     152
    172153        fibril_mutex_lock(&client_list_lock);
    173154        client->ident = ++inetping_ident;
    174155        list_append(&client->client_list, &client_list);
    175156        fibril_mutex_unlock(&client_list_lock);
    176        
     157
    177158        return EOK;
    178159}
     
    182163        async_hangup(client->sess);
    183164        client->sess = NULL;
    184        
     165
    185166        fibril_mutex_lock(&client_list_lock);
    186167        list_remove(&client->client_list);
     
    188169}
    189170
     171static inetping_client_t *inetping_client_find(uint16_t ident)
     172{
     173        fibril_mutex_lock(&client_list_lock);
     174
     175        list_foreach(client_list, link) {
     176                inetping_client_t *client = list_get_instance(link,
     177                    inetping_client_t, client_list);
     178
     179                if (client->ident == ident) {
     180                        fibril_mutex_unlock(&client_list_lock);
     181                        return client;
     182                }
     183        }
     184
     185        fibril_mutex_unlock(&client_list_lock);
     186        return NULL;
     187}
     188
    190189void inetping_conn(ipc_callid_t iid, ipc_call_t *icall, void *arg)
    191190{
     191        inetping_client_t client;
     192        int rc;
     193
    192194        log_msg(LOG_DEFAULT, LVL_DEBUG, "inetping_conn()");
    193        
     195
    194196        /* Accept the connection */
    195197        async_answer_0(iid, EOK);
    196        
    197         inetping_client_t client;
    198         int rc = inetping_client_init(&client);
     198
     199        rc = inetping_client_init(&client);
    199200        if (rc != EOK)
    200201                return;
    201        
     202
    202203        while (true) {
    203204                ipc_call_t call;
    204205                ipc_callid_t callid = async_get_call(&call);
    205206                sysarg_t method = IPC_GET_IMETHOD(call);
    206                
     207
    207208                if (!method) {
    208209                        /* The other side has hung up */
     
    210211                        break;
    211212                }
    212                
     213
    213214                switch (method) {
    214215                case INETPING_SEND:
     
    222223                }
    223224        }
    224        
     225
    225226        inetping_client_fini(&client);
    226227}
Note: See TracChangeset for help on using the changeset viewer.