osd-contiki/core/net/rime/netflood.c

185 lines
5.8 KiB
C
Raw Normal View History

2007-03-31 20:31:27 +02:00
/**
2008-07-04 00:25:22 +02:00
* \addtogroup rimenetflood
2007-03-31 20:31:27 +02:00
* @{
*/
/*
* Copyright (c) 2006, 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.
*
*/
/**
* \file
2008-07-04 00:25:22 +02:00
* Best-effort network flooding (netflood)
* \author
* Adam Dunkels <adam@sics.se>
*/
2008-07-04 00:25:22 +02:00
#include "net/rime/netflood.h"
#include <string.h>
#define HOPS_MAX 16
2008-07-04 00:25:22 +02:00
struct netflood_hdr {
uint16_t originator_seqno;
rimeaddr_t originator;
uint16_t hops;
};
2007-11-28 21:03:50 +01:00
#define DEBUG 0
2007-03-22 19:53:38 +01:00
#if DEBUG
#include <stdio.h>
#define PRINTF(...) printf(__VA_ARGS__)
#else
#define PRINTF(...)
#endif
/*---------------------------------------------------------------------------*/
static int
2008-07-04 00:25:22 +02:00
send(struct netflood_conn *c)
{
2008-07-04 00:25:22 +02:00
PRINTF("%d.%d: netflood send to ipolite\n",
2007-05-15 10:09:21 +02:00
rimeaddr_node_addr.u8[0], rimeaddr_node_addr.u8[1]);
return ipolite_send(&c->c, c->queue_time, 4);
}
/*---------------------------------------------------------------------------*/
static void
recv_from_ipolite(struct ipolite_conn *ipolite, const rimeaddr_t *from)
{
2008-07-04 00:25:22 +02:00
struct netflood_conn *c = (struct netflood_conn *)ipolite;
2009-11-09 09:22:40 +01:00
struct netflood_hdr hdr;
uint8_t hops;
struct queuebuf *queuebuf;
2009-11-09 09:22:40 +01:00
memcpy(&hdr, packetbuf_dataptr(), sizeof(struct netflood_hdr));
hops = hdr.hops;
/* Remember packet if we need to forward it. */
queuebuf = queuebuf_new_from_packetbuf();
packetbuf_hdrreduce(sizeof(struct netflood_hdr));
if(c->u->recv != NULL) {
2009-11-09 09:22:40 +01:00
if(!(rimeaddr_cmp(&hdr.originator, &c->last_originator) &&
hdr.originator_seqno <= c->last_originator_seqno)) {
2009-11-09 09:22:40 +01:00
if(c->u->recv(c, from, &hdr.originator, hdr.originator_seqno,
2007-03-15 10:56:30 +01:00
hops)) {
if(queuebuf != NULL) {
queuebuf_to_packetbuf(queuebuf);
queuebuf_free(queuebuf);
queuebuf = NULL;
2009-11-09 09:22:40 +01:00
memcpy(&hdr, packetbuf_dataptr(), sizeof(struct netflood_hdr));
/* Rebroadcast received packet. */
if(hops < HOPS_MAX) {
2008-07-04 00:25:22 +02:00
PRINTF("%d.%d: netflood rebroadcasting %d.%d/%d (%d.%d/%d) hops %d\n",
2007-03-22 19:53:38 +01:00
rimeaddr_node_addr.u8[0], rimeaddr_node_addr.u8[1],
2009-11-09 09:22:40 +01:00
hdr.originator.u8[0], hdr.originator.u8[1],
hdr.originator_seqno,
2007-03-22 19:53:38 +01:00
c->last_originator.u8[0], c->last_originator.u8[1],
c->last_originator_seqno,
hops);
2009-11-09 09:22:40 +01:00
hdr.hops++;
memcpy(packetbuf_dataptr(), &hdr, sizeof(struct netflood_hdr));
2007-05-15 10:09:21 +02:00
send(c);
2009-11-09 09:22:40 +01:00
rimeaddr_copy(&c->last_originator, &hdr.originator);
c->last_originator_seqno = hdr.originator_seqno;
}
}
}
}
}
if(queuebuf != NULL) {
queuebuf_free(queuebuf);
}
}
/*---------------------------------------------------------------------------*/
2007-05-15 10:09:21 +02:00
static void
sent(struct ipolite_conn *ipolite)
{
2008-07-04 00:25:22 +02:00
struct netflood_conn *c = (struct netflood_conn *)ipolite;
2007-05-15 10:09:21 +02:00
if(c->u->sent != NULL) {
c->u->sent(c);
}
}
/*---------------------------------------------------------------------------*/
static void
dropped(struct ipolite_conn *ipolite)
{
2008-07-04 00:25:22 +02:00
struct netflood_conn *c = (struct netflood_conn *)ipolite;
2007-05-15 10:09:21 +02:00
if(c->u->dropped != NULL) {
c->u->dropped(c);
}
}
/*---------------------------------------------------------------------------*/
2008-07-04 00:25:22 +02:00
static const struct ipolite_callbacks netflood = {recv_from_ipolite, sent, dropped};
/*---------------------------------------------------------------------------*/
void
2008-07-04 00:25:22 +02:00
netflood_open(struct netflood_conn *c, clock_time_t queue_time,
uint16_t channel, const struct netflood_callbacks *u)
{
ipolite_open(&c->c, channel, 1, &netflood);
c->u = u;
2007-03-25 14:06:28 +02:00
c->queue_time = queue_time;
}
/*---------------------------------------------------------------------------*/
void
2008-07-04 00:25:22 +02:00
netflood_close(struct netflood_conn *c)
{
2007-05-15 10:09:21 +02:00
ipolite_close(&c->c);
}
/*---------------------------------------------------------------------------*/
int
2008-07-04 00:25:22 +02:00
netflood_send(struct netflood_conn *c, uint8_t seqno)
{
if(packetbuf_hdralloc(sizeof(struct netflood_hdr))) {
struct netflood_hdr *hdr = packetbuf_hdrptr();
rimeaddr_copy(&hdr->originator, &rimeaddr_node_addr);
rimeaddr_copy(&c->last_originator, &hdr->originator);
2007-05-15 10:09:21 +02:00
c->last_originator_seqno = hdr->originator_seqno = seqno;
hdr->hops = 0;
2008-07-04 00:25:22 +02:00
PRINTF("%d.%d: netflood sending '%s'\n",
2007-05-15 10:09:21 +02:00
rimeaddr_node_addr.u8[0], rimeaddr_node_addr.u8[1],
(char *)packetbuf_dataptr());
return ipolite_send(&c->c, 0, 4);
}
return 0;
}
/*---------------------------------------------------------------------------*/
void
2008-07-04 00:25:22 +02:00
netflood_cancel(struct netflood_conn *c)
{
2007-05-15 10:09:21 +02:00
ipolite_cancel(&c->c);
}
/*---------------------------------------------------------------------------*/
2007-03-31 20:31:27 +02:00
/** @} */