--- /dev/null
+/*
+ * Copyright (c) 2005-2006 Arch Rock Corporation
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * - Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * - 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.
+ * - Neither the name of the Arch Rock Corporation 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 COPYRIGHT HOLDERS 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
+ * ARCHED ROCK OR ITS 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
+ */
+
+/**
+ * @author Jonathan Hui <jhui@archrock.com>
+ * @author David Moss
+ * @author Chad Metcalf
+ */
+
+#include "IEEE802154.h"
+#include "message.h"
+#include "CC2420.h"
+
+module CC2420PacketP {
+
+ provides {
+ interface CC2420Packet;
+ interface PacketAcknowledgements as Acks;
+ interface CC2420PacketBody;
+ interface LinkPacketMetadata;
+
+ interface PacketTimeStamp<T32khz, uint32_t> as PacketTimeStamp32khz;
+ interface PacketTimeStamp<TMilli, uint32_t> as PacketTimeStampMilli;
+ interface PacketTimeSyncOffset;
+ }
+
+ uses interface Packet;
+ uses interface LocalTime<T32khz> as LocalTime32khz;
+ uses interface LocalTime<TMilli> as LocalTimeMilli;
+}
+
+implementation {
+
+
+ /***************** PacketAcknowledgement Commands ****************/
+ async command error_t Acks.requestAck( message_t* p_msg ) {
+ (call CC2420PacketBody.getHeader( p_msg ))->fcf |= 1 << IEEE154_FCF_ACK_REQ;
+ return SUCCESS;
+ }
+
+ async command error_t Acks.noAck( message_t* p_msg ) {
+ (call CC2420PacketBody.getHeader( p_msg ))->fcf &= ~(1 << IEEE154_FCF_ACK_REQ);
+ return SUCCESS;
+ }
+
+ async command bool Acks.wasAcked( message_t* p_msg ) {
+ return (call CC2420PacketBody.getMetadata( p_msg ))->ack;
+ }
+
+ /***************** CC2420Packet Commands ****************/
+ async command void CC2420Packet.setPower( message_t* p_msg, uint8_t power ) {
+ if ( power > 31 )
+ power = 31;
+ (call CC2420PacketBody.getMetadata( p_msg ))->tx_power = power;
+ }
+
+ async command uint8_t CC2420Packet.getPower( message_t* p_msg ) {
+ return (call CC2420PacketBody.getMetadata( p_msg ))->tx_power;
+ }
+
+ async command int8_t CC2420Packet.getRssi( message_t* p_msg ) {
+ return (call CC2420PacketBody.getMetadata( p_msg ))->rssi;
+ }
+
+ async command uint8_t CC2420Packet.getLqi( message_t* p_msg ) {
+ return (call CC2420PacketBody.getMetadata( p_msg ))->lqi;
+ }
+
+ /***************** CC2420PacketBody Commands ****************/
+ async command cc2420_header_t * ONE CC2420PacketBody.getHeader( message_t* ONE msg ) {
+ return TCAST(cc2420_header_t* ONE, (uint8_t *)msg + offsetof(message_t, data) - sizeof( cc2420_header_t ));
+ }
+
+ async command cc2420_metadata_t *CC2420PacketBody.getMetadata( message_t* msg ) {
+ return (cc2420_metadata_t*)msg->metadata;
+ }
+
+ async command bool LinkPacketMetadata.highChannelQuality(message_t* msg) {
+ return call CC2420Packet.getLqi(msg) > 105;
+ }
+
+ /***************** PacketTimeStamp32khz Commands ****************/
+ async command bool PacketTimeStamp32khz.isValid(message_t* msg)
+ {
+ return ((call CC2420PacketBody.getMetadata( msg ))->timestamp != CC2420_INVALID_TIMESTAMP);
+ }
+
+ async command uint32_t PacketTimeStamp32khz.timestamp(message_t* msg)
+ {
+ return (call CC2420PacketBody.getMetadata( msg ))->timestamp;
+ }
+
+ async command void PacketTimeStamp32khz.clear(message_t* msg)
+ {
+ (call CC2420PacketBody.getMetadata( msg ))->timesync = FALSE;
+ (call CC2420PacketBody.getMetadata( msg ))->timestamp = CC2420_INVALID_TIMESTAMP;
+ }
+
+ async command void PacketTimeStamp32khz.set(message_t* msg, uint32_t value)
+ {
+ (call CC2420PacketBody.getMetadata( msg ))->timestamp = value;
+ }
+
+ /***************** PacketTimeStampMilli Commands ****************/
+ // over the air value is always T32khz, which is used to capture SFD interrupt
+ // (Timer1 on micaZ, B1 on telos)
+ async command bool PacketTimeStampMilli.isValid(message_t* msg)
+ {
+ return call PacketTimeStamp32khz.isValid(msg);
+ }
+
+ async command uint32_t PacketTimeStampMilli.timestamp(message_t* msg)
+ {
+ int32_t offset = call PacketTimeStamp32khz.timestamp(msg) - call LocalTime32khz.get();
+ return (offset >> 5) + call LocalTimeMilli.get();
+ }
+
+ async command void PacketTimeStampMilli.clear(message_t* msg)
+ {
+ call PacketTimeStamp32khz.clear(msg);
+ }
+
+ async command void PacketTimeStampMilli.set(message_t* msg, uint32_t value)
+ {
+ int32_t offset = (value - call LocalTimeMilli.get()) << 5;
+ call PacketTimeStamp32khz.set(msg, offset + call LocalTime32khz.get());
+ }
+ /*----------------- PacketTimeSyncOffset -----------------*/
+ async command bool PacketTimeSyncOffset.isSet(message_t* msg)
+ {
+ return ((call CC2420PacketBody.getMetadata( msg ))->timesync);
+ }
+
+ async command uint8_t PacketTimeSyncOffset.get(message_t* msg)
+ {
+ // minus 1 because one less byte is transmitted
+ return (call CC2420PacketBody.getHeader(msg))->length - 1 - sizeof(uint32_t);
+ }
+
+ async command void PacketTimeSyncOffset.set(message_t* msg)
+ {
+ (call CC2420PacketBody.getMetadata( msg ))->timesync = TRUE;
+ }
+
+ async command void PacketTimeSyncOffset.cancel(message_t* msg)
+ {
+ (call CC2420PacketBody.getMetadata( msg ))->timesync = FALSE;
+ }
+}