From 841cbd1b990d928c06f1a0333f814e71e83a1899 Mon Sep 17 00:00:00 2001 From: fros4943 Date: Sat, 19 May 2007 14:25:43 +0000 Subject: [PATCH] uIP over uAODV simple radio driver --- platform/cooja/init-net-uip-uaodv.c | 59 ++++++++ platform/cooja/net/radio-uip-uaodv.c | 204 +++++++++++++++++++++++++++ platform/cooja/net/radio-uip-uaodv.h | 46 ++++++ 3 files changed, 309 insertions(+) create mode 100644 platform/cooja/init-net-uip-uaodv.c create mode 100644 platform/cooja/net/radio-uip-uaodv.c create mode 100644 platform/cooja/net/radio-uip-uaodv.h diff --git a/platform/cooja/init-net-uip-uaodv.c b/platform/cooja/init-net-uip-uaodv.c new file mode 100644 index 000000000..c74978581 --- /dev/null +++ b/platform/cooja/init-net-uip-uaodv.c @@ -0,0 +1,59 @@ +/* + * Copyright (c) 2007, Swedish Institute of Computer Science. + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. Neither the name of the Institute nor the names of its contributors + * may be used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + * This file is part of the Contiki operating system. + * + * $Id: init-net-uip-uaodv.c,v 1.1 2007/05/19 14:25:43 fros4943 Exp $ + */ + +#include "contiki.h" +#include "net/uip.h" +#include "net/uip-fw.h" +#include "net/uip-fw-service.h" +#include "net/radio-uip-uaodv.h" +#include "dev/cooja-radio.h" +#include "net/uaodv.h" + +/* Default network interface */ +static struct uip_fw_netif radioif = + {UIP_FW_NETIF(0,0,0,0, 0,0,0,0, radio_uip_uaodv_send)}; + +void +init_net(void) +{ + uip_init(); + uip_fw_init(); + + process_start(&tcpip_process, NULL); + process_start(&uip_fw_process, NULL); + process_start(&uaodv_process, NULL); + + uip_fw_default(&radioif); + + radio_uip_uaodv_init(&cooja_driver); +} diff --git a/platform/cooja/net/radio-uip-uaodv.c b/platform/cooja/net/radio-uip-uaodv.c new file mode 100644 index 000000000..895d589c7 --- /dev/null +++ b/platform/cooja/net/radio-uip-uaodv.c @@ -0,0 +1,204 @@ +/* + * Copyright (c) 2007, Swedish Institute of Computer Science + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. Neither the name of the Institute nor the names of its contributors + * may be used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + * This file is part of the Contiki operating system. + * + * @(#)$Id: radio-uip-uaodv.c,v 1.1 2007/05/19 14:25:43 fros4943 Exp $ + */ + +#include "radio-uip-uaodv.h" +#include "net/hc.h" +#include "net/uip.h" +#include "net/uaodv.h" +#include "net/uaodv-rt.h" +#include "net/uaodv-def.h" +#include +#include + +static const struct radio_driver *radio; + +#define uip_udp_sender() (&((struct uip_udpip_hdr *)&uip_buf[UIP_LLH_LEN])->srcipaddr) + +#define HEADER_ID_LENGTH strlen(uniqueID) +#define HEADER_NEXT_FWD HEADER_ID_LENGTH +#define HEADER_LENGTH HEADER_NEXT_FWD + 4 +static char* uniqueID = "fWd:"; + +static struct uaodv_rt_entry *route; + +/*---------------------------------------------------------------------------*/ +int radio_uip_uaodv_add_header(u8_t *buf, int len, uip_ipaddr_t *addr); +int radio_uip_uaodv_remove_header(u8_t *buf, int len); +void radio_uip_uaodv_change_header(u8_t *buf, int len, uip_ipaddr_t *addr); +int radio_uip_uaodv_header_exists(u8_t *buf, int len); +int radio_uip_uaodv_is_broadcast(uip_ipaddr_t *addr); +int radio_uip_uaodv_fwd_is_broadcast(u8_t *buf, int len); +int radio_uip_uaodv_fwd_is_me(u8_t *buf, int len); +int radio_uip_uaodv_dest_is_me(u8_t *buf, int len); +int radio_uip_uaodv_dest_port(u8_t *buf, int len); +/*---------------------------------------------------------------------------*/ +static void +receiver(const struct radio_driver *d) +{ + uip_len = d->read(&uip_buf[UIP_LLH_LEN], UIP_BUFSIZE - UIP_LLH_LEN); + if (uip_len <= 0) { + return; + } + + /* If no uAODV header, receive as usual */ + if (!radio_uip_uaodv_header_exists(&uip_buf[UIP_LLH_LEN], uip_len)) { + uip_len = hc_inflate(&uip_buf[UIP_LLH_LEN], uip_len); + tcpip_input(); + return; + } + + /* If broadcast packet, strip header and receive without forwarding */ + if (radio_uip_uaodv_fwd_is_broadcast(&uip_buf[UIP_LLH_LEN], uip_len)) { + /* Strip header and receive */ + uip_len = radio_uip_uaodv_remove_header(&uip_buf[UIP_LLH_LEN], uip_len); + uip_len = hc_inflate(&uip_buf[UIP_LLH_LEN], uip_len); + tcpip_input(); + return; + } + + /* Drop packet unless we are the uAODV forwarder */ + if (!radio_uip_uaodv_fwd_is_me(&uip_buf[UIP_LLH_LEN], uip_len)) { + return; + } + + /* If we are final destination, strip header and receive */ + if (radio_uip_uaodv_dest_is_me(&uip_buf[UIP_LLH_LEN], uip_len)) { + uip_len = radio_uip_uaodv_remove_header(&uip_buf[UIP_LLH_LEN], uip_len); + uip_len = hc_inflate(&uip_buf[UIP_LLH_LEN], uip_len); + tcpip_input(); + return; + } + + /* Find new uAODV forwarder and forward packet */ + /* TODO TTL? Hop-count? */ + /* TODO Assuming uAODV already knows a path */ + route = uaodv_rt_lookup((&((struct uip_udpip_hdr *)&uip_buf[UIP_LLH_LEN + HEADER_LENGTH])->destipaddr)); + if (route != NULL) { + radio_uip_uaodv_change_header(&uip_buf[UIP_LLH_LEN], uip_len, &route->nexthop); + d->send(&uip_buf[UIP_LLH_LEN], uip_len); + } + +} +/*---------------------------------------------------------------------------*/ +u8_t +radio_uip_uaodv_send(void) +{ + /* uAODV process messages should be sent as usual */ + if (radio_uip_uaodv_dest_port(&uip_buf[UIP_LLH_LEN], uip_len) == HTONS(UAODV_UDPPORT)) { + uip_len = hc_compress(&uip_buf[UIP_LLH_LEN], uip_len); + return radio->send(&uip_buf[UIP_LLH_LEN], uip_len); + } + + if (radio_uip_uaodv_is_broadcast(uip_udp_sender())) { + uip_len = hc_compress(&uip_buf[UIP_LLH_LEN], uip_len); + + /* We can use the broadcast address immediately */ + uip_len = radio_uip_uaodv_add_header(&uip_buf[UIP_LLH_LEN], uip_len, uip_udp_sender()); /* TODO Correct? */ + } else { + uip_len = hc_compress(&uip_buf[UIP_LLH_LEN], uip_len); + + /* Fetch uAODV route (must be prepared!) */ + route = uaodv_rt_lookup((&((struct uip_udpip_hdr *)&uip_buf[UIP_LLH_LEN])->destipaddr)); + if (route == NULL) return UIP_FW_NOROUTE; + uip_len = radio_uip_uaodv_add_header(&uip_buf[UIP_LLH_LEN], uip_len, &route->nexthop); /* TODO Correct? */ + } + + return radio->send(&uip_buf[UIP_LLH_LEN], uip_len); +} +/*---------------------------------------------------------------------------*/ +void +radio_uip_uaodv_init(const struct radio_driver *d) +{ + radio = d; + radio->set_receive_function(receiver); + radio->on();} +/*---------------------------------------------------------------------------*/ +int +radio_uip_uaodv_add_header(u8_t *buf, int len, uip_ipaddr_t *addr) +{ + memcpy(&buf[HEADER_LENGTH], buf, len); + memcpy(buf, uniqueID, HEADER_ID_LENGTH); + memcpy(&buf[HEADER_NEXT_FWD], (char*)addr, 4); + return HEADER_LENGTH + len; +} +/*---------------------------------------------------------------------------*/ +int +radio_uip_uaodv_remove_header(u8_t *buf, int len) +{ + memcpy(buf, &buf[HEADER_LENGTH], len); + return HEADER_LENGTH + len; + return len - HEADER_LENGTH; +} +/*---------------------------------------------------------------------------*/ +void +radio_uip_uaodv_change_header(u8_t *buf, int len, uip_ipaddr_t *addr) +{ + memcpy(&buf[HEADER_NEXT_FWD], addr, 4); +} +/*---------------------------------------------------------------------------*/ +int +radio_uip_uaodv_header_exists(u8_t *buf, int len) +{ + return !memcmp(buf, uniqueID, HEADER_ID_LENGTH); +} +/*---------------------------------------------------------------------------*/ +int +radio_uip_uaodv_is_broadcast(uip_ipaddr_t *addr) +{ + return ((u8_t*)addr)[3] == 255; /* TODO Only comparing with the last */ +} +/*---------------------------------------------------------------------------*/ +int +radio_uip_uaodv_fwd_is_broadcast(u8_t *buf, int len) +{ + return radio_uip_uaodv_is_broadcast((uip_ipaddr_t*) &buf[HEADER_NEXT_FWD]); +} +/*---------------------------------------------------------------------------*/ +int +radio_uip_uaodv_fwd_is_me(u8_t *buf, int len) +{ + return !memcmp(&buf[HEADER_NEXT_FWD], &uip_hostaddr, 4); +} +/*---------------------------------------------------------------------------*/ +int +radio_uip_uaodv_dest_is_me(u8_t *buf, int len) +{ + return !memcmp((&((struct uip_udpip_hdr *)&buf[HEADER_LENGTH])->destipaddr), &uip_hostaddr, 4); +} +/*---------------------------------------------------------------------------*/ +int +radio_uip_uaodv_dest_port(u8_t *buf, int len) +{ + return (int) ((struct uip_udpip_hdr *)buf)->destport; +} +/*---------------------------------------------------------------------------*/ diff --git a/platform/cooja/net/radio-uip-uaodv.h b/platform/cooja/net/radio-uip-uaodv.h new file mode 100644 index 000000000..53faa8645 --- /dev/null +++ b/platform/cooja/net/radio-uip-uaodv.h @@ -0,0 +1,46 @@ +/* + * Copyright (c) 2007, Swedish Institute of Computer Science + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. Neither the name of the Institute nor the names of its contributors + * may be used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + * This file is part of the Contiki operating system. + * + * @(#)$Id: radio-uip-uaodv.h,v 1.1 2007/05/19 14:25:43 fros4943 Exp $ + */ + +#ifndef __RADIO_UIP_UAODV_H__ +#define __RADIO_UIP_UAODV_H__ + +#include "contiki.h" +#include "dev/radio.h" + +void +radio_uip_uaodv_init(const struct radio_driver *d); + +u8_t +radio_uip_uaodv_send(void); + +#endif /* __RADIO_UIP_UAODV_H__ */