interface CC2420Config;
interface ActiveMessageAddress;
interface RadioBackoff as SubBackoff;
+
+ interface Resource as RadioResource;
+ interface Leds;
}
}
implementation {
+ uint16_t pending_length;
+ message_t *pending_message = NULL;
+ /***************** Resource event ****************/
+ event void RadioResource.granted() {
+ uint8_t rc;
+ cc2420_header_t* header = call CC2420PacketBody.getHeader( pending_message );
+
+ signal SendNotifier.aboutToSend[header->type](header->dest, pending_message);
+ rc = call SubSend.send( pending_message, pending_length );
+ if (rc != SUCCESS) {
+ call RadioResource.release();
+ signal AMSend.sendDone[header->type]( pending_message, rc );
+ }
+ }
/***************** AMSend Commands ****************/
command error_t AMSend.send[am_id_t id](am_addr_t addr,
header->destpan = call CC2420Config.getPanAddr();
header->src = call AMPacket.address();
- signal SendNotifier.aboutToSend[id](addr, msg);
-
- return call SubSend.send( msg, len );
+ if (call RadioResource.immediateRequest() == SUCCESS) {
+ error_t rc;
+ signal SendNotifier.aboutToSend[id](addr, msg);
+
+ rc = call SubSend.send( msg, len );
+ if (rc != SUCCESS) {
+ call RadioResource.release();
+ }
+
+ return rc;
+ } else {
+ pending_length = len;
+ pending_message = msg;
+ return call RadioResource.request();
+ }
}
command error_t AMSend.cancel[am_id_t id](message_t* msg) {
}
command uint8_t Packet.payloadLength(message_t* msg) {
- return (call CC2420PacketBody.getHeader(msg))->length - CC2420_SIZE;
+ return (call CC2420PacketBody.getHeader(msg))->length - CC2420_SIZE - AM_OVERHEAD;
}
command void Packet.setPayloadLength(message_t* msg, uint8_t len) {
- (call CC2420PacketBody.getHeader(msg))->length = len + CC2420_SIZE;
+ (call CC2420PacketBody.getHeader(msg))->length = len + CC2420_SIZE + AM_OVERHEAD;
}
command uint8_t Packet.maxPayloadLength() {
- return TOSH_DATA_LENGTH;
+ return call SubSend.maxPayloadLength();
}
command void* Packet.getPayload(message_t* msg, uint8_t len) {
/***************** SubSend Events ****************/
event void SubSend.sendDone(message_t* msg, error_t result) {
+ call RadioResource.release();
signal AMSend.sendDone[call AMPacket.type(msg)](msg, result);
}
/***************** SubReceive Events ****************/
event message_t* SubReceive.receive(message_t* msg, void* payload, uint8_t len) {
- if(!(call CC2420PacketBody.getMetadata(msg))->crc) {
- return msg;
- }
-
if (call AMPacket.isForMe(msg)) {
return signal Receive.receive[call AMPacket.type(msg)](msg, payload, len);
}
async command void RadioBackoff.setCca[am_id_t amId](bool useCca) {
call SubBackoff.setCca(useCca);
}
-
-
/***************** Defaults ****************/
default event message_t* Receive.receive[am_id_t id](message_t* msg, void* payload, uint8_t len) {
}
default event void AMSend.sendDone[uint8_t id](message_t* msg, error_t err) {
+ call RadioResource.release();
}
default event void SendNotifier.aboutToSend[am_id_t amId](am_addr_t addr, message_t *msg) {