/* * 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: chameleon-raw.c,v 1.2 2008/07/02 15:02:33 matsutsuka Exp $ */ /** * \file * A Chameleon module that produces non-optimized headers * \author * Adam Dunkels */ #include #include "net/rime/chameleon.h" #include "net/rime.h" #define DEBUG 0 #if DEBUG #include #define PRINTF(...) printf(__VA_ARGS__) #else #define PRINTF(...) #endif struct raw_hdr { uint16_t channel; }; /*---------------------------------------------------------------------------*/ static struct channel * input(void) { const struct rimebuf_attrlist *a; int byteptr, bitptr, len; uint8_t *hdrptr; struct raw_hdr *hdr; struct channel *c; /* The packet has a header that tells us what channel the packet is for. */ hdr = (struct raw_hdr *)rimebuf_dataptr(); rimebuf_hdrreduce(sizeof(struct raw_hdr)); c = channel_lookup(hdr->channel); if(c == NULL) { PRINTF("chameleon-raw: input: channel %d not found\n", hdr->channel); return NULL; } rimebuf_attr_clear(); hdrptr = rimebuf_dataptr(); rimebuf_hdrreduce(c->hdrsize); byteptr = bitptr = 0; for(a = c->attrlist; a->type != RIMEBUF_ATTR_NONE; ++a) { PRINTF("%d.%d: unpack_header type %s, len %d\n", rimeaddr_node_addr.u8[0], rimeaddr_node_addr.u8[1], rimebuf_attr_strings[a->type], a->len); len = (a->len & 0xf8) + ((a->len & 7) ? 8: 0); if(a->type == RIMEBUF_ADDR_SENDER || a->type == RIMEBUF_ADDR_RECEIVER || a->type == RIMEBUF_ADDR_ESENDER || a->type == RIMEBUF_ADDR_ERECEIVER) { const rimeaddr_t addr; memcpy((uint8_t *)&addr, &hdrptr[byteptr], len / 8); PRINTF("%d.%d: unpack_header type %s, addr %d.%d\n", rimeaddr_node_addr.u8[0], rimeaddr_node_addr.u8[1], rimebuf_attr_strings[a->type], addr.u8[0], addr.u8[1]); rimebuf_set_addr(a->type, &addr); } else { rimebuf_attr_t val = 0; memcpy((uint8_t *)&val, &hdrptr[byteptr], len / 8); rimebuf_set_attr(a->type, val); PRINTF("%d.%d: unpack_header type %s, val %d\n", rimeaddr_node_addr.u8[0], rimeaddr_node_addr.u8[1], rimebuf_attr_strings[a->type], val); } byteptr += len / 8; } return c; } /*---------------------------------------------------------------------------*/ static int output(struct channel *c) { const struct rimebuf_attrlist *a; int byteptr, len; uint8_t *hdrptr; struct raw_hdr *hdr; /* Compute the total size of the final header by summing the size of all attributes that are used on this channel. */ rimebuf_hdralloc(c->hdrsize); hdrptr = rimebuf_hdrptr(); byteptr = 0; for(a = c->attrlist; a->type != RIMEBUF_ATTR_NONE; ++a) { PRINTF("%d.%d: pack_header type %s, len %d\n", rimeaddr_node_addr.u8[0], rimeaddr_node_addr.u8[1], rimebuf_attr_strings[a->type], a->len); len = (a->len & 0xf8) + ((a->len & 7) ? 8: 0); if(a->type == RIMEBUF_ADDR_SENDER || a->type == RIMEBUF_ADDR_RECEIVER || a->type == RIMEBUF_ADDR_ESENDER || a->type == RIMEBUF_ADDR_ERECEIVER) { const rimeaddr_t *rimeaddr; /* memcpy(&hdrptr[byteptr], (uint8_t *)rimebuf_attr_aget(a->type), len / 8);*/ rimeaddr = rimebuf_addr(a->type); hdrptr[byteptr] = rimeaddr->u8[0]; hdrptr[byteptr + 1] = rimeaddr->u8[1]; PRINTF("%d.%d: address %d.%d\n", rimeaddr_node_addr.u8[0], rimeaddr_node_addr.u8[1], ((uint8_t *)rimebuf_addr(a->type))[0], ((uint8_t *)rimebuf_addr(a->type))[1]); } else { rimebuf_attr_t val; val = rimebuf_attr(a->type); hdrptr[byteptr] = rimebuf_attr(a->type); PRINTF("%d.%d: value %d\n", rimeaddr_node_addr.u8[0], rimeaddr_node_addr.u8[1], val); } byteptr += len / 8; } rimebuf_hdralloc(sizeof(struct raw_hdr)); hdr = (struct raw_hdr *)rimebuf_hdrptr(); hdr->channel = c->channelno; return 1; /* Send out packet */ } /*---------------------------------------------------------------------------*/ static int hdrsize(const struct rimebuf_attrlist *a) { int size, len; /* Compute the total size of the final header by summing the size of all attributes that are used on this channel. */ size = 0; for(; a->type != RIMEBUF_ATTR_NONE; ++a) { /* PRINTF("chameleon header_size: header type %s (%d) len %d\n", rimebuf_attr_strings[a->type], a->type, a->len);*/ len = a->len; if(len < 8) { len = 8; } size += len; } return size / 8; } /*---------------------------------------------------------------------------*/ CC_CONST_FUNCTION struct chameleon_module chameleon_raw = { input, output, hdrsize, NULL };