TinyOS Programming

下面我们来看一下模块BaseStationP的代码：

module BaseStationP @safe() { uses {

interface Boot;

interface SplitControl as SerialControl; interface SplitControl as RadioControl;

interface AMSend as UartSend[am_id_t id]; interface Receive as UartReceive[am_id_t id]; interface Packet as UartPacket;

interface AMPacket as UartAMPacket;

interface AMSend as RadioSend[am_id_t id]; interface Receive as RadioReceive[am_id_t id]; interface Receive as RadioSnoop[am_id_t id]; interface Packet as RadioPacket;

interface AMPacket as RadioAMPacket; interface Leds; } }

implementation {

enum {

UART_QUEUE_LEN = 12, RADIO_QUEUE_LEN = 12, };

message_t uartQueueBufs[UART_QUEUE_LEN];

message_t * ONE_NOK uartQueue[UART_QUEUE_LEN]; uint8_t uartIn, uartOut; bool uartBusy, uartFull;

message_t radioQueueBufs[RADIO_QUEUE_LEN];

message_t * ONE_NOK radioQueue[RADIO_QUEUE_LEN]; uint8_t radioIn, radioOut; bool radioBusy, radioFull;

task void uartSendTask(); task void radioSendTask();

void dropBlink() {

call Leds.led2Toggle(); }

void failBlink() {

call Leds.led2Toggle(); }

event void Boot.booted() { uint8_t i;

for (i = 0; i < UART_QUEUE_LEN; i++) uartQueue[i] = &uartQueueBufs[i]; uartIn = uartOut = 0; uartBusy = FALSE; uartFull = TRUE;

for (i = 0; i < RADIO_QUEUE_LEN; i++) radioQueue[i] = &radioQueueBufs[i]; radioIn = radioOut = 0; radioBusy = FALSE; radioFull = TRUE;

Page 46 of 94

TinyOS Programming

call RadioControl.start(); call SerialControl.start(); }

event void RadioControl.startDone(error_t error) { if (error == SUCCESS) { radioFull = FALSE; } }

event void SerialControl.startDone(error_t error) { if (error == SUCCESS) { uartFull = FALSE; } }

event void SerialControl.stopDone(error_t error) {} event void RadioControl.stopDone(error_t error) {} uint8_t count = 0;

message_t* ONE receive(message_t* ONE msg, void* payload, uint8_t len);

event message_t *RadioSnoop.receive[am_id_t id](message_t *msg, void *payload, uint8_t len) { return receive(msg, payload, len); }

event message_t *RadioReceive.receive[am_id_t id](message_t *msg, void *payload, uint8_t len) { return receive(msg, payload, len); }

message_t* receive(message_t *msg, void *payload, uint8_t len) { message_t *ret = msg; atomic {

if (!uartFull) { ret = uartQueue[uartIn]; uartQueue[uartIn] = msg; uartIn = (uartIn + 1) % UART_QUEUE_LEN; if (uartIn == uartOut) uartFull = TRUE; if (!uartBusy) { post uartSendTask(); uartBusy = TRUE; } } else dropBlink(); }

return ret; }

uint8_t tmpLen;

task void uartSendTask() { uint8_t len; am_id_t id;

am_addr_t addr, src; message_t* msg; atomic

if (uartIn == uartOut && !uartFull)

Page 47 of 94