--- /dev/null
+/*
+ * Copyright (c) 2008, Technische Universitaet Berlin
+ * 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 Technische Universitaet Berlin 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 COPYRIGHT
+ * OWNER 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.
+ *
+ * - Revision -------------------------------------------------------------
+ * $Revision$
+ * $Date$
+ * @author: Jan Hauer <hauer@tkn.tu-berlin.de>
+ * ========================================================================
+ */
+
+#include "TKN154.h"
+#include "app_profile.h"
+module TestDeviceSenderC
+{
+ uses {
+ interface Boot;
+ interface MCPS_DATA;
+ interface MLME_RESET;
+ interface MLME_SET;
+ interface MLME_GET;
+ interface MLME_SCAN;
+ interface MLME_SYNC;
+ interface MLME_BEACON_NOTIFY;
+ interface MLME_SYNC_LOSS;
+ interface IEEE154Frame as Frame;
+ interface IEEE154BeaconFrame as BeaconFrame;
+ interface Leds;
+ interface Packet;
+ }
+} implementation {
+
+ message_t m_frame;
+ uint8_t m_payloadLen;
+ ieee154_PANDescriptor_t m_PANDescriptor;
+ bool m_ledCount;
+ bool m_wasScanSuccessful;
+
+ void startApp();
+ task void packetSendTask();
+
+
+ event void Boot.booted() {
+ char payload[] = "Hello Coordinator!";
+ uint8_t *payloadRegion;
+
+ m_payloadLen = strlen(payload);
+ payloadRegion = call Packet.getPayload(&m_frame, m_payloadLen);
+ if (m_payloadLen <= call Packet.maxPayloadLength()){
+ memcpy(payloadRegion, payload, m_payloadLen);
+ call MLME_RESET.request(TRUE);
+ }
+ }
+
+ event void MLME_RESET.confirm(ieee154_status_t status)
+ {
+ if (status == IEEE154_SUCCESS)
+ startApp();
+ }
+
+ void startApp()
+ {
+ ieee154_phyChannelsSupported_t channelMask;
+ uint8_t scanDuration = BEACON_ORDER;
+
+ call MLME_SET.phyTransmitPower(TX_POWER);
+ call MLME_SET.macShortAddress(TOS_NODE_ID);
+
+ // scan only the channel where we expect the coordinator
+ channelMask = ((uint32_t) 1) << RADIO_CHANNEL;
+
+ // we want all received beacons to be signalled
+ // through the MLME_BEACON_NOTIFY interface, i.e.
+ // we set the macAutoRequest attribute to FALSE
+ call MLME_SET.macAutoRequest(FALSE);
+ m_wasScanSuccessful = FALSE;
+ call MLME_SCAN.request (
+ PASSIVE_SCAN, // ScanType
+ channelMask, // ScanChannels
+ scanDuration, // ScanDuration
+ 0x00, // ChannelPage
+ 0, // EnergyDetectListNumEntries
+ NULL, // EnergyDetectList
+ 0, // PANDescriptorListNumEntries
+ NULL, // PANDescriptorList
+ 0 // security
+ );
+ }
+
+ event message_t* MLME_BEACON_NOTIFY.indication (message_t* frame)
+ {
+ // received a beacon frame
+ ieee154_phyCurrentPage_t page = call MLME_GET.phyCurrentPage();
+ ieee154_macBSN_t beaconSequenceNumber = call BeaconFrame.getBSN(frame);
+
+ if (!m_wasScanSuccessful) {
+ // received a beacon during channel scanning
+ if (call BeaconFrame.parsePANDescriptor(
+ frame, RADIO_CHANNEL, page, &m_PANDescriptor) == SUCCESS) {
+ // let's see if the beacon is from our coordinator...
+ if (m_PANDescriptor.CoordAddrMode == ADDR_MODE_SHORT_ADDRESS &&
+ m_PANDescriptor.CoordPANId == PAN_ID &&
+ m_PANDescriptor.CoordAddress.shortAddress == COORDINATOR_ADDRESS){
+ // yes! wait until SCAN is finished, then syncronize to the beacons
+ m_wasScanSuccessful = TRUE;
+ }
+ }
+ } else {
+ // received a beacon during synchronization, toggle LED2
+ if (beaconSequenceNumber & 1)
+ call Leds.led2On();
+ else
+ call Leds.led2Off();
+ }
+
+ return frame;
+ }
+
+ event void MLME_SCAN.confirm (
+ ieee154_status_t status,
+ uint8_t ScanType,
+ uint8_t ChannelPage,
+ uint32_t UnscannedChannels,
+ uint8_t EnergyDetectListNumEntries,
+ int8_t* EnergyDetectList,
+ uint8_t PANDescriptorListNumEntries,
+ ieee154_PANDescriptor_t* PANDescriptorList
+ )
+ {
+ if (m_wasScanSuccessful) {
+ // we received a beacon from the coordinator before
+ call MLME_SET.macCoordShortAddress(m_PANDescriptor.CoordAddress.shortAddress);
+ call MLME_SET.macPANId(m_PANDescriptor.CoordPANId);
+ call MLME_SYNC.request(m_PANDescriptor.LogicalChannel, m_PANDescriptor.ChannelPage, TRUE);
+ call Frame.setAddressingFields(
+ &m_frame,
+ ADDR_MODE_SHORT_ADDRESS, // SrcAddrMode,
+ ADDR_MODE_SHORT_ADDRESS, // DstAddrMode,
+ m_PANDescriptor.CoordPANId, // DstPANId,
+ &m_PANDescriptor.CoordAddress, // DstAddr,
+ NULL // security
+ );
+ post packetSendTask();
+ } else
+ startApp();
+ }
+
+ task void packetSendTask()
+ {
+ if (!m_wasScanSuccessful)
+ return;
+ else if (call MCPS_DATA.request (
+ &m_frame, // frame,
+ m_payloadLen, // payloadLength,
+ 0, // msduHandle,
+ TX_OPTIONS_ACK // TxOptions,
+ ) != IEEE154_SUCCESS)
+ call Leds.led0On();
+ }
+
+ event void MCPS_DATA.confirm (
+ message_t *msg,
+ uint8_t msduHandle,
+ ieee154_status_t status,
+ uint32_t timestamp
+ )
+ {
+ if (status == IEEE154_SUCCESS && m_ledCount++ >= 20) {
+ m_ledCount = 0;
+ call Leds.led1Toggle();
+ }
+ post packetSendTask();
+ }
+
+ event void MLME_SYNC_LOSS.indication(
+ ieee154_status_t lossReason,
+ uint16_t PANId,
+ uint8_t LogicalChannel,
+ uint8_t ChannelPage,
+ ieee154_security_t *security)
+ {
+ m_wasScanSuccessful = FALSE;
+ call Leds.led1Off();
+ call Leds.led2Off();
+ }
+
+ event message_t* MCPS_DATA.indication (message_t* frame)
+ {
+ // we don't expect data
+ return frame;
+ }
+
+}
projects / tinyos-2.x.git / blobdiff