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) 2009, 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>
28 #ifndef CONFIG_DEBUG_VNET
30 #define PrintDebug(fmt, args...)
38 uint16_t type; // indicates layer 3 protocol type
39 } __attribute__((packed));
48 struct v3_vm_info * vm;
50 int (*input)(struct v3_vm_info * vm, struct v3_vnet_pkt * pkt, void * private_data);
54 struct list_head node;
55 } __attribute__((packed));
61 struct vnet_route_info {
62 struct v3_vnet_route route_def;
64 struct vnet_dev * dst_dev;
65 struct vnet_dev * src_dev;
67 struct list_head node;
68 struct list_head match_node; // used for route matching
75 uint8_t hash_buf[VNET_HASH_SIZE];
78 struct vnet_route_info * routes[0];
79 } __attribute__((packed));
84 struct list_head routes;
85 struct list_head devs;
92 struct gen_queue * inpkt_q;
93 struct hashtable * route_cache;
100 #ifdef CONFIG_DEBUG_VNET
102 static void print_packet(struct v3_vnet_pkt * pkt) {
103 PrintDebug("Vnet: data_packet: size: %d\n", pkt->size);
104 v3_hexdump(pkt->data, pkt->size, NULL, 0);
108 static inline void mac_to_string(char mac[6], char * buf) {
109 snprintf(buf, 20, "%02x:%02x:%02x:%02x:%02x:%02x",
110 mac[0], mac[1], mac[2],
111 mac[3], mac[4], mac[5]);
118 * A VNET packet is a packed struct with the hashed fields grouped together.
119 * This means we can generate the hash from an offset into the pkt struct
121 static inline uint_t hash_fn(addr_t hdr_ptr) {
122 uint8_t * hdr_buf = (uint8_t *)&(hdr_ptr);
124 return v3_hash_buffer(hdr_buf, VNET_HASH_SIZE);
127 static inline int hash_eq(addr_t key1, addr_t key2) {
128 return (memcmp((uint8_t *)key1, (uint8_t *)key2, VNET_HASH_SIZE) == 0);
132 static int add_route_to_cache(struct v3_vnet_pkt * pkt, struct route_list * routes) {
133 memcpy(routes->hash_buf, pkt->hash_buf, VNET_HASH_SIZE);
135 if (v3_htable_insert(vnet_state.route_cache, (addr_t)routes->hash_buf, (addr_t)routes) == 0) {
136 PrintError("Vnet: Failed to insert new route entry to the cache\n");
143 static int clear_hash_cache() {
145 /* USE the hash table iterators.
146 * See v3_swap_flush(struct v3_vm_info * vm) in vmm_shdw_pg_swapbypass.c
149 // MAKE SURE YOU DELETE the route_list entries
150 struct hashtable_iter * ht_iter = v3_create_htable_iter(vnet_state.route_cache);
153 PrintError("NULL iterator in vnet cache!\n");
156 while (ht_iter->entry) {
157 struct route_list * route_list_ptr = (struct route_list *)v3_htable_get_iter_value(ht_iter);
158 V3_Free(route_list_ptr);
159 v3_htable_iter_advance(ht_iter);
164 //v3_free_htable(vnet_state.route_cache, 0, 1);
169 static int look_into_cache(struct v3_vnet_pkt * pkt, struct route_list ** routes) {
171 *routes = (struct route_list *)v3_htable_search(vnet_state.route_cache, (addr_t)pkt);
178 int v3_vnet_add_route(struct v3_vnet_route route) {
179 struct vnet_route_info * new_route = NULL;
182 new_route = (struct vnet_route_info *)V3_Malloc(sizeof(struct vnet_route_info));
183 memset(new_route, 0, sizeof(struct vnet_route_info));
185 PrintDebug("Vnet: vnet_add_route_entry\n");
187 new_route->route_def = route;
189 /* TODO: Find devices */
190 if (new_route->route_def.dst_type == LINK_INTERFACE) {
191 //new_route->dst_dev = FIND_DEV();
194 if (new_route->route_def.src_type == LINK_INTERFACE) {
195 // new_route->src_dev = FIND_DEV()
198 flags = v3_lock_irqsave(vnet_state.lock);
199 list_add(&(new_route->node), &(vnet_state.routes));
200 v3_unlock_irqrestore(vnet_state.lock, flags);
209 // At the end allocate a route_list
210 // This list will be inserted into the cache so we don't need to free it
211 static struct route_list * match_route(struct v3_vnet_pkt * pkt) {
212 struct vnet_route_info * route = NULL;
213 struct route_list * matches = NULL;
216 struct list_head match_list;
217 struct eth_hdr * hdr = (struct eth_hdr *)(pkt->data);
218 uint8_t src_type = pkt->src_type;
219 uint32_t src_link = pkt->src_id;
221 #ifdef CONFIG_DEBUG_VNET
226 mac_to_string(hdr->src_mac, src_str);
227 mac_to_string(hdr->dst_mac, dst_str);
228 PrintDebug("Vnet: match_route. pkt: SRC(%s), DEST(%s)\n", src_str, dst_str);
232 INIT_LIST_HEAD(&match_list);
234 #define UPDATE_MATCHES(rank) do { \
235 if (max_rank < (rank)) { \
237 INIT_LIST_HEAD(&match_list); \
239 list_add(&(route->match_node), &match_list); \
241 } else if (max_rank == (rank)) { \
242 list_add(&(route->match_node), &match_list); \
248 list_for_each_entry(route, &(vnet_state.routes), node) {
249 struct v3_vnet_route * route_def = &(route->route_def);
251 // CHECK SOURCE TYPE HERE
252 if ( (route_def->src_type != LINK_ANY) &&
253 ( (route_def->src_type != src_type) ||
254 ( (route_def->src_id != src_link) &&
255 (route_def->src_id != (uint32_t)-1)))) {
260 if ((route_def->dst_mac_qual == MAC_ANY) &&
261 (route_def->src_mac_qual == MAC_ANY)) {
265 if (memcmp(route_def->src_mac, hdr->src_mac, 6) == 0) {
266 if (route_def->src_mac_qual != MAC_NOT) {
267 if (route_def->dst_mac_qual == MAC_ANY) {
269 } else if (route_def->dst_mac_qual != MAC_NOT &&
270 memcmp(route_def->dst_mac, hdr->dst_mac, 6) == 0) {
276 if (memcmp(route_def->dst_mac, hdr->dst_mac, 6) == 0) {
277 if (route_def->dst_mac_qual != MAC_NOT) {
278 if (route_def->src_mac_qual == MAC_ANY) {
280 } else if ((route_def->src_mac_qual != MAC_NOT) &&
281 (memcmp(route_def->src_mac, hdr->src_mac, 6) == 0)) {
287 if ((route_def->dst_mac_qual == MAC_NOT) &&
288 (memcmp(route_def->dst_mac, hdr->dst_mac, 6) != 0)) {
289 if (route_def->src_mac_qual == MAC_ANY) {
291 } else if ((route_def->src_mac_qual != MAC_NOT) &&
292 (memcmp(route_def->src_mac, hdr->src_mac, 6) == 0)) {
297 if ((route_def->src_mac_qual == MAC_NOT) &&
298 (memcmp(route_def->src_mac, hdr->src_mac, 6) != 0)) {
299 if (route_def->dst_mac_qual == MAC_ANY) {
301 } else if ((route_def->dst_mac_qual != MAC_NOT) &&
302 (memcmp(route_def->dst_mac, hdr->dst_mac, 6) == 0)) {
308 if ( (memcmp(route_def->src_mac, hdr->src_mac, 6) == 0) &
309 (route_def->dst_mac_qual == MAC_NONE)) {
314 PrintDebug("Vnet: match_route: Matches=%d\n", num_matches);
316 if (num_matches == 0) {
320 matches = V3_Malloc(sizeof(struct route_list) +
321 (sizeof(struct vnet_route_info *) * num_matches));
323 matches->num_routes = num_matches;
327 list_for_each_entry(route, &match_list, node) {
328 matches->routes[i++] = route;
335 static int handle_one_pkt(struct v3_vnet_pkt * pkt) {
336 struct route_list * matched_routes = NULL;
340 #ifdef CONFIG_DEBUG_VNET
342 struct eth_hdr * hdr = (struct eth_hdr *)(pkt->data);
346 mac_to_string(hdr->src_mac, src_str);
347 mac_to_string(hdr->dst_mac, dest_str);
348 PrintDebug("Vnet: HandleDataOverLink. SRC(%s), DEST(%s)\n", src_str, dest_str);
352 look_into_cache(pkt, &matched_routes);
354 if (matched_routes == NULL) {
355 matched_routes = match_route(pkt);
357 if (matched_routes) {
358 add_route_to_cache(pkt, matched_routes);
360 PrintError("Could not find route for packet...\n");
366 for (i = 0; i < matched_routes->num_routes; i++) {
367 struct vnet_route_info * route = matched_routes->routes[i];
369 if (route->route_def.dst_type == LINK_EDGE) {
371 } else if (route->route_def.dst_type == LINK_INTERFACE) {
372 if (route->dst_dev->input(route->dst_dev->vm, pkt, route->dst_dev->private_data) == -1) {
373 PrintDebug("VNET: Packet not sent properly\n");
377 PrintDebug("Vnet: Wrong Edge type\n");
381 PrintDebug("Vnet: HandleDataOverLink: Forward packet according to Route\n");
387 int v3_vnet_send_pkt(struct v3_vnet_pkt * pkt) {
388 // find the destination and call the send packet function, passing pkt *
390 if (handle_one_pkt(pkt) != -1) {
391 PrintDebug("VNET: send one packet! pt length %d\n", pkt->size);
393 PrintDebug("VNET: Fail to forward one packet, discard it!\n");
396 #ifdef CONFIG_DEBUG_VNET
403 struct vnet_dev * find_dev_by_id(int idx) {
404 struct vnet_dev * dev = NULL;
406 list_for_each_entry(dev, &(vnet_state.devs), node) {
407 int dev_id = dev->dev_id;
416 static struct vnet_dev * find_dev_by_mac(char * name) {
417 struct vnet_dev * dev = NULL;
419 list_for_each_entry(dev, &(vnet_state.devs), node) {
420 if (!memcmp(dev->mac_addr, name, 6))
427 int v3_vnet_add_dev(struct v3_vm_info *vm,uint8_t mac[6],
428 int (*netif_input)(struct v3_vm_info * vm, struct v3_vnet_pkt * pkt, void * private_data),
430 struct vnet_dev * new_dev = NULL;
432 new_dev = find_dev_by_mac(mac);
435 PrintDebug("VNET: register device: Already has device with the same mac\n");
439 new_dev = (struct vnet_dev *)V3_Malloc(sizeof(struct vnet_dev));
441 if (new_dev == NULL) {
442 PrintError("VNET: Malloc fails\n");
446 memcpy(new_dev->mac_addr, mac, 6);
447 new_dev->input = netif_input;
448 new_dev->private_data = priv_data;
452 // increment dev count
454 list_add(&(new_dev->node), &(vnet_state.devs));
455 vnet_state.num_devs ++;
456 new_dev->dev_id = vnet_state.num_devs;
461 int v3_vnet_pkt_process() {
462 struct v3_vnet_pkt * pkt = NULL;
464 while ((pkt = (struct v3_vnet_pkt *)v3_dequeue(vnet_state.inpkt_q)) != NULL) {
465 if (handle_one_pkt(pkt) != -1) {
466 PrintDebug("VNET: vnet_check: handle one packet! pt length %d\n", (int)pkt->size);
468 PrintDebug("VNET: vnet_check: Fail to forward one packet, discard it!\n");
471 V3_Free(pkt); // be careful here
480 PrintDebug("VNET: Links table initiated\n");
482 INIT_LIST_HEAD(&(vnet_state.routes));
483 INIT_LIST_HEAD(&(vnet_state.devs));
485 vnet_state.num_devs = 0;
486 vnet_state.num_routes = 0;
488 if (v3_lock_init(&(vnet_state.lock)) == -1){
489 PrintError("VNET: Failure to init lock for routes table\n");
492 PrintDebug("VNET: Routes table initiated\n");
494 /*initial pkt receiving queue */
495 vnet_state.inpkt_q = v3_create_queue();
496 v3_init_queue(vnet_state.inpkt_q);
497 PrintDebug("VNET: Receiving queue initiated\n");
499 vnet_state.route_cache = v3_create_htable(0, &hash_fn, &hash_eq);
501 if (vnet_state.route_cache == NULL) {
502 PrintError("Vnet: Route Cache Init Fails\n");