157 lines
4.4 KiB
C
157 lines
4.4 KiB
C
/*
|
|
* 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.
|
|
*
|
|
*/
|
|
|
|
/**
|
|
* \file
|
|
* Chameleon, Rime's header processing module
|
|
* \author
|
|
* Adam Dunkels <adam@sics.se>
|
|
*/
|
|
|
|
#include "net/rime/chameleon.h"
|
|
#include "net/rime/channel.h"
|
|
#include "net/rime/rime.h"
|
|
#include "lib/list.h"
|
|
|
|
#include <stdio.h>
|
|
|
|
#ifndef CHAMELEON_MODULE
|
|
#ifdef CHAMELEON_CONF_MODULE
|
|
#define CHAMELEON_MODULE CHAMELEON_CONF_MODULE
|
|
#else /* CHAMELEON_CONF_MODULE */
|
|
#define CHAMELEON_MODULE chameleon_bitopt
|
|
#endif /* CHAMELEON_CONF_MODULE */
|
|
#endif /* CHAMELEON_MODULE */
|
|
|
|
extern const struct chameleon_module CHAMELEON_MODULE;
|
|
|
|
#define DEBUG 0
|
|
#if DEBUG
|
|
#include <stdio.h>
|
|
#define PRINTF(...) printf(__VA_ARGS__)
|
|
#else
|
|
#define PRINTF(...)
|
|
#endif
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
void
|
|
chameleon_init(void)
|
|
{
|
|
channel_init();
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|
|
#if DEBUG
|
|
static void
|
|
printbin(int n, int digits)
|
|
{
|
|
int i;
|
|
char output[128];
|
|
|
|
for(i = 0; i < digits; ++i) {
|
|
output[digits - i - 1] = (n & 1) + '0';
|
|
n >>= 1;
|
|
}
|
|
output[i] = 0;
|
|
|
|
printf(output);
|
|
}
|
|
|
|
static void
|
|
printhdr(uint8_t *hdr, int len)
|
|
{
|
|
int i, j;
|
|
|
|
j = 0;
|
|
for(i = 0; i < len; ++i) {
|
|
printbin(hdr[i], 8);
|
|
printf(" (0x%0x), ", hdr[i]);
|
|
++j;
|
|
if(j == 10) {
|
|
printf("\n");
|
|
j = 0;
|
|
}
|
|
}
|
|
|
|
if(j != 0) {
|
|
printf("\n");
|
|
}
|
|
}
|
|
#endif /* DEBUG */
|
|
/*---------------------------------------------------------------------------*/
|
|
struct channel *
|
|
chameleon_parse(void)
|
|
{
|
|
struct channel *c = NULL;
|
|
PRINTF("%d.%d: chameleon_input\n",
|
|
rimeaddr_node_addr.u8[0],rimeaddr_node_addr.u8[1]);
|
|
#if DEBUG
|
|
printhdr(packetbuf_dataptr(), packetbuf_datalen());
|
|
#endif /* DEBUG */
|
|
c = CHAMELEON_MODULE.input();
|
|
if(c != NULL) {
|
|
PRINTF("%d.%d: chameleon_input channel %d\n",
|
|
rimeaddr_node_addr.u8[0],rimeaddr_node_addr.u8[1],
|
|
c->channelno);
|
|
packetbuf_set_attr(PACKETBUF_ATTR_CHANNEL, c->channelno);
|
|
} else {
|
|
PRINTF("%d.%d: chameleon_input channel not found for incoming packet\n",
|
|
rimeaddr_node_addr.u8[0],rimeaddr_node_addr.u8[1]);
|
|
}
|
|
return c;
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|
|
int
|
|
chameleon_create(struct channel *c)
|
|
{
|
|
int ret;
|
|
|
|
PRINTF("%d.%d: chameleon_output channel %d\n",
|
|
rimeaddr_node_addr.u8[0],rimeaddr_node_addr.u8[1],
|
|
c->channelno);
|
|
|
|
ret = CHAMELEON_MODULE.output(c);
|
|
packetbuf_set_attr(PACKETBUF_ATTR_CHANNEL, c->channelno);
|
|
#if DEBUG
|
|
printhdr(packetbuf_hdrptr(), packetbuf_hdrlen());
|
|
#endif /* DEBUG */
|
|
if(ret) {
|
|
return 1;
|
|
}
|
|
return 0;
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|
|
int
|
|
chameleon_hdrsize(const struct packetbuf_attrlist attrlist[])
|
|
{
|
|
return CHAMELEON_MODULE.hdrsize(attrlist);
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|