--- /dev/null
+/*
+ * @author IPP HURRAY http://www.hurray.isep.ipp.pt/art-wise
+ * @author Andre Cunha
+ *
+ */
+#include <Timer.h>
+#include "printfUART.h"
+
+module NWKM {
+
+//uses
+ uses interface Leds;
+
+ //MAC interfaces
+
+ uses interface MLME_START;
+
+ uses interface MLME_GET;
+ uses interface MLME_SET;
+
+ uses interface MLME_BEACON_NOTIFY;
+ uses interface MLME_GTS;
+
+ uses interface MLME_ASSOCIATE;
+ uses interface MLME_DISASSOCIATE;
+
+ uses interface MLME_ORPHAN;
+
+ uses interface MLME_SYNC;
+ uses interface MLME_SYNC_LOSS;
+
+ uses interface MLME_RESET;
+
+ uses interface MLME_SCAN;
+
+
+ uses interface MCPS_DATA;
+
+
+ uses interface Random;
+
+//provides
+
+ provides interface Init;
+ provides interface NLDE_DATA;
+
+ //NLME NWK Management services
+ provides interface NLME_NETWORK_FORMATION;
+ provides interface NLME_NETWORK_DISCOVERY;
+ provides interface NLME_START_ROUTER;
+ provides interface NLME_JOIN;
+ provides interface NLME_LEAVE;
+ provides interface NLME_SYNC;
+
+ /*
+ provides interface NLME_PERMIT_JOINING;
+ provides interface NLME_DIRECT_JOIN;
+ provides interface NLME_RESET;
+*/
+ provides interface NLME_GET;
+ provides interface NLME_SET;
+
+
+}
+implementation {
+
+
+ nwkIB nwk_IB;
+
+ uint8_t device_type = END_DEVICE;
+
+/*****************************************************/
+/*************Neighbourtable Variables****************/
+/*****************************************************/
+
+ //neighbour table array:
+ neighbortableentry neighbortable[NEIGHBOUR_TABLE_SIZE];
+ //number of neigbourtable entries:
+ uint8_t neighbour_count;
+ //the index of the parents neighbortable entry
+ uint8_t parent;
+
+
+/*****************************************************/
+/****************ASSOCIATION Variables********************/
+/*****************************************************/
+
+ //CURRENT NETWORK ADDRESS
+ uint16_t networkaddress=0x0000;
+
+ //COORDINATOR
+ //address assignement variables
+ uint8_t depth=0;
+ uint8_t cskip=0;
+
+ uint8_t cskip_routing=0;
+
+ //neighbour table parent index
+ uint8_t parent_index;
+
+ //NON COORDINATOR
+
+ //current pan characteristics
+ uint16_t panid;
+ uint8_t beaconorder;
+ uint8_t superframeorder;
+
+ //next child router address
+ uint16_t next_child_router_address;
+ uint8_t number_child_router=0x01;
+ uint8_t number_child_end_devices=0x01;
+/*****************************************************/
+/****************Integer Variables********************/
+/*****************************************************/
+
+ uint8_t joined=0;
+ uint8_t sync_loss=0;
+ //uint8_t synchronizing=0;
+ uint8_t syncwait;
+
+
+ //USED AFTER DE SCAN //GIVE SOME TIME TO THE DEVICE TO SYNC WITH THE PARENT
+ uint8_t received_beacon_count=0;
+
+ uint8_t go_associate =0;
+
+ PANDescriptor pan_des;
+ uint32_t coordinator_addr[2];
+/******************************************************/
+/*********NEIGHBOuRTABLE MANAGEMENT FUNCTIONS*********/
+/******************************************************/
+
+ void init_nwkIB();
+
+ uint8_t check_neighbortableentry(uint8_t addrmode,uint32_t Extended_Address0,uint32_t Extended_Address1);
+
+ void add_neighbortableentry (uint16_t PAN_Id,uint32_t Extended_Address0,uint32_t Extended_Address1,uint32_t Network_Address,uint8_t Device_Type,uint8_t Relationship);
+ void update_neighbortableentry (uint16_t PAN_Id,uint32_t Extended_Address0,uint32_t Extended_Address1,uint32_t Network_Address,uint8_t Device_Type,uint8_t Relationship);
+
+ uint8_t find_suitable_parent();
+
+ uint16_t Cskip(uint8_t d);
+
+ uint16_t nexthopaddress(uint16_t destinationaddress,uint8_t d);
+
+ void list_neighbourtable();
+
+
+
+ command error_t Init.init() {
+
+ printfUART_init();//make the possibility to print
+
+ init_nwkIB();
+
+ nwk_IB.nwkSequenceNumber=call Random.rand16();
+
+ return SUCCESS;
+ }
+
+
+
+/*****************************************************************************************************/
+/**************************************MLME-SCAN*******************************************************/
+/*****************************************************************************************************/
+event error_t MLME_SCAN.confirm(uint8_t status,uint8_t ScanType, uint32_t UnscannedChannels, uint8_t ResultListSize, uint8_t EnergyDetectList[], SCAN_PANDescriptor PANDescriptorList[])
+{
+//FAULT-TOLERANCE
+
+//the device channel scan ends with a scan confirm containing a list of the PANs (beacons received during the scan)
+
+ int i;
+ uint8_t max_lqi=0;
+ uint8_t best_pan_index=0;
+
+
+ networkdescriptor networkdescriptorlist[1];
+
+
+ //call Leds.redOff();
+
+ printfUART("4 rec scan\n", "");
+
+ //printfUART("MLME_SCAN.confirm %i\n", ScanType);
+
+ if (ScanType == ORPHAN_SCAN)
+ {
+ printfUART("new scan \n", "");
+
+ call MLME_SCAN.request(PASSIVE_SCAN,0xFFFFFFFF,7);
+ return SUCCESS;
+ }
+
+
+
+ if(ScanType == ED_SCAN)
+ {
+ for(i=0;i<ResultListSize;i++)
+ {
+ printfUART("ED SCAN %i %i\n", (0x0A + i),EnergyDetectList[i]);
+ }
+ return SUCCESS;
+ }
+
+ for (i=0; i<ResultListSize;i++)
+ { /*
+ printfUART("cord id %i", PANDescriptorList[i].CoordPANId);
+ printfUART("CoordAddress %i", PANDescriptorList[i].CoordAddress);
+ printfUART("LogicalChannel %i", PANDescriptorList[i].LogicalChannel);
+ printfUART("SuperframeSpec %i", PANDescriptorList[i].SuperframeSpec);
+ printfUART("lqi %i\n", PANDescriptorList[i].lqi);
+ */
+ if(max_lqi < PANDescriptorList[i].lqi)
+ {
+ max_lqi =PANDescriptorList[i].lqi;
+ best_pan_index = i;
+ }
+ }
+
+ printfUART("SELECTED cord id %i", PANDescriptorList[best_pan_index].CoordPANId);
+ printfUART("CoordAddress %i", PANDescriptorList[best_pan_index].CoordAddress);
+ printfUART("LogicalChannel %i", PANDescriptorList[best_pan_index].LogicalChannel);
+ printfUART("SuperframeSpec %i", PANDescriptorList[best_pan_index].SuperframeSpec);
+ printfUART("lqi %i\n", PANDescriptorList[best_pan_index].lqi);
+
+
+
+ /*
+
+ coordinator_addr[0] = 0x00000001;
+
+ coordinator_addr[1] = (uint32_t)PANDescriptorList[best_pan_index].CoordAddress;
+
+ //pan_des = PANDescriptorList[best_pan_index];
+
+
+ //BUILD the PAN descriptor of the COORDINATOR
+ //assuming that the adress is short
+ pan_des.CoordAddrMode = SHORT_ADDRESS;
+ pan_des.CoordPANId = PANDescriptorList[best_pan_index].CoordAddress;
+ pan_des.CoordAddress0=0x00000000;
+ pan_des.CoordAddress1=0x00000000;
+ pan_des.LogicalChannel=PANDescriptorList[best_pan_index].LogicalChannel;
+ //superframe specification field
+ pan_des.SuperframeSpec = PANDescriptorList[best_pan_index].SuperframeSpec;
+
+ pan_des.GTSPermit=0x01;
+ pan_des.LinkQuality=0x00;
+ pan_des.TimeStamp=0x000000;
+ pan_des.SecurityUse=0;
+ pan_des.ACLEntry=0x00;
+ pan_des.SecurityFailure=0x00;
+
+ */
+
+
+
+ printfUART("5 en sync %x \n", PANDescriptorList[best_pan_index].LogicalChannel);
+ // the sync enables the TimerAsync events, in order to enable the synchronization with the PAN coordinator
+ call MLME_SYNC.request(PANDescriptorList[best_pan_index].LogicalChannel,0);
+
+
+
+ //The networkdescriptorlist must contain information about every network that was heard
+
+ //make NetworkDescriptorList out of the PanDescriptorList
+
+
+ printfUART("6 add neigh\n", "");
+
+ networkdescriptorlist[0].PANId=PANDescriptorList[best_pan_index].CoordPANId;
+ networkdescriptorlist[0].LogicalChannel=LOGICAL_CHANNEL;
+ networkdescriptorlist[0].StackProfile=0x00;
+ networkdescriptorlist[0].ZigBeeVersion=0x01;
+ networkdescriptorlist[0].BeaconOrder=7;
+ networkdescriptorlist[0].SuperframeOrder=6;
+ networkdescriptorlist[0].PermitJoining=1;
+
+ add_neighbortableentry(networkdescriptorlist[0].PANId,0x00000000,0x00000000,PANDescriptorList[best_pan_index].CoordAddress,COORDINATOR,NEIGHBOR_IS_PARENT);
+
+ signal NLME_NETWORK_DISCOVERY.confirm(1,networkdescriptorlist, NWK_SUCCESS);
+
+
+
+ return SUCCESS;
+}
+
+/*****************************************************************************************************/
+/**************************************MLME-ORPHAN****************************************************/
+/*****************************************************************************************************/
+event error_t MLME_ORPHAN.indication(uint32_t OrphanAddress[1], uint8_t SecurityUse, uint8_t ACLEntry)
+{
+
+
+
+ return 0x0000;
+ }
+
+/*****************************************************************************************************/
+/**************************************MLME-RESET*****************************************************/
+/*****************************************************************************************************/
+event error_t MLME_RESET.confirm(uint8_t status)
+{
+
+
+
+ return SUCCESS;
+}
+/*****************************************************************************************************/
+/**************************************MLME-SYNC-LOSS*************************************************/
+/*****************************************************************************************************/
+event error_t MLME_SYNC_LOSS.indication(uint8_t LossReason)
+{
+ ////printfUART("MLME_SYNC_LOSS.indication\n", "");
+ sync_loss = 1;
+ syncwait=1;
+ //signal NLME_SYNC.indication();
+/*
+
+printfUART("SL\n","");
+
+ call MLME_SCAN.request(ORPHAN_SCAN,0xFFFFFFFF,7);
+*/
+ return SUCCESS;
+}
+/*****************************************************************************************************/
+/**************************************MLME-GTS*******************************************************/
+/*****************************************************************************************************/
+event error_t MLME_GTS.confirm(uint8_t GTSCharacteristics, uint8_t status)
+{
+
+
+
+ return SUCCESS;
+}
+
+event error_t MLME_GTS.indication(uint16_t DevAddress, uint8_t GTSCharacteristics, bool SecurityUse, uint8_t ACLEntry)
+{
+
+
+
+ return SUCCESS;
+}
+
+/*****************************************************************************************************/
+/**************************************MLME-BEACON NOTIFY*********************************************/
+/*****************************************************************************************************/
+event error_t MLME_BEACON_NOTIFY.indication(uint8_t BSN,PANDescriptor pan_descriptor, uint8_t PenAddrSpec, uint8_t AddrList, uint8_t sduLength, uint8_t sdu[])
+{
+
+ uint32_t destinaddress[2];
+ printfUART("BN\n", "");
+
+
+ if (go_associate==1)
+ {
+ received_beacon_count++;
+
+ printfUART("bn %i\n", received_beacon_count);
+
+ if (received_beacon_count==5)
+ {
+ printfUART("sa \n", "");
+
+ go_associate=0;
+ //call MLME_ASSOCIATE.request(pan_des.LogicalChannel,SHORT_ADDRESS,pan_des.CoordPANId,coordinator_addr,0x00,0x00);
+
+ destinaddress[0]=0x00000000;
+ destinaddress[1]=0x00000000;
+
+
+ call MLME_ASSOCIATE.request(LOGICAL_CHANNEL,SHORT_ADDRESS,0x1234,destinaddress, set_capability_information(0x00,0x00,0x00,0x00,0x00,0x01),0);
+
+ }
+
+ }
+
+ return SUCCESS;
+}
+/*****************************************************************************************************/
+/**************************************MLME-START*****************************************************/
+/*****************************************************************************************************/
+event error_t MLME_START.confirm(uint8_t status)
+{
+ ////printfUART("MLME_START.confirm\n", "");
+ if (device_type==COORDINATOR)
+ {
+ signal NLME_NETWORK_FORMATION.confirm(status);
+ joined=1;
+ }
+ else
+ {
+ signal NLME_START_ROUTER.confirm(status);
+ }
+
+ return SUCCESS;
+}
+/*****************************************************************************************************/
+/********************** MLME-SET ******************************************/
+/*****************************************************************************************************/
+event error_t MLME_SET.confirm(uint8_t status,uint8_t PIBAttribute)
+{
+
+
+ return SUCCESS;
+}
+/*****************************************************************************************************/
+/************************* MLME-GET ******************************************/
+/*****************************************************************************************************/
+event error_t MLME_GET.confirm(uint8_t status,uint8_t PIBAttribute, uint8_t PIBAttributeValue[])
+{
+
+
+ return SUCCESS;
+}
+
+/*****************************************************************************************************/
+/**************************************MLME-ASSOCIATE*************************************************/
+/*****************************************************************************************************/
+event error_t MLME_ASSOCIATE.indication(uint32_t DeviceAddress[], uint8_t CapabilityInformation, bool SecurityUse, uint8_t ACLEntry)
+{
+
+ //notification that an other device wants to associate
+ //THIS DEVICE IS EITHER A COORDINATOR OR A ROUTER
+
+ uint8_t cindex=0;
+
+atomic{
+
+ //check the neighbour table
+ cindex = check_neighbortableentry(LONG_ADDRESS,DeviceAddress[0] , DeviceAddress[1]);
+
+
+ if( cindex > 0 )
+ {
+ call MLME_ASSOCIATE.response(DeviceAddress,neighbortable[cindex - 1].Network_Address,MAC_SUCCESS,0);
+ }
+ else
+ {
+ if(nwk_IB.nwkAvailableAddresses > 0)
+ {
+
+ //verify if the device is associating as a router or an end device
+ if ( get_alternate_PAN_coordinator(CapabilityInformation) == 1)
+ {
+ //add device to the neighbour table
+ add_neighbortableentry(panid,DeviceAddress[0],DeviceAddress[1],next_child_router_address,ROUTER,NEIGHBOR_IS_CHILD);
+
+ printfUART("An_cr %x\n",next_child_router_address);
+
+ //send response, this shall lead to confirm in child device
+ call MLME_ASSOCIATE.response(DeviceAddress,next_child_router_address,MAC_SUCCESS,0);
+ //calculate the next address
+ next_child_router_address = networkaddress + ((number_child_router-1) * cskip) +1 ;
+ //increment the number of associated routers
+ number_child_router++;
+ //decrese the number of available addresses //the available addresses are influenced by the network configurations
+ nwk_IB.nwkAvailableAddresses--;
+
+ printfUART("Dn_cr %x\n",next_child_router_address);
+ }
+ else
+ {
+ //verify if its possible to associate children in the address space
+ //the number of end devices must be greater than 1 and lesser or iqual to maximum children minus maximum routers
+ if (number_child_end_devices > 1 && number_child_end_devices > (MAXCHILDREN - MAXROUTERS))
+ {
+ call MLME_ASSOCIATE.response(DeviceAddress,0xffff,CMD_RESP_PAN_CAPACITY,0);
+ //return SUCCESS;
+ }
+ else
+ {
+ //CHECK COMMENTED ON SHORT VERSION
+ add_neighbortableentry(panid,DeviceAddress[0],DeviceAddress[1],nwk_IB.nwkNextAddress,END_DEVICE,NEIGHBOR_IS_CHILD);
+ //send response, this shall lead to confirm in child device
+ call MLME_ASSOCIATE.response(DeviceAddress,nwk_IB.nwkNextAddress,MAC_SUCCESS,0);
+
+ nwk_IB.nwkNextAddress=nwk_IB.nwkNextAddress + nwk_IB.nwkAddressIncrement;
+
+ number_child_end_devices++;
+
+ nwk_IB.nwkAvailableAddresses--;
+
+ }
+ }
+
+ if (nwk_IB.nwkAvailableAddresses == 0 )
+ {
+ call MLME_SET.request(MACASSOCIATIONPERMIT,(uint8_t *)0x00000000);
+ }
+ }
+ else
+ {
+ //if there are no available addresses the coordinator/router shall not respond to the association request
+ call MLME_ASSOCIATE.response(DeviceAddress,0xffff,CMD_RESP_PAN_CAPACITY,0);
+ }
+ }
+}
+ return SUCCESS;
+}
+
+event error_t MLME_ASSOCIATE.confirm(uint16_t AssocShortAddress, uint8_t status)
+{
+
+ uint8_t v_temp[2];
+ ////printfUART("MLME_ASSOCIATE.confirm\n","");
+
+ if (AssocShortAddress == 0xffff)
+ {
+ //association failed
+ //printfUART("nwkass fail\n","");
+ signal NLME_JOIN.confirm(panid,NWK_NOT_PERMITTED);
+
+ }
+ else
+ {
+
+ networkaddress = AssocShortAddress;
+ //add_neighbortableentry(panid,DeviceAddress[0],DeviceAddress[1],nwk_IB.nwkNextAddress,END_DEVICE,NEIGHBOR_IS_CHILD);
+ //set the short address
+
+ if (status == MAC_SUCCESS)
+ {
+ joined = 0x01;
+ v_temp[0] = (uint8_t)(networkaddress >> 8);
+ v_temp[1] = (uint8_t)(networkaddress );
+
+ //call MLME_SET.request(MACSHORTADDRESS,(uint32_t*)(uint32_t)&networkaddress);
+ call MLME_SET.request(MACSHORTADDRESS,v_temp);
+
+ signal NLME_JOIN.confirm(panid, NWK_SUCCESS);
+ }
+ else
+ {
+ signal NLME_JOIN.confirm(panid,NWK_NOT_PERMITTED);
+ }
+ }
+ return SUCCESS;
+}
+/*****************************************************************************************************/
+/**************************************MLME-DISASSOCIATE**********************************************/
+/*****************************************************************************************************/
+event error_t MLME_DISASSOCIATE.indication(uint32_t DeviceAddress[], uint8_t DisassociateReason, bool SecurityUse, uint8_t ACLEntry)
+{
+ ////printfUART("MLME_DISASSOCIATE.indication:SUCCESS\n", "");
+ signal NLME_LEAVE.confirm(DeviceAddress, NWK_SUCCESS);
+
+ return SUCCESS;
+}
+
+event error_t MLME_DISASSOCIATE.confirm(uint8_t status)
+{
+ if (status == MAC_SUCCESS)
+ {
+ signal NLME_LEAVE.confirm(0, status);
+ ////printfUART("MLME_DISASSOCIATE.confirm:SUCCESS\n", "");
+ }
+ else
+ {
+ signal NLME_LEAVE.confirm(0, NWK_LEAVE_UNCONFIRMED);
+ ////printfUART("MLME_DISASSOCIATE.confirm:leave unconfirmed\n", "");
+ }
+
+ return SUCCESS;
+}
+/*****************************************************************************************************/
+/*****************************************************************************************************/
+/**************** MCPS EVENTS *************************************/
+/*****************************************************************************************************/
+/*****************************************************************************************************/
+
+
+/*****************************************************************************************************/
+/********************* MCPS-DATA ***************************************/
+/*****************************************************************************************************/
+event error_t MCPS_DATA.confirm(uint8_t msduHandle, uint8_t status)
+{
+ ////printfUART("MCPS_DATA.confirm\n", "");
+ signal NLDE_DATA.confirm(1,status);
+
+ return SUCCESS;
+}
+event error_t MCPS_DATA.indication(uint16_t SrcAddrMode, uint16_t SrcPANId, uint32_t SrcAddr[2], uint16_t DstAddrMode, uint16_t DestPANId, uint32_t DstAddr[2], uint16_t msduLength,uint8_t msdu[100],uint16_t mpduLinkQuality, uint16_t SecurityUse, uint16_t ACLEntry)
+{
+ uint8_t payload[100];
+ uint32_t route_destination_address[2];
+ uint32_t net_addr[2];
+ uint8_t next_hop_index;
+
+ routing_fields *routing_fields_ptr;
+ routing_fields_ptr = (routing_fields *)&msdu[0];
+
+ net_addr[1] =(uint32_t) networkaddress;
+ net_addr[0]=0x00000000;
+
+ if ( routing_fields_ptr->destination_address == networkaddress)
+ {
+ //I am the destination
+ memcpy(&payload,&msdu[8],(msduLength-8)*sizeof(uint8_t));
+
+ //pass data on to APL layer
+ signal NLDE_DATA.indication(routing_fields_ptr->source_address,(uint16_t)(msduLength-8),payload, mpduLinkQuality);
+
+ return SUCCESS;
+ }
+ else
+ {
+ //I am not the destination
+ if(device_type != COORDINATOR)
+ {
+ if( (networkaddress < routing_fields_ptr->destination_address) && (routing_fields_ptr->destination_address < (networkaddress + cskip_routing ) ) )
+ {
+ printfUART("route down to appropriate child\n", "");
+
+ //check if destination is one of my children
+ next_hop_index = check_neighbortableentry(SHORT_ADDRESS,(uint32_t)routing_fields_ptr->destination_address,0x00000000);
+
+ if (next_hop_index == 0)
+ {
+ //destination is not my child
+ route_destination_address[0]=0x00000000;
+ route_destination_address[1]=nexthopaddress(routing_fields_ptr->destination_address,depth);
+ }
+ else
+ {
+ //Im routing to my child
+ route_destination_address[0]=0x00000000;
+ route_destination_address[1]=neighbortable[next_hop_index-1].Network_Address;
+ }
+ //send message
+ call MCPS_DATA.request(SHORT_ADDRESS, panid, net_addr, SHORT_ADDRESS, DestPANId, route_destination_address, msduLength, msdu,1,set_txoptions(1,0,0,0));
+ }
+ else
+ {
+
+ //changes to meet with the BEACON SYNCHRONIZATION requirements
+ //route up to the parent
+ atomic{
+ route_destination_address[0]=0x00000000;
+ route_destination_address[1]=neighbortable[parent].Network_Address;
+
+ call MCPS_DATA.request(SHORT_ADDRESS, panid, net_addr, SHORT_ADDRESS, DestPANId, route_destination_address, msduLength, msdu,1,set_txoptions_upstream(1,0,0,0,1));
+ }
+ }
+ }
+ else
+ {
+ //I AM THE PAN COORDINATOR
+ //THE COORDINATOR ALWAYS ROUTES DOWN
+
+ //route down to appropriate child
+ //check if destination is one of my children
+ next_hop_index = check_neighbortableentry(SHORT_ADDRESS,(uint32_t)routing_fields_ptr->destination_address,0x00000000);
+
+ if (next_hop_index == 0 )
+ {
+ //no entry in neigbortable
+ //calculate route address
+ route_destination_address[0]=0x00000000;
+ route_destination_address[1]=nexthopaddress(routing_fields_ptr->destination_address,depth);
+
+ call MCPS_DATA.request(SHORT_ADDRESS, panid, net_addr, SHORT_ADDRESS, DestPANId, route_destination_address, msduLength, msdu,1,set_txoptions(1,0,0,0));
+ }
+ else
+ {
+ //is my child
+ route_destination_address[0]=0x00000000;
+ route_destination_address[1]=neighbortable[next_hop_index-1].Network_Address;
+
+ call MCPS_DATA.request(SHORT_ADDRESS, panid, net_addr, SHORT_ADDRESS, DestPANId, route_destination_address, msduLength, msdu,1,set_txoptions(1,0,0,0));
+ }
+
+ }
+
+
+ }
+
+return SUCCESS;
+}
+
+
+/*************************************************************/
+/*******************NLDE IMPLEMENTATION***********************/
+/*************************************************************/
+
+/*************************************************************/
+/*************************NLDE - DATA*************************/
+/*************************************************************/
+
+//This primitive requests the transfer of a data PDU
+//page 159-161
+
+command error_t NLDE_DATA.request(uint16_t DstAddr, uint16_t NsduLength, uint8_t Nsdu[100], uint8_t NsduHandle, uint8_t Radius, uint8_t DiscoverRoute, uint8_t SecurityEnable)
+{
+
+ uint32_t srcadd[2];
+ //prefixed size because the devices reset itself when there is an error in the length
+ uint8_t MSDU[100];
+ uint32_t route_destination_address[2];
+ routing_fields *routing_fields_ptr;
+ uint8_t next_hop_index;
+
+ routing_fields_ptr = (routing_fields *)&MSDU[0];
+
+ if(joined==0)
+ {
+ signal NLDE_DATA.confirm(NsduHandle, NWK_INVALID_REQUEST);
+ }
+ else
+ {
+ routing_fields_ptr->frame_control= set_route_frame_control(0x00,0x01,DiscoverRoute,SecurityEnable);
+ routing_fields_ptr->destination_address=DstAddr;
+ routing_fields_ptr->source_address=networkaddress;
+ routing_fields_ptr->radius=Radius;
+ routing_fields_ptr->sequence_number=nwk_IB.nwkSequenceNumber;
+ nwk_IB.nwkSequenceNumber++;
+
+ memcpy(&MSDU[8],&Nsdu[0],NsduLength*sizeof(uint8_t));
+
+ srcadd[0] = 0x00000000;
+ srcadd[1] = (uint32_t)networkaddress;
+
+ if (device_type == END_DEVICE)
+ {
+ //if the device is an end device always sends the message to the parent
+
+ route_destination_address[0]=0x00000000;
+ route_destination_address[1]=neighbortable[parent].Network_Address;
+ //ack
+ call MCPS_DATA.request(SHORT_ADDRESS, panid, srcadd, SHORT_ADDRESS,panid, route_destination_address, (NsduLength + 8), MSDU,1,set_txoptions(1,0,0,0));
+ return SUCCESS;
+ }
+
+ //send message if the device is the COORDINATOR or a ROUTER
+ if( (networkaddress < routing_fields_ptr->destination_address) && (routing_fields_ptr->destination_address < (networkaddress + cskip_routing ) ) )
+ {
+ //route down to appropriate child
+ //check if destination is one of my children
+ next_hop_index = check_neighbortableentry(SHORT_ADDRESS,(uint32_t)routing_fields_ptr->destination_address,0x00000000);
+
+ if (next_hop_index == 0)
+ {
+ //destination is not my child
+ route_destination_address[0]=0x00000000;
+ route_destination_address[1]=nexthopaddress(routing_fields_ptr->destination_address,depth);
+ }
+ else
+ {
+ //Im routing to my child
+ route_destination_address[0]=0x00000000;
+ route_destination_address[1]=neighbortable[next_hop_index-1].Network_Address;
+ }
+ //send the data //ack
+ call MCPS_DATA.request(SHORT_ADDRESS, panid, srcadd, SHORT_ADDRESS, panid, route_destination_address, (NsduLength + 8), MSDU,1,set_txoptions(1,0,0,0));
+ }
+ else
+ {
+ //route up to parent
+ atomic{
+ route_destination_address[0]=0x00000000;
+ route_destination_address[1]=neighbortable[parent].Network_Address;
+ //ack
+ call MCPS_DATA.request(SHORT_ADDRESS, panid, srcadd, SHORT_ADDRESS, panid, route_destination_address, (NsduLength + 8), MSDU,1,set_txoptions_upstream(1,0,0,0,1));
+ }
+ }
+
+ }
+
+ return SUCCESS;
+}
+
+/*************************************************************/
+/*******************NLME IMPLEMENTATION***********************/
+/*************************************************************/
+
+/*************************************************************/
+/*******************NLME - START - ROUTER*********************/
+/*************************************************************/
+
+//This primitive allows the NHL of a ZigBee Router to initialize or change its superframe configuration.
+//p171 and 210
+command error_t NLME_START_ROUTER.request(uint8_t BeaconOrder, uint8_t SuperframeOrder, bool BatteryLifeExtension,uint32_t StartTime)
+{
+ //printfUART("NLME_START_ROUTER.request\n", "");
+
+ device_type = ROUTER;
+
+ if(TYPE_DEVICE == ROUTER)
+ {
+
+ //assign current BO and SO
+ beaconorder = BeaconOrder;
+ superframeorder = SuperframeOrder;
+
+ call MLME_SET.request(MACBEACONORDER, (uint8_t *)&BeaconOrder);
+
+ call MLME_SET.request(MACSUPERFRAMEORDER, (uint8_t *)&SuperframeOrder);
+
+ //*******************************************************
+ //***********SET PAN VARIABLES***************************
+ depth=DEVICE_DEPTH;
+
+ nwk_IB.nwkAvailableAddresses=AVAILABLEADDRESSES;
+ nwk_IB.nwkAddressIncrement= ADDRESSINCREMENT;
+
+ nwk_IB.nwkMaxChildren=MAXCHILDREN; //number of children a device is allowed to have on its current network
+ nwk_IB.nwkMaxDepth=MAXDEPTH; //the depth a device can have
+ nwk_IB.nwkMaxRouters=MAXROUTERS;
+
+ cskip = Cskip(depth);
+
+ cskip_routing = Cskip(depth -1);
+
+ nwk_IB.nwkNextAddress = networkaddress + (cskip * nwk_IB.nwkMaxRouters) + nwk_IB.nwkAddressIncrement;
+
+ next_child_router_address = networkaddress +((number_child_router-1) * cskip) +1;
+
+
+ number_child_router++;
+
+
+ printfUART("cskip %d\n", cskip);
+ printfUART("C %d D %d r %d\n", MAXCHILDREN,MAXDEPTH,MAXROUTERS);
+
+ // command error_t request(uint32_t PANId, uint8_t LogicalChannel, uint8_t BeaconOrder, uint8_t SuperframeOrder,bool PANCoordinator,bool BatteryLifeExtension,bool CoordRealignment,bool SecurityEnable);
+ call MLME_START.request(panid,LOGICAL_CHANNEL,BeaconOrder, SuperframeOrder, 0, 0,0,0,StartTime);
+
+ }
+ else
+ {
+
+ signal NLME_START_ROUTER.confirm(NWK_INVALID_REQUEST);
+
+ }
+ return SUCCESS;
+}
+
+
+/*************************************************************/
+/******************NLME - NETWORK - FORMATION*****************/
+/*************************************************************/
+
+//This primitive allows the NHL to request to start a ZigBee network with itself as the coordinator
+//Page 167-169
+command error_t NLME_NETWORK_FORMATION.request(uint32_t ScanChannels, uint8_t ScanDuration, uint8_t BeaconOrder, uint8_t SuperframeOrder, uint16_t PANId, bool BatteryLifeExtension)
+{
+
+ uint8_t v_temp[6];
+
+ v_temp[0] = 0x06;
+
+ device_type = COORDINATOR;
+ //device_type = ROUTER;
+
+ call MLME_SET.request(MACMAXBEACONPAYLOADLENGTH,v_temp);
+
+ //protocol ID
+ v_temp[0] = 0x00;
+ //uint8_t nwk_payload_profile_protocolversion(uint8_t stackprofile,uint8_t nwkcprotocolversion)
+ v_temp[1] = nwk_payload_profile_protocolversion(0x00,0x00);
+ //uint8_t nwk_payload_capacity(uint8_t routercapacity,uint8_t devicedepth,uint8_t enddevicecapacity)
+ v_temp[2] = nwk_payload_capacity(0x01,0x00,0x01);
+
+ //TX OFFSET (3 bytes)
+ v_temp[3] = 0x56;
+ v_temp[4] = 0x34;
+ v_temp[5] = 0x12;
+
+
+ call MLME_SET.request(MACBEACONPAYLOAD,v_temp);
+
+
+ ////printfUART("NLME_NETWORK_FORMATION.request\n", "");
+ //perform an energydetection scan
+ //perform an active scan
+ //and select a suitable channel
+ //panid must be less than or equal to 0x3fff
+
+ //assign current panid
+ panid=PANId;
+
+ //assign current BO and SO
+ beaconorder = BeaconOrder;
+ superframeorder = SuperframeOrder;
+
+ call MLME_SET.request(MACBEACONORDER, (uint8_t *)&BeaconOrder);
+
+ call MLME_SET.request(MACSUPERFRAMEORDER, (uint8_t *)&SuperframeOrder);
+
+ v_temp[0] = (uint8_t)(PANId >> 8);
+ v_temp[1] = (uint8_t)PANId;
+
+ call MLME_SET.request(MACPANID, v_temp);
+
+ //static assignement of the coordinator address
+ networkaddress=0x0000;//Network address of the ZC of a network always 0x0000;
+
+ //////printfUART("setting short addr: %i\n", networkaddress);
+
+ v_temp[0] = (uint8_t)(networkaddress >> 8);
+ v_temp[1] = (uint8_t)(networkaddress);
+
+
+ call MLME_SET.request(MACSHORTADDRESS,v_temp);
+
+
+ //*******************************************************
+ //***********SET PAN VARIABLES***************************
+ //nwk_IB.nwkNextAddress=networkaddress+0x0001;
+ depth=DEVICE_DEPTH;
+ nwk_IB.nwkAvailableAddresses=AVAILABLEADDRESSES;
+ nwk_IB.nwkAddressIncrement= ADDRESSINCREMENT;
+
+ nwk_IB.nwkMaxChildren=MAXCHILDREN; //number of children a device is allowed to have on its current network
+ nwk_IB.nwkMaxDepth=MAXDEPTH; //the depth a device can have
+ nwk_IB.nwkMaxRouters=MAXROUTERS;
+
+ cskip = Cskip(depth);
+
+ cskip_routing = Cskip(depth -1 );
+
+ nwk_IB.nwkNextAddress = networkaddress + (cskip * nwk_IB.nwkMaxRouters) + nwk_IB.nwkAddressIncrement;
+
+ next_child_router_address = networkaddress +((number_child_router-1) * cskip) +1;
+
+ number_child_router++;
+
+ printfUART("cskip %d\n", cskip);
+ printfUART("C %d D %d r %d\n", MAXCHILDREN,MAXDEPTH,MAXROUTERS);
+
+
+ call MLME_START.request(PANId, LOGICAL_CHANNEL,BeaconOrder ,SuperframeOrder,1,0,0,0,0);
+
+ return SUCCESS;
+}
+
+/*************************************************************/
+/***************NLME - NETWORK - DISCOVERY *******************/
+/*************************************************************/
+
+//This primitive allows the next higher layer to request that the NWK layer discover networks currently operating within the POS.
+//p164 and 210
+command error_t NLME_NETWORK_DISCOVERY.request(uint32_t ScanChannels, uint8_t Scanduration)
+{
+
+ //ISSUE an MLME_SCAN.request to find the available networks
+ //Temporary descover of the network
+ //Channel Scan is not working properly
+ //manually assign the network descriptor
+
+ /*
+ networkdescriptor networkdescriptorlist[1];
+*/
+ printfUART("2 lauch passive scan\n", "");
+ //The networkdescriptorlist must contain information about every network that was heard
+
+ //make NetworkDescriptorList out of the PanDescriptorList
+
+ call MLME_SCAN.request(PASSIVE_SCAN,0xFFFFFFFF,7);
+
+/*
+
+ networkdescriptorlist[0].PANId=0x1234;
+ networkdescriptorlist[0].LogicalChannel=LOGICAL_CHANNEL;
+ networkdescriptorlist[0].StackProfile=0x00;
+ networkdescriptorlist[0].ZigBeeVersion=0x01;
+ networkdescriptorlist[0].BeaconOrder=7;
+ networkdescriptorlist[0].SuperframeOrder=6;
+ networkdescriptorlist[0].PermitJoining=1;
+
+ //temporary assignement on the neighbout table of the suitable PAN coordinator
+ if (DEVICE_DEPTH == 0x01)
+ add_neighbortableentry(networkdescriptorlist[0].PANId,D1_PAN_EXT0,D1_PAN_EXT1,D1_PAN_SHORT,COORDINATOR,NEIGHBOR_IS_PARENT);
+ if (DEVICE_DEPTH == 0x02)
+ add_neighbortableentry(networkdescriptorlist[0].PANId,D2_PAN_EXT0,D2_PAN_EXT1,D2_PAN_SHORT,COORDINATOR,NEIGHBOR_IS_PARENT);
+ if (DEVICE_DEPTH == 0x03)
+ add_neighbortableentry(networkdescriptorlist[0].PANId,D3_PAN_EXT0,D3_PAN_EXT1,D3_PAN_SHORT,COORDINATOR,NEIGHBOR_IS_PARENT);
+ if (DEVICE_DEPTH == 0x04)
+ add_neighbortableentry(networkdescriptorlist[0].PANId,D4_PAN_EXT0,D4_PAN_EXT1,D4_PAN_SHORT,COORDINATOR,NEIGHBOR_IS_PARENT);
+
+
+
+ signal NLME_NETWORK_DISCOVERY.confirm(1,networkdescriptorlist, NWK_SUCCESS);
+*/
+ return SUCCESS;
+}
+
+/*************************************************************/
+/************************NLME - JOIN**************************/
+/*************************************************************/
+//This primitive allows the NHL to request to join a network either through association.
+//p173 and 210
+command error_t NLME_JOIN.request(uint16_t PANId, bool JoinAsRouter, bool RejoinNetwork, uint32_t ScanChannels, uint8_t ScanDuration, uint8_t PowerSource, uint8_t RxOnWhenIdle, uint8_t MACSecurity)
+{
+
+ //Assume we have selected a suitable parent and all previous conditions were true
+ uint32_t destinaddress[2];
+
+ printfUART("9 find parent\n", "");
+
+ //list_neighbourtable();
+
+ parent_index = find_suitable_parent();
+
+ panid = PANId;
+
+ //printfUART("NLME_JOIN %i %i\n", parent_index,panid);
+
+ if(parent_index == 0)
+ {
+ signal NLME_JOIN.confirm(PANId,NWK_NOT_PERMITTED);
+ }
+ else
+ {
+ //assign the true value to parent index
+ parent_index = parent_index - 1;
+
+ //destinaddress[0]=neighbortable[parent_index].Extended_Address0;
+ //destinaddress[1]=neighbortable[parent_index].Extended_Address1;
+ //verificar o endereço do pan coordinator
+ destinaddress[0]=0x00000000;
+
+
+ destinaddress[1] = neighbortable[parent_index].Network_Address;
+
+ /*
+ if (DEVICE_DEPTH == 0x01)
+ destinaddress[1]=D1_PAN_SHORT;
+ if (DEVICE_DEPTH == 0x02)
+ destinaddress[1]=D2_PAN_SHORT;
+ if (DEVICE_DEPTH == 0x03)
+ destinaddress[1]=D3_PAN_SHORT;
+ if (DEVICE_DEPTH == 0x04)
+ destinaddress[1]=D4_PAN_SHORT;
+ */
+
+ printfUART("10 associate to %i\n", destinaddress[1]);
+ //set_capability_information(uint8_t alternate_PAN_coordinator, uint8_t device_type, uint8_t power_source, uint8_t receiver_on_when_idle, uint8_t security, uint8_t allocate_address)
+
+ if (JoinAsRouter == 0x01)
+ call MLME_ASSOCIATE.request(LOGICAL_CHANNEL,SHORT_ADDRESS,PANId,destinaddress, set_capability_information(JoinAsRouter,0x01,PowerSource,RxOnWhenIdle,MACSecurity,0x01),0);
+ else
+ {
+
+ printfUART("11 go ass\n", "");
+
+ coordinator_addr[0]=0x00000000;
+ coordinator_addr[1] = neighbortable[parent_index].Network_Address;
+ //BUILD the PAN descriptor of the COORDINATOR
+ //assuming that the adress is short
+ pan_des.CoordAddrMode = SHORT_ADDRESS;
+ pan_des.CoordPANId = panid;
+ pan_des.CoordAddress0=0x00000000;
+ pan_des.CoordAddress1=(uint32_t)neighbortable[parent_index].Network_Address;
+ pan_des.LogicalChannel=neighbortable[parent_index].Logical_Channel;
+ //superframe specification field
+ //pan_des.SuperframeSpec = neighbortable[parent_index].SuperframeSpec;
+
+ pan_des.GTSPermit=0x01;
+ pan_des.LinkQuality=0x00;
+ pan_des.TimeStamp=0x000000;
+ pan_des.SecurityUse=0;
+ pan_des.ACLEntry=0x00;
+ pan_des.SecurityFailure=0x00;
+
+ received_beacon_count=0;
+ go_associate=1;
+
+ //call MLME_ASSOCIATE.request(LOGICAL_CHANNEL,SHORT_ADDRESS,PANId,destinaddress, set_capability_information(JoinAsRouter,0x00,PowerSource,RxOnWhenIdle,MACSecurity,0x01),0);
+ }
+ }
+
+ return SUCCESS;
+}
+
+
+/*************************************************************/
+/************************NLME - LEAVE*************************/
+/*************************************************************/
+
+//This primitive allows the NHL to request that it or another device leaves the network
+//page 181-183
+command error_t NLME_LEAVE.request(uint32_t DeviceAddress[],bool RemoveChildren, bool MACSecurityEnable)
+{
+ uint32_t devaddr[2];
+ ////printfUART("NLME_LEAVE.request\n", "");
+ if (DeviceAddress == 0)//child asked to leave
+ {
+ if(RemoveChildren == 0)//implemented like it is always 0
+ {
+ //send leave request command frame: RemoveChildren subfield=0 of the command option field of the command frame payload
+ //call MCPS_DATA.request(uint8_t SrcAddrMode, uint16_t SrcPANId, uint8_t SrcAddr[], uint8_t DstAddrMode, uint16_t DestPANId, uint8_t DstAddr[], uint8_t msduLength, uint8_t msdu[],uint8_t msduHandle, uint8_t TxOptions);
+ devaddr[0]=neighbortable[parent].Extended_Address0;
+ devaddr[1]=neighbortable[parent].Extended_Address1;
+ call MLME_DISASSOCIATE.request(devaddr,0x02,0);
+ }
+ else
+ {
+ //send leave request command frame: RemoveChildren subfield=1
+ //try to remove the children, call NLME_LEAVE.request(uint32_t DeviceAddress[]=address of child,bool RemoveChildren, bool MACSecurityEnable)
+ //call MCPS_DATA.request(uint8_t SrcAddrMode, uint16_t SrcPANId, uint8_t SrcAddr[], uint8_t DstAddrMode, uint16_t DestPANId, uint8_t DstAddr[], uint8_t msduLength, uint8_t msdu[],uint8_t msduHandle, uint8_t TxOptions);
+ }
+ }
+ else//parent forced a child to leave
+ {
+ //if(check_neighbortableentry(DeviceAddress[0], DeviceAddress[1]) == 0)
+ //{
+ // signal NLME_LEAVE.confirm(DeviceAddress,NWK_UNKNOWN_DEVICE);
+ // //call MCPS_DATA.request(uint8_t SrcAddrMode, uint16_t SrcPANId, uint8_t SrcAddr[], uint8_t DstAddrMode, uint16_t DestPANId, uint8_t DstAddr[], uint8_t msduLength, uint8_t msdu[],uint8_t msduHandle, uint8_t TxOptions);
+ //}
+
+ }
+
+
+ return SUCCESS;
+}
+
+/*************************************************************/
+/************************NLME - SYNC**************************/
+/*************************************************************/
+
+//This primitive allows the NHL to synchronize or extract data from its ZigBee coordinator or router
+//page 186-187
+command error_t NLME_SYNC.request(bool Track)
+{
+
+ return SUCCESS;
+}
+
+/*************************************************************/
+/***************** NLME-SET ********************/
+/*************************************************************/
+
+command error_t NLME_SET.request(uint8_t NIBAttribute, uint16_t NIBAttributeLength, uint16_t NIBAttributeValue)
+{
+
+ atomic{
+
+ switch(NIBAttribute)
+ {
+ case NWKSEQUENCENUMBER : nwk_IB.nwkSequenceNumber = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkSequenceNumber: %x\n",nwk_IB.nwkSequenceNumber);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKPASSIVEACKTIMEOUT : nwk_IB.nwkPassiveAckTimeout = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkPassiveAckTimeout: %x\n",nwk_IB.nwkPassiveAckTimeout);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+
+ case NWKMAXBROADCASTRETRIES : nwk_IB.nwkMaxBroadcastRetries = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkMaxBroadcastRetries: %x\n",nwk_IB.nwkMaxBroadcastRetries);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKMAXCHILDREN : nwk_IB.nwkMaxChildren = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkMaxChildren: %x\n",nwk_IB.nwkMaxChildren);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKMAXDEPTH : nwk_IB.nwkMaxDepth = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkMaxDepth: %x\n",nwk_IB.nwkMaxDepth);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKMAXROUTERS : nwk_IB.nwkMaxRouters = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkMaxRouters: %x\n",nwk_IB.nwkMaxRouters);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKMETWORKBROADCASTDELIVERYTIME : nwk_IB.nwkNetworkBroadcastDeliveryTime = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkNetworkBroadcastDeliveryTime: %x\n",nwk_IB.nwkNetworkBroadcastDeliveryTime);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+ case NWKREPORTCONSTANTCOST : nwk_IB.nwkReportConstantCost = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkReportConstantCost: %x\n",nwk_IB.nwkReportConstantCost);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+ case NWKROUTEDISCOVERYRETRIESPERMITED : nwk_IB.nwkRouteDiscoveryRetriesPermitted = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkRouteDiscoveryRetriesPermitted: %x\n",nwk_IB.nwkRouteDiscoveryRetriesPermitted);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKSYMLINK : nwk_IB.nwkSymLink = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkSymLink: %x\n",nwk_IB.nwkSymLink);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKCAPABILITYINFORMATION : nwk_IB.nwkCapabilityInformation = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkCapabilityInformation: %x\n",nwk_IB.nwkCapabilityInformation);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKUSETREEADDRALLOC : nwk_IB.nwkUseTreeAddrAlloc = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkUseTreeAddrAlloc: %x\n",nwk_IB.nwkUseTreeAddrAlloc);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKUSETREEROUTING : nwk_IB.nwkUseTreeRouting = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkUseTreeRouting: %x\n",nwk_IB.nwkUseTreeRouting);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKNEXTADDRESS : nwk_IB.nwkNextAddress = NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkNextAddress: %x\n",nwk_IB.nwkNextAddress);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKAVAILABLEADDRESSES : nwk_IB.nwkAvailableAddresses = NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkAvailableAddresses: %x\n",nwk_IB.nwkAvailableAddresses);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKADDRESSINCREMENT : nwk_IB.nwkAddressIncrement =NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkAddressIncrement: %x\n",nwk_IB.nwkAddressIncrement);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ case NWKTRANSACTIONPERSISTENCETIME : nwk_IB.nwkTransactionPersistenceTime = (uint8_t) NIBAttributeValue;
+ //////printfUART("nwk_IB.nwkTransactionPersistenceTime: %x\n",nwk_IB.nwkTransactionPersistenceTime);
+ signal NLME_SET.confirm(NWK_SUCCESS,NIBAttribute);
+ break;
+
+ default: signal NLME_SET.confirm(NWK_UNSUPPORTED_ATTRIBUTE,NIBAttribute);
+ break;
+
+ }
+
+ }
+
+
+ return SUCCESS;
+}
+
+/*************************************************************/
+/***************** NLME-GET ********************/
+/*************************************************************/
+
+command error_t NLME_GET.request(uint8_t NIBAttribute)
+{
+ switch(NIBAttribute)
+ {
+ case NWKSEQUENCENUMBER : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkSequenceNumber);
+ break;
+
+ case NWKPASSIVEACKTIMEOUT : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkPassiveAckTimeout);
+ break;
+
+ case NWKMAXBROADCASTRETRIES : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkMaxBroadcastRetries);
+ break;
+
+ case NWKMAXCHILDREN : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkMaxChildren);
+ break;
+
+ case NWKMAXDEPTH : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkMaxDepth);
+ break;
+
+ case NWKMAXROUTERS : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkMaxRouters);
+ break;
+
+ case NWKMETWORKBROADCASTDELIVERYTIME : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkNetworkBroadcastDeliveryTime);
+ break;
+
+ case NWKREPORTCONSTANTCOST : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkReportConstantCost);
+ break;
+
+ case NWKROUTEDISCOVERYRETRIESPERMITED : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkRouteDiscoveryRetriesPermitted);
+ break;
+
+ case NWKSYMLINK : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkSymLink);
+ break;
+
+ case NWKCAPABILITYINFORMATION : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkCapabilityInformation);
+ break;
+
+ case NWKUSETREEADDRALLOC : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkUseTreeAddrAlloc);
+ break;
+
+ case NWKUSETREEROUTING : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkUseTreeRouting);
+ break;
+
+ case NWKNEXTADDRESS : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0002,(uint16_t)&nwk_IB.nwkNextAddress);
+ break;
+
+ case NWKAVAILABLEADDRESSES : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0002,(uint16_t)&nwk_IB.nwkAvailableAddresses);
+ break;
+
+ case NWKADDRESSINCREMENT : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0002,(uint16_t)&nwk_IB.nwkAddressIncrement);
+ break;
+
+ case NWKTRANSACTIONPERSISTENCETIME : signal NLME_GET.confirm(NWK_SUCCESS,NIBAttribute,0x0001,(uint16_t)&nwk_IB.nwkTransactionPersistenceTime);
+ break;
+
+ default: signal NLME_GET.confirm(NWK_UNSUPPORTED_ATTRIBUTE,NIBAttribute,0x0000,0x00);
+ break;
+ }
+
+ return SUCCESS;
+}
+
+/*************************************************************/
+/**************neighbor table management functions************/
+/*************************************************************/
+
+//check if a specific neighbourtable Entry is present
+//Return 0:Entry is not present
+//Return i:Entry is present and return the index of the entry + 1
+ uint8_t check_neighbortableentry(uint8_t addrmode,uint32_t Address0,uint32_t Address1)
+ {
+
+ int i=0;
+
+
+ //printfUART("neighbourtable check c %i\n", neighbour_count);
+
+ if (neighbour_count == 0)
+ {
+ //printfUART("no neib\n", "");
+ return 0;
+ }
+
+ if(addrmode == SHORT_ADDRESS)
+ {
+ for(i=0; i < neighbour_count; i++)
+ {
+ ///printfUART("compare %i %i\n", neighbortable[i].Network_Address, test);
+
+ if(neighbortable[i].Network_Address == (uint16_t) Address0)
+ {
+ //printfUART("already present \n", "" );
+ return i+1;
+ }
+ }
+ return 0;
+ }
+ else
+ {
+ for(i=0; i<neighbour_count; i++)
+ {
+ ////printfUART("compare %x %x\n", neighbortable[i].Extended_Address0, Address0);
+ if( (neighbortable[i].Extended_Address0 == Address0) && (neighbortable[i].Extended_Address1 == Address1))
+ {
+ //printfUART("already present \n", "" );
+ return i+1;
+ }
+ }
+ return 0;
+ }
+
+ return 0;
+ }
+
+ //function user to find a parent in the neighbour table
+ //Return 0:no parent is present
+ //Return i:parent is present and return the index of the entry + 1
+ uint8_t find_suitable_parent()
+ {
+ int i =0;
+ for (i=0; i<neighbour_count; i++)
+ {
+ if(neighbortable[i].Relationship == NEIGHBOR_IS_PARENT)
+ {
+ return i+1;
+ }
+ }
+ return 0;
+ }
+
+
+ //add a neighbortable entry
+ void add_neighbortableentry (uint16_t PAN_Id,uint32_t Extended_Address0,uint32_t Extended_Address1,uint32_t Network_Address,uint8_t Device_Type,uint8_t Relationship)
+ {
+
+ atomic{
+ neighbortable[neighbour_count].PAN_Id=PAN_Id;
+ neighbortable[neighbour_count].Extended_Address0=Extended_Address0;
+ neighbortable[neighbour_count].Extended_Address1=Extended_Address1;
+ neighbortable[neighbour_count].Network_Address=Network_Address;
+ neighbortable[neighbour_count].Device_Type=Device_Type;
+ neighbortable[neighbour_count].Relationship=Relationship;
+
+ neighbour_count++;
+ }
+
+ }
+
+
+
+ //update a neighbourtable entry
+ void update_neighbortableentry(uint16_t PAN_Id,uint32_t Extended_Address0,uint32_t Extended_Address1,uint32_t Network_Address,uint8_t Device_Type,uint8_t Relationship)
+ {
+ //search entry with correct extended address
+ uint8_t nrofEntry=0;
+ nrofEntry = check_neighbortableentry(0x01,Extended_Address0,Extended_Address1) - 1;
+
+ //update every attribute
+ neighbortable[nrofEntry].PAN_Id=PAN_Id;
+ neighbortable[nrofEntry].Extended_Address0=Extended_Address0;
+ neighbortable[nrofEntry].Extended_Address1=Extended_Address1;
+ neighbortable[nrofEntry].Network_Address=Network_Address;
+ neighbortable[nrofEntry].Device_Type=Device_Type;
+ neighbortable[nrofEntry].Relationship=Relationship;
+
+ ////printfUART("updated neighbourtable entry\n", "");
+ }
+
+
+ void list_neighbourtable()
+ {
+ int i;
+ ////printfUART("N List Count: %u\n", neighbour_count);
+
+ for(i=0;i<neighbour_count;i++)
+ {
+ printfUART("Panid %x", neighbortable[i].PAN_Id);
+ printfUART("Extaddr0 %x", neighbortable[i].Extended_Address0);
+ printfUART("Extaddr1 %x", neighbortable[i].Extended_Address1);
+ printfUART("nwkaddr %u", neighbortable[i].Network_Address);
+ printfUART("devtype %u", neighbortable[i].Device_Type);
+ printfUART("relation %u", neighbortable[i].Relationship);
+ printfUART("depth %u\n", neighbortable[i].Depth);
+ }
+ }
+/*************************************************************/
+/*****************Address Assignment functions****************/
+/*************************************************************/
+
+//calculate the size of the address sub-block for a router at depth d
+uint16_t Cskip(uint8_t d)
+{
+ uint8_t skip;
+ uint8_t power;
+ uint8_t x=1;
+ uint8_t Cm = nwk_IB.nwkMaxChildren;
+ uint8_t Rm = nwk_IB.nwkMaxRouters;
+ uint8_t Lm = nwk_IB.nwkMaxDepth;
+ /*////printfUART("nwk_IB.nwkMaxChildren: %i\n", nwk_IB.nwkMaxChildren);
+ ////printfUART("nwk_IB.nwkMaxRouters: %i\n", nwk_IB.nwkMaxRouters);
+ ////printfUART("nwk_IB.nwkMaxDepth: %i\n", nwk_IB.nwkMaxDepth);*/
+ if (Rm == 1)
+ {
+ skip = 1 + Cm * (Lm - d - 1);
+ }
+ else
+ {
+ int i;
+
+ power=(Lm - d - 1);
+ for(i=0;i<power;i++)
+ {
+ x=x*Rm;
+ }
+ skip = (1 + Cm - Rm - (Cm * x))/(1-Rm);
+ }
+ ////printfUART("Cksip function calculated: %i\n", skip);
+ return skip;
+}
+
+//Calculate the nexthopaddress of the appropriate child if route down is required
+uint16_t nexthopaddress(uint16_t destinationaddress,uint8_t d)
+{
+ uint16_t next_hop;
+
+ next_hop=(networkaddress + 1 + ((destinationaddress-(networkaddress+1))/cskip)* cskip);
+
+ ////printfUART("Nexthop address calculated: %i\n", next_hop);
+ return next_hop;
+}
+
+/*************************************************************/
+/*****************Initialization functions********************/
+/*************************************************************/
+ //initialization of the nwk IB
+ void init_nwkIB()
+ {
+ //nwk IB default values p 204-206
+ nwk_IB.nwkPassiveAckTimeout=0x03;
+ nwk_IB.nwkMaxBroadcastRetries=0x03;
+ nwk_IB.nwkMaxChildren=0x07; //number of children a device is allowed to have on its current network
+ nwk_IB.nwkMaxDepth=0x05; //the depth a device can have
+ nwk_IB.nwkMaxRouters=0x02; //number of routers anyone device is allowed to have on its current network
+ //neighbortableentry nwkNeighborTable[];//null set
+ nwk_IB.nwkNetworkBroadcastDeliveryTime=( nwk_IB.nwkPassiveAckTimeout * nwk_IB.nwkMaxBroadcastRetries );
+ nwk_IB.nwkReportConstantCost=0x00;
+ nwk_IB.nwkRouteDiscoveryRetriesPermitted=nwkcDiscoveryRetryLimit;
+ //set? nwkRouteTable;//Null set
+ nwk_IB.nwkSymLink=0;
+ nwk_IB.nwkCapabilityInformation=0x00;
+ nwk_IB.nwkUseTreeAddrAlloc=1;
+ nwk_IB.nwkUseTreeRouting=1;
+ nwk_IB.nwkNextAddress=0x0000;
+ nwk_IB.nwkAvailableAddresses=0x0000;
+ nwk_IB.nwkAddressIncrement=0x0001;
+ nwk_IB.nwkTransactionPersistenceTime=0x01f4;
+ }
+
+
+
+}
+
projects / tinyos-2.x.git / blobdiff