diff --git a/apps/rudolph/Makefile.rudolph b/apps/rudolph/Makefile.rudolph new file mode 100644 index 000000000..89eedf677 --- /dev/null +++ b/apps/rudolph/Makefile.rudolph @@ -0,0 +1 @@ +APP_SOURCES += rudolph0.c diff --git a/apps/rudolph/rudolph0.c b/apps/rudolph/rudolph0.c new file mode 100644 index 000000000..19acc72b4 --- /dev/null +++ b/apps/rudolph/rudolph0.c @@ -0,0 +1,212 @@ +/* + * 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: rudolph0.c,v 1.1 2007/03/20 12:25:27 adamdunkels Exp $ + */ + +/** + * \file + * Rudolph0: a simple block data flooding protocol + * \author + * Adam Dunkels + */ + +#include "net/rime.h" +#include "rudolph0.h" +#include "cfs/cfs.h" + +#include /* for offsetof */ + +#define SENDING_TIME CLOCK_SECOND / 2 +#define STEADY_TIME CLOCK_SECOND * 2 + +enum { + TYPE_DATA, + TYPE_NACK, +}; + +enum { + STATE_RECEIVER, + STATE_SENDER, +}; + +#define DEBUG 0 +#if DEBUG +#include +#define PRINTF(...) printf(__VA_ARGS__) +#else +#define PRINTF(...) +#endif + +/*---------------------------------------------------------------------------*/ +static void +read_new_datapacket(struct rudolph0_conn *c) +{ + int len; + + len = cfs_read(c->cfs_fd, c->current.data, RUDOLPH0_DATASIZE); + c->current.datalen = len; + + PRINTF("read_new_datapacket len %d\n", c->current.datalen); +} +/*---------------------------------------------------------------------------*/ +static void +send_nack(struct rudolph0_conn *c) +{ + struct rudolph0_hdr *hdr; + rimebuf_clear(); + rimebuf_hdrextend(sizeof(struct rudolph0_hdr)); + hdr = rimebuf_hdrptr(); + + hdr->type = TYPE_NACK; + hdr->version = c->current.h.version; + hdr->chunk = c->current.h.chunk; + + PRINTF("Sending nack for %d:%d\n", hdr->version, hdr->chunk); + uabc_send(&c->nackc, CLOCK_SECOND / 4); +} +/*---------------------------------------------------------------------------*/ +static void +sent(struct sabc_conn *sabc) +{ + struct rudolph0_conn *c = (struct rudolph0_conn *)sabc; + + if(c->current.datalen == RUDOLPH0_DATASIZE) { + c->current.h.chunk++; + PRINTF("Sending data chunk %d next time\n", c->current.h.chunk); + read_new_datapacket(c); + } else { + sabc_set_timer(&c->c, STEADY_TIME); + PRINTF("Sending the same data chunk next time datalen %d, %d\n", + c->current.datalen, RUDOLPH0_DATASIZE); + } +} +/*---------------------------------------------------------------------------*/ +static void +recv(struct sabc_conn *sabc) +{ + struct rudolph0_conn *c = (struct rudolph0_conn *)sabc; + struct rudolph0_datapacket *p = rimebuf_dataptr(); + + /* if(rand() & 1) { + return; + }*/ + + if(p->h.type == TYPE_DATA) { + if(p->h.version > c->current.h.version) { + PRINTF("rudolph0 new version %d\n", p->h.version); + c->cfs_fd = c->cb->new_file(c); + c->current.h.version = p->h.version; + c->current.h.chunk = 0; + if(c->cfs_fd != -1) { + if(p->h.chunk != 0) { + send_nack(c); + } else { + cfs_write(c->cfs_fd, p->data, p->datalen); + c->current.h.chunk++; + } + } + } else if(p->h.version == c->current.h.version) { + if(c->cfs_fd != -1) { + if(p->h.chunk == c->current.h.chunk) { + PRINTF("received chunk %d\n", p->h.chunk); + cfs_write(c->cfs_fd, p->data, p->datalen); + c->current.h.chunk++; + if(p->datalen < RUDOLPH0_DATASIZE) { + c->cb->received_file(c, c->cfs_fd); + } + } else if(p->h.chunk > c->current.h.chunk) { + PRINTF("received chunk %d > %d, sending NACK\n", p->h.chunk, c->current.h.chunk); + send_nack(c); + } + } + } else { /* p->h.version < c->current.h.version */ + /* Ignore packets with old version */ + } + } +} +/*---------------------------------------------------------------------------*/ +static void +recv_nack(struct uabc_conn *uabc) +{ + struct rudolph0_conn *c = (struct rudolph0_conn *) + ((char *)uabc - offsetof(struct rudolph0_conn, + nackc)); + struct rudolph0_datapacket *p = rimebuf_dataptr(); + + if(p->h.type == TYPE_NACK && c->state == STATE_SENDER) { + if(p->h.version == c->current.h.version) { + PRINTF("Reseting chunk to %d\n", p->h.chunk); + c->current.h.chunk = p->h.chunk; + cfs_seek(c->cfs_fd, c->current.h.chunk * RUDOLPH0_DATASIZE); + } else { + PRINTF("Wrong version, reseting chunk to 0\n"); + c->current.h.chunk = 0; + cfs_seek(c->cfs_fd, 0); + } + read_new_datapacket(c); + sabc_set_timer(&c->c, SENDING_TIME); + } +} +/*---------------------------------------------------------------------------*/ +static const struct uabc_callbacks uabc = { recv_nack, NULL, NULL }; +static const struct sabc_callbacks sabc = { recv, sent }; +/*---------------------------------------------------------------------------*/ +void +rudolph0_open(struct rudolph0_conn *c, u16_t channel, + const struct rudolph0_callbacks *cb) +{ + sabc_open(&c->c, channel, &sabc); + uabc_open(&c->nackc, channel + 1, &uabc); + c->cb = cb; + c->current.h.version = 0; + c->state = STATE_RECEIVER; +} +/*---------------------------------------------------------------------------*/ +void +rudolph0_close(struct rudolph0_conn *c) +{ + sabc_close(&c->c); + uabc_close(&c->nackc); +} +/*---------------------------------------------------------------------------*/ +void +rudolph0_send(struct rudolph0_conn *c, int cfs_fd) +{ + c->state = STATE_SENDER; + c->cfs_fd = cfs_fd; + c->current.h.version++; + c->current.h.chunk = 0; + c->current.h.type = TYPE_DATA; + read_new_datapacket(c); + rimebuf_reference(&c->current, sizeof(struct rudolph0_datapacket)); + sabc_send_stubborn(&c->c, SENDING_TIME); +} +/*---------------------------------------------------------------------------*/ diff --git a/apps/rudolph/rudolph0.h b/apps/rudolph/rudolph0.h new file mode 100644 index 000000000..20cf0fb96 --- /dev/null +++ b/apps/rudolph/rudolph0.h @@ -0,0 +1,84 @@ +/* + * 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: rudolph0.h,v 1.1 2007/03/20 12:25:27 adamdunkels Exp $ + */ + +/** + * \file + * A brief description of what this file is. + * \author + * Adam Dunkels + */ + +#ifndef __RUDOLPH0_H__ +#define __RUDOLPH0_H__ + +#include "net/rime.h" +#include "net/rime/sabc.h" +#include "net/rime/uabc.h" +#include "contiki-net.h" + +struct rudolph0_conn; + +struct rudolph0_callbacks { + int (* new_file)(struct rudolph0_conn *c); + void (* received_file)(struct rudolph0_conn *c, int cfs_fd); +}; + +#define RUDOLPH0_DATASIZE 32 + +struct rudolph0_hdr { + u8_t type; + u8_t version; + u16_t chunk; +}; + +struct rudolph0_datapacket { + struct rudolph0_hdr h; + u8_t datalen; + u8_t data[RUDOLPH0_DATASIZE]; +}; + +struct rudolph0_conn { + struct sabc_conn c; + struct uabc_conn nackc; + const struct rudolph0_callbacks *cb; + int cfs_fd; + u8_t state; + struct rudolph0_datapacket current; +}; + +void rudolph0_open(struct rudolph0_conn *c, u16_t channel, + const struct rudolph0_callbacks *cb); +void rudolph0_close(struct rudolph0_conn *c); +void rudolph0_send(struct rudolph0_conn *c, int cfs_fd); + +#endif /* __RUDOLPH0_H__ */