palacios/src/devices/vnet_nic.c

   1 /*
   2  * This file is part of the Palacios Virtual Machine Monitor developed
   3  * by the V3VEE Project with funding from the United States National
   4  * Science Foundation and the Department of Energy.
   5  *
   6  * The V3VEE Project is a joint project between Northwestern University
   7  * and the University of New Mexico.  You can find out more at
   8  * http://www.v3vee.org
   9  *
  10  * Copyright (c) 2010, Lei Xia <lxia@northwestern.edu>
  11  * Copyright (c) 2010, The V3VEE Project <http://www.v3vee.org>
  12  * All rights reserved.
  13  *
  14  * Author: Lei Xia <lxia@northwestern.edu>
  15  *
  16  *
  17  * This is free software.  You are permitted to use,
  18  * redistribute, and modify it as specified in the file "V3VEE_LICENSE".
  19  */
  20 //backend device for Virtio NIC
  21
  22 #include <palacios/vmm_vnet.h>
  23 #include <palacios/vmm.h>
  24 #include <palacios/vmm_dev_mgr.h>
  25 #include <devices/lnx_virtio_pci.h>
  26 #include <palacios/vm_guest_mem.h>
  27 #include <devices/pci.h>
  28 #include <palacios/vmm_sprintf.h>
  29
  30 #ifndef CONFIG_DEBUG_VNET_NIC
  31 #undef PrintDebug
  32 #define PrintDebug(fmt, args...)
  33 #endif
  34
  35
  36 struct vnet_nic_state {
  37     char mac[6];
  38     struct v3_vm_info * vm;
  39     struct v3_dev_net_ops net_ops;
  40     int vnet_dev_id;
  41 };
  42
  43 /* called by frontend device,
  44   * tell the VNET can start sending pkt to it */
  45 static void start_rx(void * private_data){
  46     //struct vnet_nic_state *vnetnic = (struct vnet_nic_state *)private_data;
  47
  48     //v3_vnet_enable_device(vnetnic->vnet_dev_id);
  49 }
  50
  51 /* called by frontend device,
  52   * tell the VNET stop sending pkt to it */
  53 static void stop_rx(void * private_data){
  54     //struct vnet_nic_state *vnetnic = (struct vnet_nic_state *)private_data;
  55
  56     //v3_vnet_disable_device(vnetnic->vnet_dev_id);
  57 }
  58
  59 /* called by frontend, send pkt to VNET */
  60 static int vnet_nic_send(uint8_t * buf, uint32_t len,
  61                          void * private_data) {
  62     struct vnet_nic_state * vnetnic = (struct vnet_nic_state *)private_data;
  63
  64     struct v3_vnet_pkt pkt;
  65     pkt.size = len;
  66     pkt.src_type = LINK_INTERFACE;
  67     pkt.src_id = vnetnic->vnet_dev_id;
  68     memcpy(pkt.header, buf, ETHERNET_HEADER_LEN);
  69     pkt.data = buf;
  70
  71 #ifdef CONFIG_DEBUG_VNET_NIC
  72     {
  73         PrintDebug("VNET-NIC: send pkt (size: %d, src_id: %d, src_type: %d)\n",
  74                    pkt.size, pkt.src_id, pkt.src_type);
  75         v3_hexdump(buf, len, NULL, 0);
  76     }
  77 #endif
  78
  79     return v3_vnet_send_pkt(&pkt, NULL);;
  80 }
  81
  82
  83 /* send pkt to frontend device */
  84 static int virtio_input(struct v3_vm_info * info,
  85                         struct v3_vnet_pkt * pkt,
  86                         void * private_data){
  87     struct vnet_nic_state *vnetnic = (struct vnet_nic_state *)private_data;
  88
  89     PrintDebug("VNET-NIC: receive pkt (size %d, src_id:%d, src_type: %d, dst_id: %d, dst_type: %d)\n",
  90                 pkt->size, pkt->src_id, pkt->src_type, pkt->dst_id, pkt->dst_type);
  91
  92     return vnetnic->net_ops.recv(pkt->data, pkt->size,
  93                                  vnetnic->net_ops.frontend_data);
  94 }
  95
  96 /* tell frontend device to poll data from guest */
  97 static void virtio_poll(struct v3_vm_info * info,
  98                         void * private_data){
  99     struct vnet_nic_state *vnetnic = (struct vnet_nic_state *)private_data;
 100
 101     vnetnic->net_ops.poll(info, vnetnic->net_ops.frontend_data);
 102 }
 103
 104
 105 /* tell the frontend to start sending pkt to VNET*/
 106 static void start_tx(void * private_data){
 107     struct vnet_nic_state *vnetnic = (struct vnet_nic_state *)private_data;
 108
 109     vnetnic->net_ops.start_tx(vnetnic->net_ops.frontend_data);
 110 }
 111
 112 /* tell the frontend device to stop sending pkt to VNET*/
 113 static void stop_tx(void * private_data){
 114     struct vnet_nic_state *vnetnic = (struct vnet_nic_state *)private_data;
 115
 116     vnetnic->net_ops.stop_tx(vnetnic->net_ops.frontend_data);
 117 }
 118
 119
 120 static int vnet_nic_free(struct vnet_nic_state * vnetnic) {
 121
 122     v3_vnet_del_dev(vnetnic->vnet_dev_id);
 123     V3_Free(vnetnic);
 124
 125     return 0;
 126 }
 127
 128 static struct v3_device_ops dev_ops = {
 129     .free = (int (*)(void *))vnet_nic_free,
 130
 131 };
 132
 133 static struct v3_vnet_dev_ops vnet_dev_ops = {
 134     .input = virtio_input,
 135     .poll = virtio_poll,
 136     .start_tx = start_tx,
 137     .stop_tx = stop_tx,
 138 };
 139
 140 static int str2mac(char * macstr, char mac[6]){
 141     char hex[2], *s = macstr;
 142     int i = 0;
 143
 144     while(s){
 145         memcpy(hex, s, 2);
 146         mac[i++] = (char)atox(hex);
 147         if (i == 6) return 0;
 148         s=strchr(s, ':');
 149         if(s) s++;
 150     }
 151
 152     return -1;
 153 }
 154
 155 static int vnet_nic_init(struct v3_vm_info * vm, v3_cfg_tree_t * cfg) {
 156     struct vnet_nic_state * vnetnic = NULL;
 157     char * dev_id = v3_cfg_val(cfg, "ID");
 158     char * macstr = NULL;
 159     char mac[6];
 160     int vnet_dev_id;
 161
 162     v3_cfg_tree_t * frontend_cfg = v3_cfg_subtree(cfg, "frontend");
 163     macstr = v3_cfg_val(frontend_cfg, "mac");
 164
 165     if (macstr != NULL) {
 166         PrintDebug("Vnet-nic: Mac specified %s\n", macstr);
 167         str2mac(macstr, mac);
 168     }
 169
 170     vnetnic = (struct vnet_nic_state *)V3_Malloc(sizeof(struct vnet_nic_state));
 171     memset(vnetnic, 0, sizeof(struct vnet_nic_state));
 172
 173     struct vm_device * dev = v3_add_device(vm, dev_id, &dev_ops, vnetnic);
 174     if (dev == NULL) {
 175         PrintError("Could not attach device %s\n", dev_id);
 176         V3_Free(vnetnic);
 177         return -1;
 178     }
 179
 180     vnetnic->net_ops.send = vnet_nic_send;
 181     vnetnic->net_ops.start_rx = start_rx;
 182     vnetnic->net_ops.stop_rx = stop_rx;
 183     memcpy(vnetnic->mac, mac, 6);
 184     vnetnic->vm = vm;
 185
 186     if (v3_dev_connect_net(vm, v3_cfg_val(frontend_cfg, "tag"),
 187                            &(vnetnic->net_ops), frontend_cfg, vnetnic) == -1) {
 188         PrintError("Could not connect %s to frontend %s\n",
 189                    dev_id, v3_cfg_val(frontend_cfg, "tag"));
 190         v3_remove_device(dev);
 191         return -1;
 192     }
 193
 194     PrintDebug("Vnet-nic: Connect %s to frontend %s\n",
 195               dev_id, v3_cfg_val(frontend_cfg, "tag"));
 196
 197     if ((vnet_dev_id = v3_vnet_add_dev(vm, vnetnic->mac, &vnet_dev_ops, (void *)vnetnic)) == -1) {
 198         PrintError("Vnet-nic device %s (mac: %s) fails to registered to VNET\n", dev_id, macstr);
 199         v3_remove_device(dev);
 200         return 0;
 201     }
 202     vnetnic->vnet_dev_id = vnet_dev_id;
 203
 204     PrintDebug("Vnet-nic device %s (mac: %s, %ld) registered to VNET\n",
 205                 dev_id, macstr, *((ulong_t *)vnetnic->mac));
 206
 207
 208 //for temporary hack for vnet bridge test
 209 #if 0
 210     {
 211         uchar_t zeromac[6] = {0,0,0,0,0,0};
 212
 213         if(!strcmp(dev_id, "vnet_nic")){
 214             struct v3_vnet_route route;
 215
 216             route.dst_id = vnet_dev_id;
 217             route.dst_type = LINK_INTERFACE;
 218             route.src_id = 0;
 219             route.src_type = LINK_EDGE;
 220             memcpy(route.dst_mac, zeromac, 6);
 221             route.dst_mac_qual = MAC_ANY;
 222             memcpy(route.src_mac, zeromac, 6);
 223             route.src_mac_qual = MAC_ANY;
 224             v3_vnet_add_route(route);
 225
 226
 227             route.dst_id = 0;
 228             route.dst_type = LINK_EDGE;
 229             route.src_id = vnet_dev_id;
 230             route.src_type = LINK_INTERFACE;
 231             memcpy(route.dst_mac, zeromac, 6);
 232             route.dst_mac_qual = MAC_ANY;
 233             memcpy(route.src_mac, zeromac, 6);
 234             route.src_mac_qual = MAC_ANY;
 235
 236             v3_vnet_add_route(route);
 237         }
 238     }
 239 #endif
 240
 241 //for temporary hack for Linux bridge (w/o encapuslation) test
 242 #if 0
 243     {
 244         static int vnet_nic_guestid = -1;
 245         static int vnet_nic_dom0 = -1;
 246         uchar_t zeromac[6] = {0,0,0,0,0,0};
 247
 248         if(!strcmp(dev_id, "vnet_nic")){ //domu
 249             vnet_nic_guestid = vnet_dev_id;
 250         }
 251         if (!strcmp(dev_id, "vnet_nic_dom0")){
 252             vnet_nic_dom0 = vnet_dev_id;
 253         }
 254
 255         if(vnet_nic_guestid != -1 && vnet_nic_dom0 !=-1){
 256             struct v3_vnet_route route;
 257
 258             route.src_id = vnet_nic_guestid;
 259             route.src_type = LINK_INTERFACE;
 260             route.dst_id = vnet_nic_dom0;
 261             route.dst_type = LINK_INTERFACE;
 262             memcpy(route.dst_mac, zeromac, 6);
 263             route.dst_mac_qual = MAC_ANY;
 264             memcpy(route.src_mac, zeromac, 6);
 265             route.src_mac_qual = MAC_ANY;
 266             v3_vnet_add_route(route);
 267
 268
 269             route.src_id = vnet_nic_dom0;
 270             route.src_type = LINK_INTERFACE;
 271             route.dst_id = vnet_nic_guestid;
 272             route.dst_type = LINK_INTERFACE;
 273             memcpy(route.dst_mac, zeromac, 6);
 274             route.dst_mac_qual = MAC_ANY;
 275             memcpy(route.src_mac, zeromac, 6);
 276             route.src_mac_qual = MAC_ANY;
 277
 278             v3_vnet_add_route(route);
 279         }
 280     }
 281 #endif
 282
 283     return 0;
 284 }
 285
 286 device_register("VNET_NIC", vnet_nic_init)