* Use convince macro uip_ipaddr_to_quad.
* Printf format check and fix format strings. * More info in some printfs. * Be conservative about keeping working routes in RREQ (forward) path. * Put some spacing between forwarded packet and RREQ.
This commit is contained in:
parent
539ad552bd
commit
abbde5d8fa
1 changed files with 48 additions and 95 deletions
141
core/net/uaodv.c
141
core/net/uaodv.c
|
@ -28,7 +28,7 @@
|
||||||
*
|
*
|
||||||
* This file is part of the Contiki operating system.
|
* This file is part of the Contiki operating system.
|
||||||
*
|
*
|
||||||
* $Id: uaodv.c,v 1.3 2007/01/24 16:32:34 bg- Exp $
|
* $Id: uaodv.c,v 1.4 2007/02/01 14:33:05 bg- Exp $
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -62,22 +62,22 @@ static uip_ipaddr_t last_rreq_originator;
|
||||||
static u32_t last_rreq_id;
|
static u32_t last_rreq_id;
|
||||||
|
|
||||||
|
|
||||||
#define ip2quad(p) uip_ipaddr1(p),uip_ipaddr2(p),uip_ipaddr3(p),uip_ipaddr4(p)
|
|
||||||
|
|
||||||
#if 1
|
#if 1
|
||||||
|
#define PRINTF(...) do {} while (0)
|
||||||
#define print_debug(...) do{}while(0)
|
#define print_debug(...) do{}while(0)
|
||||||
#else
|
#else
|
||||||
|
#define PRINTF(...) printf(__VA_ARGS__)
|
||||||
|
static void
|
||||||
|
print_debug(const char *fmt, ...) __attribute__((format(printf, 1, 2)));
|
||||||
static void
|
static void
|
||||||
print_debug(const char *fmt, ...)
|
print_debug(const char *fmt, ...)
|
||||||
{
|
{
|
||||||
#if 1
|
|
||||||
va_list ap;
|
va_list ap;
|
||||||
|
|
||||||
va_start(ap, fmt);
|
va_start(ap, fmt);
|
||||||
printf("%d.%d.%d.%d: ", ip2quad(&uip_hostaddr));
|
printf("%d.%d.%d.%d: ", uip_ipaddr_to_quad(&uip_hostaddr));
|
||||||
vprintf(fmt, ap);
|
vprintf(fmt, ap);
|
||||||
va_end(ap);
|
va_end(ap);
|
||||||
#endif
|
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
@ -138,13 +138,7 @@ send_rrep(uip_ipaddr_t *dst, uip_ipaddr_t *nexthop, uip_ipaddr_t *src, u32_t seq
|
||||||
rm->lifetime = MY_ROUTE_TIMEOUT;
|
rm->lifetime = MY_ROUTE_TIMEOUT;
|
||||||
sendto(nexthop, (char *)rm, sizeof(struct uaodv_msg_rrep));
|
sendto(nexthop, (char *)rm, sizeof(struct uaodv_msg_rrep));
|
||||||
|
|
||||||
print_debug("Sending RREP to %d.%d.%d.%d\n",
|
print_debug("Sending RREP to %d.%d.%d.%d\n", uip_ipaddr_to_quad(nexthop));
|
||||||
uip_ipaddr1(nexthop),
|
|
||||||
uip_ipaddr2(nexthop),
|
|
||||||
uip_ipaddr3(nexthop),
|
|
||||||
uip_ipaddr4(nexthop));
|
|
||||||
|
|
||||||
|
|
||||||
}
|
}
|
||||||
/*---------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
#ifdef UAODV_BAD_ROUTE
|
#ifdef UAODV_BAD_ROUTE
|
||||||
|
@ -162,7 +156,8 @@ send_rerr(uip_ipaddr_t *addr, u32_t seqno)
|
||||||
|
|
||||||
sendto(&uip_broadcast_addr, (char *)rm, sizeof(struct uaodv_msg_rerr));
|
sendto(&uip_broadcast_addr, (char *)rm, sizeof(struct uaodv_msg_rerr));
|
||||||
|
|
||||||
print_debug("Broadcasting initial RERR for %d.%d.%d.%d\n", ip2quad(addr));
|
print_debug("Broadcasting initial RERR for %d.%d.%d.%d\n",
|
||||||
|
uip_ipaddr_to_quad(addr));
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
/*---------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
|
@ -175,11 +170,8 @@ handle_incoming_rreq(void)
|
||||||
|
|
||||||
#ifdef CC2420_RADIO
|
#ifdef CC2420_RADIO
|
||||||
if(cc2420_last_rssi <= -38 || cc2420_last_correlation < 100) {
|
if(cc2420_last_rssi <= -38 || cc2420_last_correlation < 100) {
|
||||||
printf("RREQ drop from %d.%d.%d.%d %d %d \n",
|
PRINTF("RREQ drop from %d.%d.%d.%d %d %d \n",
|
||||||
uip_ipaddr1(uip_udp_sender()),
|
uip_ipaddr_to_quad(uip_udp_sender()),
|
||||||
uip_ipaddr2(uip_udp_sender()),
|
|
||||||
uip_ipaddr3(uip_udp_sender()),
|
|
||||||
uip_ipaddr4(uip_udp_sender()),
|
|
||||||
cc2420_last_rssi,
|
cc2420_last_rssi,
|
||||||
cc2420_last_correlation);
|
cc2420_last_correlation);
|
||||||
return;
|
return;
|
||||||
|
@ -188,19 +180,13 @@ handle_incoming_rreq(void)
|
||||||
|
|
||||||
/* Check if it is for our address. */
|
/* Check if it is for our address. */
|
||||||
if(uip_ipaddr_cmp(&rm->dest_addr, &uip_hostaddr)) {
|
if(uip_ipaddr_cmp(&rm->dest_addr, &uip_hostaddr)) {
|
||||||
print_debug("RREQ for our address!\n");
|
|
||||||
rt = uaodv_rt_lookup(&rm->src_addr);
|
rt = uaodv_rt_lookup(&rm->src_addr);
|
||||||
if(rt == NULL || rm->hop_count <= rt->hop_count) {
|
print_debug("RREQ for our address! rt=%p\n", rt);
|
||||||
|
if(rt == NULL) {
|
||||||
/* Insert originator into routing table. */
|
/* Insert originator into routing table. */
|
||||||
print_debug("Inserting1 %d.%d.%d.%d into routing table, next hop %d.%d.%d.%d., hop_count %d\n",
|
print_debug("Inserting1 %d.%d.%d.%d into routing table, next hop %d.%d.%d.%d., hop_count %d\n",
|
||||||
uip_ipaddr1(&rm->src_addr),
|
uip_ipaddr_to_quad(&rm->src_addr),
|
||||||
uip_ipaddr2(&rm->src_addr),
|
uip_ipaddr_to_quad(uip_udp_sender()),
|
||||||
uip_ipaddr3(&rm->src_addr),
|
|
||||||
uip_ipaddr4(&rm->src_addr),
|
|
||||||
uip_ipaddr1(uip_udp_sender()),
|
|
||||||
uip_ipaddr2(uip_udp_sender()),
|
|
||||||
uip_ipaddr3(uip_udp_sender()),
|
|
||||||
uip_ipaddr4(uip_udp_sender()),
|
|
||||||
rm->hop_count);
|
rm->hop_count);
|
||||||
uaodv_rt_add(&rm->src_addr, uip_udp_sender(), rm->hop_count, 0);
|
uaodv_rt_add(&rm->src_addr, uip_udp_sender(), rm->hop_count, 0);
|
||||||
}
|
}
|
||||||
|
@ -211,23 +197,13 @@ handle_incoming_rreq(void)
|
||||||
send_rrep(&dest_addr, uip_udp_sender(), &src_addr, rm->src_seqno);
|
send_rrep(&dest_addr, uip_udp_sender(), &src_addr, rm->src_seqno);
|
||||||
} else if(!uip_ipaddr_cmp(&last_rreq_originator, &rm->src_addr) ||
|
} else if(!uip_ipaddr_cmp(&last_rreq_originator, &rm->src_addr) ||
|
||||||
last_rreq_id != rm->rreq_id) {
|
last_rreq_id != rm->rreq_id) {
|
||||||
print_debug("RREQ for %d.%d.%d.%d!\n",
|
print_debug("RREQ for %d.%d.%d.%d!\n", uip_ipaddr_to_quad(&rm->dest_addr));
|
||||||
uip_ipaddr1(&rm->dest_addr),
|
|
||||||
uip_ipaddr2(&rm->dest_addr),
|
|
||||||
uip_ipaddr3(&rm->dest_addr),
|
|
||||||
uip_ipaddr4(&rm->dest_addr));
|
|
||||||
rt = uaodv_rt_lookup(&rm->src_addr);
|
rt = uaodv_rt_lookup(&rm->src_addr);
|
||||||
if(rt == NULL || rm->hop_count <= rt->hop_count) {
|
if(rt == NULL) {
|
||||||
/* Insert originator into routing table. */
|
/* Insert originator into routing table. */
|
||||||
print_debug("Inserting2 %d.%d.%d.%d into routing table, next hop %d.%d.%d.%d., hop_count %d\n",
|
print_debug("Inserting2 %d.%d.%d.%d into routing table, next hop %d.%d.%d.%d., hop_count %d\n",
|
||||||
uip_ipaddr1(&rm->src_addr),
|
uip_ipaddr_to_quad(&rm->src_addr),
|
||||||
uip_ipaddr2(&rm->src_addr),
|
uip_ipaddr_to_quad(uip_udp_sender()),
|
||||||
uip_ipaddr3(&rm->src_addr),
|
|
||||||
uip_ipaddr4(&rm->src_addr),
|
|
||||||
uip_ipaddr1(uip_udp_sender()),
|
|
||||||
uip_ipaddr2(uip_udp_sender()),
|
|
||||||
uip_ipaddr3(uip_udp_sender()),
|
|
||||||
uip_ipaddr4(uip_udp_sender()),
|
|
||||||
rm->hop_count);
|
rm->hop_count);
|
||||||
uaodv_rt_add(&rm->src_addr, uip_udp_sender(), rm->hop_count, 0);
|
uaodv_rt_add(&rm->src_addr, uip_udp_sender(), rm->hop_count, 0);
|
||||||
}
|
}
|
||||||
|
@ -239,10 +215,7 @@ handle_incoming_rreq(void)
|
||||||
don't do it at the moment. */
|
don't do it at the moment. */
|
||||||
|
|
||||||
print_debug("Forwarding RREQ to %d.%d.%d.%d ttl=%d\n",
|
print_debug("Forwarding RREQ to %d.%d.%d.%d ttl=%d\n",
|
||||||
uip_ipaddr1(&rm->src_addr),
|
uip_ipaddr_to_quad(&rm->src_addr),
|
||||||
uip_ipaddr2(&rm->src_addr),
|
|
||||||
uip_ipaddr3(&rm->src_addr),
|
|
||||||
uip_ipaddr4(&rm->src_addr),
|
|
||||||
uip_udp_conn->ttl);
|
uip_udp_conn->ttl);
|
||||||
|
|
||||||
uip_ipaddr_copy(&last_rreq_originator, &rm->src_addr);
|
uip_ipaddr_copy(&last_rreq_originator, &rm->src_addr);
|
||||||
|
@ -250,15 +223,9 @@ handle_incoming_rreq(void)
|
||||||
rm->hop_count++;
|
rm->hop_count++;
|
||||||
uip_send((char *)rm, sizeof(struct uaodv_msg_rreq));
|
uip_send((char *)rm, sizeof(struct uaodv_msg_rreq));
|
||||||
} else {
|
} else {
|
||||||
print_debug("Not forwarding rreq last_rreq_originator %d.%d.%d.%d src_addr %d.%d.%d.%d, last_rreq_id %d rreq_id %d\n",
|
print_debug("Not forwarding rreq last_rreq_originator %d.%d.%d.%d src_addr %d.%d.%d.%d, last_rreq_id %ld rreq_id %ld\n",
|
||||||
uip_ipaddr1(&last_rreq_originator),
|
uip_ipaddr_to_quad(&last_rreq_originator),
|
||||||
uip_ipaddr2(&last_rreq_originator),
|
uip_ipaddr_to_quad(&rm->src_addr),
|
||||||
uip_ipaddr3(&last_rreq_originator),
|
|
||||||
uip_ipaddr4(&last_rreq_originator),
|
|
||||||
uip_ipaddr1(&rm->src_addr),
|
|
||||||
uip_ipaddr2(&rm->src_addr),
|
|
||||||
uip_ipaddr3(&rm->src_addr),
|
|
||||||
uip_ipaddr4(&rm->src_addr),
|
|
||||||
last_rreq_id, rm->rreq_id);
|
last_rreq_id, rm->rreq_id);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -269,63 +236,47 @@ handle_incoming_rrep(void)
|
||||||
struct uaodv_msg_rrep *rm = (struct uaodv_msg_rrep *)uip_appdata;
|
struct uaodv_msg_rrep *rm = (struct uaodv_msg_rrep *)uip_appdata;
|
||||||
struct uaodv_rt_entry *rt;
|
struct uaodv_rt_entry *rt;
|
||||||
|
|
||||||
print_debug("RREP received\n");
|
|
||||||
|
|
||||||
/* Check if we have another route to this destination. If so, we'll
|
/* Check if we have another route to this destination. If so, we'll
|
||||||
use the new one if the hop count is lower, and if the sequence
|
use the new one if the hop count is lower, and if the sequence
|
||||||
number say we should. */
|
number say we should. */
|
||||||
rt = uaodv_rt_lookup(&rm->dest_addr);
|
rt = uaodv_rt_lookup(&rm->dest_addr);
|
||||||
|
|
||||||
|
print_debug("RREP received\n rt=%p", rt);
|
||||||
|
|
||||||
if(rt == NULL ||
|
if(rt == NULL ||
|
||||||
(rt->hop_count > rm->hop_count /* && seqno < seqno */)) {
|
(rt->hop_count > rm->hop_count /* && seqno < seqno */)) {
|
||||||
|
|
||||||
/* Insert originator into routing table. */
|
/* Insert originator into routing table. */
|
||||||
print_debug("Inserting3 %d.%d.%d.%d into routing table, next hop %d.%d.%d.%d, hop_count %d.\n",
|
print_debug("Inserting3 %d.%d.%d.%d into routing table, next hop %d.%d.%d.%d, hop_count %d.\n",
|
||||||
uip_ipaddr1(&rm->dest_addr),
|
uip_ipaddr_to_quad(&rm->dest_addr),
|
||||||
uip_ipaddr2(&rm->dest_addr),
|
uip_ipaddr_to_quad(uip_udp_sender()),
|
||||||
uip_ipaddr3(&rm->dest_addr),
|
rm->hop_count);
|
||||||
uip_ipaddr4(&rm->dest_addr),
|
|
||||||
uip_ipaddr1(uip_udp_sender()),
|
|
||||||
uip_ipaddr2(uip_udp_sender()),
|
|
||||||
uip_ipaddr3(uip_udp_sender()),
|
|
||||||
uip_ipaddr4(uip_udp_sender()), rm->hop_count
|
|
||||||
);
|
|
||||||
uaodv_rt_add(&rm->dest_addr, uip_udp_sender(), rm->hop_count, 0);
|
uaodv_rt_add(&rm->dest_addr, uip_udp_sender(), rm->hop_count, 0);
|
||||||
#ifdef CC2420_RADIO
|
#ifdef CC2420_RADIO
|
||||||
/* This link is ok since he is unicasting back to us! */
|
/* This link is ok since he is unicasting back to us! */
|
||||||
cc2420_recv_ok(uip_udp_sender());
|
cc2420_recv_ok(uip_udp_sender());
|
||||||
printf("RREP recv ok from %d.%d.%d.%d %d %d \n",
|
PRINTF("RREP recv ok from %d.%d.%d.%d %d %d \n",
|
||||||
uip_ipaddr1(uip_udp_sender()),
|
uip_ipaddr_to_quad(uip_udp_sender()),
|
||||||
uip_ipaddr2(uip_udp_sender()),
|
|
||||||
uip_ipaddr3(uip_udp_sender()),
|
|
||||||
uip_ipaddr4(uip_udp_sender()),
|
|
||||||
cc2420_last_rssi,
|
cc2420_last_rssi,
|
||||||
cc2420_last_correlation);
|
cc2420_last_correlation);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
print_debug("Not inserting %d.%d.%d.%d into routing table, next hop %d.%d.%d.%d, hop_count %d.\n",
|
print_debug("Not inserting %d.%d.%d.%d into routing table, next hop %d.%d.%d.%d, hop_count %d.\n",
|
||||||
uip_ipaddr1(&rm->dest_addr),
|
uip_ipaddr_to_quad(&rm->dest_addr),
|
||||||
uip_ipaddr2(&rm->dest_addr),
|
uip_ipaddr_to_quad(uip_udp_sender()),
|
||||||
uip_ipaddr3(&rm->dest_addr),
|
rm->hop_count);
|
||||||
uip_ipaddr4(&rm->dest_addr),
|
|
||||||
uip_ipaddr1(uip_udp_sender()),
|
|
||||||
uip_ipaddr2(uip_udp_sender()),
|
|
||||||
uip_ipaddr3(uip_udp_sender()),
|
|
||||||
uip_ipaddr4(uip_udp_sender()), rm->hop_count
|
|
||||||
);
|
|
||||||
|
|
||||||
}
|
}
|
||||||
if(uip_ipaddr_cmp(&rm->src_addr, &uip_hostaddr)) {
|
if(uip_ipaddr_cmp(&rm->src_addr, &uip_hostaddr)) {
|
||||||
print_debug("------- COMPLETE ROUTE FOUND\n");
|
print_debug("------- COMPLETE ROUTE FOUND\n");
|
||||||
} else {
|
} else {
|
||||||
|
|
||||||
/* print_debug("Sending back to originator\n");
|
#if 0
|
||||||
|
print_debug("Sending back to originator\n");
|
||||||
print_debug("Route lookup for %d.%d.%d.%d\n",
|
print_debug("Route lookup for %d.%d.%d.%d\n",
|
||||||
uip_ipaddr1(&rm->src_addr),
|
uip_ipaddr_to_quad(&rm->src_addr));
|
||||||
uip_ipaddr2(&rm->src_addr),
|
#endif
|
||||||
uip_ipaddr3(&rm->src_addr),
|
|
||||||
uip_ipaddr4(&rm->src_addr));*/
|
|
||||||
|
|
||||||
rt = uaodv_rt_lookup(&rm->src_addr);
|
rt = uaodv_rt_lookup(&rm->src_addr);
|
||||||
|
|
||||||
|
@ -337,10 +288,7 @@ handle_incoming_rrep(void)
|
||||||
rm->hop_count++;
|
rm->hop_count++;
|
||||||
|
|
||||||
print_debug("Sending RREP to %d.%d.%d.%d\n",
|
print_debug("Sending RREP to %d.%d.%d.%d\n",
|
||||||
uip_ipaddr1(&rt->nexthop),
|
uip_ipaddr_to_quad(&rt->nexthop));
|
||||||
uip_ipaddr2(&rt->nexthop),
|
|
||||||
uip_ipaddr3(&rt->nexthop),
|
|
||||||
uip_ipaddr4(&rt->nexthop));
|
|
||||||
|
|
||||||
sendto(&rt->nexthop, (char *)rm, sizeof(struct uaodv_msg_rrep));
|
sendto(&rt->nexthop, (char *)rm, sizeof(struct uaodv_msg_rrep));
|
||||||
|
|
||||||
|
@ -355,9 +303,9 @@ handle_incoming_rerr(void)
|
||||||
struct uaodv_msg_rerr *rm = (struct uaodv_msg_rerr *)uip_appdata;
|
struct uaodv_msg_rerr *rm = (struct uaodv_msg_rerr *)uip_appdata;
|
||||||
struct uaodv_rt_entry *rt;
|
struct uaodv_rt_entry *rt;
|
||||||
|
|
||||||
print_debug("RERR received from %d.%d.%d.%d route to %d.%d.%d.%d seq=%d\n",
|
print_debug("RERR received from %d.%d.%d.%d route to %d.%d.%d.%d seq=%ld\n",
|
||||||
ip2quad(uip_udp_sender()),
|
uip_ipaddr_to_quad(uip_udp_sender()),
|
||||||
ip2quad(&rm->unreach[0].addr), rm->unreach[0].seqno);
|
uip_ipaddr_to_quad(&rm->unreach[0].addr), rm->unreach[0].seqno);
|
||||||
|
|
||||||
rt = uaodv_rt_lookup(&rm->unreach[0].addr);
|
rt = uaodv_rt_lookup(&rm->unreach[0].addr);
|
||||||
if(rt != NULL && uip_ipaddr_cmp(&rt->nexthop, uip_udp_sender())) {
|
if(rt != NULL && uip_ipaddr_cmp(&rt->nexthop, uip_udp_sender())) {
|
||||||
|
@ -476,6 +424,11 @@ PROCESS_THREAD(uaodv_process, ev, data)
|
||||||
}
|
}
|
||||||
|
|
||||||
if(ev == PROCESS_EVENT_MSG) {
|
if(ev == PROCESS_EVENT_MSG) {
|
||||||
|
#if 1
|
||||||
|
static struct etimer etimer;
|
||||||
|
etimer_set(&etimer, 2);
|
||||||
|
PROCESS_WAIT_UNTIL(etimer_expired(&etimer));
|
||||||
|
#endif
|
||||||
tcpip_poll_udp(aodvconn);
|
tcpip_poll_udp(aodvconn);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in a new issue