Users » dudmuck » Code » LoRaWAN_singlechannel_endnode

wayne roberts / Mbed OS LoRaWAN_singlechannel_endnode

end node on synchronous star LoRa network.

Dependencies: SX127x sx12xx_hal TSL2561

radio chip selection

Radio chip driver is not included, allowing choice of radio device.
If you're using SX1272 or SX1276, then import sx127x driver into your program.
if you're using SX1261 or SX1262, then import sx126x driver into your program.
if you're using SX1280, then import sx1280 driver into your program.
If you're using NAmote72 or Murata discovery, then you must import only sx127x driver.

This project for use with LoRaWAN_singlechannel_gateway project.

Alternately gateway running on raspberry pi can be used as gateway.

LoRaWAN on single radio channel

Network description is at gateway project page. Synchronous star network.

Hardware Support

This project supports SX1276 and SX1272, sx126x kit, sx126x shield, and sx128x 2.4GHz. The ST board B-L072Z-LRWAN1 is also supported (TypeABZ module). When B-L072Z-LRWAN1 target is selected, TARGET_DISCO_L072CZ_LRWAN1 is defined by tools, allowing correct radio driver configuration for this platform. Alternately, any mbed board that can use LoRa radio shield board should work, but NUCLEO boards are tested.

End-node Unique ID

DevEUI is created from CPU serial number. AppEUI and AppKey are declared as software constants.

End-node Configuration

Data rate definition LORAMAC_DEFAULT_DATARATE configured in LoRaMac-definitions.h. See gateway project page for configuration of gateway.
LoRaWAN addressing is configured in Comissioning.h; only OTA mode is functional.
Header file board/lora_config.h, selects application layer options (i.e. sensors) to be compiled in.

Serial Interface

Serial port operates at 115200bps.
Application layer single_us915_main.cpp User button triggers uplink (i.e. blue button on nucleo board), or jumper enables continuously sends repeated uplink packets. The MAC layer holds each uplink request until the allocated timeslot.

command	arguments	description
`?`	-	print available commands
`.` (period)	-	print status (DevEUI, DevAddr, etc)
`ul`	length integer	set payload length of test uplink packets

sensor demo

Selected grove sensors may be plugged into SX1272 shield.
To enable, edit lora_config.h to define SENSORS.

Sensor connections on SX1272MB2xAS:

D8 D9: button	RX TX: (unused)	A3 A4: Rotary Angle Sensor
D6 D7: RGB LED	SCL SDA: digital light sensor	A1 A2: Rotary Angle Sensor

Digital input pin, state reported via uplink: PC8
Digital output pin, controlled via downlink: PC6
PWM out: PB_10

Jumper enables auto-repeated transmit: PC10 and PC12 on NUCLEO board, located on end of morpho headers nearby JP4.

mac/LoRaMac.cpp@25:fed9d5b77183, 2017-08-10 (annotated)

Committer:: dudmuck
Date:: Thu Aug 10 14:47:29 2017 -0700
Revision:: 25:fed9d5b77183
Parent:: 23:a862b5601663
Child:: 29:ad409c68c0a6

uplink held during beacon, and sent after beacon done

Who changed what in which revision?

User	Revision	Line number	New contents of line
dudmuck	0:8f0d0ae0a077	1	/*
dudmuck	0:8f0d0ae0a077	2	/ _____) _ \| \|
dudmuck	0:8f0d0ae0a077	3	( (____ _____ ____ _\| \|_ _____ ____\| \|__
dudmuck	0:8f0d0ae0a077	4	\____ \\| ___ \| (_ _) ___ \|/ ___) _ \
dudmuck	0:8f0d0ae0a077	5	_____) ) ____\| \| \| \|\| \|_\| ____( (___\| \| \| \|
dudmuck	0:8f0d0ae0a077	6	(______/\|_____)_\|_\|_\| \__)_____)\____)_\| \|_\|
dudmuck	0:8f0d0ae0a077	7	(C)2013 Semtech
dudmuck	0:8f0d0ae0a077	8	___ _____ _ ___ _ _____ ___ ___ ___ ___
dudmuck	0:8f0d0ae0a077	9	/ __\|_ _/_\ / __\| \|/ / __/ _ \\| _ \/ __\| __\|
dudmuck	0:8f0d0ae0a077	10	\__ \ \| \|/ _ \ (__\| ' <\| _\| (_) \| / (__\| _\|
dudmuck	0:8f0d0ae0a077	11	\|___/ \|_/_/ \_\___\|_\|\_\_\| \___/\|_\|_\\___\|___\|
dudmuck	0:8f0d0ae0a077	12	embedded.connectivity.solutions===============
dudmuck	0:8f0d0ae0a077	13
dudmuck	0:8f0d0ae0a077	14	Description: LoRa MAC layer implementation
dudmuck	0:8f0d0ae0a077	15
dudmuck	0:8f0d0ae0a077	16	License: Revised BSD License, see LICENSE.TXT file include in the project
dudmuck	0:8f0d0ae0a077	17
dudmuck	0:8f0d0ae0a077	18	Maintainer: Miguel Luis ( Semtech ), Gregory Cristian ( Semtech ) and Daniel Jäckle ( STACKFORCE )
dudmuck	0:8f0d0ae0a077	19	*/
dudmuck	0:8f0d0ae0a077	20	#include <math.h>
dudmuck	0:8f0d0ae0a077	21	#include "board.h"
dudmuck	0:8f0d0ae0a077	22
dudmuck	0:8f0d0ae0a077	23	#include "LoRaMacCrypto.h"
dudmuck	0:8f0d0ae0a077	24	#include "LoRaMac.h"
dudmuck	0:8f0d0ae0a077	25	#include "LoRaMacTest.h"
dudmuck	0:8f0d0ae0a077	26
dudmuck	16:915815632c1f	27	#define TX_DEBUG
dudmuck	16:915815632c1f	28
dudmuck	0:8f0d0ae0a077	29	#define PING_SLOT_RESOLUTION_us 30000
dudmuck	0:8f0d0ae0a077	30
dudmuck	0:8f0d0ae0a077	31	/*!
dudmuck	0:8f0d0ae0a077	32	* Maximum PHY layer payload size
dudmuck	0:8f0d0ae0a077	33	*/
dudmuck	0:8f0d0ae0a077	34	#define LORAMAC_PHY_MAXPAYLOAD 255
dudmuck	0:8f0d0ae0a077	35
dudmuck	0:8f0d0ae0a077	36	/*!
dudmuck	0:8f0d0ae0a077	37	* Maximum MAC commands buffer size
dudmuck	0:8f0d0ae0a077	38	*/
dudmuck	0:8f0d0ae0a077	39	#define LORA_MAC_COMMAND_MAX_LENGTH 15
dudmuck	0:8f0d0ae0a077	40
dudmuck	0:8f0d0ae0a077	41	/*!
dudmuck	0:8f0d0ae0a077	42	* FRMPayload overhead to be used when setting the Radio.SetMaxPayloadLength
dudmuck	0:8f0d0ae0a077	43	* in RxWindowSetup function.
dudmuck	0:8f0d0ae0a077	44	* Maximum PHYPayload = MaxPayloadOfDatarate/MaxPayloadOfDatarateRepeater + LORA_MAC_FRMPAYLOAD_OVERHEAD
dudmuck	0:8f0d0ae0a077	45	*/
dudmuck	0:8f0d0ae0a077	46	#define LORA_MAC_FRMPAYLOAD_OVERHEAD 13 // MHDR(1) + FHDR(7) + Port(1) + MIC(4)
dudmuck	0:8f0d0ae0a077	47
dudmuck	0:8f0d0ae0a077	48	/*!
dudmuck	0:8f0d0ae0a077	49	* LoRaMac duty cycle for the back-off procedure during the first hour.
dudmuck	0:8f0d0ae0a077	50	*/
dudmuck	0:8f0d0ae0a077	51	#define BACKOFF_DC_1_HOUR 100
dudmuck	0:8f0d0ae0a077	52
dudmuck	0:8f0d0ae0a077	53	/*!
dudmuck	0:8f0d0ae0a077	54	* LoRaMac duty cycle for the back-off procedure during the next 10 hours.
dudmuck	0:8f0d0ae0a077	55	*/
dudmuck	0:8f0d0ae0a077	56	#define BACKOFF_DC_10_HOURS 1000
dudmuck	0:8f0d0ae0a077	57
dudmuck	0:8f0d0ae0a077	58	/*!
dudmuck	0:8f0d0ae0a077	59	* LoRaMac duty cycle for the back-off procedure during the next 24 hours.
dudmuck	0:8f0d0ae0a077	60	*/
dudmuck	0:8f0d0ae0a077	61	#define BACKOFF_DC_24_HOURS 10000
dudmuck	0:8f0d0ae0a077	62
dudmuck	20:42839629a5dc	63	#define DIO0_LAG_us 1000
dudmuck	20:42839629a5dc	64
dudmuck	0:8f0d0ae0a077	65	/*!
dudmuck	0:8f0d0ae0a077	66	* Device IEEE EUI
dudmuck	0:8f0d0ae0a077	67	*/
dudmuck	0:8f0d0ae0a077	68	static uint8_t *LoRaMacDevEui;
dudmuck	0:8f0d0ae0a077	69
dudmuck	0:8f0d0ae0a077	70	/*!
dudmuck	0:8f0d0ae0a077	71	* Application IEEE EUI
dudmuck	0:8f0d0ae0a077	72	*/
dudmuck	0:8f0d0ae0a077	73	static uint8_t *LoRaMacAppEui;
dudmuck	0:8f0d0ae0a077	74
dudmuck	0:8f0d0ae0a077	75	/*!
dudmuck	0:8f0d0ae0a077	76	* AES encryption/decryption cipher application key
dudmuck	0:8f0d0ae0a077	77	*/
dudmuck	0:8f0d0ae0a077	78	static uint8_t *LoRaMacAppKey;
dudmuck	0:8f0d0ae0a077	79
dudmuck	0:8f0d0ae0a077	80	/*!
dudmuck	0:8f0d0ae0a077	81	* AES encryption/decryption cipher network session key
dudmuck	0:8f0d0ae0a077	82	*/
dudmuck	0:8f0d0ae0a077	83	static uint8_t LoRaMacNwkSKey[] =
dudmuck	0:8f0d0ae0a077	84	{
dudmuck	0:8f0d0ae0a077	85	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
dudmuck	0:8f0d0ae0a077	86	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
dudmuck	0:8f0d0ae0a077	87	};
dudmuck	0:8f0d0ae0a077	88
dudmuck	0:8f0d0ae0a077	89	/*!
dudmuck	0:8f0d0ae0a077	90	* AES encryption/decryption cipher application session key
dudmuck	0:8f0d0ae0a077	91	*/
dudmuck	0:8f0d0ae0a077	92	static uint8_t LoRaMacAppSKey[] =
dudmuck	0:8f0d0ae0a077	93	{
dudmuck	0:8f0d0ae0a077	94	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
dudmuck	0:8f0d0ae0a077	95	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
dudmuck	0:8f0d0ae0a077	96	};
dudmuck	0:8f0d0ae0a077	97
dudmuck	0:8f0d0ae0a077	98	/*!
dudmuck	0:8f0d0ae0a077	99	* Device nonce is a random value extracted by issuing a sequence of RSSI
dudmuck	0:8f0d0ae0a077	100	* measurements
dudmuck	0:8f0d0ae0a077	101	*/
dudmuck	0:8f0d0ae0a077	102	static uint16_t LoRaMacDevNonce;
dudmuck	0:8f0d0ae0a077	103
dudmuck	0:8f0d0ae0a077	104	/*!
dudmuck	0:8f0d0ae0a077	105	* Network ID ( 3 bytes )
dudmuck	0:8f0d0ae0a077	106	*/
dudmuck	0:8f0d0ae0a077	107	static uint32_t LoRaMacNetID;
dudmuck	0:8f0d0ae0a077	108
dudmuck	0:8f0d0ae0a077	109	/*!
dudmuck	0:8f0d0ae0a077	110	* Mote Address
dudmuck	0:8f0d0ae0a077	111	*/
dudmuck	0:8f0d0ae0a077	112	static uint32_t LoRaMacDevAddr;
dudmuck	0:8f0d0ae0a077	113
dudmuck	0:8f0d0ae0a077	114	/*!
dudmuck	0:8f0d0ae0a077	115	* Multicast channels linked list
dudmuck	0:8f0d0ae0a077	116	*/
dudmuck	0:8f0d0ae0a077	117	static MulticastParams_t *MulticastChannels = NULL;
dudmuck	0:8f0d0ae0a077	118
dudmuck	0:8f0d0ae0a077	119	/*!
dudmuck	0:8f0d0ae0a077	120	* Actual device class
dudmuck	0:8f0d0ae0a077	121	*/
dudmuck	0:8f0d0ae0a077	122	static DeviceClass_t LoRaMacDeviceClass;
dudmuck	0:8f0d0ae0a077	123
dudmuck	0:8f0d0ae0a077	124	/*!
dudmuck	0:8f0d0ae0a077	125	* Indicates if the node is connected to a private or public network
dudmuck	0:8f0d0ae0a077	126	*/
dudmuck	0:8f0d0ae0a077	127	static bool PublicNetwork;
dudmuck	0:8f0d0ae0a077	128
dudmuck	0:8f0d0ae0a077	129	/*!
dudmuck	0:8f0d0ae0a077	130	* Buffer containing the data to be sent or received.
dudmuck	0:8f0d0ae0a077	131	*/
dudmuck	0:8f0d0ae0a077	132	static uint8_t LoRaMacBuffer[LORAMAC_PHY_MAXPAYLOAD];
dudmuck	0:8f0d0ae0a077	133
dudmuck	0:8f0d0ae0a077	134	/*!
dudmuck	0:8f0d0ae0a077	135	* Length of packet in LoRaMacBuffer
dudmuck	0:8f0d0ae0a077	136	*/
dudmuck	0:8f0d0ae0a077	137	static uint16_t LoRaMacBufferPktLen = 0;
dudmuck	0:8f0d0ae0a077	138
dudmuck	0:8f0d0ae0a077	139	/*!
dudmuck	0:8f0d0ae0a077	140	* Length of the payload in LoRaMacBuffer
dudmuck	0:8f0d0ae0a077	141	*/
dudmuck	0:8f0d0ae0a077	142	static uint8_t LoRaMacTxPayloadLen = 0;
dudmuck	0:8f0d0ae0a077	143
dudmuck	0:8f0d0ae0a077	144	/*!
dudmuck	0:8f0d0ae0a077	145	* Buffer containing the upper layer data.
dudmuck	0:8f0d0ae0a077	146	*/
dudmuck	0:8f0d0ae0a077	147	static uint8_t LoRaMacRxPayload[LORAMAC_PHY_MAXPAYLOAD];
dudmuck	0:8f0d0ae0a077	148
dudmuck	0:8f0d0ae0a077	149	/*!
dudmuck	0:8f0d0ae0a077	150	* LoRaMAC frame counter. Each time a packet is sent the counter is incremented.
dudmuck	0:8f0d0ae0a077	151	* Only the 16 LSB bits are sent
dudmuck	0:8f0d0ae0a077	152	*/
dudmuck	0:8f0d0ae0a077	153	static uint32_t UpLinkCounter = 0;
dudmuck	0:8f0d0ae0a077	154
dudmuck	0:8f0d0ae0a077	155	/*!
dudmuck	0:8f0d0ae0a077	156	* LoRaMAC frame counter. Each time a packet is received the counter is incremented.
dudmuck	0:8f0d0ae0a077	157	* Only the 16 LSB bits are received
dudmuck	0:8f0d0ae0a077	158	*/
dudmuck	0:8f0d0ae0a077	159	static uint32_t DownLinkCounter = 0;
dudmuck	0:8f0d0ae0a077	160
dudmuck	0:8f0d0ae0a077	161	/*!
dudmuck	0:8f0d0ae0a077	162	* IsPacketCounterFixed enables the MIC field tests by fixing the
dudmuck	0:8f0d0ae0a077	163	* UpLinkCounter value
dudmuck	0:8f0d0ae0a077	164	*/
dudmuck	16:915815632c1f	165	//static bool IsUpLinkCounterFixed = false;
dudmuck	0:8f0d0ae0a077	166
dudmuck	0:8f0d0ae0a077	167	/*!
dudmuck	0:8f0d0ae0a077	168	* Used for test purposes. Disables the opening of the reception windows.
dudmuck	0:8f0d0ae0a077	169	*/
dudmuck	0:8f0d0ae0a077	170	static bool IsRxWindowsEnabled = true;
dudmuck	0:8f0d0ae0a077	171	LowPowerTimeout rx_timeout;
dudmuck	0:8f0d0ae0a077	172
dudmuck	0:8f0d0ae0a077	173	/*!
dudmuck	0:8f0d0ae0a077	174	* Indicates if the MAC layer has already joined a network.
dudmuck	0:8f0d0ae0a077	175	*/
dudmuck	0:8f0d0ae0a077	176	static bool IsLoRaMacNetworkJoined = false;
dudmuck	0:8f0d0ae0a077	177
dudmuck	0:8f0d0ae0a077	178	/*!
dudmuck	0:8f0d0ae0a077	179	* If the node has sent a FRAME_TYPE_DATA_CONFIRMED_UP this variable indicates
dudmuck	0:8f0d0ae0a077	180	* if the nodes needs to manage the server acknowledgement.
dudmuck	0:8f0d0ae0a077	181	*/
dudmuck	0:8f0d0ae0a077	182	static bool NodeAckRequested = false;
dudmuck	0:8f0d0ae0a077	183
dudmuck	0:8f0d0ae0a077	184	/*!
dudmuck	0:8f0d0ae0a077	185	* If the server has sent a FRAME_TYPE_DATA_CONFIRMED_DOWN this variable indicates
dudmuck	0:8f0d0ae0a077	186	* if the ACK bit must be set for the next transmission
dudmuck	0:8f0d0ae0a077	187	*/
dudmuck	0:8f0d0ae0a077	188	static bool SrvAckRequested = false;
dudmuck	0:8f0d0ae0a077	189
dudmuck	0:8f0d0ae0a077	190	/*!
dudmuck	0:8f0d0ae0a077	191	* Indicates if the MAC layer wants to send MAC commands
dudmuck	0:8f0d0ae0a077	192	*/
dudmuck	0:8f0d0ae0a077	193	static bool MacCommandsInNextTx = false;
dudmuck	0:8f0d0ae0a077	194
dudmuck	0:8f0d0ae0a077	195	/*!
dudmuck	0:8f0d0ae0a077	196	* Contains the current MacCommandsBuffer index
dudmuck	0:8f0d0ae0a077	197	*/
dudmuck	0:8f0d0ae0a077	198	static uint8_t MacCommandsBufferIndex = 0;
dudmuck	0:8f0d0ae0a077	199
dudmuck	0:8f0d0ae0a077	200	/*!
dudmuck	0:8f0d0ae0a077	201	* Contains the current MacCommandsBuffer index for MAC commands to repeat
dudmuck	0:8f0d0ae0a077	202	*/
dudmuck	0:8f0d0ae0a077	203	static uint8_t MacCommandsBufferToRepeatIndex = 0;
dudmuck	0:8f0d0ae0a077	204
dudmuck	0:8f0d0ae0a077	205	/*!
dudmuck	0:8f0d0ae0a077	206	* Buffer containing the MAC layer commands
dudmuck	0:8f0d0ae0a077	207	*/
dudmuck	0:8f0d0ae0a077	208	static uint8_t MacCommandsBuffer[LORA_MAC_COMMAND_MAX_LENGTH];
dudmuck	0:8f0d0ae0a077	209
dudmuck	0:8f0d0ae0a077	210	/*!
dudmuck	0:8f0d0ae0a077	211	* Buffer containing the MAC layer commands which must be repeated
dudmuck	0:8f0d0ae0a077	212	*/
dudmuck	0:8f0d0ae0a077	213	static uint8_t MacCommandsBufferToRepeat[LORA_MAC_COMMAND_MAX_LENGTH];
dudmuck	0:8f0d0ae0a077	214
dudmuck	18:9ac71c0eb70d	215	#define BEACON_SIZE 6 /* bytes */
dudmuck	18:9ac71c0eb70d	216	#define BEACON_CHANNEL_DR LORAMAC_DEFAULT_DATARATE
dudmuck	18:9ac71c0eb70d	217
dudmuck	18:9ac71c0eb70d	218
dudmuck	0:8f0d0ae0a077	219	#if defined( USE_BAND_915_SINGLE )
dudmuck	18:9ac71c0eb70d	220	/*!
dudmuck	18:9ac71c0eb70d	221	* Data rates table definition
dudmuck	18:9ac71c0eb70d	222	*/
dudmuck	18:9ac71c0eb70d	223	const uint8_t Datarates[] = { 10, 9, 8, 7, 8, 0, 0, 0, 12, 11, 10, 9, 8, 7, 0, 0 };
dudmuck	18:9ac71c0eb70d	224
dudmuck	18:9ac71c0eb70d	225	/*!
dudmuck	18:9ac71c0eb70d	226	* Bandwidths table definition in Hz
dudmuck	18:9ac71c0eb70d	227	*/
dudmuck	18:9ac71c0eb70d	228	const uint32_t Bandwidths[] = { 125000, 125000, 125000, 125000, 500000, 0, 0, 0, 500000, 500000, 500000, 500000, 500000, 500000, 0, 0 };
dudmuck	18:9ac71c0eb70d	229
dudmuck	18:9ac71c0eb70d	230	/*!
dudmuck	18:9ac71c0eb70d	231	* LoRaMac bands
dudmuck	18:9ac71c0eb70d	232	*/
dudmuck	18:9ac71c0eb70d	233	/*static Band_t Bands[LORA_MAX_NB_BANDS] =
dudmuck	18:9ac71c0eb70d	234	{
dudmuck	18:9ac71c0eb70d	235	BAND0,
dudmuck	18:9ac71c0eb70d	236	};*/
dudmuck	18:9ac71c0eb70d	237
dudmuck	18:9ac71c0eb70d	238	/*!
dudmuck	18:9ac71c0eb70d	239	* Tx output powers table definition
dudmuck	18:9ac71c0eb70d	240	*/
dudmuck	23:a862b5601663	241	// 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
dudmuck	23:a862b5601663	242	const int8_t TxPowers[] = { 30, 28, 26, 24, 22, 20, 18, 16, 14, 12, 10, 8, 6, 4, 2, 0 };
dudmuck	18:9ac71c0eb70d	243	#define LORAMAC_FIRST_CHANNEL ( (uint32_t)910.0e6 )
dudmuck	18:9ac71c0eb70d	244	#define LORAMAC_STEPWIDTH_CHANNEL ( (uint32_t)800e3 )
dudmuck	18:9ac71c0eb70d	245	#define LORA_MAX_NB_CHANNELS 8
dudmuck	18:9ac71c0eb70d	246
dudmuck	18:9ac71c0eb70d	247	#define LORA_BANDWIDTH 2 /* 2=500KHz */
dudmuck	18:9ac71c0eb70d	248
dudmuck	18:9ac71c0eb70d	249	/* measured beacon duration (all at bw500, 6 byte fixed payload length)
dudmuck	18:9ac71c0eb70d	250	* latency assigned for correct rx-before-tx measurement */
dudmuck	18:9ac71c0eb70d	251	#if (LORAMAC_DEFAULT_DATARATE == DR_8)
dudmuck	18:9ac71c0eb70d	252	#define BEACON_RXDONE_LATENCY_us 6000
dudmuck	18:9ac71c0eb70d	253	#define BEACON_TOA_us 209000
dudmuck	18:9ac71c0eb70d	254	#elif (LORAMAC_DEFAULT_DATARATE == DR_9)
dudmuck	18:9ac71c0eb70d	255	#define BEACON_RXDONE_LATENCY_us 3500
dudmuck	18:9ac71c0eb70d	256	#define BEACON_TOA_us 105000
dudmuck	18:9ac71c0eb70d	257	#elif (LORAMAC_DEFAULT_DATARATE == DR_10)
dudmuck	18:9ac71c0eb70d	258	#define BEACON_RXDONE_LATENCY_us 1460
dudmuck	18:9ac71c0eb70d	259	#define BEACON_TOA_us 52800
dudmuck	18:9ac71c0eb70d	260	#elif (LORAMAC_DEFAULT_DATARATE == DR_11)
dudmuck	18:9ac71c0eb70d	261	#define BEACON_RXDONE_LATENCY_us 2000
dudmuck	18:9ac71c0eb70d	262	#define BEACON_TOA_us 26000
dudmuck	18:9ac71c0eb70d	263	#elif (LORAMAC_DEFAULT_DATARATE == DR_12)
dudmuck	18:9ac71c0eb70d	264	#define BEACON_RXDONE_LATENCY_us 1500
dudmuck	18:9ac71c0eb70d	265	#define BEACON_TOA_us 12800
dudmuck	18:9ac71c0eb70d	266	#elif (LORAMAC_DEFAULT_DATARATE == DR_13)
dudmuck	18:9ac71c0eb70d	267	#define BEACON_RXDONE_LATENCY_us 1300
dudmuck	18:9ac71c0eb70d	268	#define BEACON_TOA_us 6560
dudmuck	18:9ac71c0eb70d	269	#else
dudmuck	18:9ac71c0eb70d	270	#error datarate
dudmuck	18:9ac71c0eb70d	271	#endif
dudmuck	18:9ac71c0eb70d	272
dudmuck	18:9ac71c0eb70d	273	/* end us915 */
dudmuck	18:9ac71c0eb70d	274	#elif defined(USE_BAND_433) && defined(ENABLE_SX1276)
dudmuck	18:9ac71c0eb70d	275	const uint8_t Datarates[] = { 12, 11, 10, 9, 8, 7, 7, 50 };
dudmuck	18:9ac71c0eb70d	276	const uint32_t Bandwidths[] = { 125000, 125000, 125000, 125000, 125000, 125000, 250000, 0 };
dudmuck	18:9ac71c0eb70d	277	const int8_t TxPowers[] = { 10, 7, 4, 1, -2, -5 };
dudmuck	18:9ac71c0eb70d	278	#define LORA_BANDWIDTH 0 /* 0=125KHz */
dudmuck	18:9ac71c0eb70d	279
dudmuck	18:9ac71c0eb70d	280	#define LORAMAC_FIRST_CHANNEL ( (uint32_t)433.32e6 )
dudmuck	18:9ac71c0eb70d	281	#define LORAMAC_STEPWIDTH_CHANNEL ( (uint32_t)200e3 )
dudmuck	18:9ac71c0eb70d	282	#define LORA_MAX_NB_CHANNELS 7
dudmuck	18:9ac71c0eb70d	283
dudmuck	18:9ac71c0eb70d	284	#if (LORAMAC_DEFAULT_DATARATE == DR_0)
dudmuck	18:9ac71c0eb70d	285	#define BEACON_RXDONE_LATENCY_us 27500
dudmuck	18:9ac71c0eb70d	286	#define BEACON_TOA_us 828100
dudmuck	18:9ac71c0eb70d	287	#elif (LORAMAC_DEFAULT_DATARATE == DR_1)
dudmuck	18:9ac71c0eb70d	288	#define BEACON_RXDONE_LATENCY_us 12500
dudmuck	18:9ac71c0eb70d	289	#define BEACON_TOA_us 414400
dudmuck	18:9ac71c0eb70d	290	#elif (LORAMAC_DEFAULT_DATARATE == DR_2)
dudmuck	18:9ac71c0eb70d	291	#define BEACON_RXDONE_LATENCY_us 6000
dudmuck	18:9ac71c0eb70d	292	#define BEACON_TOA_us 207500
dudmuck	18:9ac71c0eb70d	293	#elif (LORAMAC_DEFAULT_DATARATE == DR_3)
dudmuck	18:9ac71c0eb70d	294	#define BEACON_RXDONE_LATENCY_us 3840
dudmuck	18:9ac71c0eb70d	295	#define BEACON_TOA_us 103000
dudmuck	18:9ac71c0eb70d	296	#elif (LORAMAC_DEFAULT_DATARATE == DR_4)
dudmuck	18:9ac71c0eb70d	297	#define BEACON_RXDONE_LATENCY_us 2800
dudmuck	18:9ac71c0eb70d	298	#define BEACON_TOA_us 51000
dudmuck	18:9ac71c0eb70d	299	#elif (LORAMAC_DEFAULT_DATARATE == DR_5)
dudmuck	18:9ac71c0eb70d	300	#define BEACON_RXDONE_LATENCY_us 1400
dudmuck	18:9ac71c0eb70d	301	#define BEACON_TOA_us 25800
dudmuck	18:9ac71c0eb70d	302	#else
dudmuck	18:9ac71c0eb70d	303	#error datarate
dudmuck	18:9ac71c0eb70d	304	#endif
dudmuck	18:9ac71c0eb70d	305
dudmuck	18:9ac71c0eb70d	306	/* end USE_BAND_433 */
dudmuck	18:9ac71c0eb70d	307	#else
dudmuck	18:9ac71c0eb70d	308	#error "Please define a frequency band in the compiler options."
dudmuck	0:8f0d0ae0a077	309	#endif
dudmuck	0:8f0d0ae0a077	310
dudmuck	18:9ac71c0eb70d	311	static ChannelParams_t Channels[LORA_MAX_NB_CHANNELS]; // populated in init
dudmuck	18:9ac71c0eb70d	312
dudmuck	16:915815632c1f	313	#define BEACON_GUARD_us 2000000 // pre-beacon start
dudmuck	0:8f0d0ae0a077	314	#define BEACON_RESERVED_us 2120000 // post-beacon start
dudmuck	0:8f0d0ae0a077	315
dudmuck	0:8f0d0ae0a077	316	#define BEACON_MIN_SYMBOL_TIMEOUT 8
dudmuck	0:8f0d0ae0a077	317
dudmuck	0:8f0d0ae0a077	318	LowPowerTimer lp_timer;
dudmuck	0:8f0d0ae0a077	319
dudmuck	13:18de9ee3a461	320	#ifdef DEBUG_GWTX_JUMPER
dudmuck	13:18de9ee3a461	321	InterruptIn gwtx_pin(DEBUG_GWTX_JUMPER);
dudmuck	13:18de9ee3a461	322	unsigned int gwtx_rise_us;
dudmuck	13:18de9ee3a461	323
dudmuck	13:18de9ee3a461	324	void gwtx_pin_callback()
dudmuck	13:18de9ee3a461	325	{
dudmuck	13:18de9ee3a461	326	gwtx_rise_us = lp_timer.read_us();
dudmuck	13:18de9ee3a461	327	}
dudmuck	13:18de9ee3a461	328	#endif
dudmuck	13:18de9ee3a461	329
dudmuck	0:8f0d0ae0a077	330	/*!
dudmuck	0:8f0d0ae0a077	331	* LoRaMac parameters
dudmuck	0:8f0d0ae0a077	332	*/
dudmuck	0:8f0d0ae0a077	333	LoRaMacParams_t LoRaMacParams;
dudmuck	0:8f0d0ae0a077	334
dudmuck	0:8f0d0ae0a077	335	/*!
dudmuck	0:8f0d0ae0a077	336	* LoRaMac default parameters
dudmuck	0:8f0d0ae0a077	337	*/
dudmuck	0:8f0d0ae0a077	338	LoRaMacParams_t LoRaMacParamsDefaults;
dudmuck	0:8f0d0ae0a077	339
dudmuck	0:8f0d0ae0a077	340	/*!
dudmuck	0:8f0d0ae0a077	341	* Uplink messages repetitions counter
dudmuck	0:8f0d0ae0a077	342	*/
dudmuck	0:8f0d0ae0a077	343	static uint8_t ChannelsNbRepCounter = 0;
dudmuck	0:8f0d0ae0a077	344
dudmuck	0:8f0d0ae0a077	345	static uint32_t AggregatedLastTxDoneTime_us;
dudmuck	0:8f0d0ae0a077	346
dudmuck	0:8f0d0ae0a077	347	/*!
dudmuck	0:8f0d0ae0a077	348	* Current channel index
dudmuck	0:8f0d0ae0a077	349	*/
dudmuck	0:8f0d0ae0a077	350	static uint8_t Channel;
dudmuck	0:8f0d0ae0a077	351
dudmuck	0:8f0d0ae0a077	352	/*!
dudmuck	0:8f0d0ae0a077	353	* Stores the time at LoRaMac initialization.
dudmuck	0:8f0d0ae0a077	354	*
dudmuck	0:8f0d0ae0a077	355	* \remark Used for the BACKOFF_DC computation.
dudmuck	0:8f0d0ae0a077	356	*/
dudmuck	0:8f0d0ae0a077	357	//static TimerTime_t LoRaMacInitializationTime = 0;
dudmuck	0:8f0d0ae0a077	358
dudmuck	0:8f0d0ae0a077	359	/*!
dudmuck	0:8f0d0ae0a077	360	* LoRaMac upper layer event functions
dudmuck	0:8f0d0ae0a077	361	*/
dudmuck	0:8f0d0ae0a077	362	static LoRaMacPrimitives_t *LoRaMacPrimitives;
dudmuck	0:8f0d0ae0a077	363
dudmuck	0:8f0d0ae0a077	364	/*!
dudmuck	0:8f0d0ae0a077	365	* LoRaMac upper layer callback functions
dudmuck	0:8f0d0ae0a077	366	*/
dudmuck	0:8f0d0ae0a077	367	static LoRaMacCallback_t *LoRaMacCallbacks;
dudmuck	0:8f0d0ae0a077	368
dudmuck	0:8f0d0ae0a077	369	/*!
dudmuck	0:8f0d0ae0a077	370	* Radio events function pointer
dudmuck	0:8f0d0ae0a077	371	*/
dudmuck	0:8f0d0ae0a077	372	static RadioEvents_t RadioEvents;
dudmuck	0:8f0d0ae0a077	373
dudmuck	0:8f0d0ae0a077	374	/*!
dudmuck	0:8f0d0ae0a077	375	* LoRaMac duty cycle delayed Tx timer
dudmuck	0:8f0d0ae0a077	376	*/
dudmuck	0:8f0d0ae0a077	377	LowPowerTimeout tx_timeout;
dudmuck	0:8f0d0ae0a077	378
dudmuck	0:8f0d0ae0a077	379
dudmuck	0:8f0d0ae0a077	380	/*!
dudmuck	0:8f0d0ae0a077	381	* LoRaMac reception windows delay
dudmuck	0:8f0d0ae0a077	382	* \remark normal frame: RxWindowXDelay = ReceiveDelayX - RADIO_WAKEUP_TIME
dudmuck	0:8f0d0ae0a077	383	* join frame : RxWindowXDelay = JoinAcceptDelayX - RADIO_WAKEUP_TIME
dudmuck	0:8f0d0ae0a077	384	*/
dudmuck	0:8f0d0ae0a077	385	static uint32_t RxWindowDelay_us;
dudmuck	0:8f0d0ae0a077	386
dudmuck	0:8f0d0ae0a077	387	typedef enum {
dudmuck	0:8f0d0ae0a077	388	BEACON_STATE_NONE = 0,
dudmuck	0:8f0d0ae0a077	389	BEACON_STATE_FIRST_ACQ,
dudmuck	0:8f0d0ae0a077	390	BEACON_STATE_ACQ_ERROR,
dudmuck	21:500ff43d8424	391	BEACON_STATE_LOCKED,
dudmuck	0:8f0d0ae0a077	392	} beacon_state_e;
dudmuck	0:8f0d0ae0a077	393
dudmuck	16:915815632c1f	394	static struct beacon_struct {
dudmuck	0:8f0d0ae0a077	395	int rx_precession_us; // positive: rxing before tx start, negative: rxing after tx start
dudmuck	0:8f0d0ae0a077	396	unsigned int RxBeaconSetupAt_us;
dudmuck	0:8f0d0ae0a077	397	unsigned int LastBeaconRx_us; // updated only at beacon reception
dudmuck	13:18de9ee3a461	398	int last_BeaconRxTimerError_us;
dudmuck	13:18de9ee3a461	399	int known_working_BeaconRxTimerError_us;
dudmuck	0:8f0d0ae0a077	400
dudmuck	0:8f0d0ae0a077	401	float symbol_period_secs;
dudmuck	0:8f0d0ae0a077	402
dudmuck	0:8f0d0ae0a077	403	uint8_t Precess_symbols; // how many symbols we want to start receiver before expected transmitter
dudmuck	16:915815632c1f	404	uint16_t SymbolTimeout;
dudmuck	0:8f0d0ae0a077	405	float SymbolTimeout_sec;
dudmuck	0:8f0d0ae0a077	406	uint8_t num_missed;
dudmuck	0:8f0d0ae0a077	407
dudmuck	0:8f0d0ae0a077	408	beacon_state_e state;
dudmuck	0:8f0d0ae0a077	409
dudmuck	0:8f0d0ae0a077	410	uint16_t tx_slot_offset;
dudmuck	0:8f0d0ae0a077	411	uint16_t periodicity_slots;
dudmuck	0:8f0d0ae0a077	412
dudmuck	16:915815632c1f	413	LowPowerTimeout timeout_rx;
dudmuck	16:915815632c1f	414	LowPowerTimeout timeout_guard;
dudmuck	16:915815632c1f	415	bool guard;
dudmuck	17:3215f12051f9	416	unsigned guard_at;
dudmuck	0:8f0d0ae0a077	417	} BeaconCtx;
dudmuck	16:915815632c1f	418	bool expecting_beacon;
dudmuck	0:8f0d0ae0a077	419
dudmuck	0:8f0d0ae0a077	420	/*!
dudmuck	0:8f0d0ae0a077	421	* Rx window parameters
dudmuck	0:8f0d0ae0a077	422	*/
dudmuck	0:8f0d0ae0a077	423	typedef struct
dudmuck	0:8f0d0ae0a077	424	{
dudmuck	0:8f0d0ae0a077	425	int8_t Datarate;
dudmuck	0:8f0d0ae0a077	426	uint8_t Bandwidth;
dudmuck	0:8f0d0ae0a077	427	uint32_t RxWindowTimeout;
dudmuck	0:8f0d0ae0a077	428	int32_t RxOffset;
dudmuck	0:8f0d0ae0a077	429	}RxConfigParams_t;
dudmuck	0:8f0d0ae0a077	430
dudmuck	0:8f0d0ae0a077	431	/*!
dudmuck	0:8f0d0ae0a077	432	* Rx windows params
dudmuck	0:8f0d0ae0a077	433	*/
dudmuck	0:8f0d0ae0a077	434	static RxConfigParams_t RxWindowsParam;
dudmuck	0:8f0d0ae0a077	435
dudmuck	16:915815632c1f	436
dudmuck	0:8f0d0ae0a077	437	/*!
dudmuck	0:8f0d0ae0a077	438	* Acknowledge timeout timer. Used for packet retransmissions.
dudmuck	0:8f0d0ae0a077	439	*/
dudmuck	0:8f0d0ae0a077	440	static LowPowerTimeout AckTimeoutTimer;
dudmuck	0:8f0d0ae0a077	441
dudmuck	0:8f0d0ae0a077	442	uint32_t TxTimeOnAir = 0;
dudmuck	0:8f0d0ae0a077	443
dudmuck	0:8f0d0ae0a077	444	/*!
dudmuck	0:8f0d0ae0a077	445	* Number of trials for the Join Request
dudmuck	0:8f0d0ae0a077	446	*/
dudmuck	0:8f0d0ae0a077	447	static uint8_t JoinRequestTrials;
dudmuck	0:8f0d0ae0a077	448
dudmuck	0:8f0d0ae0a077	449	/*!
dudmuck	0:8f0d0ae0a077	450	* Maximum number of trials for the Join Request
dudmuck	0:8f0d0ae0a077	451	*/
dudmuck	0:8f0d0ae0a077	452	static uint8_t MaxJoinRequestTrials;
dudmuck	0:8f0d0ae0a077	453
dudmuck	0:8f0d0ae0a077	454	/*!
dudmuck	0:8f0d0ae0a077	455	* Structure to hold an MCPS indication data.
dudmuck	0:8f0d0ae0a077	456	*/
dudmuck	0:8f0d0ae0a077	457	static McpsIndication_t McpsIndication;
dudmuck	0:8f0d0ae0a077	458
dudmuck	0:8f0d0ae0a077	459	/*!
dudmuck	0:8f0d0ae0a077	460	* Structure to hold MCPS confirm data.
dudmuck	0:8f0d0ae0a077	461	*/
dudmuck	0:8f0d0ae0a077	462	static McpsConfirm_t McpsConfirm;
dudmuck	0:8f0d0ae0a077	463
dudmuck	0:8f0d0ae0a077	464	/*!
dudmuck	0:8f0d0ae0a077	465	* Structure to hold MLME confirm data.
dudmuck	0:8f0d0ae0a077	466	*/
dudmuck	0:8f0d0ae0a077	467	static MlmeConfirm_t MlmeConfirm;
dudmuck	0:8f0d0ae0a077	468
dudmuck	0:8f0d0ae0a077	469	/*!
dudmuck	0:8f0d0ae0a077	470	* Structure to hold MLME indication data.
dudmuck	0:8f0d0ae0a077	471	*/
dudmuck	0:8f0d0ae0a077	472	static MlmeIndication_t MlmeIndication;
dudmuck	0:8f0d0ae0a077	473
dudmuck	0:8f0d0ae0a077	474	/*!
dudmuck	0:8f0d0ae0a077	475	* LoRaMac tx/rx operation state
dudmuck	0:8f0d0ae0a077	476	*/
dudmuck	0:8f0d0ae0a077	477	LoRaMacFlags_t LoRaMacFlags;
dudmuck	20:42839629a5dc	478	static volatile struct {
dudmuck	20:42839629a5dc	479	uint8_t rx_win : 1;
dudmuck	20:42839629a5dc	480	uint8_t join_send : 1;
dudmuck	20:42839629a5dc	481	uint8_t beacon_setup : 1;
dudmuck	20:42839629a5dc	482	uint8_t send : 1;
dudmuck	20:42839629a5dc	483	} flags;
dudmuck	0:8f0d0ae0a077	484
dudmuck	0:8f0d0ae0a077	485	/*!
dudmuck	0:8f0d0ae0a077	486	* \brief Function to be executed on Radio Tx Done event
dudmuck	0:8f0d0ae0a077	487	*/
dudmuck	0:8f0d0ae0a077	488	static void OnRadioTxDone( unsigned int tx_done_us );
dudmuck	0:8f0d0ae0a077	489	unsigned int TxDone_us;
dudmuck	0:8f0d0ae0a077	490
dudmuck	0:8f0d0ae0a077	491	/*!
dudmuck	0:8f0d0ae0a077	492	* \brief This function prepares the MAC to abort the execution of function
dudmuck	0:8f0d0ae0a077	493	* OnRadioRxDone in case of a reception error.
dudmuck	0:8f0d0ae0a077	494	*/
dudmuck	0:8f0d0ae0a077	495	static void PrepareRxDoneAbort( void );
dudmuck	0:8f0d0ae0a077	496
dudmuck	0:8f0d0ae0a077	497	/*!
dudmuck	0:8f0d0ae0a077	498	* \brief Function to be executed on Radio Rx Done event
dudmuck	0:8f0d0ae0a077	499	*/
dudmuck	0:8f0d0ae0a077	500	static void OnRadioRxDone(unsigned rx_us, uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr );
dudmuck	0:8f0d0ae0a077	501
dudmuck	0:8f0d0ae0a077	502	/*!
dudmuck	0:8f0d0ae0a077	503	* \brief Function executed on Radio Tx Timeout event
dudmuck	0:8f0d0ae0a077	504	*/
dudmuck	0:8f0d0ae0a077	505	static void OnRadioTxTimeout( void );
dudmuck	0:8f0d0ae0a077	506
dudmuck	0:8f0d0ae0a077	507	/*!
dudmuck	0:8f0d0ae0a077	508	* \brief Function executed on Radio Rx error event
dudmuck	0:8f0d0ae0a077	509	*/
dudmuck	0:8f0d0ae0a077	510	static void OnRadioRxError( void );
dudmuck	0:8f0d0ae0a077	511
dudmuck	0:8f0d0ae0a077	512	/*!
dudmuck	0:8f0d0ae0a077	513	* \brief Function executed on Radio Rx Timeout event
dudmuck	0:8f0d0ae0a077	514	*/
dudmuck	0:8f0d0ae0a077	515	static void OnRadioRxTimeout( void );
dudmuck	0:8f0d0ae0a077	516
dudmuck	0:8f0d0ae0a077	517	static void OnRxWindowTimerEvent( void );
dudmuck	0:8f0d0ae0a077	518
dudmuck	0:8f0d0ae0a077	519	/*!
dudmuck	0:8f0d0ae0a077	520	* \brief Function executed on AckTimeout timer event
dudmuck	0:8f0d0ae0a077	521	*/
dudmuck	0:8f0d0ae0a077	522	static void OnAckTimeoutTimerEvent( void );
dudmuck	0:8f0d0ae0a077	523
dudmuck	0:8f0d0ae0a077	524
dudmuck	0:8f0d0ae0a077	525	/*!
dudmuck	0:8f0d0ae0a077	526	* \brief Initializes and opens the reception window
dudmuck	0:8f0d0ae0a077	527	*
dudmuck	0:8f0d0ae0a077	528	* \param [IN] freq window channel frequency
dudmuck	0:8f0d0ae0a077	529	* \param [IN] datarate window channel datarate
dudmuck	0:8f0d0ae0a077	530	* \param [IN] bandwidth window channel bandwidth
dudmuck	0:8f0d0ae0a077	531	* \param [IN] timeout window channel timeout
dudmuck	0:8f0d0ae0a077	532	*
dudmuck	0:8f0d0ae0a077	533	* \retval status Operation status [true: Success, false: Fail]
dudmuck	0:8f0d0ae0a077	534	*/
dudmuck	0:8f0d0ae0a077	535	static bool RxWindowSetup( uint32_t freq, int8_t datarate, uint32_t bandwidth, uint16_t timeout, bool rxContinuous );
dudmuck	0:8f0d0ae0a077	536
dudmuck	0:8f0d0ae0a077	537	/*!
dudmuck	0:8f0d0ae0a077	538	* \brief Adds a new MAC command to be sent.
dudmuck	0:8f0d0ae0a077	539	*
dudmuck	0:8f0d0ae0a077	540	* \Remark MAC layer internal function
dudmuck	0:8f0d0ae0a077	541	*
dudmuck	0:8f0d0ae0a077	542	* \param [in] cmd MAC command to be added
dudmuck	0:8f0d0ae0a077	543	* [MOTE_MAC_LINK_CHECK_REQ,
dudmuck	0:8f0d0ae0a077	544	* MOTE_MAC_LINK_ADR_ANS,
dudmuck	0:8f0d0ae0a077	545	* MOTE_MAC_DUTY_CYCLE_ANS,
dudmuck	0:8f0d0ae0a077	546	* MOTE_MAC_RX2_PARAM_SET_ANS,
dudmuck	0:8f0d0ae0a077	547	* MOTE_MAC_DEV_STATUS_ANS
dudmuck	0:8f0d0ae0a077	548	* MOTE_MAC_NEW_CHANNEL_ANS]
dudmuck	0:8f0d0ae0a077	549	* \param [in] p1 1st parameter ( optional depends on the command )
dudmuck	0:8f0d0ae0a077	550	* \param [in] p2 2nd parameter ( optional depends on the command )
dudmuck	0:8f0d0ae0a077	551	*
dudmuck	0:8f0d0ae0a077	552	* \retval status Function status [0: OK, 1: Unknown command, 2: Buffer full]
dudmuck	0:8f0d0ae0a077	553	*/
dudmuck	0:8f0d0ae0a077	554	static LoRaMacStatus_t AddMacCommand( uint8_t cmd, uint8_t p1, uint8_t p2 );
dudmuck	0:8f0d0ae0a077	555
dudmuck	0:8f0d0ae0a077	556	/*!
dudmuck	0:8f0d0ae0a077	557	* \brief Parses the MAC commands which must be repeated.
dudmuck	0:8f0d0ae0a077	558	*
dudmuck	0:8f0d0ae0a077	559	* \Remark MAC layer internal function
dudmuck	0:8f0d0ae0a077	560	*
dudmuck	0:8f0d0ae0a077	561	* \param [IN] cmdBufIn Buffer which stores the MAC commands to send
dudmuck	0:8f0d0ae0a077	562	* \param [IN] length Length of the input buffer to parse
dudmuck	0:8f0d0ae0a077	563	* \param [OUT] cmdBufOut Buffer which stores the MAC commands which must be
dudmuck	0:8f0d0ae0a077	564	* repeated.
dudmuck	0:8f0d0ae0a077	565	*
dudmuck	0:8f0d0ae0a077	566	* \retval Size of the MAC commands to repeat.
dudmuck	0:8f0d0ae0a077	567	*/
dudmuck	0:8f0d0ae0a077	568	static uint8_t ParseMacCommandsToRepeat( uint8_t* cmdBufIn, uint8_t length, uint8_t* cmdBufOut );
dudmuck	0:8f0d0ae0a077	569
dudmuck	0:8f0d0ae0a077	570	/*!
dudmuck	0:8f0d0ae0a077	571	* \brief Verifies, if a value is in a given range.
dudmuck	0:8f0d0ae0a077	572	*
dudmuck	0:8f0d0ae0a077	573	* \param value Value to verify, if it is in range
dudmuck	0:8f0d0ae0a077	574	*
dudmuck	0:8f0d0ae0a077	575	* \param min Minimum possible value
dudmuck	0:8f0d0ae0a077	576	*
dudmuck	0:8f0d0ae0a077	577	* \param max Maximum possible value
dudmuck	0:8f0d0ae0a077	578	*
dudmuck	0:8f0d0ae0a077	579	* \retval Returns the maximum valid tx power
dudmuck	0:8f0d0ae0a077	580	*/
dudmuck	0:8f0d0ae0a077	581	static bool ValueInRange( int8_t value, int8_t min, int8_t max );
dudmuck	0:8f0d0ae0a077	582
dudmuck	0:8f0d0ae0a077	583
dudmuck	0:8f0d0ae0a077	584	/*!
dudmuck	0:8f0d0ae0a077	585	* \brief Decodes MAC commands in the fOpts field and in the payload
dudmuck	0:8f0d0ae0a077	586	*/
dudmuck	0:8f0d0ae0a077	587	static void ProcessMacCommands( uint8_t *payload, uint8_t macIndex, uint8_t commandsSize, uint8_t snr );
dudmuck	0:8f0d0ae0a077	588
dudmuck	0:8f0d0ae0a077	589	/*!
dudmuck	0:8f0d0ae0a077	590	* \brief LoRaMAC layer generic send frame
dudmuck	0:8f0d0ae0a077	591	*
dudmuck	0:8f0d0ae0a077	592	* \param [IN] macHdr MAC header field
dudmuck	0:8f0d0ae0a077	593	* \param [IN] fPort MAC payload port
dudmuck	0:8f0d0ae0a077	594	* \param [IN] fBuffer MAC data buffer to be sent
dudmuck	0:8f0d0ae0a077	595	* \param [IN] fBufferSize MAC data buffer size
dudmuck	0:8f0d0ae0a077	596	* \retval status Status of the operation.
dudmuck	0:8f0d0ae0a077	597	*/
dudmuck	0:8f0d0ae0a077	598	LoRaMacStatus_t Send( LoRaMacHeader_t macHdr, uint8_t fPort, void fBuffer, uint16_t fBufferSize );
dudmuck	0:8f0d0ae0a077	599
dudmuck	0:8f0d0ae0a077	600	/*!
dudmuck	0:8f0d0ae0a077	601	* \brief LoRaMAC layer frame buffer initialization
dudmuck	0:8f0d0ae0a077	602	*
dudmuck	0:8f0d0ae0a077	603	* \param [IN] macHdr MAC header field
dudmuck	0:8f0d0ae0a077	604	* \param [IN] fCtrl MAC frame control field
dudmuck	0:8f0d0ae0a077	605	* \param [IN] fOpts MAC commands buffer
dudmuck	0:8f0d0ae0a077	606	* \param [IN] fPort MAC payload port
dudmuck	0:8f0d0ae0a077	607	* \param [IN] fBuffer MAC data buffer to be sent
dudmuck	0:8f0d0ae0a077	608	* \param [IN] fBufferSize MAC data buffer size
dudmuck	0:8f0d0ae0a077	609	* \retval status Status of the operation.
dudmuck	0:8f0d0ae0a077	610	*/
dudmuck	0:8f0d0ae0a077	611	LoRaMacStatus_t PrepareFrame( LoRaMacHeader_t macHdr, LoRaMacFrameCtrl_t fCtrl, uint8_t fPort, void *fBuffer, uint16_t fBufferSize );
dudmuck	0:8f0d0ae0a077	612
dudmuck	0:8f0d0ae0a077	613	/*!
dudmuck	0:8f0d0ae0a077	614	* \brief Sets the radio in continuous transmission mode
dudmuck	0:8f0d0ae0a077	615	*
dudmuck	0:8f0d0ae0a077	616	* \remark Uses the radio parameters set on the previous transmission.
dudmuck	0:8f0d0ae0a077	617	*
dudmuck	0:8f0d0ae0a077	618	* \param [IN] timeout Time in seconds while the radio is kept in continuous wave mode
dudmuck	0:8f0d0ae0a077	619	* \retval status Status of the operation.
dudmuck	0:8f0d0ae0a077	620	*/
dudmuck	0:8f0d0ae0a077	621	LoRaMacStatus_t SetTxContinuousWave( uint16_t timeout );
dudmuck	0:8f0d0ae0a077	622
dudmuck	0:8f0d0ae0a077	623	/*!
dudmuck	0:8f0d0ae0a077	624	* \brief Sets the radio in continuous transmission mode
dudmuck	0:8f0d0ae0a077	625	*
dudmuck	0:8f0d0ae0a077	626	* \remark Uses the radio parameters set on the previous transmission.
dudmuck	0:8f0d0ae0a077	627	*
dudmuck	0:8f0d0ae0a077	628	* \param [IN] timeout Time in seconds while the radio is kept in continuous wave mode
dudmuck	0:8f0d0ae0a077	629	* \param [IN] frequency RF frequency to be set.
dudmuck	0:8f0d0ae0a077	630	* \param [IN] power RF ouptput power to be set.
dudmuck	0:8f0d0ae0a077	631	* \retval status Status of the operation.
dudmuck	0:8f0d0ae0a077	632	*/
dudmuck	0:8f0d0ae0a077	633	LoRaMacStatus_t SetTxContinuousWave1( uint16_t timeout, uint32_t frequency, uint8_t power );
dudmuck	0:8f0d0ae0a077	634
dudmuck	0:8f0d0ae0a077	635	/*!
dudmuck	0:8f0d0ae0a077	636	* \brief Resets MAC specific parameters to default
dudmuck	0:8f0d0ae0a077	637	*/
dudmuck	0:8f0d0ae0a077	638	static void ResetMacParameters( void );
dudmuck	0:8f0d0ae0a077	639
dudmuck	0:8f0d0ae0a077	640	void
dudmuck	0:8f0d0ae0a077	641	loramac_print_status()
dudmuck	0:8f0d0ae0a077	642	{
dudmuck	16:915815632c1f	643	isr_printf("DR%u=sf%u guard:%d\r\n",
dudmuck	16:915815632c1f	644	LoRaMacParams.ChannelsDatarate_fixed,
dudmuck	16:915815632c1f	645	Datarates[LoRaMacParams.ChannelsDatarate_fixed],
dudmuck	16:915815632c1f	646	BeaconCtx.guard
dudmuck	16:915815632c1f	647	);
dudmuck	0:8f0d0ae0a077	648	}
dudmuck	0:8f0d0ae0a077	649
dudmuck	0:8f0d0ae0a077	650	/*
dudmuck	0:8f0d0ae0a077	651	* Rx window precise timing
dudmuck	0:8f0d0ae0a077	652	*
dudmuck	0:8f0d0ae0a077	653	* For more details please consult the following document, chapter 3.1.2.
dudmuck	0:8f0d0ae0a077	654	* http://www.semtech.com/images/datasheet/SX1272_settings_for_LoRaWAN_v2.0.pdf
dudmuck	0:8f0d0ae0a077	655	* or
dudmuck	0:8f0d0ae0a077	656	* http://www.semtech.com/images/datasheet/SX1276_settings_for_LoRaWAN_v2.0.pdf
dudmuck	0:8f0d0ae0a077	657	*
dudmuck	0:8f0d0ae0a077	658	* Downlink start: T = Tx + 1s (+/- 20 us)
dudmuck	0:8f0d0ae0a077	659	* \|
dudmuck	0:8f0d0ae0a077	660	* TRxEarly \| TRxLate
dudmuck	0:8f0d0ae0a077	661	* \| \| \|
dudmuck	0:8f0d0ae0a077	662	* \| \| +---+---+---+---+---+---+---+---+
dudmuck	0:8f0d0ae0a077	663	* \| \| \| Latest Rx window \|
dudmuck	0:8f0d0ae0a077	664	* \| \| +---+---+---+---+---+---+---+---+
dudmuck	0:8f0d0ae0a077	665	* \| \| \|
dudmuck	0:8f0d0ae0a077	666	* +---+---+---+---+---+---+---+---+
dudmuck	0:8f0d0ae0a077	667	* \| Earliest Rx window \|
dudmuck	0:8f0d0ae0a077	668	* +---+---+---+---+---+---+---+---+
dudmuck	0:8f0d0ae0a077	669	* \|
dudmuck	0:8f0d0ae0a077	670	* +---+---+---+---+---+---+---+---+
dudmuck	0:8f0d0ae0a077	671	*Downlink preamble 8 symbols \| \| \| \| \| \| \| \| \|
dudmuck	0:8f0d0ae0a077	672	* +---+---+---+---+---+---+---+---+
dudmuck	0:8f0d0ae0a077	673	*
dudmuck	0:8f0d0ae0a077	674	* Worst case Rx window timings
dudmuck	0:8f0d0ae0a077	675	*
dudmuck	0:8f0d0ae0a077	676	* TRxLate = DEFAULT_MIN_RX_SYMBOLS * tSymbol - RADIO_WAKEUP_TIME
dudmuck	0:8f0d0ae0a077	677	* TRxEarly = 8 - DEFAULT_MIN_RX_SYMBOLS * tSymbol - RxWindowTimeout - RADIO_WAKEUP_TIME
dudmuck	0:8f0d0ae0a077	678	*
dudmuck	0:8f0d0ae0a077	679	* TRxLate - TRxEarly = 2 * DEFAULT_SYSTEM_MAX_RX_ERROR
dudmuck	0:8f0d0ae0a077	680	*
dudmuck	0:8f0d0ae0a077	681	* RxOffset = ( TRxLate + TRxEarly ) / 2
dudmuck	0:8f0d0ae0a077	682	*
dudmuck	0:8f0d0ae0a077	683	* RxWindowTimeout = ( 2 * DEFAULT_MIN_RX_SYMBOLS - 8 ) * tSymbol + 2 * DEFAULT_SYSTEM_MAX_RX_ERROR
dudmuck	0:8f0d0ae0a077	684	* RxOffset = 4 * tSymbol - RxWindowTimeout / 2 - RADIO_WAKE_UP_TIME
dudmuck	0:8f0d0ae0a077	685	*
dudmuck	0:8f0d0ae0a077	686	* Minimal value of RxWindowTimeout must be 5 symbols which implies that the system always tolerates at least an error of 1.5 * tSymbol
dudmuck	0:8f0d0ae0a077	687	*/
dudmuck	0:8f0d0ae0a077	688	/*!
dudmuck	0:8f0d0ae0a077	689	* Computes the Rx window parameters.
dudmuck	0:8f0d0ae0a077	690	*
dudmuck	0:8f0d0ae0a077	691	* \param [IN] datarate Rx window datarate to be used
dudmuck	0:8f0d0ae0a077	692	* \param [IN] rxError Maximum timing error of the receiver. in milliseconds
dudmuck	0:8f0d0ae0a077	693	* The receiver will turn on in a [-rxError : +rxError] ms
dudmuck	0:8f0d0ae0a077	694	* interval around RxOffset
dudmuck	0:8f0d0ae0a077	695	*
dudmuck	0:8f0d0ae0a077	696	* \retval rxConfigParams Returns a RxConfigParams_t structure.
dudmuck	0:8f0d0ae0a077	697	*/
dudmuck	0:8f0d0ae0a077	698	static RxConfigParams_t ComputeRxWindowParameters( int8_t datarate, uint32_t rxError );
dudmuck	0:8f0d0ae0a077	699
dudmuck	0:8f0d0ae0a077	700	static void OnRadioTxDone( unsigned int tx_done_us )
dudmuck	0:8f0d0ae0a077	701	{
dudmuck	0:8f0d0ae0a077	702	// Setup timers
dudmuck	16:915815632c1f	703	if (IsRxWindowsEnabled)
dudmuck	0:8f0d0ae0a077	704	{
dudmuck	0:8f0d0ae0a077	705	rx_timeout.attach_us(&OnRxWindowTimerEvent, RxWindowDelay_us);
dudmuck	16:915815632c1f	706	if (NodeAckRequested)
dudmuck	0:8f0d0ae0a077	707	{
dudmuck	0:8f0d0ae0a077	708	AckTimeoutTimer.attach_us(&OnAckTimeoutTimerEvent, (RxWindowDelay_us/1000) + ACK_TIMEOUT_us + randr(-ACK_TIMEOUT_RND_us, ACK_TIMEOUT_RND_us));
dudmuck	0:8f0d0ae0a077	709	}
dudmuck	0:8f0d0ae0a077	710	}
dudmuck	0:8f0d0ae0a077	711	else
dudmuck	0:8f0d0ae0a077	712	{
dudmuck	0:8f0d0ae0a077	713	McpsConfirm.Status = LORAMAC_EVENT_INFO_STATUS_OK;
dudmuck	0:8f0d0ae0a077	714	MlmeConfirm.Status = LORAMAC_EVENT_INFO_STATUS_RX_TIMEOUT;
dudmuck	0:8f0d0ae0a077	715
dudmuck	0:8f0d0ae0a077	716	if( LoRaMacFlags.Value == 0 )
dudmuck	0:8f0d0ae0a077	717	{
dudmuck	0:8f0d0ae0a077	718	LoRaMacFlags.Bits.McpsReq = 1;
dudmuck	0:8f0d0ae0a077	719	}
dudmuck	0:8f0d0ae0a077	720	LoRaMacFlags.Bits.MacDone = 1;
dudmuck	0:8f0d0ae0a077	721	}
dudmuck	16:915815632c1f	722	Radio.Sleep( );
dudmuck	16:915815632c1f	723	TxDone_us = tx_done_us;
dudmuck	0:8f0d0ae0a077	724
dudmuck	0:8f0d0ae0a077	725	// Update Aggregated last tx done time
dudmuck	0:8f0d0ae0a077	726	AggregatedLastTxDoneTime_us = tx_done_us;
dudmuck	0:8f0d0ae0a077	727	// Update Backoff
dudmuck	0:8f0d0ae0a077	728
dudmuck	16:915815632c1f	729	if (!NodeAckRequested)
dudmuck	0:8f0d0ae0a077	730	{
dudmuck	0:8f0d0ae0a077	731	McpsConfirm.Status = LORAMAC_EVENT_INFO_STATUS_OK;
dudmuck	0:8f0d0ae0a077	732	ChannelsNbRepCounter++;
dudmuck	0:8f0d0ae0a077	733	}
dudmuck	10:00997daeb0c0	734
dudmuck	10:00997daeb0c0	735	MlmeIndication.MlmeIndication = MLME_TXDONE;
dudmuck	10:00997daeb0c0	736	MlmeIndication.Status = LORAMAC_EVENT_INFO_STATUS_OK;
dudmuck	16:915815632c1f	737	LoRaMacPrimitives->MacMlmeIndication( &MlmeIndication );
dudmuck	16:915815632c1f	738	}
dudmuck	16:915815632c1f	739
dudmuck	16:915815632c1f	740
dudmuck	16:915815632c1f	741	static void application_callbacks()
dudmuck	16:915815632c1f	742	{
dudmuck	16:915815632c1f	743	if (LoRaMacFlags.Bits.McpsInd) {
dudmuck	16:915815632c1f	744	LoRaMacFlags.Bits.McpsInd = 0;
dudmuck	16:915815632c1f	745	LoRaMacPrimitives->MacMcpsIndication( &McpsIndication );
dudmuck	16:915815632c1f	746	}
dudmuck	16:915815632c1f	747
dudmuck	16:915815632c1f	748	if (LoRaMacFlags.Bits.McpsReq) {
dudmuck	16:915815632c1f	749	LoRaMacPrimitives->MacMcpsConfirm( &McpsConfirm );
dudmuck	16:915815632c1f	750	LoRaMacFlags.Bits.McpsReq = 0;
dudmuck	16:915815632c1f	751	}
dudmuck	0:8f0d0ae0a077	752	}
dudmuck	0:8f0d0ae0a077	753
dudmuck	0:8f0d0ae0a077	754	static void PrepareRxDoneAbort( void )
dudmuck	0:8f0d0ae0a077	755	{
dudmuck	16:915815632c1f	756	if (NodeAckRequested)
dudmuck	0:8f0d0ae0a077	757	{
dudmuck	0:8f0d0ae0a077	758	OnAckTimeoutTimerEvent( );
dudmuck	0:8f0d0ae0a077	759	}
dudmuck	0:8f0d0ae0a077	760
dudmuck	0:8f0d0ae0a077	761	LoRaMacFlags.Bits.McpsInd = 1;
dudmuck	0:8f0d0ae0a077	762	LoRaMacFlags.Bits.MacDone = 1;
dudmuck	16:915815632c1f	763
dudmuck	16:915815632c1f	764	application_callbacks();
dudmuck	0:8f0d0ae0a077	765	}
dudmuck	0:8f0d0ae0a077	766
dudmuck	20:42839629a5dc	767	void send_bh()
dudmuck	16:915815632c1f	768	{
dudmuck	25:fed9d5b77183	769	int8_t datarate = Datarates[LoRaMacParams.ChannelsDatarate_fixed];
dudmuck	25:fed9d5b77183	770	int8_t txPowerIndex = 0;
dudmuck	25:fed9d5b77183	771	int8_t txPower = 0;
dudmuck	25:fed9d5b77183	772
dudmuck	25:fed9d5b77183	773	txPowerIndex = LoRaMacParams.ChannelsTxPower;
dudmuck	25:fed9d5b77183	774	txPower = TxPowers[txPowerIndex];
dudmuck	25:fed9d5b77183	775
dudmuck	25:fed9d5b77183	776	MlmeConfirm.Status = LORAMAC_EVENT_INFO_STATUS_ERROR_SEND;
dudmuck	25:fed9d5b77183	777	McpsConfirm.Status = LORAMAC_EVENT_INFO_STATUS_ERROR_SEND;
dudmuck	25:fed9d5b77183	778	McpsConfirm.TxPower = txPowerIndex;
dudmuck	25:fed9d5b77183	779	McpsConfirm.UpLinkFrequency = Channels[Channel].Frequency;
dudmuck	25:fed9d5b77183	780
dudmuck	25:fed9d5b77183	781	if (!IsLoRaMacNetworkJoined) // joining is channel hunting
dudmuck	25:fed9d5b77183	782	Radio.SetChannel( Channels[Channel].Frequency );
dudmuck	25:fed9d5b77183	783
dudmuck	25:fed9d5b77183	784	#if defined( USE_BAND_915_SINGLE )
dudmuck	25:fed9d5b77183	785	// High speed LoRa channel BW500 kHz
dudmuck	25:fed9d5b77183	786	Radio.SetTxConfig( MODEM_LORA, txPower, 0, 2, datarate, 1, 8, false, true, 0, 0, false, 3e3 );
dudmuck	25:fed9d5b77183	787	TxTimeOnAir = Radio.TimeOnAir( MODEM_LORA, LoRaMacBufferPktLen );
dudmuck	25:fed9d5b77183	788	#elif defined(USE_BAND_433) && defined (ENABLE_SX1276)
dudmuck	25:fed9d5b77183	789	if( LoRaMacParams.ChannelsDatarate_fixed == DR_7 )
dudmuck	25:fed9d5b77183	790	{ // High Speed FSK channel
dudmuck	25:fed9d5b77183	791	//Radio.SetMaxPayloadLength( MODEM_FSK, LoRaMacBufferPktLen );
dudmuck	25:fed9d5b77183	792	Radio.SetTxConfig( MODEM_FSK, txPower, 25e3, 0, datarate * 1e3, 0, 5, false, true, 0, 0, false, 3e3 );
dudmuck	25:fed9d5b77183	793	TxTimeOnAir = Radio.TimeOnAir( MODEM_FSK, LoRaMacBufferPktLen );
dudmuck	25:fed9d5b77183	794
dudmuck	25:fed9d5b77183	795	}
dudmuck	25:fed9d5b77183	796	else if( LoRaMacParams.ChannelsDatarate_fixed == DR_6 )
dudmuck	25:fed9d5b77183	797	{ // High speed LoRa channel
dudmuck	25:fed9d5b77183	798	//Radio.SetMaxPayloadLength( MODEM_LORA, LoRaMacBufferPktLen );
dudmuck	25:fed9d5b77183	799	Radio.SetTxConfig( MODEM_LORA, txPower, 0, 1, datarate, 1, 8, false, true, 0, 0, false, 3e3 );
dudmuck	25:fed9d5b77183	800	TxTimeOnAir = Radio.TimeOnAir( MODEM_LORA, LoRaMacBufferPktLen );
dudmuck	25:fed9d5b77183	801	}
dudmuck	25:fed9d5b77183	802	else
dudmuck	25:fed9d5b77183	803	{ // Normal LoRa channel
dudmuck	25:fed9d5b77183	804	//Radio.SetMaxPayloadLength( MODEM_LORA, LoRaMacBufferPktLen );
dudmuck	25:fed9d5b77183	805	Radio.SetTxConfig( MODEM_LORA, txPower, 0, 0, datarate, 1, 8, false, true, 0, 0, false, 3e3 );
dudmuck	25:fed9d5b77183	806	TxTimeOnAir = Radio.TimeOnAir( MODEM_LORA, LoRaMacBufferPktLen );
dudmuck	25:fed9d5b77183	807	}
dudmuck	25:fed9d5b77183	808	#endif
dudmuck	25:fed9d5b77183	809
dudmuck	25:fed9d5b77183	810	// Store the time on air
dudmuck	25:fed9d5b77183	811	McpsConfirm.TxTimeOnAir = TxTimeOnAir;
dudmuck	25:fed9d5b77183	812	MlmeConfirm.TxTimeOnAir = TxTimeOnAir;
dudmuck	25:fed9d5b77183	813
dudmuck	25:fed9d5b77183	814	if (!IsLoRaMacNetworkJoined)
dudmuck	25:fed9d5b77183	815	{
dudmuck	25:fed9d5b77183	816	JoinRequestTrials++;
dudmuck	25:fed9d5b77183	817	isr_printf("join %luhz try%u DR%u\r\n", Channels[Channel].Frequency, JoinRequestTrials, LoRaMacParams.ChannelsDatarate_fixed);
dudmuck	25:fed9d5b77183	818	}
dudmuck	25:fed9d5b77183	819
dudmuck	5:c108560af4c3	820	Radio.SetTxConfig(
dudmuck	5:c108560af4c3	821	/* RadioModems_t modem */ MODEM_LORA,
dudmuck	5:c108560af4c3	822	/* int8_t power */ TxPowers[LoRaMacParams.ChannelsTxPower],
dudmuck	5:c108560af4c3	823	/* uint32_t fdev */ 0,
dudmuck	18:9ac71c0eb70d	824	/* uint32_t bandwidth */ LORA_BANDWIDTH,
dudmuck	5:c108560af4c3	825	/* uint32_t datarate */ Datarates[LoRaMacParams.ChannelsDatarate_fixed],
dudmuck	5:c108560af4c3	826	/* uint8_t coderate */ 1,
dudmuck	5:c108560af4c3	827	/* uint16_t preambleLen */ 8,
dudmuck	5:c108560af4c3	828	/* bool fixLen */ false,
dudmuck	5:c108560af4c3	829	/* bool crcOn */ true,
dudmuck	5:c108560af4c3	830	/* bool freqHopOn */ 0,
dudmuck	5:c108560af4c3	831	/* uint8_t hopPeriod */ 0,
dudmuck	5:c108560af4c3	832	/* bool iqInverted */ false,
dudmuck	5:c108560af4c3	833	/* uint32_t timeout */ 3e3
dudmuck	5:c108560af4c3	834	);
dudmuck	16:915815632c1f	835	Radio.Send( LoRaMacBuffer, LoRaMacBufferPktLen );
dudmuck	16:915815632c1f	836
dudmuck	25:fed9d5b77183	837	LoRaMacFlags.Bits.uplink_pending = 0; // sent
dudmuck	25:fed9d5b77183	838
dudmuck	25:fed9d5b77183	839	// Compute Rx1 windows parameters, taken at TxDone
dudmuck	25:fed9d5b77183	840	if (!IsLoRaMacNetworkJoined)
dudmuck	25:fed9d5b77183	841	RxWindowDelay_us = LoRaMacParams.JoinAcceptDelay_us + RxWindowsParam.RxOffset;
dudmuck	25:fed9d5b77183	842	else
dudmuck	25:fed9d5b77183	843	RxWindowDelay_us = LoRaMacParams.ReceiveDelay_us + RxWindowsParam.RxOffset;
dudmuck	25:fed9d5b77183	844
dudmuck	25:fed9d5b77183	845	RxWindowDelay_us -= DIO0_LAG_us;
dudmuck	20:42839629a5dc	846	}
dudmuck	20:42839629a5dc	847
dudmuck	20:42839629a5dc	848	void send_callback()
dudmuck	20:42839629a5dc	849	{
dudmuck	20:42839629a5dc	850	if (BeaconCtx.guard) {
dudmuck	25:fed9d5b77183	851	/* last send, this will be restarted after beacon sent */
dudmuck	20:42839629a5dc	852	return;
dudmuck	20:42839629a5dc	853	}
dudmuck	20:42839629a5dc	854
dudmuck	20:42839629a5dc	855	tx_timeout.attach_us(&send_callback, BeaconCtx.periodicity_slots * 30000);
dudmuck	20:42839629a5dc	856
dudmuck	25:fed9d5b77183	857	if (LoRaMacFlags.Bits.uplink_pending)
dudmuck	25:fed9d5b77183	858	flags.send = 1;
dudmuck	0:8f0d0ae0a077	859	}
dudmuck	0:8f0d0ae0a077	860
dudmuck	0:8f0d0ae0a077	861	void OnRxBeaconSetup()
dudmuck	0:8f0d0ae0a077	862	{
dudmuck	20:42839629a5dc	863	flags.beacon_setup = 1;
dudmuck	20:42839629a5dc	864	}
dudmuck	20:42839629a5dc	865
dudmuck	20:42839629a5dc	866	void OnRxBeaconSetupBH()
dudmuck	20:42839629a5dc	867	{
dudmuck	16:915815632c1f	868	unsigned int prevRxBeaconSetupAt_us;
dudmuck	16:915815632c1f	869	unsigned now_us = lp_timer.read_us();
dudmuck	20:42839629a5dc	870
dudmuck	16:915815632c1f	871	prevRxBeaconSetupAt_us = BeaconCtx.RxBeaconSetupAt_us;
dudmuck	16:915815632c1f	872	BeaconCtx.RxBeaconSetupAt_us = now_us;
dudmuck	10:00997daeb0c0	873	expecting_beacon = true;
dudmuck	10:00997daeb0c0	874
dudmuck	0:8f0d0ae0a077	875	Radio.SetRxConfig(
dudmuck	0:8f0d0ae0a077	876	/* RadioModems_t */ MODEM_LORA,
dudmuck	18:9ac71c0eb70d	877	/* uint32_t bandwidth */ LORA_BANDWIDTH,
dudmuck	0:8f0d0ae0a077	878	/* uint32_t datarate */ Datarates[BEACON_CHANNEL_DR],
dudmuck	0:8f0d0ae0a077	879	/* uint8_t coderate */ 1,
dudmuck	0:8f0d0ae0a077	880	/* uint32_t bandwidthAfc */ 0,
dudmuck	0:8f0d0ae0a077	881	/* uint16_t preambleLen */ 10,
dudmuck	0:8f0d0ae0a077	882	/* uint16_t symbTimeout */ BeaconCtx.SymbolTimeout,
dudmuck	0:8f0d0ae0a077	883	/* bool fixLen */ true,
dudmuck	0:8f0d0ae0a077	884	/* uint8_t payloadLen */ BEACON_SIZE,
dudmuck	0:8f0d0ae0a077	885	/* bool crcOn */ false,
dudmuck	0:8f0d0ae0a077	886	/* bool freqHopOn */ 0,
dudmuck	0:8f0d0ae0a077	887	/* uint8_t hopPeriod */ 0,
dudmuck	0:8f0d0ae0a077	888	/* bool iqInverted */ false,
dudmuck	0:8f0d0ae0a077	889	/* bool rxContinuous */false
dudmuck	0:8f0d0ae0a077	890	);
dudmuck	0:8f0d0ae0a077	891
dudmuck	0:8f0d0ae0a077	892	Radio.Rx(2000);
dudmuck	16:915815632c1f	893
dudmuck	16:915815632c1f	894	unsigned int us_since_last_beacon_start = BeaconCtx.RxBeaconSetupAt_us - prevRxBeaconSetupAt_us;
dudmuck	16:915815632c1f	895	isr_printf("OnRxBeaconSetup() %u since-last:%u\r\n", BeaconCtx.SymbolTimeout, us_since_last_beacon_start);
dudmuck	16:915815632c1f	896	}
dudmuck	16:915815632c1f	897
dudmuck	16:915815632c1f	898	void guard_callback()
dudmuck	16:915815632c1f	899	{
dudmuck	16:915815632c1f	900	unsigned now_us = lp_timer.read_us();
dudmuck	21:500ff43d8424	901	unsigned since_last = now_us - BeaconCtx.guard_at;
dudmuck	21:500ff43d8424	902
dudmuck	23:a862b5601663	903	if (BeaconCtx.state != BEACON_STATE_FIRST_ACQ && since_last < (BEACON_INTERVAL_us - 1000000)) {
dudmuck	21:500ff43d8424	904	isr_printf("guard-fail %u\r\n", since_last);
dudmuck	21:500ff43d8424	905	BeaconCtx.timeout_rx.detach();
dudmuck	21:500ff43d8424	906	BeaconCtx.state = BEACON_STATE_NONE;
dudmuck	21:500ff43d8424	907	IsLoRaMacNetworkJoined = false;
dudmuck	23:a862b5601663	908
dudmuck	23:a862b5601663	909	/*McpsConfirm.Status = LORAMAC_EVENT_INFO_STATUS_STOP;
dudmuck	23:a862b5601663	910	MlmeConfirm.Status = LORAMAC_EVENT_INFO_STATUS_STOP;
dudmuck	23:a862b5601663	911	LoRaMacFlags.Bits.MacDone = 1;
dudmuck	23:a862b5601663	912	LoRaMacPrimitives->MacMcpsConfirm( &McpsConfirm );*/
dudmuck	21:500ff43d8424	913	return;
dudmuck	21:500ff43d8424	914	}
dudmuck	16:915815632c1f	915
dudmuck	16:915815632c1f	916	/* occurs BEACON_GUARD_us prior to OnRxBeaconSetup() */
dudmuck	16:915815632c1f	917	BeaconCtx.guard = true;
dudmuck	21:500ff43d8424	918
dudmuck	21:500ff43d8424	919	isr_printf("guard since-last:%u\r\n", since_last);
dudmuck	17:3215f12051f9	920
dudmuck	17:3215f12051f9	921	BeaconCtx.guard_at = now_us;
dudmuck	0:8f0d0ae0a077	922	}
dudmuck	0:8f0d0ae0a077	923
dudmuck	0:8f0d0ae0a077	924	static void set_beacon_symbol_timeout(float secs)
dudmuck	0:8f0d0ae0a077	925	{
dudmuck	16:915815632c1f	926	isr_printf("symTo:%.1f ", secs);
dudmuck	0:8f0d0ae0a077	927	BeaconCtx.SymbolTimeout = secs / BeaconCtx.symbol_period_secs;
dudmuck	0:8f0d0ae0a077	928	if (BeaconCtx.SymbolTimeout < (BEACON_MIN_SYMBOL_TIMEOUT+BeaconCtx.Precess_symbols)) {
dudmuck	8:ab2f9a8d2eaa	929	BeaconCtx.SymbolTimeout = BEACON_MIN_SYMBOL_TIMEOUT+BeaconCtx.Precess_symbols;
dudmuck	0:8f0d0ae0a077	930	}
dudmuck	8:ab2f9a8d2eaa	931	BeaconCtx.SymbolTimeout_sec = BeaconCtx.SymbolTimeout * BeaconCtx.symbol_period_secs;
dudmuck	16:915815632c1f	932	isr_printf("%u\r\n", BeaconCtx.SymbolTimeout);
dudmuck	0:8f0d0ae0a077	933	}
dudmuck	0:8f0d0ae0a077	934
dudmuck	0:8f0d0ae0a077	935	static uint16_t beacon_crc( uint8_t *buffer, uint16_t length )
dudmuck	0:8f0d0ae0a077	936	{
dudmuck	0:8f0d0ae0a077	937	// The CRC calculation follows CCITT
dudmuck	0:8f0d0ae0a077	938	const uint16_t polynom = 0x1021;
dudmuck	0:8f0d0ae0a077	939	// CRC initial value
dudmuck	0:8f0d0ae0a077	940	uint16_t crc = 0x0000;
dudmuck	0:8f0d0ae0a077	941
dudmuck	0:8f0d0ae0a077	942	if( buffer == NULL )
dudmuck	0:8f0d0ae0a077	943	{
dudmuck	0:8f0d0ae0a077	944	return 0;
dudmuck	0:8f0d0ae0a077	945	}
dudmuck	0:8f0d0ae0a077	946
dudmuck	0:8f0d0ae0a077	947	for( uint16_t i = 0; i < length; ++i )
dudmuck	0:8f0d0ae0a077	948	{
dudmuck	0:8f0d0ae0a077	949	crc ^= ( uint16_t ) buffer[i] << 8;
dudmuck	0:8f0d0ae0a077	950	for( uint16_t j = 0; j < 8; ++j )
dudmuck	0:8f0d0ae0a077	951	{
dudmuck	0:8f0d0ae0a077	952	crc = ( crc & 0x8000 ) ? ( crc << 1 ) ^ polynom : ( crc << 1 );
dudmuck	0:8f0d0ae0a077	953	}
dudmuck	0:8f0d0ae0a077	954	}
dudmuck	0:8f0d0ae0a077	955
dudmuck	0:8f0d0ae0a077	956	return crc;
dudmuck	0:8f0d0ae0a077	957	}
dudmuck	0:8f0d0ae0a077	958
dudmuck	0:8f0d0ae0a077	959	/* low power timer needs larger value due to poor resolution */
dudmuck	0:8f0d0ae0a077	960	#define TARGET_PRECESSION_US 3000
dudmuck	0:8f0d0ae0a077	961	#define BEACON_RX_TIMEOUT_LOCKED 0.008
dudmuck	0:8f0d0ae0a077	962
dudmuck	0:8f0d0ae0a077	963	void rx_beacon(unsigned int rx_us, uint8_t* payload, uint16_t size)
dudmuck	0:8f0d0ae0a077	964	{
dudmuck	0:8f0d0ae0a077	965	static bool compensate_precession = false;
dudmuck	0:8f0d0ae0a077	966	int32_t compensation = 0;
dudmuck	0:8f0d0ae0a077	967	unsigned ThisBeaconRx_us = rx_us - (BEACON_TOA_us + BEACON_RXDONE_LATENCY_us);
dudmuck	0:8f0d0ae0a077	968
dudmuck	16:915815632c1f	969	BeaconCtx.guard = false;
dudmuck	0:8f0d0ae0a077	970	BeaconCtx.rx_precession_us = ThisBeaconRx_us - BeaconCtx.RxBeaconSetupAt_us;
dudmuck	0:8f0d0ae0a077	971	if (BeaconCtx.state != BEACON_STATE_FIRST_ACQ) {
dudmuck	12:ed33c53afcaf	972	unsigned int us_since_last = ThisBeaconRx_us - BeaconCtx.LastBeaconRx_us;
dudmuck	12:ed33c53afcaf	973	unsigned int intervals_since_last = us_since_last / BEACON_INTERVAL_us;
dudmuck	13:18de9ee3a461	974	BeaconCtx.known_working_BeaconRxTimerError_us = BeaconCtx.last_BeaconRxTimerError_us;
dudmuck	0:8f0d0ae0a077	975	/* get average of error history */
dudmuck	13:18de9ee3a461	976	BeaconCtx.last_BeaconRxTimerError_us = (ThisBeaconRx_us - BeaconCtx.LastBeaconRx_us) % BEACON_INTERVAL_us;
dudmuck	0:8f0d0ae0a077	977	/* BeaconRxTimerError: positive means our clock is fast
dudmuck	0:8f0d0ae0a077	978	* negative means our clock is slow */
dudmuck	13:18de9ee3a461	979	if (BeaconCtx.last_BeaconRxTimerError_us > (BEACON_INTERVAL_us/2))
dudmuck	13:18de9ee3a461	980	BeaconCtx.last_BeaconRxTimerError_us -= BEACON_INTERVAL_us; // negative value representing slow crystal
dudmuck	0:8f0d0ae0a077	981
dudmuck	0:8f0d0ae0a077	982	if (intervals_since_last > 1) {
dudmuck	0:8f0d0ae0a077	983	/* timer error is measured over more than one beacon period */
dudmuck	13:18de9ee3a461	984	BeaconCtx.last_BeaconRxTimerError_us /= intervals_since_last;
dudmuck	0:8f0d0ae0a077	985	}
dudmuck	0:8f0d0ae0a077	986
dudmuck	0:8f0d0ae0a077	987	if (BeaconCtx.state == BEACON_STATE_ACQ_ERROR) {
dudmuck	1:53c30224eda8	988	isr_printf("-->LOCKED ");
dudmuck	21:500ff43d8424	989	BeaconCtx.state = BEACON_STATE_LOCKED;
dudmuck	0:8f0d0ae0a077	990	compensate_precession = true;
dudmuck	0:8f0d0ae0a077	991	set_beacon_symbol_timeout(BEACON_RX_TIMEOUT_LOCKED);
dudmuck	0:8f0d0ae0a077	992	}
dudmuck	0:8f0d0ae0a077	993	} else {
dudmuck	0:8f0d0ae0a077	994	/* ignore precession at first acquisition because it has slot resolution added */
dudmuck	1:53c30224eda8	995	isr_printf("-->ACQ_ERROR ");
dudmuck	0:8f0d0ae0a077	996	// next beacon will give us our crystal error
dudmuck	0:8f0d0ae0a077	997	BeaconCtx.state = BEACON_STATE_ACQ_ERROR;
dudmuck	0:8f0d0ae0a077	998	}
dudmuck	0:8f0d0ae0a077	999
dudmuck	13:18de9ee3a461	1000	#ifdef DEBUG_GWTX_JUMPER
dudmuck	13:18de9ee3a461	1001	isr_printf("rx-before-gwtx:%d ", gwtx_rise_us - BeaconCtx.RxBeaconSetupAt_us);
dudmuck	13:18de9ee3a461	1002	#endif /* DEBUG_GWTX_JUMPER */
dudmuck	13:18de9ee3a461	1003	isr_printf("err%d=%u-%u ", BeaconCtx.last_BeaconRxTimerError_us, ThisBeaconRx_us, BeaconCtx.LastBeaconRx_us);
dudmuck	1:53c30224eda8	1004	isr_printf(" rx-before-tx:%d ", BeaconCtx.rx_precession_us);
dudmuck	0:8f0d0ae0a077	1005	BeaconCtx.LastBeaconRx_us = ThisBeaconRx_us;
dudmuck	0:8f0d0ae0a077	1006
dudmuck	21:500ff43d8424	1007	if (BeaconCtx.state == BEACON_STATE_LOCKED) {
dudmuck	0:8f0d0ae0a077	1008	if (compensate_precession) {
dudmuck	13:18de9ee3a461	1009	compensation = BeaconCtx.rx_precession_us - TARGET_PRECESSION_US + BeaconCtx.last_BeaconRxTimerError_us;
dudmuck	1:53c30224eda8	1010	isr_printf(" comp%ld", compensation);
dudmuck	0:8f0d0ae0a077	1011	}
dudmuck	0:8f0d0ae0a077	1012	}
dudmuck	0:8f0d0ae0a077	1013
dudmuck	16:915815632c1f	1014	unsigned int next_beacon_expected_us = BEACON_INTERVAL_us + compensation;
dudmuck	0:8f0d0ae0a077	1015	unsigned now_us = lp_timer.read_us();
dudmuck	0:8f0d0ae0a077	1016	unsigned us_since_rx_setup = now_us - BeaconCtx.RxBeaconSetupAt_us;
dudmuck	16:915815632c1f	1017	unsigned timeout_us = next_beacon_expected_us - us_since_rx_setup;
dudmuck	16:915815632c1f	1018	BeaconCtx.timeout_rx.attach_us(&OnRxBeaconSetup, timeout_us);
dudmuck	16:915815632c1f	1019	BeaconCtx.timeout_guard.attach_us(&guard_callback, timeout_us - BEACON_GUARD_us);
dudmuck	16:915815632c1f	1020
dudmuck	16:915815632c1f	1021	/***************************************/
dudmuck	16:915815632c1f	1022	unsigned us_since_beacon_start = now_us - ThisBeaconRx_us;
dudmuck	16:915815632c1f	1023	timeout_us = BEACON_RESERVED_us + (BeaconCtx.tx_slot_offset * 30000) - us_since_beacon_start;
dudmuck	16:915815632c1f	1024	tx_timeout.attach_us(&send_callback, timeout_us);
dudmuck	16:915815632c1f	1025	/***************************************/
dudmuck	16:915815632c1f	1026	isr_printf(" nextTx:%u\r\n", timeout_us);
dudmuck	0:8f0d0ae0a077	1027
dudmuck	0:8f0d0ae0a077	1028	if (BeaconCtx.num_missed > 0) {
dudmuck	0:8f0d0ae0a077	1029	/* restore rx symbol timeout */
dudmuck	0:8f0d0ae0a077	1030	set_beacon_symbol_timeout(BEACON_RX_TIMEOUT_LOCKED);
dudmuck	0:8f0d0ae0a077	1031	}
dudmuck	0:8f0d0ae0a077	1032
dudmuck	0:8f0d0ae0a077	1033	BeaconCtx.num_missed = 0;
dudmuck	0:8f0d0ae0a077	1034
dudmuck	0:8f0d0ae0a077	1035	MlmeIndication.MlmeIndication = MLME_BEACON;
dudmuck	0:8f0d0ae0a077	1036	MlmeIndication.Status = LORAMAC_EVENT_INFO_STATUS_BEACON_LOCKED;
dudmuck	0:8f0d0ae0a077	1037	LoRaMacPrimitives->MacMlmeIndication( &MlmeIndication );
dudmuck	0:8f0d0ae0a077	1038
dudmuck	0:8f0d0ae0a077	1039	/* check beacon payload */
dudmuck	0:8f0d0ae0a077	1040	uint16_t calc_crc = beacon_crc(payload, 4);
dudmuck	0:8f0d0ae0a077	1041	uint16_t rx_crc = payload[4];
dudmuck	0:8f0d0ae0a077	1042	rx_crc \|= payload[5] << 8;
dudmuck	0:8f0d0ae0a077	1043	if (rx_crc == calc_crc) {
dudmuck	0:8f0d0ae0a077	1044	unsigned int rx = payload[0];
dudmuck	0:8f0d0ae0a077	1045	rx \|= payload[1] << 8;
dudmuck	0:8f0d0ae0a077	1046	rx \|= payload[2] << 16;
dudmuck	0:8f0d0ae0a077	1047	rx \|= payload[3] << 24;
dudmuck	10:00997daeb0c0	1048	if (rx != 0) {
dudmuck	10:00997daeb0c0	1049	//isr_printf("beacon payload:%08x\r\n", rx);
dudmuck	10:00997daeb0c0	1050	LoRaMacRxPayload[0] = payload[0];
dudmuck	10:00997daeb0c0	1051	LoRaMacRxPayload[1] = payload[1];
dudmuck	10:00997daeb0c0	1052	LoRaMacRxPayload[2] = payload[2];
dudmuck	10:00997daeb0c0	1053	LoRaMacRxPayload[3] = payload[3];
dudmuck	10:00997daeb0c0	1054	McpsIndication.McpsIndication = MCPS_MULTICAST;
dudmuck	10:00997daeb0c0	1055	McpsIndication.Status = LORAMAC_EVENT_INFO_STATUS_OK;
dudmuck	10:00997daeb0c0	1056	McpsIndication.Buffer = LoRaMacRxPayload;
dudmuck	10:00997daeb0c0	1057	McpsIndication.BufferSize = 4;
dudmuck	10:00997daeb0c0	1058	McpsIndication.RxData = true;
dudmuck	16:915815632c1f	1059	LoRaMacPrimitives->MacMcpsIndication( &McpsIndication );
dudmuck	10:00997daeb0c0	1060	}
dudmuck	0:8f0d0ae0a077	1061	} else
dudmuck	1:53c30224eda8	1062	isr_printf("calc_crc:%04x rx_crc:%04x\r\n", calc_crc, rx_crc);
dudmuck	0:8f0d0ae0a077	1063	}
dudmuck	0:8f0d0ae0a077	1064
dudmuck	0:8f0d0ae0a077	1065	float get_symbol_period(uint8_t bw, uint8_t sf)
dudmuck	0:8f0d0ae0a077	1066	{
dudmuck	0:8f0d0ae0a077	1067	//bw:, // 0=125kHz, 1=250kHz, 2=500KHz
dudmuck	0:8f0d0ae0a077	1068	float hz;
dudmuck	0:8f0d0ae0a077	1069	switch( bw )
dudmuck	0:8f0d0ae0a077	1070	{
dudmuck	0:8f0d0ae0a077	1071	//case 0: // 7.8 kHz
dudmuck	0:8f0d0ae0a077	1072	// bw = 78e2;
dudmuck	0:8f0d0ae0a077	1073	// break;
dudmuck	0:8f0d0ae0a077	1074	//case 1: // 10.4 kHz
dudmuck	0:8f0d0ae0a077	1075	// bw = 104e2;
dudmuck	0:8f0d0ae0a077	1076	// break;
dudmuck	0:8f0d0ae0a077	1077	//case 2: // 15.6 kHz
dudmuck	0:8f0d0ae0a077	1078	// bw = 156e2;
dudmuck	0:8f0d0ae0a077	1079	// break;
dudmuck	0:8f0d0ae0a077	1080	//case 3: // 20.8 kHz
dudmuck	0:8f0d0ae0a077	1081	// bw = 208e2;
dudmuck	0:8f0d0ae0a077	1082	// break;
dudmuck	0:8f0d0ae0a077	1083	//case 4: // 31.2 kHz
dudmuck	0:8f0d0ae0a077	1084	// bw = 312e2;
dudmuck	0:8f0d0ae0a077	1085	// break;
dudmuck	0:8f0d0ae0a077	1086	//case 5: // 41.4 kHz
dudmuck	0:8f0d0ae0a077	1087	// bw = 414e2;
dudmuck	0:8f0d0ae0a077	1088	// break;
dudmuck	0:8f0d0ae0a077	1089	//case 6: // 62.5 kHz
dudmuck	0:8f0d0ae0a077	1090	// bw = 625e2;
dudmuck	0:8f0d0ae0a077	1091	// break;
dudmuck	0:8f0d0ae0a077	1092	case 0: // 125 kHz
dudmuck	0:8f0d0ae0a077	1093	hz = 125e3;
dudmuck	0:8f0d0ae0a077	1094	break;
dudmuck	0:8f0d0ae0a077	1095	case 1: // 250 kHz
dudmuck	0:8f0d0ae0a077	1096	hz = 250e3;
dudmuck	0:8f0d0ae0a077	1097	break;
dudmuck	0:8f0d0ae0a077	1098	case 2: // 500 kHz
dudmuck	0:8f0d0ae0a077	1099	hz = 500e3;
dudmuck	0:8f0d0ae0a077	1100	break;
dudmuck	0:8f0d0ae0a077	1101	default:
dudmuck	0:8f0d0ae0a077	1102	return 0;
dudmuck	0:8f0d0ae0a077	1103	}
dudmuck	0:8f0d0ae0a077	1104
dudmuck	0:8f0d0ae0a077	1105	// return symbol period in seconds
dudmuck	0:8f0d0ae0a077	1106	return (1 << sf) / hz;
dudmuck	0:8f0d0ae0a077	1107	}
dudmuck	0:8f0d0ae0a077	1108
dudmuck	0:8f0d0ae0a077	1109	static uint32_t GetRxBandwidth( int8_t datarate )
dudmuck	0:8f0d0ae0a077	1110	{
dudmuck	0:8f0d0ae0a077	1111	return 2; /* always 500KHz */
dudmuck	0:8f0d0ae0a077	1112	}
dudmuck	0:8f0d0ae0a077	1113
dudmuck	0:8f0d0ae0a077	1114	static void OnRadioRxDone(unsigned rx_us, uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr )
dudmuck	0:8f0d0ae0a077	1115	{
dudmuck	0:8f0d0ae0a077	1116	LoRaMacHeader_t macHdr;
dudmuck	0:8f0d0ae0a077	1117	LoRaMacFrameCtrl_t fCtrl;
dudmuck	0:8f0d0ae0a077	1118	bool skipIndication = false;
dudmuck	0:8f0d0ae0a077	1119
dudmuck	0:8f0d0ae0a077	1120	uint8_t pktHeaderLen = 0;
dudmuck	0:8f0d0ae0a077	1121	uint32_t address = 0;
dudmuck	0:8f0d0ae0a077	1122	uint8_t appPayloadStartIndex = 0;
dudmuck	0:8f0d0ae0a077	1123	uint8_t port = 0xFF;
dudmuck	0:8f0d0ae0a077	1124	uint8_t frameLen = 0;
dudmuck	0:8f0d0ae0a077	1125	uint32_t mic = 0;
dudmuck	0:8f0d0ae0a077	1126	uint32_t micRx = 0;
dudmuck	0:8f0d0ae0a077	1127
dudmuck	0:8f0d0ae0a077	1128	uint16_t sequenceCounter = 0;
dudmuck	0:8f0d0ae0a077	1129	uint16_t sequenceCounterPrev = 0;
dudmuck	0:8f0d0ae0a077	1130	uint16_t sequenceCounterDiff = 0;
dudmuck	0:8f0d0ae0a077	1131	uint32_t downLinkCounter = 0;
dudmuck	0:8f0d0ae0a077	1132
dudmuck	0:8f0d0ae0a077	1133	MulticastParams_t *curMulticastParams = NULL;
dudmuck	0:8f0d0ae0a077	1134	uint8_t *nwkSKey = LoRaMacNwkSKey;
dudmuck	0:8f0d0ae0a077	1135	uint8_t *appSKey = LoRaMacAppSKey;
dudmuck	0:8f0d0ae0a077	1136
dudmuck	0:8f0d0ae0a077	1137	uint8_t multicast = 0;
dudmuck	0:8f0d0ae0a077	1138
dudmuck	0:8f0d0ae0a077	1139	bool isMicOk = false;
dudmuck	0:8f0d0ae0a077	1140
dudmuck	0:8f0d0ae0a077	1141	McpsConfirm.AckReceived = false;
dudmuck	0:8f0d0ae0a077	1142	McpsIndication.Rssi = rssi;
dudmuck	0:8f0d0ae0a077	1143	McpsIndication.Snr = snr;
dudmuck	0:8f0d0ae0a077	1144	McpsIndication.Port = 0;
dudmuck	0:8f0d0ae0a077	1145	McpsIndication.Multicast = 0;
dudmuck	0:8f0d0ae0a077	1146	McpsIndication.FramePending = 0;
dudmuck	0:8f0d0ae0a077	1147	McpsIndication.Buffer = NULL;
dudmuck	0:8f0d0ae0a077	1148	McpsIndication.BufferSize = 0;
dudmuck	0:8f0d0ae0a077	1149	McpsIndication.RxData = false;
dudmuck	0:8f0d0ae0a077	1150	McpsIndication.AckReceived = false;
dudmuck	0:8f0d0ae0a077	1151	McpsIndication.DownLinkCounter = 0;
dudmuck	0:8f0d0ae0a077	1152	McpsIndication.McpsIndication = MCPS_UNCONFIRMED;
dudmuck	0:8f0d0ae0a077	1153
dudmuck	0:8f0d0ae0a077	1154	Radio.Sleep( );
dudmuck	0:8f0d0ae0a077	1155
dudmuck	0:8f0d0ae0a077	1156	if (expecting_beacon) {
dudmuck	0:8f0d0ae0a077	1157	rx_beacon(rx_us, payload, size);
dudmuck	0:8f0d0ae0a077	1158	expecting_beacon = false;
dudmuck	0:8f0d0ae0a077	1159	return;
dudmuck	0:8f0d0ae0a077	1160	}
dudmuck	0:8f0d0ae0a077	1161
dudmuck	0:8f0d0ae0a077	1162	macHdr.Value = payload[pktHeaderLen++];
dudmuck	0:8f0d0ae0a077	1163
dudmuck	0:8f0d0ae0a077	1164	switch( macHdr.Bits.MType )
dudmuck	0:8f0d0ae0a077	1165	{
dudmuck	0:8f0d0ae0a077	1166	case FRAME_TYPE_JOIN_ACCEPT:
dudmuck	16:915815632c1f	1167	if (IsLoRaMacNetworkJoined)
dudmuck	0:8f0d0ae0a077	1168	{
dudmuck	2:f2d9aa163652	1169	McpsIndication.Status = LORAMAC_EVENT_INFO_STATUS_ERROR_JOIN_ACCEPT;
dudmuck	0:8f0d0ae0a077	1170	PrepareRxDoneAbort( );
dudmuck	0:8f0d0ae0a077	1171	return;
dudmuck	0:8f0d0ae0a077	1172	}
dudmuck	0:8f0d0ae0a077	1173	LoRaMacJoinDecrypt( payload + 1, size - 1, LoRaMacAppKey, LoRaMacRxPayload + 1 );
dudmuck	0:8f0d0ae0a077	1174
dudmuck	0:8f0d0ae0a077	1175	LoRaMacRxPayload[0] = macHdr.Value;
dudmuck	0:8f0d0ae0a077	1176
dudmuck	0:8f0d0ae0a077	1177	LoRaMacJoinComputeMic( LoRaMacRxPayload, size - LORAMAC_MFR_LEN, LoRaMacAppKey, &mic );
dudmuck	0:8f0d0ae0a077	1178
dudmuck	0:8f0d0ae0a077	1179	micRx \|= ( uint32_t )LoRaMacRxPayload[size - LORAMAC_MFR_LEN];
dudmuck	0:8f0d0ae0a077	1180	micRx \|= ( ( uint32_t )LoRaMacRxPayload[size - LORAMAC_MFR_LEN + 1] << 8 );
dudmuck	0:8f0d0ae0a077	1181	micRx \|= ( ( uint32_t )LoRaMacRxPayload[size - LORAMAC_MFR_LEN + 2] << 16 );
dudmuck	0:8f0d0ae0a077	1182	micRx \|= ( ( uint32_t )LoRaMacRxPayload[size - LORAMAC_MFR_LEN + 3] << 24 );
dudmuck	0:8f0d0ae0a077	1183
dudmuck	0:8f0d0ae0a077	1184	if( micRx == mic )
dudmuck	0:8f0d0ae0a077	1185	{
dudmuck	0:8f0d0ae0a077	1186	LoRaMacJoinComputeSKeys( LoRaMacAppKey, LoRaMacRxPayload + 1, LoRaMacDevNonce, LoRaMacNwkSKey, LoRaMacAppSKey );
dudmuck	0:8f0d0ae0a077	1187
dudmuck	0:8f0d0ae0a077	1188	LoRaMacNetID = ( uint32_t )LoRaMacRxPayload[4];
dudmuck	0:8f0d0ae0a077	1189	LoRaMacNetID \|= ( ( uint32_t )LoRaMacRxPayload[5] << 8 );
dudmuck	0:8f0d0ae0a077	1190	LoRaMacNetID \|= ( ( uint32_t )LoRaMacRxPayload[6] << 16 );
dudmuck	0:8f0d0ae0a077	1191
dudmuck	0:8f0d0ae0a077	1192	LoRaMacDevAddr = ( uint32_t )LoRaMacRxPayload[7];
dudmuck	0:8f0d0ae0a077	1193	LoRaMacDevAddr \|= ( ( uint32_t )LoRaMacRxPayload[8] << 8 );
dudmuck	0:8f0d0ae0a077	1194	LoRaMacDevAddr \|= ( ( uint32_t )LoRaMacRxPayload[9] << 16 );
dudmuck	0:8f0d0ae0a077	1195	LoRaMacDevAddr \|= ( ( uint32_t )LoRaMacRxPayload[10] << 24 );
dudmuck	0:8f0d0ae0a077	1196
dudmuck	0:8f0d0ae0a077	1197	// DLSettings
dudmuck	0:8f0d0ae0a077	1198	LoRaMacParams.Rx1DrOffset = ( LoRaMacRxPayload[11] >> 4 ) & 0x07;
dudmuck	0:8f0d0ae0a077	1199
dudmuck	0:8f0d0ae0a077	1200	LoRaMacParams.ReceiveDelay_us = ( LoRaMacRxPayload[12] & 0x0F );
dudmuck	0:8f0d0ae0a077	1201	if( LoRaMacParams.ReceiveDelay_us == 0 )
dudmuck	0:8f0d0ae0a077	1202	LoRaMacParams.ReceiveDelay_us = RECEIVE_DELAY_us;
dudmuck	0:8f0d0ae0a077	1203	else
dudmuck	0:8f0d0ae0a077	1204	LoRaMacParams.ReceiveDelay_us *= 10;
dudmuck	0:8f0d0ae0a077	1205
dudmuck	0:8f0d0ae0a077	1206	uint16_t beaconTimingDelay = LoRaMacRxPayload[13] & 0xff;
dudmuck	0:8f0d0ae0a077	1207	beaconTimingDelay \|= LoRaMacRxPayload[14] << 8;
dudmuck	0:8f0d0ae0a077	1208
dudmuck	1:53c30224eda8	1209	isr_printf("%lx slots:%x (rxdelay %lu)", LoRaMacDevAddr, beaconTimingDelay, LoRaMacParams.ReceiveDelay_us);
dudmuck	0:8f0d0ae0a077	1210	unsigned int now_us = lp_timer.read_us();
dudmuck	0:8f0d0ae0a077	1211	unsigned int us_since_TxDone = now_us - TxDone_us;
dudmuck	16:915815632c1f	1212	unsigned us_to_beacon = ( PING_SLOT_RESOLUTION_us * beaconTimingDelay );
dudmuck	16:915815632c1f	1213	unsigned timeout_us = us_to_beacon - us_since_TxDone;
dudmuck	16:915815632c1f	1214	BeaconCtx.timeout_rx.attach_us(&OnRxBeaconSetup, timeout_us);
dudmuck	16:915815632c1f	1215	BeaconCtx.timeout_guard.attach_us(&guard_callback, timeout_us - BEACON_GUARD_us);
dudmuck	16:915815632c1f	1216
dudmuck	16:915815632c1f	1217	BeaconCtx.tx_slot_offset = LoRaMacRxPayload[15];
dudmuck	16:915815632c1f	1218	BeaconCtx.tx_slot_offset \|= LoRaMacRxPayload[16] << 8;
dudmuck	16:915815632c1f	1219	BeaconCtx.periodicity_slots = LoRaMacRxPayload[17];
dudmuck	16:915815632c1f	1220	BeaconCtx.periodicity_slots \|= LoRaMacRxPayload[18] << 8;
dudmuck	16:915815632c1f	1221
dudmuck	16:915815632c1f	1222	BeaconCtx.LastBeaconRx_us = (us_to_beacon + TxDone_us) - BEACON_INTERVAL_us;
dudmuck	16:915815632c1f	1223	unsigned us_since_beacon_start = now_us - BeaconCtx.LastBeaconRx_us;
dudmuck	16:915815632c1f	1224	int now_slot = (us_since_beacon_start - BEACON_RESERVED_us) / 30000;
dudmuck	16:915815632c1f	1225	int use_slot = BeaconCtx.tx_slot_offset;
dudmuck	16:915815632c1f	1226	while (use_slot < now_slot)
dudmuck	16:915815632c1f	1227	use_slot += BeaconCtx.periodicity_slots;
dudmuck	16:915815632c1f	1228	int slots_now_to_next = use_slot - now_slot;
dudmuck	16:915815632c1f	1229	timeout_us = slots_now_to_next * 30000;
dudmuck	16:915815632c1f	1230	tx_timeout.attach_us(&send_callback, timeout_us);
dudmuck	16:915815632c1f	1231
dudmuck	16:915815632c1f	1232	isr_printf(" now_slot:%d use_slot:%d timeout_us:%u\r\n", now_slot, use_slot, timeout_us);
dudmuck	16:915815632c1f	1233	isr_printf("us_to_beacon:%u, since_txDone:%u\r\n", us_to_beacon, us_since_TxDone);
dudmuck	0:8f0d0ae0a077	1234	BeaconCtx.state = BEACON_STATE_FIRST_ACQ;
dudmuck	16:915815632c1f	1235	BeaconCtx.guard = false;
dudmuck	0:8f0d0ae0a077	1236	BeaconCtx.num_missed = 0;
dudmuck	0:8f0d0ae0a077	1237	BeaconCtx.rx_precession_us = 0;
dudmuck	13:18de9ee3a461	1238	BeaconCtx.last_BeaconRxTimerError_us = -PPM_100_BEACON_INTERVAL;
dudmuck	13:18de9ee3a461	1239	BeaconCtx.known_working_BeaconRxTimerError_us = -PPM_100_BEACON_INTERVAL;
dudmuck	0:8f0d0ae0a077	1240	BeaconCtx.symbol_period_secs = get_symbol_period(GetRxBandwidth(LORAMAC_DEFAULT_DATARATE), Datarates[LORAMAC_DEFAULT_DATARATE]);
dudmuck	0:8f0d0ae0a077	1241	// N-ms: slot resolution + minimum for preamble detector + 100ppm fast crystal rxing 12ms early
dudmuck	0:8f0d0ae0a077	1242	BeaconCtx.Precess_symbols = TARGET_PRECESSION_US * (BeaconCtx.symbol_period_secs);
dudmuck	8:ab2f9a8d2eaa	1243	BeaconCtx.SymbolTimeout_sec = 0.1 + (BEACON_MIN_SYMBOL_TIMEOUT * BeaconCtx.symbol_period_secs);
dudmuck	0:8f0d0ae0a077	1244	BeaconCtx.SymbolTimeout = BeaconCtx.SymbolTimeout_sec / BeaconCtx.symbol_period_secs;
dudmuck	0:8f0d0ae0a077	1245
dudmuck	0:8f0d0ae0a077	1246	MlmeConfirm.Status = LORAMAC_EVENT_INFO_STATUS_OK;
dudmuck	0:8f0d0ae0a077	1247	IsLoRaMacNetworkJoined = true;
dudmuck	0:8f0d0ae0a077	1248	LoRaMacParams.ChannelsDatarate_fixed = LoRaMacParamsDefaults.ChannelsDatarate_fixed;
dudmuck	0:8f0d0ae0a077	1249	}
dudmuck	0:8f0d0ae0a077	1250	else
dudmuck	0:8f0d0ae0a077	1251	{
dudmuck	0:8f0d0ae0a077	1252	MlmeConfirm.Status = LORAMAC_EVENT_INFO_STATUS_JOIN_FAIL;
dudmuck	1:53c30224eda8	1253	isr_printf("join-mic-fail\r\n");
dudmuck	0:8f0d0ae0a077	1254	JoinRequestTrials = MaxJoinRequestTrials; // stop trying
dudmuck	0:8f0d0ae0a077	1255	}
dudmuck	16:915815632c1f	1256	LoRaMacPrimitives->MacMlmeConfirm( &MlmeConfirm );
dudmuck	16:915815632c1f	1257	LoRaMacFlags.Bits.MlmeReq = 0; // MacMlmeConfirm() called
dudmuck	0:8f0d0ae0a077	1258	break;
dudmuck	0:8f0d0ae0a077	1259	case FRAME_TYPE_DATA_CONFIRMED_DOWN:
dudmuck	0:8f0d0ae0a077	1260	case FRAME_TYPE_DATA_UNCONFIRMED_DOWN:
dudmuck	0:8f0d0ae0a077	1261	{
dudmuck	0:8f0d0ae0a077	1262	address = payload[pktHeaderLen++];
dudmuck	0:8f0d0ae0a077	1263	address \|= ( (uint32_t)payload[pktHeaderLen++] << 8 );
dudmuck	0:8f0d0ae0a077	1264	address \|= ( (uint32_t)payload[pktHeaderLen++] << 16 );
dudmuck	0:8f0d0ae0a077	1265	address \|= ( (uint32_t)payload[pktHeaderLen++] << 24 );
dudmuck	0:8f0d0ae0a077	1266
dudmuck	0:8f0d0ae0a077	1267	if( address != LoRaMacDevAddr )
dudmuck	0:8f0d0ae0a077	1268	{
dudmuck	0:8f0d0ae0a077	1269	curMulticastParams = MulticastChannels;
dudmuck	0:8f0d0ae0a077	1270	while( curMulticastParams != NULL )
dudmuck	0:8f0d0ae0a077	1271	{
dudmuck	0:8f0d0ae0a077	1272	if( address == curMulticastParams->Address )
dudmuck	0:8f0d0ae0a077	1273	{
dudmuck	0:8f0d0ae0a077	1274	multicast = 1;
dudmuck	0:8f0d0ae0a077	1275	nwkSKey = curMulticastParams->NwkSKey;
dudmuck	0:8f0d0ae0a077	1276	appSKey = curMulticastParams->AppSKey;
dudmuck	0:8f0d0ae0a077	1277	downLinkCounter = curMulticastParams->DownLinkCounter;
dudmuck	0:8f0d0ae0a077	1278	break;
dudmuck	0:8f0d0ae0a077	1279	}
dudmuck	0:8f0d0ae0a077	1280	curMulticastParams = curMulticastParams->Next;
dudmuck	0:8f0d0ae0a077	1281	}
dudmuck	0:8f0d0ae0a077	1282	if( multicast == 0 )
dudmuck	0:8f0d0ae0a077	1283	{
dudmuck	0:8f0d0ae0a077	1284	// We are not the destination of this frame.
dudmuck	0:8f0d0ae0a077	1285	McpsIndication.Status = LORAMAC_EVENT_INFO_STATUS_ADDRESS_FAIL;
dudmuck	0:8f0d0ae0a077	1286	PrepareRxDoneAbort( );
dudmuck	0:8f0d0ae0a077	1287	return;
dudmuck	0:8f0d0ae0a077	1288	}
dudmuck	0:8f0d0ae0a077	1289	}
dudmuck	0:8f0d0ae0a077	1290	else
dudmuck	0:8f0d0ae0a077	1291	{
dudmuck	0:8f0d0ae0a077	1292	multicast = 0;
dudmuck	0:8f0d0ae0a077	1293	nwkSKey = LoRaMacNwkSKey;
dudmuck	0:8f0d0ae0a077	1294	appSKey = LoRaMacAppSKey;
dudmuck	0:8f0d0ae0a077	1295	downLinkCounter = DownLinkCounter;
dudmuck	0:8f0d0ae0a077	1296	}
dudmuck	0:8f0d0ae0a077	1297
dudmuck	0:8f0d0ae0a077	1298	fCtrl.Value = payload[pktHeaderLen++];
dudmuck	0:8f0d0ae0a077	1299
dudmuck	0:8f0d0ae0a077	1300	sequenceCounter = ( uint16_t )payload[pktHeaderLen++];
dudmuck	0:8f0d0ae0a077	1301	sequenceCounter \|= ( uint16_t )payload[pktHeaderLen++] << 8;
dudmuck	0:8f0d0ae0a077	1302
dudmuck	0:8f0d0ae0a077	1303	appPayloadStartIndex = 8 + fCtrl.Bits.FOptsLen;
dudmuck	0:8f0d0ae0a077	1304
dudmuck	0:8f0d0ae0a077	1305	micRx \|= ( uint32_t )payload[size - LORAMAC_MFR_LEN];
dudmuck	0:8f0d0ae0a077	1306	micRx \|= ( ( uint32_t )payload[size - LORAMAC_MFR_LEN + 1] << 8 );
dudmuck	0:8f0d0ae0a077	1307	micRx \|= ( ( uint32_t )payload[size - LORAMAC_MFR_LEN + 2] << 16 );
dudmuck	0:8f0d0ae0a077	1308	micRx \|= ( ( uint32_t )payload[size - LORAMAC_MFR_LEN + 3] << 24 );
dudmuck	0:8f0d0ae0a077	1309
dudmuck	0:8f0d0ae0a077	1310	sequenceCounterPrev = ( uint16_t )downLinkCounter;
dudmuck	0:8f0d0ae0a077	1311	sequenceCounterDiff = ( sequenceCounter - sequenceCounterPrev );
dudmuck	0:8f0d0ae0a077	1312
dudmuck	0:8f0d0ae0a077	1313	if( sequenceCounterDiff < ( 1 << 15 ) )
dudmuck	0:8f0d0ae0a077	1314	{
dudmuck	0:8f0d0ae0a077	1315	downLinkCounter += sequenceCounterDiff;
dudmuck	0:8f0d0ae0a077	1316	LoRaMacComputeMic( payload, size - LORAMAC_MFR_LEN, nwkSKey, address, DOWN_LINK, downLinkCounter, &mic );
dudmuck	0:8f0d0ae0a077	1317	if( micRx == mic )
dudmuck	0:8f0d0ae0a077	1318	{
dudmuck	0:8f0d0ae0a077	1319	isMicOk = true;
dudmuck	0:8f0d0ae0a077	1320	}
dudmuck	0:8f0d0ae0a077	1321	}
dudmuck	0:8f0d0ae0a077	1322	else
dudmuck	0:8f0d0ae0a077	1323	{
dudmuck	0:8f0d0ae0a077	1324	// check for sequence roll-over
dudmuck	0:8f0d0ae0a077	1325	uint32_t downLinkCounterTmp = downLinkCounter + 0x10000 + ( int16_t )sequenceCounterDiff;
dudmuck	0:8f0d0ae0a077	1326	LoRaMacComputeMic( payload, size - LORAMAC_MFR_LEN, nwkSKey, address, DOWN_LINK, downLinkCounterTmp, &mic );
dudmuck	0:8f0d0ae0a077	1327	if( micRx == mic )
dudmuck	0:8f0d0ae0a077	1328	{
dudmuck	0:8f0d0ae0a077	1329	isMicOk = true;
dudmuck	0:8f0d0ae0a077	1330	downLinkCounter = downLinkCounterTmp;
dudmuck	0:8f0d0ae0a077	1331	}
dudmuck	0:8f0d0ae0a077	1332	}
dudmuck	0:8f0d0ae0a077	1333
dudmuck	0:8f0d0ae0a077	1334	// Check for a the maximum allowed counter difference
dudmuck	0:8f0d0ae0a077	1335	if( sequenceCounterDiff >= MAX_FCNT_GAP )
dudmuck	0:8f0d0ae0a077	1336	{
dudmuck	0:8f0d0ae0a077	1337	McpsIndication.Status = LORAMAC_EVENT_INFO_STATUS_DOWNLINK_TOO_MANY_FRAMES_LOSS;
dudmuck	0:8f0d0ae0a077	1338	McpsIndication.DownLinkCounter = downLinkCounter;
dudmuck	0:8f0d0ae0a077	1339	PrepareRxDoneAbort( );
dudmuck	0:8f0d0ae0a077	1340	return;
dudmuck	0:8f0d0ae0a077	1341	}
dudmuck	0:8f0d0ae0a077	1342
dudmuck	0:8f0d0ae0a077	1343	if( isMicOk == true )
dudmuck	0:8f0d0ae0a077	1344	{
dudmuck	0:8f0d0ae0a077	1345	McpsIndication.Status = LORAMAC_EVENT_INFO_STATUS_OK;
dudmuck	0:8f0d0ae0a077	1346	McpsIndication.Multicast = multicast;
dudmuck	0:8f0d0ae0a077	1347	McpsIndication.FramePending = fCtrl.Bits.FPending;
dudmuck	0:8f0d0ae0a077	1348	McpsIndication.Buffer = NULL;
dudmuck	0:8f0d0ae0a077	1349	McpsIndication.BufferSize = 0;
dudmuck	0:8f0d0ae0a077	1350	McpsIndication.DownLinkCounter = downLinkCounter;
dudmuck	0:8f0d0ae0a077	1351
dudmuck	0:8f0d0ae0a077	1352	McpsConfirm.Status = LORAMAC_EVENT_INFO_STATUS_OK;
dudmuck	0:8f0d0ae0a077	1353
dudmuck	0:8f0d0ae0a077	1354	MacCommandsBufferToRepeatIndex = 0;
dudmuck	0:8f0d0ae0a077	1355
dudmuck	0:8f0d0ae0a077	1356	// Update 32 bits downlink counter
dudmuck	0:8f0d0ae0a077	1357	if( multicast == 1 )
dudmuck	0:8f0d0ae0a077	1358	{
dudmuck	0:8f0d0ae0a077	1359	McpsIndication.McpsIndication = MCPS_MULTICAST;
dudmuck	0:8f0d0ae0a077	1360
dudmuck	0:8f0d0ae0a077	1361	if( ( curMulticastParams->DownLinkCounter == downLinkCounter ) &&
dudmuck	0:8f0d0ae0a077	1362	( curMulticastParams->DownLinkCounter != 0 ) )
dudmuck	0:8f0d0ae0a077	1363	{
dudmuck	0:8f0d0ae0a077	1364	McpsIndication.Status = LORAMAC_EVENT_INFO_STATUS_DOWNLINK_REPEATED;
dudmuck	0:8f0d0ae0a077	1365	McpsIndication.DownLinkCounter = downLinkCounter;
dudmuck	0:8f0d0ae0a077	1366	PrepareRxDoneAbort( );
dudmuck	0:8f0d0ae0a077	1367	return;
dudmuck	0:8f0d0ae0a077	1368	}
dudmuck	0:8f0d0ae0a077	1369	curMulticastParams->DownLinkCounter = downLinkCounter;
dudmuck	0:8f0d0ae0a077	1370	}
dudmuck	0:8f0d0ae0a077	1371	else
dudmuck	0:8f0d0ae0a077	1372	{
dudmuck	0:8f0d0ae0a077	1373	if( macHdr.Bits.MType == FRAME_TYPE_DATA_CONFIRMED_DOWN )
dudmuck	0:8f0d0ae0a077	1374	{
dudmuck	0:8f0d0ae0a077	1375	SrvAckRequested = true;
dudmuck	0:8f0d0ae0a077	1376	McpsIndication.McpsIndication = MCPS_CONFIRMED;
dudmuck	0:8f0d0ae0a077	1377
dudmuck	0:8f0d0ae0a077	1378	if( ( DownLinkCounter == downLinkCounter ) &&
dudmuck	0:8f0d0ae0a077	1379	( DownLinkCounter != 0 ) )
dudmuck	0:8f0d0ae0a077	1380	{
dudmuck	0:8f0d0ae0a077	1381	// Duplicated confirmed downlink. Skip indication.
dudmuck	0:8f0d0ae0a077	1382	// In this case, the MAC layer shall accept the MAC commands
dudmuck	0:8f0d0ae0a077	1383	// which are included in the downlink retransmission.
dudmuck	0:8f0d0ae0a077	1384	// It should not provide the same frame to the application
dudmuck	0:8f0d0ae0a077	1385	// layer again.
dudmuck	0:8f0d0ae0a077	1386	skipIndication = true;
dudmuck	0:8f0d0ae0a077	1387	}
dudmuck	0:8f0d0ae0a077	1388	}
dudmuck	0:8f0d0ae0a077	1389	else
dudmuck	0:8f0d0ae0a077	1390	{
dudmuck	0:8f0d0ae0a077	1391	SrvAckRequested = false;
dudmuck	0:8f0d0ae0a077	1392	McpsIndication.McpsIndication = MCPS_UNCONFIRMED;
dudmuck	0:8f0d0ae0a077	1393
dudmuck	0:8f0d0ae0a077	1394	if( ( DownLinkCounter == downLinkCounter ) &&
dudmuck	0:8f0d0ae0a077	1395	( DownLinkCounter != 0 ) )
dudmuck	0:8f0d0ae0a077	1396	{
dudmuck	0:8f0d0ae0a077	1397	McpsIndication.Status = LORAMAC_EVENT_INFO_STATUS_DOWNLINK_REPEATED;
dudmuck	0:8f0d0ae0a077	1398	McpsIndication.DownLinkCounter = downLinkCounter;
dudmuck	0:8f0d0ae0a077	1399	PrepareRxDoneAbort( );
dudmuck	0:8f0d0ae0a077	1400	return;
dudmuck	0:8f0d0ae0a077	1401	}
dudmuck	0:8f0d0ae0a077	1402	}
dudmuck	0:8f0d0ae0a077	1403	DownLinkCounter = downLinkCounter;
dudmuck	0:8f0d0ae0a077	1404	}
dudmuck	0:8f0d0ae0a077	1405
dudmuck	0:8f0d0ae0a077	1406	// This must be done before parsing the payload and the MAC commands.
dudmuck	0:8f0d0ae0a077	1407	// We need to reset the MacCommandsBufferIndex here, since we need
dudmuck	0:8f0d0ae0a077	1408	// to take retransmissions and repititions into account. Error cases
dudmuck	0:8f0d0ae0a077	1409	// will be handled in function OnMacStateCheckTimerEvent.
dudmuck	0:8f0d0ae0a077	1410	if( McpsConfirm.McpsRequest == MCPS_CONFIRMED )
dudmuck	0:8f0d0ae0a077	1411	{
dudmuck	0:8f0d0ae0a077	1412	if( fCtrl.Bits.Ack == 1 )
dudmuck	0:8f0d0ae0a077	1413	{// Reset MacCommandsBufferIndex when we have received an ACK.
dudmuck	0:8f0d0ae0a077	1414	MacCommandsBufferIndex = 0;
dudmuck	0:8f0d0ae0a077	1415	}
dudmuck	0:8f0d0ae0a077	1416	}
dudmuck	0:8f0d0ae0a077	1417	else
dudmuck	0:8f0d0ae0a077	1418	{// Reset the variable if we have received any valid frame.
dudmuck	0:8f0d0ae0a077	1419	MacCommandsBufferIndex = 0;
dudmuck	0:8f0d0ae0a077	1420	}
dudmuck	0:8f0d0ae0a077	1421
dudmuck	0:8f0d0ae0a077	1422	// Process payload and MAC commands
dudmuck	0:8f0d0ae0a077	1423	if( ( ( size - 4 ) - appPayloadStartIndex ) > 0 )
dudmuck	0:8f0d0ae0a077	1424	{
dudmuck	0:8f0d0ae0a077	1425	port = payload[appPayloadStartIndex++];
dudmuck	0:8f0d0ae0a077	1426	frameLen = ( size - 4 ) - appPayloadStartIndex;
dudmuck	0:8f0d0ae0a077	1427
dudmuck	0:8f0d0ae0a077	1428	McpsIndication.Port = port;
dudmuck	0:8f0d0ae0a077	1429
dudmuck	0:8f0d0ae0a077	1430	if( port == 0 )
dudmuck	0:8f0d0ae0a077	1431	{
dudmuck	0:8f0d0ae0a077	1432	// Only allow frames which do not have fOpts
dudmuck	0:8f0d0ae0a077	1433	if( fCtrl.Bits.FOptsLen == 0 )
dudmuck	0:8f0d0ae0a077	1434	{
dudmuck	0:8f0d0ae0a077	1435	LoRaMacPayloadDecrypt( payload + appPayloadStartIndex,
dudmuck	0:8f0d0ae0a077	1436	frameLen,
dudmuck	0:8f0d0ae0a077	1437	nwkSKey,
dudmuck	0:8f0d0ae0a077	1438	address,
dudmuck	0:8f0d0ae0a077	1439	DOWN_LINK,
dudmuck	0:8f0d0ae0a077	1440	downLinkCounter,
dudmuck	0:8f0d0ae0a077	1441	LoRaMacRxPayload );
dudmuck	0:8f0d0ae0a077	1442
dudmuck	0:8f0d0ae0a077	1443	// Decode frame payload MAC commands
dudmuck	0:8f0d0ae0a077	1444	ProcessMacCommands( LoRaMacRxPayload, 0, frameLen, snr );
dudmuck	0:8f0d0ae0a077	1445	}
dudmuck	0:8f0d0ae0a077	1446	else
dudmuck	0:8f0d0ae0a077	1447	{
dudmuck	0:8f0d0ae0a077	1448	skipIndication = true;
dudmuck	0:8f0d0ae0a077	1449	}
dudmuck	0:8f0d0ae0a077	1450	}
dudmuck	0:8f0d0ae0a077	1451	else
dudmuck	0:8f0d0ae0a077	1452	{
dudmuck	0:8f0d0ae0a077	1453	if( fCtrl.Bits.FOptsLen > 0 )
dudmuck	0:8f0d0ae0a077	1454	{
dudmuck	0:8f0d0ae0a077	1455	// Decode Options field MAC commands. Omit the fPort.
dudmuck	0:8f0d0ae0a077	1456	ProcessMacCommands( payload, 8, appPayloadStartIndex - 1, snr );
dudmuck	0:8f0d0ae0a077	1457	}
dudmuck	0:8f0d0ae0a077	1458
dudmuck	0:8f0d0ae0a077	1459	LoRaMacPayloadDecrypt( payload + appPayloadStartIndex,
dudmuck	0:8f0d0ae0a077	1460	frameLen,
dudmuck	0:8f0d0ae0a077	1461	appSKey,
dudmuck	0:8f0d0ae0a077	1462	address,
dudmuck	0:8f0d0ae0a077	1463	DOWN_LINK,
dudmuck	0:8f0d0ae0a077	1464	downLinkCounter,
dudmuck	0:8f0d0ae0a077	1465	LoRaMacRxPayload );
dudmuck	0:8f0d0ae0a077	1466
dudmuck	0:8f0d0ae0a077	1467	if( skipIndication == false )
dudmuck	0:8f0d0ae0a077	1468	{
dudmuck	0:8f0d0ae0a077	1469	McpsIndication.Buffer = LoRaMacRxPayload;
dudmuck	0:8f0d0ae0a077	1470	McpsIndication.BufferSize = frameLen;
dudmuck	0:8f0d0ae0a077	1471	McpsIndication.RxData = true;
dudmuck	0:8f0d0ae0a077	1472	}
dudmuck	0:8f0d0ae0a077	1473	}
dudmuck	0:8f0d0ae0a077	1474	}
dudmuck	0:8f0d0ae0a077	1475	else
dudmuck	0:8f0d0ae0a077	1476	{
dudmuck	0:8f0d0ae0a077	1477	if( fCtrl.Bits.FOptsLen > 0 )
dudmuck	0:8f0d0ae0a077	1478	{
dudmuck	0:8f0d0ae0a077	1479	// Decode Options field MAC commands
dudmuck	0:8f0d0ae0a077	1480	ProcessMacCommands( payload, 8, appPayloadStartIndex, snr );
dudmuck	0:8f0d0ae0a077	1481	}
dudmuck	0:8f0d0ae0a077	1482	}
dudmuck	0:8f0d0ae0a077	1483
dudmuck	0:8f0d0ae0a077	1484	if( skipIndication == false )
dudmuck	0:8f0d0ae0a077	1485	{
dudmuck	0:8f0d0ae0a077	1486	// Check if the frame is an acknowledgement
dudmuck	0:8f0d0ae0a077	1487	if( fCtrl.Bits.Ack == 1 )
dudmuck	0:8f0d0ae0a077	1488	{
dudmuck	0:8f0d0ae0a077	1489	McpsConfirm.AckReceived = true;
dudmuck	0:8f0d0ae0a077	1490	McpsIndication.AckReceived = true;
dudmuck	0:8f0d0ae0a077	1491
dudmuck	0:8f0d0ae0a077	1492	// Stop the AckTimeout timer as no more retransmissions
dudmuck	0:8f0d0ae0a077	1493	// are needed.
dudmuck	0:8f0d0ae0a077	1494	}
dudmuck	0:8f0d0ae0a077	1495	else
dudmuck	0:8f0d0ae0a077	1496	{
dudmuck	0:8f0d0ae0a077	1497	McpsConfirm.AckReceived = false;
dudmuck	0:8f0d0ae0a077	1498	}
dudmuck	0:8f0d0ae0a077	1499	}
dudmuck	0:8f0d0ae0a077	1500	// Provide always an indication, skip the callback to the user application,
dudmuck	0:8f0d0ae0a077	1501	// in case of a confirmed downlink retransmission.
dudmuck	0:8f0d0ae0a077	1502	LoRaMacFlags.Bits.McpsInd = 1;
dudmuck	0:8f0d0ae0a077	1503	LoRaMacFlags.Bits.McpsIndSkip = skipIndication;
dudmuck	0:8f0d0ae0a077	1504	}
dudmuck	0:8f0d0ae0a077	1505	else
dudmuck	0:8f0d0ae0a077	1506	{
dudmuck	0:8f0d0ae0a077	1507	McpsIndication.Status = LORAMAC_EVENT_INFO_STATUS_MIC_FAIL;
dudmuck	5:c108560af4c3	1508	McpsConfirm.Status = LORAMAC_EVENT_INFO_STATUS_MIC_FAIL;
dudmuck	0:8f0d0ae0a077	1509	PrepareRxDoneAbort( );
dudmuck	0:8f0d0ae0a077	1510	return;
dudmuck	0:8f0d0ae0a077	1511	}
dudmuck	0:8f0d0ae0a077	1512	}
dudmuck	0:8f0d0ae0a077	1513	break;
dudmuck	0:8f0d0ae0a077	1514	case FRAME_TYPE_PROPRIETARY:
dudmuck	0:8f0d0ae0a077	1515	{
dudmuck	0:8f0d0ae0a077	1516	memcpy1( LoRaMacRxPayload, &payload[pktHeaderLen], size );
dudmuck	0:8f0d0ae0a077	1517
dudmuck	0:8f0d0ae0a077	1518	McpsIndication.McpsIndication = MCPS_PROPRIETARY;
dudmuck	0:8f0d0ae0a077	1519	McpsIndication.Status = LORAMAC_EVENT_INFO_STATUS_OK;
dudmuck	0:8f0d0ae0a077	1520	McpsIndication.Buffer = LoRaMacRxPayload;
dudmuck	0:8f0d0ae0a077	1521	McpsIndication.BufferSize = size - pktHeaderLen;
dudmuck	0:8f0d0ae0a077	1522
dudmuck	0:8f0d0ae0a077	1523	LoRaMacFlags.Bits.McpsInd = 1;
dudmuck	0:8f0d0ae0a077	1524	break;
dudmuck	0:8f0d0ae0a077	1525	}
dudmuck	0:8f0d0ae0a077	1526	default:
dudmuck	2:f2d9aa163652	1527	McpsIndication.Status = LORAMAC_EVENT_INFO_STATUS_ERROR_RX_MTYPE;
dudmuck	5:c108560af4c3	1528	McpsConfirm.Status = LORAMAC_EVENT_INFO_STATUS_ERROR_RX_MTYPE;
dudmuck	20:42839629a5dc	1529	isr_printf("%d:macHdr:%02x(%d,%d) ", size, macHdr.Value, rssi, snr);
dudmuck	0:8f0d0ae0a077	1530	PrepareRxDoneAbort( );
dudmuck	0:8f0d0ae0a077	1531	break;
dudmuck	0:8f0d0ae0a077	1532	}
dudmuck	0:8f0d0ae0a077	1533	LoRaMacFlags.Bits.MacDone = 1;
dudmuck	0:8f0d0ae0a077	1534
dudmuck	16:915815632c1f	1535	application_callbacks();
dudmuck	16:915815632c1f	1536
dudmuck	1:53c30224eda8	1537	} // ..OnRadioRxDone();
dudmuck	0:8f0d0ae0a077	1538
dudmuck	16:915815632c1f	1539
dudmuck	16:915815632c1f	1540
dudmuck	0:8f0d0ae0a077	1541	static void OnRadioTxTimeout( void )
dudmuck	0:8f0d0ae0a077	1542	{
dudmuck	0:8f0d0ae0a077	1543	Radio.Sleep( );
dudmuck	0:8f0d0ae0a077	1544
dudmuck	0:8f0d0ae0a077	1545	McpsConfirm.Status = LORAMAC_EVENT_INFO_STATUS_TX_TIMEOUT;
dudmuck	0:8f0d0ae0a077	1546	MlmeConfirm.Status = LORAMAC_EVENT_INFO_STATUS_TX_TIMEOUT;
dudmuck	0:8f0d0ae0a077	1547	LoRaMacFlags.Bits.MacDone = 1;
dudmuck	0:8f0d0ae0a077	1548	}
dudmuck	0:8f0d0ae0a077	1549
dudmuck	0:8f0d0ae0a077	1550	static void OnRadioRxError( void )
dudmuck	0:8f0d0ae0a077	1551	{
dudmuck	0:8f0d0ae0a077	1552	Radio.Sleep( );
dudmuck	0:8f0d0ae0a077	1553
dudmuck	16:915815632c1f	1554	if (NodeAckRequested)
dudmuck	0:8f0d0ae0a077	1555	{
dudmuck	0:8f0d0ae0a077	1556	McpsConfirm.Status = LORAMAC_EVENT_INFO_STATUS_RX_ERROR;
dudmuck	0:8f0d0ae0a077	1557	}
dudmuck	0:8f0d0ae0a077	1558	MlmeConfirm.Status = LORAMAC_EVENT_INFO_STATUS_RX_ERROR;
dudmuck	0:8f0d0ae0a077	1559
dudmuck	0:8f0d0ae0a077	1560	if ((lp_timer.read_us() - AggregatedLastTxDoneTime_us) >= RxWindowDelay_us )
dudmuck	0:8f0d0ae0a077	1561	{
dudmuck	0:8f0d0ae0a077	1562	LoRaMacFlags.Bits.MacDone = 1;
dudmuck	0:8f0d0ae0a077	1563	}
dudmuck	0:8f0d0ae0a077	1564	}
dudmuck	0:8f0d0ae0a077	1565
dudmuck	16:915815632c1f	1566	static void
dudmuck	16:915815632c1f	1567	join_send()
dudmuck	16:915815632c1f	1568	{
dudmuck	20:42839629a5dc	1569	flags.join_send = 1;
dudmuck	20:42839629a5dc	1570	}
dudmuck	20:42839629a5dc	1571
dudmuck	25:fed9d5b77183	1572	static void ScheduleTx( void )
dudmuck	25:fed9d5b77183	1573	{
dudmuck	25:fed9d5b77183	1574	if (!IsLoRaMacNetworkJoined)
dudmuck	25:fed9d5b77183	1575	flags.send = 1; // immediately send join asychronously
dudmuck	25:fed9d5b77183	1576	else
dudmuck	25:fed9d5b77183	1577	LoRaMacFlags.Bits.uplink_pending = 1; // send synchronously
dudmuck	25:fed9d5b77183	1578	}
dudmuck	25:fed9d5b77183	1579
dudmuck	20:42839629a5dc	1580	static void
dudmuck	20:42839629a5dc	1581	join_send_bh()
dudmuck	20:42839629a5dc	1582	{
dudmuck	16:915815632c1f	1583	if (JoinRequestTrials < MaxJoinRequestTrials) {
dudmuck	16:915815632c1f	1584	LoRaMacHeader_t macHdr;
dudmuck	16:915815632c1f	1585	LoRaMacFrameCtrl_t fCtrl;
dudmuck	16:915815632c1f	1586
dudmuck	16:915815632c1f	1587	if (++Channel == LORA_MAX_NB_CHANNELS)
dudmuck	16:915815632c1f	1588	Channel = 0;
dudmuck	16:915815632c1f	1589	isr_printf("<join-ch%u>", Channel);
dudmuck	16:915815632c1f	1590
dudmuck	16:915815632c1f	1591	macHdr.Value = 0;
dudmuck	16:915815632c1f	1592	macHdr.Bits.MType = FRAME_TYPE_JOIN_REQ;
dudmuck	16:915815632c1f	1593
dudmuck	16:915815632c1f	1594	fCtrl.Value = 0;
dudmuck	16:915815632c1f	1595	fCtrl.Bits.Adr = 0;
dudmuck	16:915815632c1f	1596
dudmuck	16:915815632c1f	1597	/* In case of join request retransmissions, the stack must prepare
dudmuck	16:915815632c1f	1598	* the frame again, because the network server keeps track of the random
dudmuck	16:915815632c1f	1599	* LoRaMacDevNonce values to prevent reply attacks. */
dudmuck	16:915815632c1f	1600	PrepareFrame( &macHdr, &fCtrl, 0, NULL, 0 );
dudmuck	16:915815632c1f	1601
dudmuck	16:915815632c1f	1602	ScheduleTx();
dudmuck	16:915815632c1f	1603	} else {
dudmuck	16:915815632c1f	1604	MlmeConfirm.MlmeRequest = MLME_JOIN;
dudmuck	16:915815632c1f	1605	MlmeConfirm.Status = LORAMAC_EVENT_INFO_STATUS_JOIN_FAIL;
dudmuck	16:915815632c1f	1606	LoRaMacPrimitives->MacMlmeConfirm( &MlmeConfirm );
dudmuck	16:915815632c1f	1607	}
dudmuck	16:915815632c1f	1608	}
dudmuck	16:915815632c1f	1609
dudmuck	0:8f0d0ae0a077	1610	static void OnRadioRxTimeout( void )
dudmuck	0:8f0d0ae0a077	1611	{
dudmuck	16:915815632c1f	1612	static unsigned LastBeaconRx_us;
dudmuck	16:915815632c1f	1613
dudmuck	0:8f0d0ae0a077	1614	Radio.Sleep( );
dudmuck	0:8f0d0ae0a077	1615
dudmuck	0:8f0d0ae0a077	1616	if (expecting_beacon) {
dudmuck	16:915815632c1f	1617	unsigned next_beacon_expected_us = BEACON_INTERVAL_us;
dudmuck	0:8f0d0ae0a077	1618	if (BeaconCtx.state == BEACON_STATE_FIRST_ACQ) {
dudmuck	16:915815632c1f	1619	next_beacon_expected_us -= 1000000;
dudmuck	16:915815632c1f	1620	set_beacon_symbol_timeout(1.000);
dudmuck	0:8f0d0ae0a077	1621	} else {
dudmuck	16:915815632c1f	1622	next_beacon_expected_us += BeaconCtx.known_working_BeaconRxTimerError_us;
dudmuck	0:8f0d0ae0a077	1623	// for measurement resolution and temperature drift while missing beacons:
dudmuck	16:915815632c1f	1624	next_beacon_expected_us -= 10000;
dudmuck	16:915815632c1f	1625	set_beacon_symbol_timeout(BeaconCtx.SymbolTimeout_sec + 0.025);
dudmuck	0:8f0d0ae0a077	1626	}
dudmuck	16:915815632c1f	1627	unsigned now_us = lp_timer.read_us();
dudmuck	0:8f0d0ae0a077	1628	unsigned us_since_rx_setup = now_us - BeaconCtx.RxBeaconSetupAt_us;
dudmuck	16:915815632c1f	1629	unsigned b_timeout_us = next_beacon_expected_us - us_since_rx_setup;
dudmuck	16:915815632c1f	1630	BeaconCtx.timeout_rx.attach_us(&OnRxBeaconSetup, b_timeout_us);
dudmuck	16:915815632c1f	1631	BeaconCtx.timeout_guard.attach_us(&guard_callback, b_timeout_us - BEACON_GUARD_us);
dudmuck	16:915815632c1f	1632
dudmuck	16:915815632c1f	1633	if (BeaconCtx.num_missed == 0) /* first missed beacon, init our local LastBeaconRx_us */
dudmuck	16:915815632c1f	1634	LastBeaconRx_us = BeaconCtx.LastBeaconRx_us;
dudmuck	16:915815632c1f	1635
dudmuck	16:915815632c1f	1636	BeaconCtx.num_missed++;
dudmuck	16:915815632c1f	1637	/***************************************/
dudmuck	16:915815632c1f	1638	unsigned fake_ThisBeaconRx_us = LastBeaconRx_us + BEACON_INTERVAL_us + BeaconCtx.known_working_BeaconRxTimerError_us;
dudmuck	16:915815632c1f	1639	unsigned us_since_beacon_start = now_us - fake_ThisBeaconRx_us;
dudmuck	16:915815632c1f	1640	unsigned timeout_us = BEACON_RESERVED_us + (BeaconCtx.tx_slot_offset * 30000) - us_since_beacon_start;
dudmuck	16:915815632c1f	1641	tx_timeout.attach_us(&send_callback, timeout_us);
dudmuck	16:915815632c1f	1642	isr_printf("fake %u\r\n", fake_ThisBeaconRx_us - LastBeaconRx_us);
dudmuck	16:915815632c1f	1643	LastBeaconRx_us = fake_ThisBeaconRx_us; // update our local for next missed beacon
dudmuck	16:915815632c1f	1644	/***************************************/
dudmuck	13:18de9ee3a461	1645
dudmuck	13:18de9ee3a461	1646	#ifdef DEBUG_GWTX_JUMPER
dudmuck	13:18de9ee3a461	1647	isr_printf("rx-before-gwtx:%d ", gwtx_rise_us - BeaconCtx.RxBeaconSetupAt_us);
dudmuck	16:915815632c1f	1648	#endif /* DEBUG_GWTX_JUMPER */
dudmuck	16:915815632c1f	1649
dudmuck	21:500ff43d8424	1650	isr_printf("beacon-rx-timeout %u %u next in %uus (rxing for %u)", BeaconCtx.num_missed, BeaconCtx.SymbolTimeout, b_timeout_us, us_since_rx_setup);
dudmuck	21:500ff43d8424	1651	isr_printf(" %u,nextTx:%u\r\n", us_since_beacon_start, timeout_us);
dudmuck	0:8f0d0ae0a077	1652
dudmuck	0:8f0d0ae0a077	1653	MlmeIndication.MlmeIndication = MLME_BEACON;
dudmuck	0:8f0d0ae0a077	1654	MlmeIndication.Status = LORAMAC_EVENT_INFO_STATUS_BEACON_LOST;
dudmuck	0:8f0d0ae0a077	1655	LoRaMacPrimitives->MacMlmeIndication( &MlmeIndication );
dudmuck	0:8f0d0ae0a077	1656
dudmuck	16:915815632c1f	1657	BeaconCtx.guard = false;
dudmuck	0:8f0d0ae0a077	1658	expecting_beacon = false;
dudmuck	16:915815632c1f	1659	} else {
dudmuck	25:fed9d5b77183	1660	if (LoRaMacFlags.Bits.MlmeReq && ( MlmeConfirm.MlmeRequest == MLME_JOIN )) {
dudmuck	25:fed9d5b77183	1661	/* no join accept received: join retry */
dudmuck	25:fed9d5b77183	1662	tx_timeout.attach_us(&join_send, (JoinRequestTrials*20000) + randr(0, 70000));
dudmuck	25:fed9d5b77183	1663	}
dudmuck	0:8f0d0ae0a077	1664	}
dudmuck	0:8f0d0ae0a077	1665
dudmuck	16:915815632c1f	1666	if (NodeAckRequested)
dudmuck	0:8f0d0ae0a077	1667	{
dudmuck	0:8f0d0ae0a077	1668	McpsConfirm.Status = LORAMAC_EVENT_INFO_STATUS_RX_TIMEOUT;
dudmuck	0:8f0d0ae0a077	1669	}
dudmuck	0:8f0d0ae0a077	1670	MlmeConfirm.Status = LORAMAC_EVENT_INFO_STATUS_RX_TIMEOUT;
dudmuck	0:8f0d0ae0a077	1671	LoRaMacFlags.Bits.MacDone = 1;
dudmuck	16:915815632c1f	1672
dudmuck	16:915815632c1f	1673	application_callbacks();
dudmuck	1:53c30224eda8	1674	} // ..OnRadioRxTimeout();
dudmuck	0:8f0d0ae0a077	1675
dudmuck	20:42839629a5dc	1676	static void OnRxWindowTimerEventBH()
dudmuck	0:8f0d0ae0a077	1677	{
dudmuck	0:8f0d0ae0a077	1678	Radio.Standby( );
dudmuck	8:ab2f9a8d2eaa	1679	if (expecting_beacon) {
dudmuck	8:ab2f9a8d2eaa	1680	isr_printf("rxwin-during-beacon\r\n");
dudmuck	16:915815632c1f	1681	McpsConfirm.Status = LORAMAC_EVENT_INFO_STATUS_RX_ERROR;
dudmuck	16:915815632c1f	1682	MlmeConfirm.Status = LORAMAC_EVENT_INFO_STATUS_RX_ERROR;
dudmuck	16:915815632c1f	1683	LoRaMacFlags.Bits.MacDone = 1;
dudmuck	16:915815632c1f	1684	LoRaMacPrimitives->MacMcpsConfirm( &McpsConfirm );
dudmuck	8:ab2f9a8d2eaa	1685	} else {
dudmuck	25:fed9d5b77183	1686	//RxWindowSetup( LORAMAC_FIRST_CHANNEL + ( Channel * LORAMAC_STEPWIDTH_CHANNEL), RxWindowsParam.Datarate, RxWindowsParam.Bandwidth, RxWindowsParam.RxWindowTimeout, false );
dudmuck	25:fed9d5b77183	1687	RxWindowSetup( Channels[Channel].Frequency, RxWindowsParam.Datarate, RxWindowsParam.Bandwidth, RxWindowsParam.RxWindowTimeout, false );
dudmuck	8:ab2f9a8d2eaa	1688	}
dudmuck	0:8f0d0ae0a077	1689	}
dudmuck	0:8f0d0ae0a077	1690
dudmuck	20:42839629a5dc	1691	static void OnRxWindowTimerEvent( void )
dudmuck	20:42839629a5dc	1692	{
dudmuck	20:42839629a5dc	1693	flags.rx_win = 1;
dudmuck	20:42839629a5dc	1694	}
dudmuck	20:42839629a5dc	1695
dudmuck	0:8f0d0ae0a077	1696	static void OnAckTimeoutTimerEvent( void )
dudmuck	0:8f0d0ae0a077	1697	{
dudmuck	0:8f0d0ae0a077	1698	}
dudmuck	0:8f0d0ae0a077	1699
dudmuck	0:8f0d0ae0a077	1700	static bool RxWindowSetup( uint32_t freq, int8_t datarate, uint32_t bandwidth, uint16_t timeout, bool rxContinuous )
dudmuck	0:8f0d0ae0a077	1701	{
dudmuck	0:8f0d0ae0a077	1702	uint8_t downlinkDatarate = Datarates[datarate];
dudmuck	0:8f0d0ae0a077	1703	RadioModems_t modem;
dudmuck	0:8f0d0ae0a077	1704
dudmuck	0:8f0d0ae0a077	1705	if( Radio.GetStatus( ) == RF_IDLE )
dudmuck	0:8f0d0ae0a077	1706	{
dudmuck	0:8f0d0ae0a077	1707	Radio.SetChannel( freq );
dudmuck	0:8f0d0ae0a077	1708
dudmuck	0:8f0d0ae0a077	1709	// Store downlink datarate
dudmuck	0:8f0d0ae0a077	1710	McpsIndication.RxDatarate = ( uint8_t ) datarate;
dudmuck	0:8f0d0ae0a077	1711
dudmuck	0:8f0d0ae0a077	1712	modem = MODEM_LORA;
dudmuck	0:8f0d0ae0a077	1713	Radio.SetRxConfig( modem, bandwidth, downlinkDatarate, 1, 0, 8, timeout, false, 0, false, 0, 0, true, rxContinuous );
dudmuck	0:8f0d0ae0a077	1714	Radio.SetMaxPayloadLength( MODEM_LORA, 255 );
dudmuck	0:8f0d0ae0a077	1715
dudmuck	0:8f0d0ae0a077	1716	if( rxContinuous == false )
dudmuck	0:8f0d0ae0a077	1717	{
dudmuck	0:8f0d0ae0a077	1718	Radio.Rx( LoRaMacParams.MaxRxWindow );
dudmuck	0:8f0d0ae0a077	1719	}
dudmuck	0:8f0d0ae0a077	1720	else
dudmuck	0:8f0d0ae0a077	1721	{
dudmuck	0:8f0d0ae0a077	1722	Radio.Rx( 0 ); // Continuous mode
dudmuck	0:8f0d0ae0a077	1723	}
dudmuck	0:8f0d0ae0a077	1724	return true;
dudmuck	0:8f0d0ae0a077	1725	}
dudmuck	0:8f0d0ae0a077	1726	return false;
dudmuck	0:8f0d0ae0a077	1727	}
dudmuck	0:8f0d0ae0a077	1728
dudmuck	0:8f0d0ae0a077	1729	static bool ValueInRange( int8_t value, int8_t min, int8_t max )
dudmuck	0:8f0d0ae0a077	1730	{
dudmuck	0:8f0d0ae0a077	1731	if( ( value >= min ) && ( value <= max ) )
dudmuck	0:8f0d0ae0a077	1732	{
dudmuck	0:8f0d0ae0a077	1733	return true;
dudmuck	0:8f0d0ae0a077	1734	}
dudmuck	0:8f0d0ae0a077	1735	return false;
dudmuck	0:8f0d0ae0a077	1736	}
dudmuck	0:8f0d0ae0a077	1737
dudmuck	0:8f0d0ae0a077	1738	static LoRaMacStatus_t AddMacCommand( uint8_t cmd, uint8_t p1, uint8_t p2 )
dudmuck	0:8f0d0ae0a077	1739	{
dudmuck	0:8f0d0ae0a077	1740	LoRaMacStatus_t status = LORAMAC_STATUS_BUSY;
dudmuck	0:8f0d0ae0a077	1741	// The maximum buffer length must take MAC commands to re-send into account.
dudmuck	0:8f0d0ae0a077	1742	uint8_t bufLen = LORA_MAC_COMMAND_MAX_LENGTH - MacCommandsBufferToRepeatIndex;
dudmuck	0:8f0d0ae0a077	1743
dudmuck	0:8f0d0ae0a077	1744	switch( cmd )
dudmuck	0:8f0d0ae0a077	1745	{
dudmuck	0:8f0d0ae0a077	1746	case MOTE_MAC_LINK_CHECK_REQ:
dudmuck	0:8f0d0ae0a077	1747	if( MacCommandsBufferIndex < bufLen )
dudmuck	0:8f0d0ae0a077	1748	{
dudmuck	0:8f0d0ae0a077	1749	MacCommandsBuffer[MacCommandsBufferIndex++] = cmd;
dudmuck	0:8f0d0ae0a077	1750	// No payload for this command
dudmuck	0:8f0d0ae0a077	1751	status = LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	1752	}
dudmuck	0:8f0d0ae0a077	1753	break;
dudmuck	0:8f0d0ae0a077	1754	case MOTE_MAC_RX_PARAM_SETUP_ANS:
dudmuck	0:8f0d0ae0a077	1755	if( MacCommandsBufferIndex < ( bufLen - 1 ) )
dudmuck	0:8f0d0ae0a077	1756	{
dudmuck	0:8f0d0ae0a077	1757	MacCommandsBuffer[MacCommandsBufferIndex++] = cmd;
dudmuck	0:8f0d0ae0a077	1758	// Status: Datarate ACK, Channel ACK
dudmuck	0:8f0d0ae0a077	1759	MacCommandsBuffer[MacCommandsBufferIndex++] = p1;
dudmuck	0:8f0d0ae0a077	1760	status = LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	1761	}
dudmuck	0:8f0d0ae0a077	1762	break;
dudmuck	0:8f0d0ae0a077	1763	case MOTE_MAC_DEV_STATUS_ANS:
dudmuck	0:8f0d0ae0a077	1764	if( MacCommandsBufferIndex < ( bufLen - 2 ) )
dudmuck	0:8f0d0ae0a077	1765	{
dudmuck	0:8f0d0ae0a077	1766	MacCommandsBuffer[MacCommandsBufferIndex++] = cmd;
dudmuck	0:8f0d0ae0a077	1767	// 1st byte Battery
dudmuck	0:8f0d0ae0a077	1768	// 2nd byte Margin
dudmuck	0:8f0d0ae0a077	1769	MacCommandsBuffer[MacCommandsBufferIndex++] = p1;
dudmuck	0:8f0d0ae0a077	1770	MacCommandsBuffer[MacCommandsBufferIndex++] = p2;
dudmuck	0:8f0d0ae0a077	1771	status = LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	1772	}
dudmuck	0:8f0d0ae0a077	1773	break;
dudmuck	0:8f0d0ae0a077	1774	case MOTE_MAC_RX_TIMING_SETUP_ANS:
dudmuck	0:8f0d0ae0a077	1775	if( MacCommandsBufferIndex < bufLen )
dudmuck	0:8f0d0ae0a077	1776	{
dudmuck	0:8f0d0ae0a077	1777	MacCommandsBuffer[MacCommandsBufferIndex++] = cmd;
dudmuck	0:8f0d0ae0a077	1778	// No payload for this answer
dudmuck	0:8f0d0ae0a077	1779	status = LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	1780	}
dudmuck	0:8f0d0ae0a077	1781	break;
dudmuck	0:8f0d0ae0a077	1782	default:
dudmuck	0:8f0d0ae0a077	1783	return LORAMAC_STATUS_SERVICE_UNKNOWN;
dudmuck	0:8f0d0ae0a077	1784	}
dudmuck	0:8f0d0ae0a077	1785	if( status == LORAMAC_STATUS_OK )
dudmuck	0:8f0d0ae0a077	1786	{
dudmuck	0:8f0d0ae0a077	1787	MacCommandsInNextTx = true;
dudmuck	0:8f0d0ae0a077	1788	}
dudmuck	0:8f0d0ae0a077	1789	return status;
dudmuck	0:8f0d0ae0a077	1790	}
dudmuck	0:8f0d0ae0a077	1791
dudmuck	0:8f0d0ae0a077	1792	static uint8_t ParseMacCommandsToRepeat( uint8_t* cmdBufIn, uint8_t length, uint8_t* cmdBufOut )
dudmuck	0:8f0d0ae0a077	1793	{
dudmuck	0:8f0d0ae0a077	1794	uint8_t i = 0;
dudmuck	0:8f0d0ae0a077	1795	uint8_t cmdCount = 0;
dudmuck	0:8f0d0ae0a077	1796
dudmuck	0:8f0d0ae0a077	1797	if( ( cmdBufIn == NULL ) \|\| ( cmdBufOut == NULL ) )
dudmuck	0:8f0d0ae0a077	1798	{
dudmuck	0:8f0d0ae0a077	1799	return 0;
dudmuck	0:8f0d0ae0a077	1800	}
dudmuck	0:8f0d0ae0a077	1801
dudmuck	0:8f0d0ae0a077	1802	for( i = 0; i < length; i++ )
dudmuck	0:8f0d0ae0a077	1803	{
dudmuck	0:8f0d0ae0a077	1804	switch( cmdBufIn[i] )
dudmuck	0:8f0d0ae0a077	1805	{
dudmuck	0:8f0d0ae0a077	1806	// STICKY
dudmuck	0:8f0d0ae0a077	1807	case MOTE_MAC_RX_PARAM_SETUP_ANS:
dudmuck	0:8f0d0ae0a077	1808	{
dudmuck	0:8f0d0ae0a077	1809	cmdBufOut[cmdCount++] = cmdBufIn[i++];
dudmuck	0:8f0d0ae0a077	1810	cmdBufOut[cmdCount++] = cmdBufIn[i];
dudmuck	0:8f0d0ae0a077	1811	break;
dudmuck	0:8f0d0ae0a077	1812	}
dudmuck	0:8f0d0ae0a077	1813	case MOTE_MAC_RX_TIMING_SETUP_ANS:
dudmuck	0:8f0d0ae0a077	1814	{
dudmuck	0:8f0d0ae0a077	1815	cmdBufOut[cmdCount++] = cmdBufIn[i];
dudmuck	0:8f0d0ae0a077	1816	break;
dudmuck	0:8f0d0ae0a077	1817	}
dudmuck	0:8f0d0ae0a077	1818	// NON-STICKY
dudmuck	0:8f0d0ae0a077	1819	case MOTE_MAC_DEV_STATUS_ANS:
dudmuck	0:8f0d0ae0a077	1820	{ // 2 bytes payload
dudmuck	0:8f0d0ae0a077	1821	i += 2;
dudmuck	0:8f0d0ae0a077	1822	break;
dudmuck	0:8f0d0ae0a077	1823	}
dudmuck	0:8f0d0ae0a077	1824	case MOTE_MAC_LINK_CHECK_REQ:
dudmuck	0:8f0d0ae0a077	1825	{ // 0 byte payload
dudmuck	0:8f0d0ae0a077	1826	break;
dudmuck	0:8f0d0ae0a077	1827	}
dudmuck	0:8f0d0ae0a077	1828	default:
dudmuck	0:8f0d0ae0a077	1829	break;
dudmuck	0:8f0d0ae0a077	1830	}
dudmuck	0:8f0d0ae0a077	1831	}
dudmuck	0:8f0d0ae0a077	1832
dudmuck	0:8f0d0ae0a077	1833	return cmdCount;
dudmuck	0:8f0d0ae0a077	1834	}
dudmuck	0:8f0d0ae0a077	1835
dudmuck	0:8f0d0ae0a077	1836	static void ProcessMacCommands( uint8_t *payload, uint8_t macIndex, uint8_t commandsSize, uint8_t snr )
dudmuck	0:8f0d0ae0a077	1837	{
dudmuck	0:8f0d0ae0a077	1838	while( macIndex < commandsSize )
dudmuck	0:8f0d0ae0a077	1839	{
dudmuck	0:8f0d0ae0a077	1840	// Decode Frame MAC commands
dudmuck	0:8f0d0ae0a077	1841	switch( payload[macIndex++] )
dudmuck	0:8f0d0ae0a077	1842	{
dudmuck	0:8f0d0ae0a077	1843	case SRV_MAC_LINK_CHECK_ANS:
dudmuck	0:8f0d0ae0a077	1844	MlmeConfirm.Status = LORAMAC_EVENT_INFO_STATUS_OK;
dudmuck	0:8f0d0ae0a077	1845	MlmeConfirm.DemodMargin = payload[macIndex++];
dudmuck	0:8f0d0ae0a077	1846	MlmeConfirm.NbGateways = payload[macIndex++];
dudmuck	0:8f0d0ae0a077	1847	break;
dudmuck	0:8f0d0ae0a077	1848	case SRV_MAC_DEV_STATUS_REQ:
dudmuck	0:8f0d0ae0a077	1849	{
dudmuck	0:8f0d0ae0a077	1850	uint8_t batteryLevel = BAT_LEVEL_NO_MEASURE;
dudmuck	0:8f0d0ae0a077	1851	if( ( LoRaMacCallbacks != NULL ) && ( LoRaMacCallbacks->GetBatteryLevel != NULL ) )
dudmuck	0:8f0d0ae0a077	1852	{
dudmuck	0:8f0d0ae0a077	1853	batteryLevel = LoRaMacCallbacks->GetBatteryLevel( );
dudmuck	0:8f0d0ae0a077	1854	}
dudmuck	0:8f0d0ae0a077	1855	AddMacCommand( MOTE_MAC_DEV_STATUS_ANS, batteryLevel, snr );
dudmuck	0:8f0d0ae0a077	1856	break;
dudmuck	0:8f0d0ae0a077	1857	}
dudmuck	0:8f0d0ae0a077	1858	case SRV_MAC_RX_TIMING_SETUP_REQ:
dudmuck	0:8f0d0ae0a077	1859	{
dudmuck	0:8f0d0ae0a077	1860	uint8_t delay = payload[macIndex++] & 0x0F;
dudmuck	0:8f0d0ae0a077	1861
dudmuck	0:8f0d0ae0a077	1862	if( delay == 0 )
dudmuck	0:8f0d0ae0a077	1863	{
dudmuck	0:8f0d0ae0a077	1864	delay++;
dudmuck	0:8f0d0ae0a077	1865	}
dudmuck	0:8f0d0ae0a077	1866	LoRaMacParams.ReceiveDelay_us = delay * 1e6;
dudmuck	0:8f0d0ae0a077	1867	AddMacCommand( MOTE_MAC_RX_TIMING_SETUP_ANS, 0, 0 );
dudmuck	0:8f0d0ae0a077	1868	}
dudmuck	0:8f0d0ae0a077	1869	break;
dudmuck	0:8f0d0ae0a077	1870	default:
dudmuck	0:8f0d0ae0a077	1871	// Unknown command. ABORT MAC commands processing
dudmuck	0:8f0d0ae0a077	1872	return;
dudmuck	0:8f0d0ae0a077	1873	}
dudmuck	0:8f0d0ae0a077	1874	}
dudmuck	0:8f0d0ae0a077	1875	}
dudmuck	0:8f0d0ae0a077	1876
dudmuck	0:8f0d0ae0a077	1877	LoRaMacStatus_t Send( LoRaMacHeader_t macHdr, uint8_t fPort, void fBuffer, uint16_t fBufferSize )
dudmuck	0:8f0d0ae0a077	1878	{
dudmuck	0:8f0d0ae0a077	1879	LoRaMacFrameCtrl_t fCtrl;
dudmuck	0:8f0d0ae0a077	1880	LoRaMacStatus_t status = LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	1881
dudmuck	0:8f0d0ae0a077	1882	fCtrl.Value = 0;
dudmuck	0:8f0d0ae0a077	1883	fCtrl.Bits.FOptsLen = 0;
dudmuck	0:8f0d0ae0a077	1884	fCtrl.Bits.FPending = 0;
dudmuck	0:8f0d0ae0a077	1885	fCtrl.Bits.Ack = false;
dudmuck	0:8f0d0ae0a077	1886	fCtrl.Bits.AdrAckReq = false;
dudmuck	0:8f0d0ae0a077	1887	fCtrl.Bits.Adr = false;
dudmuck	0:8f0d0ae0a077	1888
dudmuck	0:8f0d0ae0a077	1889	// Prepare the frame
dudmuck	0:8f0d0ae0a077	1890	status = PrepareFrame( macHdr, &fCtrl, fPort, fBuffer, fBufferSize );
dudmuck	0:8f0d0ae0a077	1891
dudmuck	0:8f0d0ae0a077	1892	// Validate status
dudmuck	0:8f0d0ae0a077	1893	if( status != LORAMAC_STATUS_OK )
dudmuck	0:8f0d0ae0a077	1894	{
dudmuck	0:8f0d0ae0a077	1895	return status;
dudmuck	0:8f0d0ae0a077	1896	}
dudmuck	0:8f0d0ae0a077	1897
dudmuck	0:8f0d0ae0a077	1898	// Reset confirm parameters
dudmuck	0:8f0d0ae0a077	1899	McpsConfirm.AckReceived = false;
dudmuck	0:8f0d0ae0a077	1900	McpsConfirm.UpLinkCounter = UpLinkCounter;
dudmuck	0:8f0d0ae0a077	1901
dudmuck	25:fed9d5b77183	1902	ScheduleTx();
dudmuck	25:fed9d5b77183	1903
dudmuck	25:fed9d5b77183	1904	return LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	1905	}
dudmuck	0:8f0d0ae0a077	1906
dudmuck	0:8f0d0ae0a077	1907
dudmuck	0:8f0d0ae0a077	1908	static void ResetMacParameters( void )
dudmuck	0:8f0d0ae0a077	1909	{
dudmuck	0:8f0d0ae0a077	1910	IsLoRaMacNetworkJoined = false;
dudmuck	0:8f0d0ae0a077	1911
dudmuck	0:8f0d0ae0a077	1912	// Counters
dudmuck	0:8f0d0ae0a077	1913	UpLinkCounter = 0;
dudmuck	0:8f0d0ae0a077	1914	DownLinkCounter = 0;
dudmuck	0:8f0d0ae0a077	1915
dudmuck	0:8f0d0ae0a077	1916	ChannelsNbRepCounter = 0;
dudmuck	0:8f0d0ae0a077	1917
dudmuck	0:8f0d0ae0a077	1918	MacCommandsBufferIndex = 0;
dudmuck	0:8f0d0ae0a077	1919	MacCommandsBufferToRepeatIndex = 0;
dudmuck	0:8f0d0ae0a077	1920
dudmuck	0:8f0d0ae0a077	1921	IsRxWindowsEnabled = true;
dudmuck	0:8f0d0ae0a077	1922
dudmuck	0:8f0d0ae0a077	1923	LoRaMacParams.ChannelsTxPower = LoRaMacParamsDefaults.ChannelsTxPower;
dudmuck	0:8f0d0ae0a077	1924	LoRaMacParams.ChannelsDatarate_fixed = LoRaMacParamsDefaults.ChannelsDatarate_fixed;
dudmuck	0:8f0d0ae0a077	1925
dudmuck	0:8f0d0ae0a077	1926	LoRaMacParams.Rx1DrOffset = LoRaMacParamsDefaults.Rx1DrOffset;
dudmuck	0:8f0d0ae0a077	1927
dudmuck	0:8f0d0ae0a077	1928	NodeAckRequested = false;
dudmuck	0:8f0d0ae0a077	1929	SrvAckRequested = false;
dudmuck	0:8f0d0ae0a077	1930	MacCommandsInNextTx = false;
dudmuck	0:8f0d0ae0a077	1931
dudmuck	0:8f0d0ae0a077	1932	// Reset Multicast downlink counters
dudmuck	0:8f0d0ae0a077	1933	MulticastParams_t *cur = MulticastChannels;
dudmuck	0:8f0d0ae0a077	1934	while( cur != NULL )
dudmuck	0:8f0d0ae0a077	1935	{
dudmuck	0:8f0d0ae0a077	1936	cur->DownLinkCounter = 0;
dudmuck	0:8f0d0ae0a077	1937	cur = cur->Next;
dudmuck	0:8f0d0ae0a077	1938	}
dudmuck	0:8f0d0ae0a077	1939
dudmuck	0:8f0d0ae0a077	1940	}
dudmuck	0:8f0d0ae0a077	1941
dudmuck	0:8f0d0ae0a077	1942	LoRaMacStatus_t PrepareFrame( LoRaMacHeader_t macHdr, LoRaMacFrameCtrl_t fCtrl, uint8_t fPort, void *fBuffer, uint16_t fBufferSize )
dudmuck	0:8f0d0ae0a077	1943	{
dudmuck	0:8f0d0ae0a077	1944	uint16_t i;
dudmuck	0:8f0d0ae0a077	1945	uint8_t pktHeaderLen = 0;
dudmuck	0:8f0d0ae0a077	1946	uint32_t mic = 0;
dudmuck	0:8f0d0ae0a077	1947	const void* payload = fBuffer;
dudmuck	0:8f0d0ae0a077	1948	uint8_t framePort = fPort;
dudmuck	0:8f0d0ae0a077	1949
dudmuck	0:8f0d0ae0a077	1950	LoRaMacBufferPktLen = 0;
dudmuck	0:8f0d0ae0a077	1951
dudmuck	0:8f0d0ae0a077	1952	NodeAckRequested = false;
dudmuck	0:8f0d0ae0a077	1953
dudmuck	0:8f0d0ae0a077	1954	if( fBuffer == NULL )
dudmuck	0:8f0d0ae0a077	1955	{
dudmuck	0:8f0d0ae0a077	1956	fBufferSize = 0;
dudmuck	0:8f0d0ae0a077	1957	}
dudmuck	0:8f0d0ae0a077	1958
dudmuck	0:8f0d0ae0a077	1959	LoRaMacTxPayloadLen = fBufferSize;
dudmuck	0:8f0d0ae0a077	1960
dudmuck	0:8f0d0ae0a077	1961	LoRaMacBuffer[pktHeaderLen++] = macHdr->Value;
dudmuck	0:8f0d0ae0a077	1962
dudmuck	0:8f0d0ae0a077	1963	switch( macHdr->Bits.MType )
dudmuck	0:8f0d0ae0a077	1964	{
dudmuck	0:8f0d0ae0a077	1965	case FRAME_TYPE_JOIN_REQ:
dudmuck	0:8f0d0ae0a077	1966	LoRaMacBufferPktLen = pktHeaderLen;
dudmuck	0:8f0d0ae0a077	1967
dudmuck	0:8f0d0ae0a077	1968	memcpyr( LoRaMacBuffer + LoRaMacBufferPktLen, LoRaMacAppEui, 8 );
dudmuck	0:8f0d0ae0a077	1969	LoRaMacBufferPktLen += 8;
dudmuck	0:8f0d0ae0a077	1970	memcpyr( LoRaMacBuffer + LoRaMacBufferPktLen, LoRaMacDevEui, 8 );
dudmuck	0:8f0d0ae0a077	1971	LoRaMacBufferPktLen += 8;
dudmuck	0:8f0d0ae0a077	1972
dudmuck	0:8f0d0ae0a077	1973	LoRaMacDevNonce = Radio.Random( );
dudmuck	0:8f0d0ae0a077	1974
dudmuck	0:8f0d0ae0a077	1975	LoRaMacBuffer[LoRaMacBufferPktLen++] = LoRaMacDevNonce & 0xFF;
dudmuck	0:8f0d0ae0a077	1976	LoRaMacBuffer[LoRaMacBufferPktLen++] = ( LoRaMacDevNonce >> 8 ) & 0xFF;
dudmuck	0:8f0d0ae0a077	1977
dudmuck	0:8f0d0ae0a077	1978	LoRaMacJoinComputeMic( LoRaMacBuffer, LoRaMacBufferPktLen & 0xFF, LoRaMacAppKey, &mic );
dudmuck	0:8f0d0ae0a077	1979
dudmuck	0:8f0d0ae0a077	1980	LoRaMacBuffer[LoRaMacBufferPktLen++] = mic & 0xFF;
dudmuck	0:8f0d0ae0a077	1981	LoRaMacBuffer[LoRaMacBufferPktLen++] = ( mic >> 8 ) & 0xFF;
dudmuck	0:8f0d0ae0a077	1982	LoRaMacBuffer[LoRaMacBufferPktLen++] = ( mic >> 16 ) & 0xFF;
dudmuck	0:8f0d0ae0a077	1983	LoRaMacBuffer[LoRaMacBufferPktLen++] = ( mic >> 24 ) & 0xFF;
dudmuck	0:8f0d0ae0a077	1984
dudmuck	0:8f0d0ae0a077	1985	break;
dudmuck	0:8f0d0ae0a077	1986	case FRAME_TYPE_DATA_CONFIRMED_UP:
dudmuck	0:8f0d0ae0a077	1987	NodeAckRequested = true;
dudmuck	0:8f0d0ae0a077	1988	//Intentional fallthrough
dudmuck	0:8f0d0ae0a077	1989	case FRAME_TYPE_DATA_UNCONFIRMED_UP:
dudmuck	16:915815632c1f	1990	if (!IsLoRaMacNetworkJoined)
dudmuck	0:8f0d0ae0a077	1991	{
dudmuck	0:8f0d0ae0a077	1992	return LORAMAC_STATUS_NO_NETWORK_JOINED; // No network has been joined yet
dudmuck	0:8f0d0ae0a077	1993	}
dudmuck	0:8f0d0ae0a077	1994
dudmuck	0:8f0d0ae0a077	1995	fCtrl->Bits.AdrAckReq = 0;
dudmuck	0:8f0d0ae0a077	1996
dudmuck	0:8f0d0ae0a077	1997	if( SrvAckRequested == true )
dudmuck	0:8f0d0ae0a077	1998	{
dudmuck	0:8f0d0ae0a077	1999	SrvAckRequested = false;
dudmuck	0:8f0d0ae0a077	2000	fCtrl->Bits.Ack = 1;
dudmuck	0:8f0d0ae0a077	2001	}
dudmuck	0:8f0d0ae0a077	2002
dudmuck	0:8f0d0ae0a077	2003	LoRaMacBuffer[pktHeaderLen++] = ( LoRaMacDevAddr ) & 0xFF;
dudmuck	0:8f0d0ae0a077	2004	LoRaMacBuffer[pktHeaderLen++] = ( LoRaMacDevAddr >> 8 ) & 0xFF;
dudmuck	0:8f0d0ae0a077	2005	LoRaMacBuffer[pktHeaderLen++] = ( LoRaMacDevAddr >> 16 ) & 0xFF;
dudmuck	0:8f0d0ae0a077	2006	LoRaMacBuffer[pktHeaderLen++] = ( LoRaMacDevAddr >> 24 ) & 0xFF;
dudmuck	0:8f0d0ae0a077	2007
dudmuck	0:8f0d0ae0a077	2008	LoRaMacBuffer[pktHeaderLen++] = fCtrl->Value;
dudmuck	0:8f0d0ae0a077	2009
dudmuck	0:8f0d0ae0a077	2010	LoRaMacBuffer[pktHeaderLen++] = UpLinkCounter & 0xFF;
dudmuck	0:8f0d0ae0a077	2011	LoRaMacBuffer[pktHeaderLen++] = ( UpLinkCounter >> 8 ) & 0xFF;
dudmuck	0:8f0d0ae0a077	2012
dudmuck	0:8f0d0ae0a077	2013	// Copy the MAC commands which must be re-send into the MAC command buffer
dudmuck	0:8f0d0ae0a077	2014	memcpy1( &MacCommandsBuffer[MacCommandsBufferIndex], MacCommandsBufferToRepeat, MacCommandsBufferToRepeatIndex );
dudmuck	0:8f0d0ae0a077	2015	MacCommandsBufferIndex += MacCommandsBufferToRepeatIndex;
dudmuck	0:8f0d0ae0a077	2016
dudmuck	0:8f0d0ae0a077	2017	if( ( payload != NULL ) && ( LoRaMacTxPayloadLen > 0 ) )
dudmuck	0:8f0d0ae0a077	2018	{
dudmuck	0:8f0d0ae0a077	2019	if( ( MacCommandsBufferIndex <= LORA_MAC_COMMAND_MAX_LENGTH ) && ( MacCommandsInNextTx == true ) )
dudmuck	0:8f0d0ae0a077	2020	{
dudmuck	0:8f0d0ae0a077	2021	fCtrl->Bits.FOptsLen += MacCommandsBufferIndex;
dudmuck	0:8f0d0ae0a077	2022
dudmuck	0:8f0d0ae0a077	2023	// Update FCtrl field with new value of OptionsLength
dudmuck	0:8f0d0ae0a077	2024	LoRaMacBuffer[0x05] = fCtrl->Value;
dudmuck	0:8f0d0ae0a077	2025	for( i = 0; i < MacCommandsBufferIndex; i++ )
dudmuck	0:8f0d0ae0a077	2026	{
dudmuck	0:8f0d0ae0a077	2027	LoRaMacBuffer[pktHeaderLen++] = MacCommandsBuffer[i];
dudmuck	0:8f0d0ae0a077	2028	}
dudmuck	0:8f0d0ae0a077	2029	}
dudmuck	0:8f0d0ae0a077	2030	}
dudmuck	0:8f0d0ae0a077	2031	else
dudmuck	0:8f0d0ae0a077	2032	{
dudmuck	0:8f0d0ae0a077	2033	if( ( MacCommandsBufferIndex > 0 ) && ( MacCommandsInNextTx ) )
dudmuck	0:8f0d0ae0a077	2034	{
dudmuck	0:8f0d0ae0a077	2035	LoRaMacTxPayloadLen = MacCommandsBufferIndex;
dudmuck	0:8f0d0ae0a077	2036	payload = MacCommandsBuffer;
dudmuck	0:8f0d0ae0a077	2037	framePort = 0;
dudmuck	0:8f0d0ae0a077	2038	}
dudmuck	0:8f0d0ae0a077	2039	}
dudmuck	0:8f0d0ae0a077	2040	MacCommandsInNextTx = false;
dudmuck	0:8f0d0ae0a077	2041	// Store MAC commands which must be re-send in case the device does not receive a downlink anymore
dudmuck	0:8f0d0ae0a077	2042	MacCommandsBufferToRepeatIndex = ParseMacCommandsToRepeat( MacCommandsBuffer, MacCommandsBufferIndex, MacCommandsBufferToRepeat );
dudmuck	0:8f0d0ae0a077	2043	if( MacCommandsBufferToRepeatIndex > 0 )
dudmuck	0:8f0d0ae0a077	2044	{
dudmuck	0:8f0d0ae0a077	2045	MacCommandsInNextTx = true;
dudmuck	0:8f0d0ae0a077	2046	}
dudmuck	0:8f0d0ae0a077	2047
dudmuck	0:8f0d0ae0a077	2048	if( ( payload != NULL ) && ( LoRaMacTxPayloadLen > 0 ) )
dudmuck	0:8f0d0ae0a077	2049	{
dudmuck	0:8f0d0ae0a077	2050	LoRaMacBuffer[pktHeaderLen++] = framePort;
dudmuck	0:8f0d0ae0a077	2051
dudmuck	0:8f0d0ae0a077	2052	if( framePort == 0 )
dudmuck	0:8f0d0ae0a077	2053	{
dudmuck	0:8f0d0ae0a077	2054	LoRaMacPayloadEncrypt( (uint8_t* ) payload, LoRaMacTxPayloadLen, LoRaMacNwkSKey, LoRaMacDevAddr, UP_LINK, UpLinkCounter, &LoRaMacBuffer[pktHeaderLen] );
dudmuck	0:8f0d0ae0a077	2055	}
dudmuck	0:8f0d0ae0a077	2056	else
dudmuck	0:8f0d0ae0a077	2057	{
dudmuck	0:8f0d0ae0a077	2058	LoRaMacPayloadEncrypt( (uint8_t* ) payload, LoRaMacTxPayloadLen, LoRaMacAppSKey, LoRaMacDevAddr, UP_LINK, UpLinkCounter, &LoRaMacBuffer[pktHeaderLen] );
dudmuck	0:8f0d0ae0a077	2059	}
dudmuck	0:8f0d0ae0a077	2060	}
dudmuck	0:8f0d0ae0a077	2061	LoRaMacBufferPktLen = pktHeaderLen + LoRaMacTxPayloadLen;
dudmuck	0:8f0d0ae0a077	2062
dudmuck	0:8f0d0ae0a077	2063	LoRaMacComputeMic( LoRaMacBuffer, LoRaMacBufferPktLen, LoRaMacNwkSKey, LoRaMacDevAddr, UP_LINK, UpLinkCounter, &mic );
dudmuck	0:8f0d0ae0a077	2064
dudmuck	0:8f0d0ae0a077	2065	LoRaMacBuffer[LoRaMacBufferPktLen + 0] = mic & 0xFF;
dudmuck	0:8f0d0ae0a077	2066	LoRaMacBuffer[LoRaMacBufferPktLen + 1] = ( mic >> 8 ) & 0xFF;
dudmuck	0:8f0d0ae0a077	2067	LoRaMacBuffer[LoRaMacBufferPktLen + 2] = ( mic >> 16 ) & 0xFF;
dudmuck	0:8f0d0ae0a077	2068	LoRaMacBuffer[LoRaMacBufferPktLen + 3] = ( mic >> 24 ) & 0xFF;
dudmuck	0:8f0d0ae0a077	2069
dudmuck	0:8f0d0ae0a077	2070	LoRaMacBufferPktLen += LORAMAC_MFR_LEN;
dudmuck	0:8f0d0ae0a077	2071
dudmuck	0:8f0d0ae0a077	2072	break;
dudmuck	0:8f0d0ae0a077	2073	case FRAME_TYPE_PROPRIETARY:
dudmuck	0:8f0d0ae0a077	2074	if( ( fBuffer != NULL ) && ( LoRaMacTxPayloadLen > 0 ) )
dudmuck	0:8f0d0ae0a077	2075	{
dudmuck	0:8f0d0ae0a077	2076	memcpy1( LoRaMacBuffer + pktHeaderLen, ( uint8_t* ) fBuffer, LoRaMacTxPayloadLen );
dudmuck	0:8f0d0ae0a077	2077	LoRaMacBufferPktLen = pktHeaderLen + LoRaMacTxPayloadLen;
dudmuck	0:8f0d0ae0a077	2078	}
dudmuck	0:8f0d0ae0a077	2079	break;
dudmuck	0:8f0d0ae0a077	2080	default:
dudmuck	0:8f0d0ae0a077	2081	return LORAMAC_STATUS_SERVICE_UNKNOWN;
dudmuck	0:8f0d0ae0a077	2082	}
dudmuck	0:8f0d0ae0a077	2083
dudmuck	0:8f0d0ae0a077	2084	return LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	2085	}
dudmuck	0:8f0d0ae0a077	2086
dudmuck	0:8f0d0ae0a077	2087
dudmuck	0:8f0d0ae0a077	2088	LoRaMacStatus_t SetTxContinuousWave( uint16_t timeout )
dudmuck	0:8f0d0ae0a077	2089	{
dudmuck	0:8f0d0ae0a077	2090	int8_t txPowerIndex = 0;
dudmuck	0:8f0d0ae0a077	2091	int8_t txPower = 0;
dudmuck	0:8f0d0ae0a077	2092
dudmuck	0:8f0d0ae0a077	2093	txPowerIndex = LoRaMacParams.ChannelsTxPower;
dudmuck	0:8f0d0ae0a077	2094	txPower = TxPowers[txPowerIndex];
dudmuck	0:8f0d0ae0a077	2095	Radio.SetTxContinuousWave( Channels[Channel].Frequency, txPower, timeout );
dudmuck	0:8f0d0ae0a077	2096
dudmuck	0:8f0d0ae0a077	2097	return LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	2098	}
dudmuck	0:8f0d0ae0a077	2099
dudmuck	0:8f0d0ae0a077	2100	LoRaMacStatus_t SetTxContinuousWave1( uint16_t timeout, uint32_t frequency, uint8_t power )
dudmuck	0:8f0d0ae0a077	2101	{
dudmuck	0:8f0d0ae0a077	2102	Radio.SetTxContinuousWave( frequency, power, timeout );
dudmuck	0:8f0d0ae0a077	2103
dudmuck	0:8f0d0ae0a077	2104	return LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	2105	}
dudmuck	0:8f0d0ae0a077	2106
dudmuck	0:8f0d0ae0a077	2107	void seconds()
dudmuck	0:8f0d0ae0a077	2108	{
dudmuck	1:53c30224eda8	2109	isr_printf("second\r\n");
dudmuck	0:8f0d0ae0a077	2110	}
dudmuck	0:8f0d0ae0a077	2111
dudmuck	0:8f0d0ae0a077	2112	LoRaMacStatus_t LoRaMacInitialization( LoRaMacPrimitives_t primitives, LoRaMacCallback_t callbacks )
dudmuck	0:8f0d0ae0a077	2113	{
dudmuck	0:8f0d0ae0a077	2114	if( primitives == NULL )
dudmuck	0:8f0d0ae0a077	2115	{
dudmuck	0:8f0d0ae0a077	2116	return LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2117	}
dudmuck	0:8f0d0ae0a077	2118
dudmuck	0:8f0d0ae0a077	2119	if( ( primitives->MacMcpsConfirm == NULL ) \|\|
dudmuck	0:8f0d0ae0a077	2120	( primitives->MacMcpsIndication == NULL ) \|\|
dudmuck	0:8f0d0ae0a077	2121	( primitives->MacMlmeConfirm == NULL ) )
dudmuck	0:8f0d0ae0a077	2122	{
dudmuck	0:8f0d0ae0a077	2123	return LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2124	}
dudmuck	0:8f0d0ae0a077	2125
dudmuck	0:8f0d0ae0a077	2126	LoRaMacPrimitives = primitives;
dudmuck	0:8f0d0ae0a077	2127	LoRaMacCallbacks = callbacks;
dudmuck	0:8f0d0ae0a077	2128
dudmuck	0:8f0d0ae0a077	2129	LoRaMacFlags.Value = 0;
dudmuck	0:8f0d0ae0a077	2130
dudmuck	0:8f0d0ae0a077	2131	LoRaMacDeviceClass = CLASS_A;
dudmuck	0:8f0d0ae0a077	2132
dudmuck	0:8f0d0ae0a077	2133	JoinRequestTrials = 0;
dudmuck	0:8f0d0ae0a077	2134	MaxJoinRequestTrials = 255;
dudmuck	0:8f0d0ae0a077	2135
dudmuck	0:8f0d0ae0a077	2136
dudmuck	0:8f0d0ae0a077	2137	// Reset to defaults
dudmuck	0:8f0d0ae0a077	2138	LoRaMacParamsDefaults.ChannelsTxPower = LORAMAC_DEFAULT_TX_POWER;
dudmuck	0:8f0d0ae0a077	2139	LoRaMacParamsDefaults.ChannelsDatarate_fixed = LORAMAC_DEFAULT_DATARATE;
dudmuck	0:8f0d0ae0a077	2140
dudmuck	0:8f0d0ae0a077	2141	LoRaMacParamsDefaults.SystemMaxRxError = 10;
dudmuck	0:8f0d0ae0a077	2142	LoRaMacParamsDefaults.MinRxSymbols = 6; // TODO XXX increase
dudmuck	0:8f0d0ae0a077	2143	LoRaMacParamsDefaults.MaxRxWindow = MAX_RX_WINDOW;
dudmuck	0:8f0d0ae0a077	2144
dudmuck	0:8f0d0ae0a077	2145	LoRaMacParamsDefaults.ReceiveDelay_us = RECEIVE_DELAY_us;
dudmuck	0:8f0d0ae0a077	2146	LoRaMacParamsDefaults.JoinAcceptDelay_us = JOIN_ACCEPT_DELAY_us;
dudmuck	0:8f0d0ae0a077	2147
dudmuck	0:8f0d0ae0a077	2148	LoRaMacParamsDefaults.ChannelsNbRep = 1;
dudmuck	0:8f0d0ae0a077	2149	LoRaMacParamsDefaults.Rx1DrOffset = 0;
dudmuck	0:8f0d0ae0a077	2150
dudmuck	0:8f0d0ae0a077	2151	for( uint8_t i = 0; i < LORA_MAX_NB_CHANNELS; i++ )
dudmuck	0:8f0d0ae0a077	2152	{
dudmuck	0:8f0d0ae0a077	2153	Channels[i].Frequency = LORAMAC_FIRST_CHANNEL + (i * LORAMAC_STEPWIDTH_CHANNEL);
dudmuck	18:9ac71c0eb70d	2154	Channels[i].DrRange.Value = (LORAMAC_MAX_DATARATE << 4) \| LORAMAC_MIN_DATARATE;
dudmuck	0:8f0d0ae0a077	2155	Channels[i].Band = 0;
dudmuck	0:8f0d0ae0a077	2156	}
dudmuck	0:8f0d0ae0a077	2157
dudmuck	0:8f0d0ae0a077	2158	// Init parameters which are not set in function ResetMacParameters
dudmuck	0:8f0d0ae0a077	2159	LoRaMacParams.SystemMaxRxError = LoRaMacParamsDefaults.SystemMaxRxError;
dudmuck	0:8f0d0ae0a077	2160	LoRaMacParams.MinRxSymbols = LoRaMacParamsDefaults.MinRxSymbols;
dudmuck	0:8f0d0ae0a077	2161	LoRaMacParams.MaxRxWindow = LoRaMacParamsDefaults.MaxRxWindow;
dudmuck	0:8f0d0ae0a077	2162	LoRaMacParams.ReceiveDelay_us = LoRaMacParamsDefaults.ReceiveDelay_us;
dudmuck	0:8f0d0ae0a077	2163	LoRaMacParams.JoinAcceptDelay_us = LoRaMacParamsDefaults.JoinAcceptDelay_us;
dudmuck	0:8f0d0ae0a077	2164	LoRaMacParams.ChannelsNbRep = LoRaMacParamsDefaults.ChannelsNbRep;
dudmuck	0:8f0d0ae0a077	2165
dudmuck	0:8f0d0ae0a077	2166	ResetMacParameters( );
dudmuck	0:8f0d0ae0a077	2167
dudmuck	0:8f0d0ae0a077	2168	// Initialize Radio driver
dudmuck	0:8f0d0ae0a077	2169	RadioEvents.TxDone = OnRadioTxDone;
dudmuck	0:8f0d0ae0a077	2170	RadioEvents.RxDone = OnRadioRxDone;
dudmuck	0:8f0d0ae0a077	2171	RadioEvents.RxError = OnRadioRxError;
dudmuck	0:8f0d0ae0a077	2172	RadioEvents.TxTimeout = OnRadioTxTimeout;
dudmuck	0:8f0d0ae0a077	2173	RadioEvents.RxTimeout = OnRadioRxTimeout;
dudmuck	0:8f0d0ae0a077	2174	Radio.Init( &RadioEvents );
dudmuck	0:8f0d0ae0a077	2175
dudmuck	0:8f0d0ae0a077	2176	// Random seed initialization
dudmuck	0:8f0d0ae0a077	2177	srand1( Radio.Random( ) );
dudmuck	0:8f0d0ae0a077	2178
dudmuck	0:8f0d0ae0a077	2179	PublicNetwork = true;
dudmuck	0:8f0d0ae0a077	2180	Radio.SetPublicNetwork( PublicNetwork );
dudmuck	0:8f0d0ae0a077	2181	Radio.Sleep( );
dudmuck	0:8f0d0ae0a077	2182
dudmuck	0:8f0d0ae0a077	2183	lp_timer.start();
dudmuck	0:8f0d0ae0a077	2184
dudmuck	0:8f0d0ae0a077	2185	RxWindowsParam = ComputeRxWindowParameters(LORAMAC_DEFAULT_DATARATE, LoRaMacParams.SystemMaxRxError);
dudmuck	13:18de9ee3a461	2186
dudmuck	13:18de9ee3a461	2187	#ifdef DEBUG_GWTX_JUMPER
dudmuck	13:18de9ee3a461	2188	gwtx_pin.rise(&gwtx_pin_callback);
dudmuck	13:18de9ee3a461	2189	#endif
dudmuck	0:8f0d0ae0a077	2190
dudmuck	0:8f0d0ae0a077	2191	return LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	2192	}
dudmuck	0:8f0d0ae0a077	2193
dudmuck	0:8f0d0ae0a077	2194	LoRaMacStatus_t LoRaMacQueryTxPossible( uint8_t size, LoRaMacTxInfo_t* txInfo )
dudmuck	0:8f0d0ae0a077	2195	{
dudmuck	0:8f0d0ae0a077	2196	uint8_t fOptLen = MacCommandsBufferIndex + MacCommandsBufferToRepeatIndex;
dudmuck	0:8f0d0ae0a077	2197
dudmuck	0:8f0d0ae0a077	2198	if( txInfo == NULL )
dudmuck	0:8f0d0ae0a077	2199	{
dudmuck	0:8f0d0ae0a077	2200	return LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2201	}
dudmuck	0:8f0d0ae0a077	2202
dudmuck	0:8f0d0ae0a077	2203	txInfo->CurrentPayloadSize = 255;
dudmuck	0:8f0d0ae0a077	2204
dudmuck	0:8f0d0ae0a077	2205	if( txInfo->CurrentPayloadSize >= fOptLen )
dudmuck	0:8f0d0ae0a077	2206	{
dudmuck	0:8f0d0ae0a077	2207	txInfo->MaxPossiblePayload = txInfo->CurrentPayloadSize - fOptLen;
dudmuck	0:8f0d0ae0a077	2208	}
dudmuck	0:8f0d0ae0a077	2209	else
dudmuck	0:8f0d0ae0a077	2210	{
dudmuck	0:8f0d0ae0a077	2211	return LORAMAC_STATUS_MAC_CMD_LENGTH_ERROR;
dudmuck	0:8f0d0ae0a077	2212	}
dudmuck	0:8f0d0ae0a077	2213
dudmuck	0:8f0d0ae0a077	2214	return LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	2215	}
dudmuck	0:8f0d0ae0a077	2216
dudmuck	0:8f0d0ae0a077	2217	LoRaMacStatus_t LoRaMacMibGetRequestConfirm( MibRequestConfirm_t *mibGet )
dudmuck	0:8f0d0ae0a077	2218	{
dudmuck	0:8f0d0ae0a077	2219	LoRaMacStatus_t status = LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	2220
dudmuck	0:8f0d0ae0a077	2221	if( mibGet == NULL )
dudmuck	0:8f0d0ae0a077	2222	{
dudmuck	0:8f0d0ae0a077	2223	return LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2224	}
dudmuck	0:8f0d0ae0a077	2225
dudmuck	0:8f0d0ae0a077	2226	switch( mibGet->Type )
dudmuck	0:8f0d0ae0a077	2227	{
dudmuck	0:8f0d0ae0a077	2228	case MIB_DEVICE_CLASS:
dudmuck	0:8f0d0ae0a077	2229	{
dudmuck	0:8f0d0ae0a077	2230	mibGet->Param.Class = LoRaMacDeviceClass;
dudmuck	0:8f0d0ae0a077	2231	break;
dudmuck	0:8f0d0ae0a077	2232	}
dudmuck	0:8f0d0ae0a077	2233	case MIB_NETWORK_JOINED:
dudmuck	0:8f0d0ae0a077	2234	{
dudmuck	0:8f0d0ae0a077	2235	mibGet->Param.IsNetworkJoined = IsLoRaMacNetworkJoined;
dudmuck	0:8f0d0ae0a077	2236	break;
dudmuck	0:8f0d0ae0a077	2237	}
dudmuck	0:8f0d0ae0a077	2238	case MIB_NET_ID:
dudmuck	0:8f0d0ae0a077	2239	{
dudmuck	0:8f0d0ae0a077	2240	mibGet->Param.NetID = LoRaMacNetID;
dudmuck	0:8f0d0ae0a077	2241	break;
dudmuck	0:8f0d0ae0a077	2242	}
dudmuck	0:8f0d0ae0a077	2243	case MIB_DEV_ADDR:
dudmuck	0:8f0d0ae0a077	2244	{
dudmuck	0:8f0d0ae0a077	2245	mibGet->Param.DevAddr = LoRaMacDevAddr;
dudmuck	0:8f0d0ae0a077	2246	break;
dudmuck	0:8f0d0ae0a077	2247	}
dudmuck	0:8f0d0ae0a077	2248	case MIB_NWK_SKEY:
dudmuck	0:8f0d0ae0a077	2249	{
dudmuck	0:8f0d0ae0a077	2250	mibGet->Param.NwkSKey = LoRaMacNwkSKey;
dudmuck	0:8f0d0ae0a077	2251	break;
dudmuck	0:8f0d0ae0a077	2252	}
dudmuck	0:8f0d0ae0a077	2253	case MIB_APP_SKEY:
dudmuck	0:8f0d0ae0a077	2254	{
dudmuck	0:8f0d0ae0a077	2255	mibGet->Param.AppSKey = LoRaMacAppSKey;
dudmuck	0:8f0d0ae0a077	2256	break;
dudmuck	0:8f0d0ae0a077	2257	}
dudmuck	0:8f0d0ae0a077	2258	case MIB_PUBLIC_NETWORK:
dudmuck	0:8f0d0ae0a077	2259	{
dudmuck	0:8f0d0ae0a077	2260	mibGet->Param.EnablePublicNetwork = PublicNetwork;
dudmuck	0:8f0d0ae0a077	2261	break;
dudmuck	0:8f0d0ae0a077	2262	}
dudmuck	0:8f0d0ae0a077	2263	case MIB_CHANNELS_NB_REP:
dudmuck	0:8f0d0ae0a077	2264	{
dudmuck	0:8f0d0ae0a077	2265	mibGet->Param.ChannelNbRep = LoRaMacParams.ChannelsNbRep;
dudmuck	0:8f0d0ae0a077	2266	break;
dudmuck	0:8f0d0ae0a077	2267	}
dudmuck	0:8f0d0ae0a077	2268	case MIB_MAX_RX_WINDOW_DURATION:
dudmuck	0:8f0d0ae0a077	2269	{
dudmuck	0:8f0d0ae0a077	2270	mibGet->Param.MaxRxWindow = LoRaMacParams.MaxRxWindow;
dudmuck	0:8f0d0ae0a077	2271	break;
dudmuck	0:8f0d0ae0a077	2272	}
dudmuck	0:8f0d0ae0a077	2273	case MIB_CHANNELS_DEFAULT_TX_POWER:
dudmuck	0:8f0d0ae0a077	2274	{
dudmuck	0:8f0d0ae0a077	2275	mibGet->Param.ChannelsDefaultTxPower = LoRaMacParamsDefaults.ChannelsTxPower;
dudmuck	0:8f0d0ae0a077	2276	break;
dudmuck	0:8f0d0ae0a077	2277	}
dudmuck	0:8f0d0ae0a077	2278	case MIB_CHANNELS_TX_POWER:
dudmuck	0:8f0d0ae0a077	2279	{
dudmuck	0:8f0d0ae0a077	2280	mibGet->Param.ChannelsTxPower = LoRaMacParams.ChannelsTxPower;
dudmuck	0:8f0d0ae0a077	2281	break;
dudmuck	0:8f0d0ae0a077	2282	}
dudmuck	0:8f0d0ae0a077	2283	case MIB_UPLINK_COUNTER:
dudmuck	0:8f0d0ae0a077	2284	{
dudmuck	0:8f0d0ae0a077	2285	mibGet->Param.UpLinkCounter = UpLinkCounter;
dudmuck	0:8f0d0ae0a077	2286	break;
dudmuck	0:8f0d0ae0a077	2287	}
dudmuck	0:8f0d0ae0a077	2288	case MIB_DOWNLINK_COUNTER:
dudmuck	0:8f0d0ae0a077	2289	{
dudmuck	0:8f0d0ae0a077	2290	mibGet->Param.DownLinkCounter = DownLinkCounter;
dudmuck	0:8f0d0ae0a077	2291	break;
dudmuck	0:8f0d0ae0a077	2292	}
dudmuck	0:8f0d0ae0a077	2293	case MIB_MULTICAST_CHANNEL:
dudmuck	0:8f0d0ae0a077	2294	{
dudmuck	0:8f0d0ae0a077	2295	mibGet->Param.MulticastList = MulticastChannels;
dudmuck	0:8f0d0ae0a077	2296	break;
dudmuck	0:8f0d0ae0a077	2297	}
dudmuck	0:8f0d0ae0a077	2298	case MIB_SYSTEM_MAX_RX_ERROR:
dudmuck	0:8f0d0ae0a077	2299	{
dudmuck	0:8f0d0ae0a077	2300	mibGet->Param.SystemMaxRxError = LoRaMacParams.SystemMaxRxError;
dudmuck	0:8f0d0ae0a077	2301	break;
dudmuck	0:8f0d0ae0a077	2302	}
dudmuck	0:8f0d0ae0a077	2303	case MIB_MIN_RX_SYMBOLS:
dudmuck	0:8f0d0ae0a077	2304	{
dudmuck	0:8f0d0ae0a077	2305	mibGet->Param.MinRxSymbols = LoRaMacParams.MinRxSymbols;
dudmuck	0:8f0d0ae0a077	2306	break;
dudmuck	0:8f0d0ae0a077	2307	}
dudmuck	0:8f0d0ae0a077	2308	default:
dudmuck	0:8f0d0ae0a077	2309	status = LORAMAC_STATUS_SERVICE_UNKNOWN;
dudmuck	0:8f0d0ae0a077	2310	break;
dudmuck	0:8f0d0ae0a077	2311	}
dudmuck	0:8f0d0ae0a077	2312
dudmuck	0:8f0d0ae0a077	2313	return status;
dudmuck	0:8f0d0ae0a077	2314	}
dudmuck	0:8f0d0ae0a077	2315
dudmuck	0:8f0d0ae0a077	2316	LoRaMacStatus_t LoRaMacMibSetRequestConfirm( MibRequestConfirm_t *mibSet )
dudmuck	0:8f0d0ae0a077	2317	{
dudmuck	0:8f0d0ae0a077	2318	LoRaMacStatus_t status = LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	2319
dudmuck	0:8f0d0ae0a077	2320	if( mibSet == NULL )
dudmuck	0:8f0d0ae0a077	2321	{
dudmuck	0:8f0d0ae0a077	2322	return LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2323	}
dudmuck	0:8f0d0ae0a077	2324
dudmuck	0:8f0d0ae0a077	2325	switch( mibSet->Type )
dudmuck	0:8f0d0ae0a077	2326	{
dudmuck	0:8f0d0ae0a077	2327	case MIB_DEVICE_CLASS:
dudmuck	0:8f0d0ae0a077	2328	{
dudmuck	0:8f0d0ae0a077	2329	LoRaMacDeviceClass = mibSet->Param.Class;
dudmuck	0:8f0d0ae0a077	2330	switch( LoRaMacDeviceClass )
dudmuck	0:8f0d0ae0a077	2331	{
dudmuck	0:8f0d0ae0a077	2332	case CLASS_A:
dudmuck	0:8f0d0ae0a077	2333	{
dudmuck	0:8f0d0ae0a077	2334	// Set the radio into sleep to setup a defined state
dudmuck	0:8f0d0ae0a077	2335	Radio.Sleep( );
dudmuck	0:8f0d0ae0a077	2336	break;
dudmuck	0:8f0d0ae0a077	2337	}
dudmuck	0:8f0d0ae0a077	2338	case CLASS_B:
dudmuck	0:8f0d0ae0a077	2339	{
dudmuck	0:8f0d0ae0a077	2340	break;
dudmuck	0:8f0d0ae0a077	2341	}
dudmuck	0:8f0d0ae0a077	2342	case CLASS_D:
dudmuck	1:53c30224eda8	2343	isr_printf("TODO MIB_DEVICE_CLASS:D\r\n");
dudmuck	0:8f0d0ae0a077	2344	break;
dudmuck	0:8f0d0ae0a077	2345	}
dudmuck	0:8f0d0ae0a077	2346	break;
dudmuck	0:8f0d0ae0a077	2347	}
dudmuck	0:8f0d0ae0a077	2348	case MIB_NETWORK_JOINED:
dudmuck	0:8f0d0ae0a077	2349	{
dudmuck	0:8f0d0ae0a077	2350	IsLoRaMacNetworkJoined = mibSet->Param.IsNetworkJoined;
dudmuck	16:915815632c1f	2351	if (!IsLoRaMacNetworkJoined) {
dudmuck	16:915815632c1f	2352	BeaconCtx.timeout_rx.detach();
dudmuck	16:915815632c1f	2353	BeaconCtx.timeout_guard.detach();
dudmuck	16:915815632c1f	2354	BeaconCtx.state = BEACON_STATE_NONE;
dudmuck	16:915815632c1f	2355	}
dudmuck	0:8f0d0ae0a077	2356	break;
dudmuck	0:8f0d0ae0a077	2357	}
dudmuck	0:8f0d0ae0a077	2358	case MIB_NET_ID:
dudmuck	0:8f0d0ae0a077	2359	{
dudmuck	0:8f0d0ae0a077	2360	LoRaMacNetID = mibSet->Param.NetID;
dudmuck	0:8f0d0ae0a077	2361	break;
dudmuck	0:8f0d0ae0a077	2362	}
dudmuck	0:8f0d0ae0a077	2363	case MIB_DEV_ADDR:
dudmuck	0:8f0d0ae0a077	2364	{
dudmuck	0:8f0d0ae0a077	2365	LoRaMacDevAddr = mibSet->Param.DevAddr;
dudmuck	0:8f0d0ae0a077	2366	break;
dudmuck	0:8f0d0ae0a077	2367	}
dudmuck	0:8f0d0ae0a077	2368	case MIB_NWK_SKEY:
dudmuck	0:8f0d0ae0a077	2369	{
dudmuck	0:8f0d0ae0a077	2370	if( mibSet->Param.NwkSKey != NULL )
dudmuck	0:8f0d0ae0a077	2371	{
dudmuck	0:8f0d0ae0a077	2372	memcpy1( LoRaMacNwkSKey, mibSet->Param.NwkSKey,
dudmuck	0:8f0d0ae0a077	2373	sizeof( LoRaMacNwkSKey ) );
dudmuck	0:8f0d0ae0a077	2374	}
dudmuck	0:8f0d0ae0a077	2375	else
dudmuck	0:8f0d0ae0a077	2376	{
dudmuck	0:8f0d0ae0a077	2377	status = LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2378	}
dudmuck	0:8f0d0ae0a077	2379	break;
dudmuck	0:8f0d0ae0a077	2380	}
dudmuck	0:8f0d0ae0a077	2381	case MIB_APP_SKEY:
dudmuck	0:8f0d0ae0a077	2382	{
dudmuck	0:8f0d0ae0a077	2383	if( mibSet->Param.AppSKey != NULL )
dudmuck	0:8f0d0ae0a077	2384	{
dudmuck	0:8f0d0ae0a077	2385	memcpy1( LoRaMacAppSKey, mibSet->Param.AppSKey,
dudmuck	0:8f0d0ae0a077	2386	sizeof( LoRaMacAppSKey ) );
dudmuck	0:8f0d0ae0a077	2387	}
dudmuck	0:8f0d0ae0a077	2388	else
dudmuck	0:8f0d0ae0a077	2389	{
dudmuck	0:8f0d0ae0a077	2390	status = LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2391	}
dudmuck	0:8f0d0ae0a077	2392	break;
dudmuck	0:8f0d0ae0a077	2393	}
dudmuck	0:8f0d0ae0a077	2394	case MIB_PUBLIC_NETWORK:
dudmuck	0:8f0d0ae0a077	2395	{
dudmuck	0:8f0d0ae0a077	2396	PublicNetwork = mibSet->Param.EnablePublicNetwork;
dudmuck	0:8f0d0ae0a077	2397	Radio.SetPublicNetwork( PublicNetwork );
dudmuck	0:8f0d0ae0a077	2398	break;
dudmuck	0:8f0d0ae0a077	2399	}
dudmuck	0:8f0d0ae0a077	2400	case MIB_CHANNELS_NB_REP:
dudmuck	0:8f0d0ae0a077	2401	{
dudmuck	0:8f0d0ae0a077	2402	if( ( mibSet->Param.ChannelNbRep >= 1 ) &&
dudmuck	0:8f0d0ae0a077	2403	( mibSet->Param.ChannelNbRep <= 15 ) )
dudmuck	0:8f0d0ae0a077	2404	{
dudmuck	0:8f0d0ae0a077	2405	LoRaMacParams.ChannelsNbRep = mibSet->Param.ChannelNbRep;
dudmuck	0:8f0d0ae0a077	2406	}
dudmuck	0:8f0d0ae0a077	2407	else
dudmuck	0:8f0d0ae0a077	2408	{
dudmuck	0:8f0d0ae0a077	2409	status = LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2410	}
dudmuck	0:8f0d0ae0a077	2411	break;
dudmuck	0:8f0d0ae0a077	2412	}
dudmuck	0:8f0d0ae0a077	2413	case MIB_MAX_RX_WINDOW_DURATION:
dudmuck	0:8f0d0ae0a077	2414	{
dudmuck	0:8f0d0ae0a077	2415	LoRaMacParams.MaxRxWindow = mibSet->Param.MaxRxWindow;
dudmuck	0:8f0d0ae0a077	2416	break;
dudmuck	0:8f0d0ae0a077	2417	}
dudmuck	0:8f0d0ae0a077	2418	case MIB_CHANNELS_DEFAULT_TX_POWER:
dudmuck	0:8f0d0ae0a077	2419	{
dudmuck	0:8f0d0ae0a077	2420	if( ValueInRange( mibSet->Param.ChannelsDefaultTxPower,
dudmuck	0:8f0d0ae0a077	2421	LORAMAC_MAX_TX_POWER, LORAMAC_MIN_TX_POWER ) )
dudmuck	0:8f0d0ae0a077	2422	{
dudmuck	0:8f0d0ae0a077	2423	LoRaMacParamsDefaults.ChannelsTxPower = mibSet->Param.ChannelsDefaultTxPower;
dudmuck	0:8f0d0ae0a077	2424	}
dudmuck	0:8f0d0ae0a077	2425	else
dudmuck	0:8f0d0ae0a077	2426	{
dudmuck	0:8f0d0ae0a077	2427	status = LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2428	}
dudmuck	0:8f0d0ae0a077	2429	break;
dudmuck	0:8f0d0ae0a077	2430	}
dudmuck	0:8f0d0ae0a077	2431	case MIB_CHANNELS_TX_POWER:
dudmuck	0:8f0d0ae0a077	2432	{
dudmuck	0:8f0d0ae0a077	2433	if( ValueInRange( mibSet->Param.ChannelsTxPower,
dudmuck	0:8f0d0ae0a077	2434	LORAMAC_MAX_TX_POWER, LORAMAC_MIN_TX_POWER ) )
dudmuck	0:8f0d0ae0a077	2435	{
dudmuck	0:8f0d0ae0a077	2436	LoRaMacParams.ChannelsTxPower = mibSet->Param.ChannelsTxPower;
dudmuck	0:8f0d0ae0a077	2437	}
dudmuck	0:8f0d0ae0a077	2438	else
dudmuck	0:8f0d0ae0a077	2439	{
dudmuck	0:8f0d0ae0a077	2440	status = LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2441	}
dudmuck	0:8f0d0ae0a077	2442	break;
dudmuck	0:8f0d0ae0a077	2443	}
dudmuck	0:8f0d0ae0a077	2444	case MIB_UPLINK_COUNTER:
dudmuck	0:8f0d0ae0a077	2445	{
dudmuck	0:8f0d0ae0a077	2446	UpLinkCounter = mibSet->Param.UpLinkCounter;
dudmuck	0:8f0d0ae0a077	2447	break;
dudmuck	0:8f0d0ae0a077	2448	}
dudmuck	0:8f0d0ae0a077	2449	case MIB_DOWNLINK_COUNTER:
dudmuck	0:8f0d0ae0a077	2450	{
dudmuck	0:8f0d0ae0a077	2451	DownLinkCounter = mibSet->Param.DownLinkCounter;
dudmuck	0:8f0d0ae0a077	2452	break;
dudmuck	0:8f0d0ae0a077	2453	}
dudmuck	0:8f0d0ae0a077	2454	case MIB_SYSTEM_MAX_RX_ERROR:
dudmuck	0:8f0d0ae0a077	2455	{
dudmuck	0:8f0d0ae0a077	2456	LoRaMacParams.SystemMaxRxError = LoRaMacParamsDefaults.SystemMaxRxError = mibSet->Param.SystemMaxRxError;
dudmuck	0:8f0d0ae0a077	2457	break;
dudmuck	0:8f0d0ae0a077	2458	}
dudmuck	0:8f0d0ae0a077	2459	case MIB_MIN_RX_SYMBOLS:
dudmuck	0:8f0d0ae0a077	2460	{
dudmuck	0:8f0d0ae0a077	2461	LoRaMacParams.MinRxSymbols = LoRaMacParamsDefaults.MinRxSymbols = mibSet->Param.MinRxSymbols;
dudmuck	0:8f0d0ae0a077	2462	break;
dudmuck	0:8f0d0ae0a077	2463	}
dudmuck	0:8f0d0ae0a077	2464	default:
dudmuck	0:8f0d0ae0a077	2465	status = LORAMAC_STATUS_SERVICE_UNKNOWN;
dudmuck	0:8f0d0ae0a077	2466	break;
dudmuck	0:8f0d0ae0a077	2467	}
dudmuck	0:8f0d0ae0a077	2468
dudmuck	0:8f0d0ae0a077	2469	return status;
dudmuck	0:8f0d0ae0a077	2470	}
dudmuck	0:8f0d0ae0a077	2471
dudmuck	0:8f0d0ae0a077	2472	LoRaMacStatus_t LoRaMacMulticastChannelLink( MulticastParams_t *channelParam )
dudmuck	0:8f0d0ae0a077	2473	{
dudmuck	0:8f0d0ae0a077	2474	if( channelParam == NULL )
dudmuck	0:8f0d0ae0a077	2475	{
dudmuck	0:8f0d0ae0a077	2476	return LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2477	}
dudmuck	0:8f0d0ae0a077	2478
dudmuck	0:8f0d0ae0a077	2479	// Reset downlink counter
dudmuck	0:8f0d0ae0a077	2480	channelParam->DownLinkCounter = 0;
dudmuck	0:8f0d0ae0a077	2481
dudmuck	0:8f0d0ae0a077	2482	if( MulticastChannels == NULL )
dudmuck	0:8f0d0ae0a077	2483	{
dudmuck	0:8f0d0ae0a077	2484	// New node is the fist element
dudmuck	0:8f0d0ae0a077	2485	MulticastChannels = channelParam;
dudmuck	0:8f0d0ae0a077	2486	}
dudmuck	0:8f0d0ae0a077	2487	else
dudmuck	0:8f0d0ae0a077	2488	{
dudmuck	0:8f0d0ae0a077	2489	MulticastParams_t *cur = MulticastChannels;
dudmuck	0:8f0d0ae0a077	2490
dudmuck	0:8f0d0ae0a077	2491	// Search the last node in the list
dudmuck	0:8f0d0ae0a077	2492	while( cur->Next != NULL )
dudmuck	0:8f0d0ae0a077	2493	{
dudmuck	0:8f0d0ae0a077	2494	cur = cur->Next;
dudmuck	0:8f0d0ae0a077	2495	}
dudmuck	0:8f0d0ae0a077	2496	// This function always finds the last node
dudmuck	0:8f0d0ae0a077	2497	cur->Next = channelParam;
dudmuck	0:8f0d0ae0a077	2498	}
dudmuck	0:8f0d0ae0a077	2499
dudmuck	0:8f0d0ae0a077	2500	return LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	2501	}
dudmuck	0:8f0d0ae0a077	2502
dudmuck	0:8f0d0ae0a077	2503	LoRaMacStatus_t LoRaMacMulticastChannelUnlink( MulticastParams_t *channelParam )
dudmuck	0:8f0d0ae0a077	2504	{
dudmuck	0:8f0d0ae0a077	2505	if( channelParam == NULL )
dudmuck	0:8f0d0ae0a077	2506	{
dudmuck	0:8f0d0ae0a077	2507	return LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2508	}
dudmuck	0:8f0d0ae0a077	2509
dudmuck	0:8f0d0ae0a077	2510	if( MulticastChannels != NULL )
dudmuck	0:8f0d0ae0a077	2511	{
dudmuck	0:8f0d0ae0a077	2512	if( MulticastChannels == channelParam )
dudmuck	0:8f0d0ae0a077	2513	{
dudmuck	0:8f0d0ae0a077	2514	// First element
dudmuck	0:8f0d0ae0a077	2515	MulticastChannels = channelParam->Next;
dudmuck	0:8f0d0ae0a077	2516	}
dudmuck	0:8f0d0ae0a077	2517	else
dudmuck	0:8f0d0ae0a077	2518	{
dudmuck	0:8f0d0ae0a077	2519	MulticastParams_t *cur = MulticastChannels;
dudmuck	0:8f0d0ae0a077	2520
dudmuck	0:8f0d0ae0a077	2521	// Search the node in the list
dudmuck	0:8f0d0ae0a077	2522	while( cur->Next && cur->Next != channelParam )
dudmuck	0:8f0d0ae0a077	2523	{
dudmuck	0:8f0d0ae0a077	2524	cur = cur->Next;
dudmuck	0:8f0d0ae0a077	2525	}
dudmuck	0:8f0d0ae0a077	2526	// If we found the node, remove it
dudmuck	0:8f0d0ae0a077	2527	if( cur->Next )
dudmuck	0:8f0d0ae0a077	2528	{
dudmuck	0:8f0d0ae0a077	2529	cur->Next = channelParam->Next;
dudmuck	0:8f0d0ae0a077	2530	}
dudmuck	0:8f0d0ae0a077	2531	}
dudmuck	0:8f0d0ae0a077	2532	channelParam->Next = NULL;
dudmuck	0:8f0d0ae0a077	2533	}
dudmuck	0:8f0d0ae0a077	2534
dudmuck	0:8f0d0ae0a077	2535	return LORAMAC_STATUS_OK;
dudmuck	0:8f0d0ae0a077	2536	}
dudmuck	0:8f0d0ae0a077	2537
dudmuck	0:8f0d0ae0a077	2538	LoRaMacStatus_t LoRaMacMlmeRequest( MlmeReq_t *mlmeRequest )
dudmuck	0:8f0d0ae0a077	2539	{
dudmuck	0:8f0d0ae0a077	2540	LoRaMacStatus_t status = LORAMAC_STATUS_SERVICE_UNKNOWN;
dudmuck	0:8f0d0ae0a077	2541	LoRaMacHeader_t macHdr;
dudmuck	0:8f0d0ae0a077	2542
dudmuck	0:8f0d0ae0a077	2543	if( mlmeRequest == NULL )
dudmuck	0:8f0d0ae0a077	2544	{
dudmuck	0:8f0d0ae0a077	2545	return LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2546	}
dudmuck	0:8f0d0ae0a077	2547
dudmuck	0:8f0d0ae0a077	2548	memset1( ( uint8_t* ) &MlmeConfirm, 0, sizeof( MlmeConfirm ) );
dudmuck	0:8f0d0ae0a077	2549
dudmuck	2:f2d9aa163652	2550	MlmeConfirm.Status = LORAMAC_EVENT_INFO_STATUS_ERROR_MLMEREQ;
dudmuck	0:8f0d0ae0a077	2551
dudmuck	0:8f0d0ae0a077	2552	switch( mlmeRequest->Type )
dudmuck	0:8f0d0ae0a077	2553	{
dudmuck	0:8f0d0ae0a077	2554	case MLME_JOIN:
dudmuck	0:8f0d0ae0a077	2555	{
dudmuck	0:8f0d0ae0a077	2556	if( ( mlmeRequest->Req.Join.DevEui == NULL ) \|\|
dudmuck	0:8f0d0ae0a077	2557	( mlmeRequest->Req.Join.AppEui == NULL ) \|\|
dudmuck	0:8f0d0ae0a077	2558	( mlmeRequest->Req.Join.AppKey == NULL ) \|\|
dudmuck	0:8f0d0ae0a077	2559	( mlmeRequest->Req.Join.NbTrials == 0 ) )
dudmuck	0:8f0d0ae0a077	2560	{
dudmuck	0:8f0d0ae0a077	2561	return LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2562	}
dudmuck	0:8f0d0ae0a077	2563
dudmuck	0:8f0d0ae0a077	2564	// Enables at least the usage of all datarates.
dudmuck	0:8f0d0ae0a077	2565	if( mlmeRequest->Req.Join.NbTrials < 48 )
dudmuck	0:8f0d0ae0a077	2566	{
dudmuck	0:8f0d0ae0a077	2567	mlmeRequest->Req.Join.NbTrials = 48;
dudmuck	0:8f0d0ae0a077	2568	}
dudmuck	0:8f0d0ae0a077	2569
dudmuck	0:8f0d0ae0a077	2570	LoRaMacFlags.Bits.MlmeReq = 1;
dudmuck	0:8f0d0ae0a077	2571	MlmeConfirm.MlmeRequest = mlmeRequest->Type;
dudmuck	0:8f0d0ae0a077	2572
dudmuck	0:8f0d0ae0a077	2573	LoRaMacDevEui = mlmeRequest->Req.Join.DevEui;
dudmuck	0:8f0d0ae0a077	2574	LoRaMacAppEui = mlmeRequest->Req.Join.AppEui;
dudmuck	0:8f0d0ae0a077	2575	LoRaMacAppKey = mlmeRequest->Req.Join.AppKey;
dudmuck	0:8f0d0ae0a077	2576	MaxJoinRequestTrials = mlmeRequest->Req.Join.NbTrials;
dudmuck	0:8f0d0ae0a077	2577
dudmuck	0:8f0d0ae0a077	2578	// Reset variable JoinRequestTrials
dudmuck	0:8f0d0ae0a077	2579	JoinRequestTrials = 0;
dudmuck	0:8f0d0ae0a077	2580
dudmuck	0:8f0d0ae0a077	2581	// Setup header information
dudmuck	0:8f0d0ae0a077	2582	macHdr.Value = 0;
dudmuck	0:8f0d0ae0a077	2583	macHdr.Bits.MType = FRAME_TYPE_JOIN_REQ;
dudmuck	0:8f0d0ae0a077	2584
dudmuck	0:8f0d0ae0a077	2585	ResetMacParameters( );
dudmuck	16:915815632c1f	2586	expecting_beacon = false;
dudmuck	16:915815632c1f	2587	BeaconCtx.state = BEACON_STATE_NONE;
dudmuck	0:8f0d0ae0a077	2588
dudmuck	0:8f0d0ae0a077	2589	Channel = 0; // start with first channel
dudmuck	1:53c30224eda8	2590	isr_printf("<ch0>");
dudmuck	1:53c30224eda8	2591	isr_printf("mlme-join-send ch%u\r\n", Channel);
dudmuck	0:8f0d0ae0a077	2592	status = Send( &macHdr, 0, NULL, 0 );
dudmuck	0:8f0d0ae0a077	2593	break;
dudmuck	0:8f0d0ae0a077	2594	}
dudmuck	0:8f0d0ae0a077	2595	case MLME_LINK_CHECK:
dudmuck	0:8f0d0ae0a077	2596	{
dudmuck	0:8f0d0ae0a077	2597	LoRaMacFlags.Bits.MlmeReq = 1;
dudmuck	0:8f0d0ae0a077	2598	// LoRaMac will send this command piggy-pack
dudmuck	0:8f0d0ae0a077	2599	MlmeConfirm.MlmeRequest = mlmeRequest->Type;
dudmuck	0:8f0d0ae0a077	2600
dudmuck	0:8f0d0ae0a077	2601	status = AddMacCommand( MOTE_MAC_LINK_CHECK_REQ, 0, 0 );
dudmuck	0:8f0d0ae0a077	2602	break;
dudmuck	0:8f0d0ae0a077	2603	}
dudmuck	0:8f0d0ae0a077	2604	case MLME_TXCW:
dudmuck	0:8f0d0ae0a077	2605	{
dudmuck	0:8f0d0ae0a077	2606	MlmeConfirm.MlmeRequest = mlmeRequest->Type;
dudmuck	0:8f0d0ae0a077	2607	LoRaMacFlags.Bits.MlmeReq = 1;
dudmuck	0:8f0d0ae0a077	2608	status = SetTxContinuousWave( mlmeRequest->Req.TxCw.Timeout );
dudmuck	0:8f0d0ae0a077	2609	break;
dudmuck	0:8f0d0ae0a077	2610	}
dudmuck	0:8f0d0ae0a077	2611	case MLME_TXCW_1:
dudmuck	0:8f0d0ae0a077	2612	{
dudmuck	0:8f0d0ae0a077	2613	MlmeConfirm.MlmeRequest = mlmeRequest->Type;
dudmuck	0:8f0d0ae0a077	2614	LoRaMacFlags.Bits.MlmeReq = 1;
dudmuck	0:8f0d0ae0a077	2615	status = SetTxContinuousWave1( mlmeRequest->Req.TxCw.Timeout, mlmeRequest->Req.TxCw.Frequency, mlmeRequest->Req.TxCw.Power );
dudmuck	0:8f0d0ae0a077	2616	break;
dudmuck	0:8f0d0ae0a077	2617	}
dudmuck	0:8f0d0ae0a077	2618	default:
dudmuck	0:8f0d0ae0a077	2619	break;
dudmuck	0:8f0d0ae0a077	2620	}
dudmuck	0:8f0d0ae0a077	2621
dudmuck	0:8f0d0ae0a077	2622	if( status != LORAMAC_STATUS_OK )
dudmuck	0:8f0d0ae0a077	2623	{
dudmuck	0:8f0d0ae0a077	2624	NodeAckRequested = false;
dudmuck	0:8f0d0ae0a077	2625	LoRaMacFlags.Bits.MlmeReq = 0;
dudmuck	0:8f0d0ae0a077	2626	}
dudmuck	0:8f0d0ae0a077	2627
dudmuck	0:8f0d0ae0a077	2628	return status;
dudmuck	0:8f0d0ae0a077	2629	}
dudmuck	0:8f0d0ae0a077	2630
dudmuck	0:8f0d0ae0a077	2631	LoRaMacStatus_t LoRaMacMcpsRequest( McpsReq_t *mcpsRequest )
dudmuck	0:8f0d0ae0a077	2632	{
dudmuck	0:8f0d0ae0a077	2633	LoRaMacStatus_t status = LORAMAC_STATUS_SERVICE_UNKNOWN;
dudmuck	0:8f0d0ae0a077	2634	LoRaMacHeader_t macHdr;
dudmuck	0:8f0d0ae0a077	2635	uint8_t fPort = 0;
dudmuck	0:8f0d0ae0a077	2636	void *fBuffer;
dudmuck	0:8f0d0ae0a077	2637	uint16_t fBufferSize;
dudmuck	0:8f0d0ae0a077	2638	bool readyToSend = false;
dudmuck	0:8f0d0ae0a077	2639
dudmuck	0:8f0d0ae0a077	2640	if( mcpsRequest == NULL )
dudmuck	0:8f0d0ae0a077	2641	{
dudmuck	0:8f0d0ae0a077	2642	return LORAMAC_STATUS_PARAMETER_INVALID;
dudmuck	0:8f0d0ae0a077	2643	}
dudmuck	0:8f0d0ae0a077	2644
dudmuck	0:8f0d0ae0a077	2645	macHdr.Value = 0;
dudmuck	0:8f0d0ae0a077	2646	memset1 ( ( uint8_t* ) &McpsConfirm, 0, sizeof( McpsConfirm ) );
dudmuck	2:f2d9aa163652	2647	McpsConfirm.Status = LORAMAC_EVENT_INFO_STATUS_ERROR_MCPSREQ;
dudmuck	0:8f0d0ae0a077	2648
dudmuck	0:8f0d0ae0a077	2649	switch( mcpsRequest->Type )
dudmuck	0:8f0d0ae0a077	2650	{
dudmuck	0:8f0d0ae0a077	2651	case MCPS_UNCONFIRMED:
dudmuck	0:8f0d0ae0a077	2652	{
dudmuck	0:8f0d0ae0a077	2653	readyToSend = true;
dudmuck	0:8f0d0ae0a077	2654
dudmuck	0:8f0d0ae0a077	2655	macHdr.Bits.MType = FRAME_TYPE_DATA_UNCONFIRMED_UP;
dudmuck	0:8f0d0ae0a077	2656	fPort = mcpsRequest->Req.Unconfirmed.fPort;
dudmuck	0:8f0d0ae0a077	2657	fBuffer = mcpsRequest->Req.Unconfirmed.fBuffer;
dudmuck	0:8f0d0ae0a077	2658	fBufferSize = mcpsRequest->Req.Unconfirmed.fBufferSize;
dudmuck	0:8f0d0ae0a077	2659	break;
dudmuck	0:8f0d0ae0a077	2660	}
dudmuck	0:8f0d0ae0a077	2661	case MCPS_CONFIRMED:
dudmuck	0:8f0d0ae0a077	2662	{
dudmuck	0:8f0d0ae0a077	2663	readyToSend = true;
dudmuck	0:8f0d0ae0a077	2664
dudmuck	0:8f0d0ae0a077	2665	macHdr.Bits.MType = FRAME_TYPE_DATA_CONFIRMED_UP;
dudmuck	0:8f0d0ae0a077	2666	fPort = mcpsRequest->Req.Confirmed.fPort;
dudmuck	0:8f0d0ae0a077	2667	fBuffer = mcpsRequest->Req.Confirmed.fBuffer;
dudmuck	0:8f0d0ae0a077	2668	fBufferSize = mcpsRequest->Req.Confirmed.fBufferSize;
dudmuck	0:8f0d0ae0a077	2669	break;
dudmuck	0:8f0d0ae0a077	2670	}
dudmuck	0:8f0d0ae0a077	2671	case MCPS_PROPRIETARY:
dudmuck	0:8f0d0ae0a077	2672	{
dudmuck	0:8f0d0ae0a077	2673	readyToSend = true;
dudmuck	0:8f0d0ae0a077	2674
dudmuck	0:8f0d0ae0a077	2675	macHdr.Bits.MType = FRAME_TYPE_PROPRIETARY;
dudmuck	0:8f0d0ae0a077	2676	fBuffer = mcpsRequest->Req.Proprietary.fBuffer;
dudmuck	0:8f0d0ae0a077	2677	fBufferSize = mcpsRequest->Req.Proprietary.fBufferSize;
dudmuck	0:8f0d0ae0a077	2678	break;
dudmuck	0:8f0d0ae0a077	2679	}
dudmuck	0:8f0d0ae0a077	2680	default:
dudmuck	0:8f0d0ae0a077	2681	break;
dudmuck	0:8f0d0ae0a077	2682	}
dudmuck	0:8f0d0ae0a077	2683
dudmuck	0:8f0d0ae0a077	2684	if( readyToSend == true )
dudmuck	0:8f0d0ae0a077	2685	{
dudmuck	0:8f0d0ae0a077	2686	status = Send( &macHdr, fPort, fBuffer, fBufferSize );
dudmuck	0:8f0d0ae0a077	2687	if( status == LORAMAC_STATUS_OK )
dudmuck	0:8f0d0ae0a077	2688	{
dudmuck	0:8f0d0ae0a077	2689	McpsConfirm.McpsRequest = mcpsRequest->Type;
dudmuck	0:8f0d0ae0a077	2690	LoRaMacFlags.Bits.McpsReq = 1;
dudmuck	0:8f0d0ae0a077	2691	}
dudmuck	0:8f0d0ae0a077	2692	else
dudmuck	0:8f0d0ae0a077	2693	{
dudmuck	0:8f0d0ae0a077	2694	NodeAckRequested = false;
dudmuck	0:8f0d0ae0a077	2695	}
dudmuck	0:8f0d0ae0a077	2696	}
dudmuck	0:8f0d0ae0a077	2697
dudmuck	0:8f0d0ae0a077	2698	return status;
dudmuck	0:8f0d0ae0a077	2699	}
dudmuck	0:8f0d0ae0a077	2700
dudmuck	0:8f0d0ae0a077	2701	void LoRaMacTestRxWindowsOn( bool enable )
dudmuck	0:8f0d0ae0a077	2702	{
dudmuck	0:8f0d0ae0a077	2703	IsRxWindowsEnabled = enable;
dudmuck	0:8f0d0ae0a077	2704	}
dudmuck	0:8f0d0ae0a077	2705
dudmuck	0:8f0d0ae0a077	2706	void LoRaMacTestSetMic( uint16_t txPacketCounter )
dudmuck	0:8f0d0ae0a077	2707	{
dudmuck	0:8f0d0ae0a077	2708	UpLinkCounter = txPacketCounter;
dudmuck	16:915815632c1f	2709	//IsUpLinkCounterFixed = true;
dudmuck	0:8f0d0ae0a077	2710	}
dudmuck	0:8f0d0ae0a077	2711
dudmuck	0:8f0d0ae0a077	2712	void LoRaMacTestSetChannel( uint8_t channel )
dudmuck	0:8f0d0ae0a077	2713	{
dudmuck	1:53c30224eda8	2714	isr_printf("set-testch%u\r\n", channel);
dudmuck	0:8f0d0ae0a077	2715	Channel = channel;
dudmuck	0:8f0d0ae0a077	2716	}
dudmuck	0:8f0d0ae0a077	2717
dudmuck	0:8f0d0ae0a077	2718
dudmuck	0:8f0d0ae0a077	2719	static RxConfigParams_t ComputeRxWindowParameters( int8_t datarate, uint32_t rxError )
dudmuck	0:8f0d0ae0a077	2720	{
dudmuck	0:8f0d0ae0a077	2721	RxConfigParams_t rxConfigParams = { 0, 0, 0, 0 };
dudmuck	0:8f0d0ae0a077	2722	double tSymbol = 0.0;
dudmuck	0:8f0d0ae0a077	2723
dudmuck	0:8f0d0ae0a077	2724	rxConfigParams.Datarate = datarate;
dudmuck	0:8f0d0ae0a077	2725	switch( Bandwidths[datarate] )
dudmuck	0:8f0d0ae0a077	2726	{
dudmuck	0:8f0d0ae0a077	2727	default:
dudmuck	0:8f0d0ae0a077	2728	case 125000:
dudmuck	0:8f0d0ae0a077	2729	rxConfigParams.Bandwidth = 0;
dudmuck	0:8f0d0ae0a077	2730	break;
dudmuck	0:8f0d0ae0a077	2731	case 250000:
dudmuck	0:8f0d0ae0a077	2732	rxConfigParams.Bandwidth = 1;
dudmuck	0:8f0d0ae0a077	2733	break;
dudmuck	0:8f0d0ae0a077	2734	case 500000:
dudmuck	0:8f0d0ae0a077	2735	rxConfigParams.Bandwidth = 2;
dudmuck	0:8f0d0ae0a077	2736	break;
dudmuck	0:8f0d0ae0a077	2737	}
dudmuck	0:8f0d0ae0a077	2738
dudmuck	0:8f0d0ae0a077	2739	#if defined( USE_BAND_433 ) \|\| defined( USE_BAND_780 ) \|\| defined( USE_BAND_868 )
dudmuck	0:8f0d0ae0a077	2740	if( datarate == DR_7 )
dudmuck	0:8f0d0ae0a077	2741	{ // FSK
dudmuck	0:8f0d0ae0a077	2742	tSymbol = ( 1.0 / ( double )Datarates[datarate] ) * 8.0; // 1 symbol equals 1 byte
dudmuck	0:8f0d0ae0a077	2743	}
dudmuck	0:8f0d0ae0a077	2744	else
dudmuck	0:8f0d0ae0a077	2745	#endif
dudmuck	0:8f0d0ae0a077	2746	{ // LoRa
dudmuck	0:8f0d0ae0a077	2747	tSymbol = ( ( double )( 1 << Datarates[datarate] ) / ( double )Bandwidths[datarate] ) * 1e3;
dudmuck	0:8f0d0ae0a077	2748	}
dudmuck	0:8f0d0ae0a077	2749
dudmuck	0:8f0d0ae0a077	2750	rxConfigParams.RxWindowTimeout = MAX( ( uint32_t )ceil( ( ( 2 * LoRaMacParams.MinRxSymbols - 8 ) * tSymbol + 2 * rxError ) / tSymbol ), LoRaMacParams.MinRxSymbols ); // Computed number of symbols
dudmuck	0:8f0d0ae0a077	2751
dudmuck	0:8f0d0ae0a077	2752	rxConfigParams.RxOffset = ( int32_t )ceil( ( 4.0 * tSymbol ) - ( ( rxConfigParams.RxWindowTimeout * tSymbol ) / 2.0 ) - RADIO_WAKEUP_TIME );
dudmuck	0:8f0d0ae0a077	2753
dudmuck	0:8f0d0ae0a077	2754	return rxConfigParams;
dudmuck	0:8f0d0ae0a077	2755	}
dudmuck	0:8f0d0ae0a077	2756
dudmuck	20:42839629a5dc	2757	void LoRaMacBottomHalf()
dudmuck	20:42839629a5dc	2758	{
dudmuck	20:42839629a5dc	2759	if (flags.rx_win) {
dudmuck	20:42839629a5dc	2760	OnRxWindowTimerEventBH();
dudmuck	20:42839629a5dc	2761	flags.rx_win = 0;
dudmuck	20:42839629a5dc	2762	}
dudmuck	20:42839629a5dc	2763	if (flags.join_send) {
dudmuck	20:42839629a5dc	2764	join_send_bh();
dudmuck	20:42839629a5dc	2765	flags.join_send = 0;
dudmuck	20:42839629a5dc	2766	}
dudmuck	20:42839629a5dc	2767	if (flags.beacon_setup) {
dudmuck	20:42839629a5dc	2768	OnRxBeaconSetupBH();
dudmuck	20:42839629a5dc	2769	flags.beacon_setup = 0;
dudmuck	20:42839629a5dc	2770	}
dudmuck	20:42839629a5dc	2771	if (flags.send) {
dudmuck	20:42839629a5dc	2772	send_bh();
dudmuck	20:42839629a5dc	2773	flags.send = 0;
dudmuck	20:42839629a5dc	2774	}
dudmuck	20:42839629a5dc	2775	Radio.BottomHalf();
dudmuck	20:42839629a5dc	2776	}

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed OS
Created:	17 May 2017
Imports:	241
Forks:	0
Commits:	36
Dependents:	0
Dependencies:	3
Followers:	7