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.
6 * The V3VEE Project is a joint project between Northwestern University
7 * and the University of New Mexico. You can find out more at
10 * Copyright (c) 2010, Lei Xia <lxia@northwestern.edu>
11 * Copyright (c) 2009, Yuan Tang <ytang@northwestern.edu>
12 * Copyright (c) 2009, The V3VEE Project <http://www.v3vee.org>
13 * All rights reserved.
15 * Author: Lei Xia <lxia@northwestern.edu>
16 * Yuan Tang <ytang@northwestern.edu>
18 * This is free software. You are permitted to use,
19 * redistribute, and modify it as specified in the file "V3VEE_LICENSE".
22 #include <palacios/vmm_vnet.h>
23 #include <palacios/vm_guest_mem.h>
24 #include <palacios/vmm_lock.h>
25 #include <palacios/vmm_queue.h>
26 #include <palacios/vmm_sprintf.h>
27 #include <palacios/vmm_ethernet.h>
29 #ifndef CONFIG_DEBUG_VNET
31 #define PrintDebug(fmt, args...)
35 uint8_t dst_mac[ETH_ALEN];
36 uint8_t src_mac[ETH_ALEN];
37 uint16_t type; /* indicates layer 3 protocol type */
38 } __attribute__((packed));
43 uint8_t mac_addr[ETH_ALEN];
44 struct v3_vm_info * vm;
45 struct v3_vnet_dev_ops dev_ops;
49 uint8_t mode; //vmm_drivern or guest_drivern
51 struct list_head node;
52 } __attribute__((packed));
56 struct v3_vm_info * vm;
57 struct v3_vnet_bridge_ops brg_ops;
63 } __attribute__((packed));
67 struct vnet_route_info {
68 struct v3_vnet_route route_def;
70 struct vnet_dev * dst_dev;
71 struct vnet_dev * src_dev;
73 struct list_head node;
74 struct list_head match_node; // used for route matching
79 uint8_t hash_buf[VNET_HASH_SIZE];
82 struct vnet_route_info * routes[0];
83 } __attribute__((packed));
87 struct list_head routes;
88 struct list_head devs;
93 struct vnet_brg_dev *bridge;
97 struct hashtable * route_cache;
102 #ifdef CONFIG_DEBUG_VNET
103 static inline void mac_to_string(uint8_t * mac, char * buf) {
104 snprintf(buf, 100, "%2x:%2x:%2x:%2x:%2x:%2x",
105 mac[0], mac[1], mac[2],
106 mac[3], mac[4], mac[5]);
109 static void print_route(struct v3_vnet_route * route){
112 mac_to_string(route->src_mac, str);
113 PrintDebug("Src Mac (%s), src_qual (%d)\n",
114 str, route->src_mac_qual);
115 mac_to_string(route->dst_mac, str);
116 PrintDebug("Dst Mac (%s), dst_qual (%d)\n",
117 str, route->dst_mac_qual);
118 PrintDebug("Src dev id (%d), src type (%d)",
121 PrintDebug("Dst dev id (%d), dst type (%d)\n",
126 static void dump_routes(){
127 struct vnet_route_info *route;
130 PrintDebug("\n========Dump routes starts ============\n");
131 list_for_each_entry(route, &(vnet_state.routes), node) {
132 PrintDebug("\nroute %d:\n", i++);
134 print_route(&(route->route_def));
135 if (route->route_def.dst_type == LINK_INTERFACE) {
136 PrintDebug("dst_dev (%p), dst_dev_id (%d), dst_dev_ops(%p), dst_dev_data (%p)\n",
138 route->dst_dev->dev_id,
139 (void *)&(route->dst_dev->dev_ops),
140 route->dst_dev->private_data);
144 PrintDebug("\n========Dump routes end ============\n");
151 * A VNET packet is a packed struct with the hashed fields grouped together.
152 * This means we can generate the hash from an offset into the pkt struct
154 static inline uint_t hash_fn(addr_t hdr_ptr) {
155 uint8_t * hdr_buf = (uint8_t *)hdr_ptr;
157 return v3_hash_buffer(hdr_buf, VNET_HASH_SIZE);
160 static inline int hash_eq(addr_t key1, addr_t key2) {
161 return (memcmp((uint8_t *)key1, (uint8_t *)key2, VNET_HASH_SIZE) == 0);
164 static int add_route_to_cache(const struct v3_vnet_pkt * pkt, struct route_list * routes) {
165 memcpy(routes->hash_buf, pkt->hash_buf, VNET_HASH_SIZE);
167 if (v3_htable_insert(vnet_state.route_cache, (addr_t)routes->hash_buf, (addr_t)routes) == 0) {
168 PrintError("VNET/P Core: Failed to insert new route entry to the cache\n");
175 static int clear_hash_cache() {
176 v3_free_htable(vnet_state.route_cache, 1, 1);
177 vnet_state.route_cache = v3_create_htable(0, &hash_fn, &hash_eq);
182 static int look_into_cache(const struct v3_vnet_pkt * pkt, struct route_list ** routes) {
183 *routes = (struct route_list *)v3_htable_search(vnet_state.route_cache, (addr_t)(pkt->hash_buf));
189 static struct vnet_dev * dev_by_id(int idx) {
190 struct vnet_dev * dev = NULL;
192 list_for_each_entry(dev, &(vnet_state.devs), node) {
193 int dev_id = dev->dev_id;
202 static struct vnet_dev * dev_by_mac(uint8_t * mac) {
203 struct vnet_dev * dev = NULL;
205 list_for_each_entry(dev, &(vnet_state.devs), node) {
206 if (!compare_ethaddr(dev->mac_addr, mac)){
210 char *dmac = dev->mac_addr;
211 PrintDebug("device %d: %2x:%2x:%2x:%2x:%2x:%2x\n", dev->dev_id, dmac[0], dmac[1], dmac[2], dmac[3], dmac[4], dmac[5]);
218 int v3_vnet_find_dev(uint8_t * mac) {
219 struct vnet_dev * dev = NULL;
221 PrintDebug("find_dev: %2x:%2x:%2x:%2x:%2x:%2x\n", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
223 dev = dev_by_mac(mac);
233 int v3_vnet_add_route(struct v3_vnet_route route) {
234 struct vnet_route_info * new_route = NULL;
237 new_route = (struct vnet_route_info *)V3_Malloc(sizeof(struct vnet_route_info));
238 memset(new_route, 0, sizeof(struct vnet_route_info));
240 PrintDebug("VNET/P Core: add_route_entry:\n");
243 memcpy(new_route->route_def.src_mac, route.src_mac, ETH_ALEN);
244 memcpy(new_route->route_def.dst_mac, route.dst_mac, ETH_ALEN);
245 new_route->route_def.src_mac_qual = route.src_mac_qual;
246 new_route->route_def.dst_mac_qual = route.dst_mac_qual;
247 new_route->route_def.dst_type = route.dst_type;
248 new_route->route_def.src_type = route.src_type;
249 new_route->route_def.src_id = route.src_id;
250 new_route->route_def.dst_id = route.dst_id;
252 if (new_route->route_def.dst_type == LINK_INTERFACE) {
253 new_route->dst_dev = dev_by_id(new_route->route_def.dst_id);
256 if (new_route->route_def.src_type == LINK_INTERFACE) {
257 new_route->src_dev = dev_by_id(new_route->route_def.src_id);
261 flags = v3_lock_irqsave(vnet_state.lock);
263 list_add(&(new_route->node), &(vnet_state.routes));
266 v3_unlock_irqrestore(vnet_state.lock, flags);
269 #ifdef CONFIG_DEBUG_VNET
277 /* delete all route entries with specfied src or dst device id */
278 static void inline del_routes_by_dev(int dev_id){
279 struct vnet_route_info * route = NULL;
282 flags = v3_lock_irqsave(vnet_state.lock);
284 list_for_each_entry(route, &(vnet_state.routes), node) {
285 if((route->route_def.dst_type == LINK_INTERFACE &&
286 route->route_def.dst_id == dev_id) ||
287 (route->route_def.src_type == LINK_INTERFACE &&
288 route->route_def.src_id == dev_id)){
290 list_del(&(route->node));
291 list_del(&(route->match_node));
296 v3_unlock_irqrestore(vnet_state.lock, flags);
299 /* At the end allocate a route_list
300 * This list will be inserted into the cache so we don't need to free it
302 static struct route_list * match_route(const struct v3_vnet_pkt * pkt) {
303 struct vnet_route_info * route = NULL;
304 struct route_list * matches = NULL;
307 struct list_head match_list;
308 struct eth_hdr * hdr = (struct eth_hdr *)(pkt->data);
309 // uint8_t src_type = pkt->src_type;
310 // uint32_t src_link = pkt->src_id;
312 #ifdef CONFIG_DEBUG_VNET
317 mac_to_string(hdr->src_mac, src_str);
318 mac_to_string(hdr->dst_mac, dst_str);
319 PrintDebug("VNET/P Core: match_route. pkt: SRC(%s), DEST(%s)\n", src_str, dst_str);
323 INIT_LIST_HEAD(&match_list);
325 #define UPDATE_MATCHES(rank) do { \
326 if (max_rank < (rank)) { \
328 INIT_LIST_HEAD(&match_list); \
330 list_add(&(route->match_node), &match_list); \
332 } else if (max_rank == (rank)) { \
333 list_add(&(route->match_node), &match_list); \
339 list_for_each_entry(route, &(vnet_state.routes), node) {
340 struct v3_vnet_route * route_def = &(route->route_def);
343 // CHECK SOURCE TYPE HERE
344 if ( (route_def->src_type != LINK_ANY) &&
345 ( (route_def->src_type != src_type) ||
346 ( (route_def->src_id != src_link) &&
347 (route_def->src_id != -1)))) {
352 if ((route_def->dst_mac_qual == MAC_ANY) &&
353 (route_def->src_mac_qual == MAC_ANY)) {
357 if (memcmp(route_def->src_mac, hdr->src_mac, 6) == 0) {
358 if (route_def->src_mac_qual != MAC_NOT) {
359 if (route_def->dst_mac_qual == MAC_ANY) {
361 } else if (route_def->dst_mac_qual != MAC_NOT &&
362 memcmp(route_def->dst_mac, hdr->dst_mac, 6) == 0) {
368 if (memcmp(route_def->dst_mac, hdr->dst_mac, 6) == 0) {
369 if (route_def->dst_mac_qual != MAC_NOT) {
370 if (route_def->src_mac_qual == MAC_ANY) {
372 } else if ((route_def->src_mac_qual != MAC_NOT) &&
373 (memcmp(route_def->src_mac, hdr->src_mac, 6) == 0)) {
379 if ((route_def->dst_mac_qual == MAC_NOT) &&
380 (memcmp(route_def->dst_mac, hdr->dst_mac, 6) != 0)) {
381 if (route_def->src_mac_qual == MAC_ANY) {
383 } else if ((route_def->src_mac_qual != MAC_NOT) &&
384 (memcmp(route_def->src_mac, hdr->src_mac, 6) == 0)) {
389 if ((route_def->src_mac_qual == MAC_NOT) &&
390 (memcmp(route_def->src_mac, hdr->src_mac, 6) != 0)) {
391 if (route_def->dst_mac_qual == MAC_ANY) {
393 } else if ((route_def->dst_mac_qual != MAC_NOT) &&
394 (memcmp(route_def->dst_mac, hdr->dst_mac, 6) == 0)) {
400 if ( (memcmp(route_def->src_mac, hdr->src_mac, 6) == 0) &&
401 (route_def->dst_mac_qual == MAC_NONE)) {
406 PrintDebug("VNET/P Core: match_route: Matches=%d\n", num_matches);
408 if (num_matches == 0) {
412 matches = (struct route_list *)V3_Malloc(sizeof(struct route_list) +
413 (sizeof(struct vnet_route_info *) * num_matches));
415 matches->num_routes = num_matches;
419 list_for_each_entry(route, &match_list, match_node) {
420 matches->routes[i++] = route;
428 int v3_vnet_send_pkt(struct v3_vnet_pkt * pkt, void * private_data) {
429 struct route_list * matched_routes = NULL;
433 #ifdef CONFIG_DEBUG_VNET
435 int cpu = V3_Get_CPU();
436 PrintDebug("VNET/P Core: cpu %d: pkt (size %d, src_id:%d, src_type: %d, dst_id: %d, dst_type: %d)\n",
437 cpu, pkt->size, pkt->src_id,
438 pkt->src_type, pkt->dst_id, pkt->dst_type);
439 //v3_hexdump(pkt->data, pkt->size, NULL, 0);
443 flags = v3_lock_irqsave(vnet_state.lock);
445 look_into_cache(pkt, &matched_routes);
446 if (matched_routes == NULL) {
447 PrintDebug("VNET/P Core: send pkt Looking into routing table\n");
449 matched_routes = match_route(pkt);
451 if (matched_routes) {
452 add_route_to_cache(pkt, matched_routes);
454 PrintDebug("VNET/P Core: Could not find route for packet... discards packet\n");
455 v3_unlock_irqrestore(vnet_state.lock, flags);
456 return 0; /* do we return -1 here?*/
460 v3_unlock_irqrestore(vnet_state.lock, flags);
462 PrintDebug("VNET/P Core: send pkt route matches %d\n", matched_routes->num_routes);
464 for (i = 0; i < matched_routes->num_routes; i++) {
465 struct vnet_route_info * route = matched_routes->routes[i];
467 if (route->route_def.dst_type == LINK_EDGE) {
468 struct vnet_brg_dev *bridge = vnet_state.bridge;
469 pkt->dst_type = LINK_EDGE;
470 pkt->dst_id = route->route_def.dst_id;
472 if (bridge == NULL || (bridge->active == 0)) {
473 PrintDebug("VNET/P Core: No active bridge to sent data to\n");
477 if(bridge->brg_ops.input(bridge->vm, pkt, bridge->private_data) < 0){
478 PrintDebug("VNET/P Core: Packet not sent properly to bridge\n");
481 } else if (route->route_def.dst_type == LINK_INTERFACE) {
482 if (route->dst_dev == NULL || route->dst_dev->active == 0){
483 PrintDebug("VNET/P Core: No active device to sent data to\n");
487 if(route->dst_dev->dev_ops.input(route->dst_dev->vm, pkt, route->dst_dev->private_data) < 0) {
488 PrintDebug("VNET/P Core: Packet not sent properly\n");
492 PrintError("VNET/P Core: Wrong dst type\n");
499 int v3_vnet_add_dev(struct v3_vm_info * vm, uint8_t * mac,
500 struct v3_vnet_dev_ops *ops,
502 struct vnet_dev * new_dev = NULL;
505 new_dev = (struct vnet_dev *)V3_Malloc(sizeof(struct vnet_dev));
507 if (new_dev == NULL) {
508 PrintError("Malloc fails\n");
512 memcpy(new_dev->mac_addr, mac, 6);
513 new_dev->dev_ops.input = ops->input;
514 new_dev->dev_ops.poll = ops->poll;
515 new_dev->private_data = priv_data;
519 new_dev->mode = GUEST_DRIVERN;
521 flags = v3_lock_irqsave(vnet_state.lock);
523 if (dev_by_mac(mac) == NULL) {
524 list_add(&(new_dev->node), &(vnet_state.devs));
525 new_dev->dev_id = ++vnet_state.num_devs;
528 v3_unlock_irqrestore(vnet_state.lock, flags);
530 /* if the device was found previosly the id should still be 0 */
531 if (new_dev->dev_id == 0) {
532 PrintError("VNET/P Core: Device Already exists\n");
536 PrintDebug("VNET/P Core: Add Device: dev_id %d\n", new_dev->dev_id);
538 return new_dev->dev_id;
543 int v3_vnet_del_dev(int dev_id){
544 struct vnet_dev * dev = NULL;
547 flags = v3_lock_irqsave(vnet_state.lock);
549 dev = dev_by_id(dev_id);
551 list_del(&(dev->node));
552 del_routes_by_dev(dev_id);
555 v3_unlock_irqrestore(vnet_state.lock, flags);
559 PrintDebug("VNET/P Core: Remove Device: dev_id %d\n", dev_id);
565 static void free_devices(){
566 struct vnet_dev * dev = NULL;
568 list_for_each_entry(dev, &(vnet_state.devs), node) {
569 list_del(&(dev->node));
574 static void free_routes(){
575 struct vnet_route_info * route = NULL;
577 list_for_each_entry(route, &(vnet_state.routes), node) {
578 list_del(&(route->node));
579 list_del(&(route->match_node));
584 int v3_vnet_add_bridge(struct v3_vm_info * vm,
585 struct v3_vnet_bridge_ops * ops,
590 struct vnet_brg_dev * tmp_bridge = NULL;
592 flags = v3_lock_irqsave(vnet_state.lock);
594 if (vnet_state.bridge == NULL) {
596 vnet_state.bridge = (void *)1;
599 v3_unlock_irqrestore(vnet_state.lock, flags);
601 if (bridge_free == 0) {
602 PrintError("VNET/P Core: Bridge already set\n");
606 tmp_bridge = (struct vnet_brg_dev *)V3_Malloc(sizeof(struct vnet_brg_dev));
608 if (tmp_bridge == NULL) {
609 PrintError("Malloc Fails\n");
610 vnet_state.bridge = NULL;
615 tmp_bridge->brg_ops.input = ops->input;
616 tmp_bridge->brg_ops.poll = ops->poll;
617 tmp_bridge->private_data = priv_data;
618 tmp_bridge->active = 1;
619 tmp_bridge->mode = GUEST_DRIVERN;
620 tmp_bridge->type = type;
622 /* make this atomic to avoid possible race conditions */
623 flags = v3_lock_irqsave(vnet_state.lock);
624 vnet_state.bridge = tmp_bridge;
625 v3_unlock_irqrestore(vnet_state.lock, flags);
632 memset(&vnet_state, 0, sizeof(vnet_state));
634 INIT_LIST_HEAD(&(vnet_state.routes));
635 INIT_LIST_HEAD(&(vnet_state.devs));
637 vnet_state.num_devs = 0;
638 vnet_state.num_routes = 0;
640 if (v3_lock_init(&(vnet_state.lock)) == -1){
641 PrintError("VNET/P Core: Fails to initiate lock\n");
644 vnet_state.route_cache = v3_create_htable(0, &hash_fn, &hash_eq);
646 if (vnet_state.route_cache == NULL) {
647 PrintError("VNET/P Core: Fails to initiate route cache\n");
651 PrintDebug("VNET/P Core is initiated\n");
657 void v3_deinit_vnet(){
659 v3_lock_deinit(&(vnet_state.lock));
664 v3_free_htable(vnet_state.route_cache, 1, 1);
665 V3_Free(vnet_state.bridge);