-/* tab:4
+/*
* "Copyright (c) 2005 Stanford University. All rights reserved.
*
* Permission to use, copy, modify, and distribute this software and
#include "CC2420.h"
-module CC2420ActiveMessageP {
+module CC2420ActiveMessageP @safe() {
provides {
interface AMSend[am_id_t id];
interface Receive[am_id_t id];
}
implementation {
- enum {
- CC2420_SIZE = MAC_HEADER_SIZE + MAC_FOOTER_SIZE,
- };
-
/***************** AMSend Commands ****************/
command error_t AMSend.send[am_id_t id](am_addr_t addr,
message_t* msg,
uint8_t len) {
cc2420_header_t* header = call CC2420PacketBody.getHeader( msg );
+
+ if (len > call Packet.maxPayloadLength()) {
+ return ESIZE;
+ }
+
header->type = id;
header->dest = addr;
header->destpan = call CC2420Config.getPanAddr();
signal SendNotifier.aboutToSend[id](addr, msg);
- return call SubSend.send( msg, len + CC2420_SIZE );
+ return call SubSend.send( msg, len );
}
command error_t AMSend.cancel[am_id_t id](message_t* msg) {
}
if (call AMPacket.isForMe(msg)) {
- return signal Receive.receive[call AMPacket.type(msg)](msg, payload, len - CC2420_SIZE);
+ return signal Receive.receive[call AMPacket.type(msg)](msg, payload, len);
}
else {
- return signal Snoop.receive[call AMPacket.type(msg)](msg, payload, len - CC2420_SIZE);
+ return signal Snoop.receive[call AMPacket.type(msg)](msg, payload, len);
}
}
/***************** RadioBackoff ***********************/
async event void SubBackoff.requestInitialBackoff(message_t *msg) {
- signal RadioBackoff.requestInitialBackoff[((cc2420_header_t*)(msg->data -
- sizeof(cc2420_header_t)))->type](msg);
+ signal RadioBackoff.requestInitialBackoff[(TCAST(cc2420_header_t* ONE,
+ (uint8_t*)msg + offsetof(message_t, data) - sizeof(cc2420_header_t)))->type](msg);
}
async event void SubBackoff.requestCongestionBackoff(message_t *msg) {
- signal RadioBackoff.requestCongestionBackoff[((cc2420_header_t*)(msg->data -
- sizeof(cc2420_header_t)))->type](msg);
+ signal RadioBackoff.requestCongestionBackoff[(TCAST(cc2420_header_t* ONE,
+ (uint8_t*)msg + offsetof(message_t, data) - sizeof(cc2420_header_t)))->type](msg);
}
async event void SubBackoff.requestCca(message_t *msg) {
// Lower layers than this do not configure the CCA settings
- signal RadioBackoff.requestCca[((cc2420_header_t*)(msg->data -
- sizeof(cc2420_header_t)))->type](msg);
+ signal RadioBackoff.requestCca[(TCAST(cc2420_header_t* ONE,
+ (uint8_t*)msg + offsetof(message_t, data) - sizeof(cc2420_header_t)))->type](msg);
}
async command void RadioBackoff.setInitialBackoff[am_id_t amId](uint16_t backoffTime) {