Ignore:
File:
1 edited

Legend:

Unmodified
Added
Removed

  • uspace/srv/net/loopip/loopip.c

    ra1a101d r417a2ba1  
    3939#include <errno.h>
    4040#include <inet/iplink_srv.h>
     41#include <inet/addr.h>
    4142#include <io/log.h>
    4243#include <loc.h>
    … …  
    4445#include <stdlib.h>
    4546
    46 #define NAME "loopip"
     47#define NAME  "loopip"
    4748
    4849static int loopip_open(iplink_srv_t *srv);
    4950static int loopip_close(iplink_srv_t *srv);
    50 static int loopip_send(iplink_srv_t *srv, iplink_srv_sdu_t *sdu);
     51static int loopip_send(iplink_srv_t *srv, iplink_sdu_t *sdu);
     52static int loopip_send6(iplink_srv_t *srv, iplink_sdu6_t *sdu);
    5153static int loopip_get_mtu(iplink_srv_t *srv, size_t *mtu);
    52 static int loopip_addr_add(iplink_srv_t *srv, iplink_srv_addr_t *addr);
    53 static int loopip_addr_remove(iplink_srv_t *srv, iplink_srv_addr_t *addr);
     54static int loopip_get_mac48(iplink_srv_t *srv, addr48_t *mac);
     55static int loopip_addr_add(iplink_srv_t *srv, inet_addr_t *addr);
     56static int loopip_addr_remove(iplink_srv_t *srv, inet_addr_t *addr);
    5457
    5558static void loopip_client_conn(ipc_callid_t iid, ipc_call_t *icall, void *arg);
    … …  
    5962        .close = loopip_close,
    6063        .send = loopip_send,
     64        .send6 = loopip_send6,
    6165        .get_mtu = loopip_get_mtu,
     66        .get_mac48 = loopip_get_mac48,
    6267        .addr_add = loopip_addr_add,
    6368        .addr_remove = loopip_addr_remove
    … …  
    6974typedef struct {
    7075        link_t link;
    71         iplink_srv_sdu_t sdu;
     76       
     77        /* XXX Version should be part of SDU */
     78        ip_ver_t ver;
     79        iplink_recv_sdu_t sdu;
    7280} rqueue_entry_t;
    7381
    … …  
    7785                log_msg(LOG_DEFAULT, LVL_DEBUG, "loopip_recv_fibril(): Wait for one item");
    7886                link_t *link = prodcons_consume(&loopip_rcv_queue);
    79                 rqueue_entry_t *rqe = list_get_instance(link, rqueue_entry_t, link);
    80 
    81                 (void) iplink_ev_recv(&loopip_iplink, &rqe->sdu);
    82         }
    83 
     87                rqueue_entry_t *rqe =
     88                    list_get_instance(link, rqueue_entry_t, link);
     89               
     90                (void) iplink_ev_recv(&loopip_iplink, &rqe->sdu, rqe->ver);
     91               
     92                free(rqe->sdu.data);
     93                free(rqe);
     94        }
     95       
    8496        return 0;
    8597}
    … …  
    8799static int loopip_init(void)
    88100{
    89         int rc;
    90         service_id_t sid;
    91         category_id_t iplink_cat;
    92         const char *svc_name = "net/loopback";
    93        
    94101        async_set_client_connection(loopip_client_conn);
    95102       
    96         rc = loc_server_register(NAME);
     103        int rc = loc_server_register(NAME);
    97104        if (rc != EOK) {
    98105                log_msg(LOG_DEFAULT, LVL_ERROR, "Failed registering server.");
    99106                return rc;
    100107        }
    101 
     108       
    102109        iplink_srv_init(&loopip_iplink);
    103110        loopip_iplink.ops = &loopip_iplink_ops;
    104111        loopip_iplink.arg = NULL;
    105 
     112       
    106113        prodcons_initialize(&loopip_rcv_queue);
    107 
     114       
     115        const char *svc_name = "net/loopback";
     116        service_id_t sid;
    108117        rc = loc_service_register(svc_name, &sid);
    109118        if (rc != EOK) {
    110                 log_msg(LOG_DEFAULT, LVL_ERROR, "Failed registering service %s.", svc_name);
    111                 return rc;
    112         }
    113 
     119                log_msg(LOG_DEFAULT, LVL_ERROR, "Failed registering service %s.",
     120                    svc_name);
     121                return rc;
     122        }
     123       
     124        category_id_t iplink_cat;
    114125        rc = loc_category_get_id("iplink", &iplink_cat, IPC_FLAG_BLOCKING);
    115126        if (rc != EOK) {
    … …  
    117128                return rc;
    118129        }
    119 
     130       
    120131        rc = loc_service_add_to_cat(sid, iplink_cat);
    121132        if (rc != EOK) {
    122                 log_msg(LOG_DEFAULT, LVL_ERROR, "Failed adding %s to category.", svc_name);
    123                 return rc;
    124         }
    125 
     133                log_msg(LOG_DEFAULT, LVL_ERROR, "Failed adding %s to category.",
     134                    svc_name);
     135                return rc;
     136        }
     137       
    126138        fid_t fid = fibril_create(loopip_recv_fibril, NULL);
    127139        if (fid == 0)
    128140                return ENOMEM;
    129 
     141       
    130142        fibril_add_ready(fid);
    131 
     143       
    132144        return EOK;
    133145}
    … …  
    151163}
    152164
    153 static int loopip_send(iplink_srv_t *srv, iplink_srv_sdu_t *sdu)
    154 {
    155         rqueue_entry_t *rqe;
    156 
     165static int loopip_send(iplink_srv_t *srv, iplink_sdu_t *sdu)
     166{
    157167        log_msg(LOG_DEFAULT, LVL_DEBUG, "loopip_send()");
    158 
    159         rqe = calloc(1, sizeof(rqueue_entry_t));
     168       
     169        rqueue_entry_t *rqe = calloc(1, sizeof(rqueue_entry_t));
    160170        if (rqe == NULL)
    161171                return ENOMEM;
     172       
    162173        /*
    163174         * Clone SDU
    164175         */
    165         rqe->sdu.lsrc = sdu->ldest;
    166         rqe->sdu.ldest = sdu->lsrc;
     176        rqe->ver = ip_v4;
    167177        rqe->sdu.data = malloc(sdu->size);
    168178        if (rqe->sdu.data == NULL) {
    … …  
    170180                return ENOMEM;
    171181        }
    172 
     182       
    173183        memcpy(rqe->sdu.data, sdu->data, sdu->size);
    174184        rqe->sdu.size = sdu->size;
    175 
     185       
    176186        /*
    177187         * Insert to receive queue
    178188         */
    179189        prodcons_produce(&loopip_rcv_queue, &rqe->link);
    180 
     190       
     191        return EOK;
     192}
     193
     194static int loopip_send6(iplink_srv_t *srv, iplink_sdu6_t *sdu)
     195{
     196        log_msg(LOG_DEFAULT, LVL_DEBUG, "loopip6_send()");
     197       
     198        rqueue_entry_t *rqe = calloc(1, sizeof(rqueue_entry_t));
     199        if (rqe == NULL)
     200                return ENOMEM;
     201       
     202        /*
     203         * Clone SDU
     204         */
     205        rqe->ver = ip_v6;
     206        rqe->sdu.data = malloc(sdu->size);
     207        if (rqe->sdu.data == NULL) {
     208                free(rqe);
     209                return ENOMEM;
     210        }
     211       
     212        memcpy(rqe->sdu.data, sdu->data, sdu->size);
     213        rqe->sdu.size = sdu->size;
     214       
     215        /*
     216         * Insert to receive queue
     217         */
     218        prodcons_produce(&loopip_rcv_queue, &rqe->link);
     219       
    181220        return EOK;
    182221}
    … …  
    189228}
    190229
    191 static int loopip_addr_add(iplink_srv_t *srv, iplink_srv_addr_t *addr)
    192 {
    193         log_msg(LOG_DEFAULT, LVL_DEBUG, "loopip_addr_add(0x%" PRIx32 ")", addr->ipv4);
    194         return EOK;
    195 }
    196 
    197 static int loopip_addr_remove(iplink_srv_t *srv, iplink_srv_addr_t *addr)
    198 {
    199         log_msg(LOG_DEFAULT, LVL_DEBUG, "loopip_addr_remove(0x%" PRIx32 ")", addr->ipv4);
     230static int loopip_get_mac48(iplink_srv_t *src, addr48_t *mac)
     231{
     232        log_msg(LOG_DEFAULT, LVL_DEBUG, "loopip_get_mac48()");
     233        return ENOTSUP;
     234}
     235
     236static int loopip_addr_add(iplink_srv_t *srv, inet_addr_t *addr)
     237{
     238        return EOK;
     239}
     240
     241static int loopip_addr_remove(iplink_srv_t *srv, inet_addr_t *addr)
     242{
    200243        return EOK;
    201244}
    … …  
    203246int main(int argc, char *argv[])
    204247{
    205         int rc;
    206 
    207         printf(NAME ": HelenOS loopback IP link provider\n");
    208 
    209         if (log_init(NAME) != EOK) {
    210                 printf(NAME ": Failed to initialize logging.\n");
    211                 return 1;
    212         }
    213 
     248        printf("%s: HelenOS loopback IP link provider\n", NAME);
     249       
     250        int rc = log_init(NAME);
     251        if (rc != EOK) {
     252                printf("%s: Failed to initialize logging.\n", NAME);
     253                return rc;
     254        }
     255       
    214256        rc = loopip_init();
    215257        if (rc != EOK)
    216                 return 1;
    217 
    218         printf(NAME ": Accepting connections.\n");
     258                return rc;
     259       
     260        printf("%s: Accepting connections.\n", NAME);
    219261        task_retval(0);
    220262        async_manager();
    221 
     263       
    222264        /* Not reached */
    223265        return 0;
Note: See TracChangeset for help on using the changeset viewer.