Team Fox
/
workinQM_5thJan_azad
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: FreescaleIAP mbed-rtos mbed
Fork of
workinQM_10thDec
by 
Team Fox
Diff: BCN.cpp
- Revision:
- 20:949d13045431
- Parent:
- 19:79e69017c855
- Child:
- 23:c65456ec5e61
- Child:
- 27:61c856be467e
--- a/BCN.cpp Sat Jun 04 11:29:13 2016 +0000
+++ b/BCN.cpp Fri Jul 01 17:55:30 2016 +0000
@@ -1,424 +1,693 @@
-
-#include "BCN.h"
-#include <stdio.h>
-#include "pin_config.h"
-//Check the pin names
-//Takes max 4.3 sec in void FCTN_BCN_TX_MAIN() (temp.calc. + long_beacon + short_beacon)
-
-Serial pc_bcn(USBTX, USBRX); //tx,rx
-SPI spi(PIN16, PIN17, PIN15); // mosi, miso, sclk
-DigitalOut cs(PIN6); //slave select or chip select
-Timer t_i;
-Timeout rf_sl_timeout;
-Ticker loop;
-
-//GLOBAL VARIABLES
-uint8_t BCN_INIT_STATUS = 0;
-uint8_t BCN_TX_MAIN_STATUS = 0;
-uint8_t BCN_TX_STATUS = 0;
-uint8_t BCN_TX_EN = 1; //hardcoding for now //check where is this variable toggled??
-uint8_t BCN_FEN = 0; //hardcoding for now //write this value to flash // CHANGED WILL BE UPDATED AUTOMATICALLY
-uint8_t BCN_STANDBY = 0; //hardcoding for now //check where is this variable toggled??
-uint8_t BCN_TS_BUFFER = 0; // For Temperature
-
-/*for long bcn */
-uint8_t *L_BCN=NULL;
-/*see if this works.!? else see uint8_t L_BCN[125] its kind of buffer */
-
-/*acquiring data for short beacon*/
-/*try using a new convertion algo if quant data doesn't work having presion of +- 0.2 from float to 4 bit made in some other file*/
-//extern BAE_HK_actual actual_data;
-
-void FCTN_BCN_INIT()
-{
- pc_bcn.printf("FCTN_BCN_INIT\n");
- BCN_INIT_STATUS = 1;
-/// if(BCN_FEN == 0)
-/// rf_sl_timeout.attach(&FCTN_BCN_FEN, 70);//actually 30 \\ so basically not able to call the interrupt .!! is it so?
-/// FCTN_BCN_FEN();
-
- //Init_BEACON_HW();
- BCN_INIT_STATUS = 0;
-}
-void FCTN_BCN_FEN(void const *args)
-{
- printf("\n\n\rFCTN_FEN\n");
- BCN_FEN = 1;//write this value to flash
-}
-void FCTN_BCN_TX_MAIN()
-{
- pc_bcn.printf("FCTN_BCN_TX_MAIN\n");
- t_i.start();
- int begin = t_i.read_us();
- BCN_TX_MAIN_STATUS = 1;
-
- if(BCN_FEN == 1)
- {
- if(BCN_TX_EN == 1)
- {
- //Measure and store BCN temperature in BCN_TS_BUFFER
- BCN_TS_BUFFER = check_Temperature();
- pc_bcn.printf("\n\ntemperature = %d\n\n",BCN_TS_BUFFER);
- //Get BCN_HK data from BCN HW(SPI) //Store BCN_HK data in BCN_HK_BUFFER
- if(BCN_STANDBY == 1 )
- {
- Set_BCN_TX_STATUS(BCN_TX_STANDBY);
- BCN_TX_MAIN_STATUS = 0;
-
- // break;
- }
- else
- {
- //transmit short beacon and long beacon
- SHORT_BCN_TX();
- LONG_BCN_TX();
-
- if(Check_ACK_RECEIVED() == 1)
- {
- Set_BCN_TX_STATUS(BCN_TX_SUCCESS);
- BCN_TX_MAIN_STATUS = 0;
- }
- else
- {
- Set_BCN_TX_STATUS(BCN_TX_FAILURE);
- BCN_TX_MAIN_STATUS = 0;
-
- }
- }
- }
- else
- {
- Set_BCN_TX_STATUS(BCN_TX_DISABLED);
- BCN_TX_MAIN_STATUS = 0;
- }
- }
- else
- {
- Set_BCN_TX_STATUS(BCN_RF_SILENCE); //Window of RF Silence: None of the Txs should be on.
- BCN_TX_MAIN_STATUS = 0;
- }
- t_i.stop();
- int end = t_i.read_us();
- pc_bcn.printf("The time required for FCTN_BCN_TX_MAIN is %d useconds\r\n", end-begin);
-
-}
-
-void Set_BCN_TX_STATUS(uint8_t STATUS)
-{
- BCN_TX_STATUS = STATUS;
-}
-
-void LONG_BCN_DATA(uint8_t* l_bcn)//azad to send the modified code
-{
- /*check if this works.!! if so so then send it to long beacon tx*/
- L_BCN=l_bcn;
- //edit this item to keep an array maybe by creating a global array or some thing smarter
-}
-
-uint8_t check_Temperature()
-{
- uint8_t temperature;
- writereg(RF22_REG_0F_ADC_CONFIGURATION,0x00);
- writereg(RF22_REG_12_Temperature_Sensor_Calibration,0x20);
- writereg(RF22_REG_0F_ADC_CONFIGURATION,0x80);
- wait(0.1);
- temperature = readreg(RF22_REG_11_ADC_Value);
- temperature = (float)temperature*0.5 - 64;
- return temperature;
-}
-
-void SHORT_BCN_TX()
-{
- writereg(RF22_REG_6E_TX_DATA_RATE,0x01);
- writereg(RF22_REG_6F_TX_DATA_RATE,0x50);//160bps
- writereg(RF22_REG_3E_PACKET_LENGTH,SHORT_TX_DATA); //short packet length
- wait(0.02);
-
- printf("\n\rstage 1");
-
- uint32_t timeout_count = 10e5;
- //extract values from short_beacon[]
-
- struct Short_beacon
- {
- uint8_t Voltage[1];
- uint8_t AngularSpeed[2];
- uint8_t SubsystemStatus[1];
- uint8_t Temp[3];
- uint8_t ErrorFlag[1];
-/*
- uint8_t callsign[7];
- uint8_t bat_v_+_solar_ccurr;
- uint8_t omega_+_bootcountet;
- uint8_t bae_batt_temp;
- uint8_t comm_rec_trans_vol;
- uint8_t combi;//combination
- uint8_t crc;
-*/
- }Shortbeacon = { {0x88}, {0x99, 0xAA} , {0xAA},{0xAA,0xDD,0xEE}, {0x00} };
-
- /* acquiring data
-
-
- */
-
-
- //filling hk data
- //uint8_t short_beacon[] = { 0xAB, 0x8A, 0xE2, 0xBB, 0xB8, 0xA2, 0x8E,Shortbeacon.Voltage[0],Shortbeacon.AngularSpeed[0], Shortbeacon.AngularSpeed[1],Shortbeacon.SubsystemStatus[0],Shortbeacon.Temp[0],Shortbeacon.Temp[1],Shortbeacon.Temp[2],Shortbeacon.ErrorFlag[0]};
- uint8_t short_beacon[] = { 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77,Shortbeacon.Voltage[0],Shortbeacon.AngularSpeed[0], Shortbeacon.AngularSpeed[1],Shortbeacon.SubsystemStatus[0],Shortbeacon.Temp[0],Shortbeacon.Temp[1],Shortbeacon.Temp[2],Shortbeacon.ErrorFlag[0]};
-
- clearTxBuf();
- //writing data first time
- int byte = 0;
- cs = 0;
- spi.write(0xFF);
-
- for (int byte_counter = 0; byte_counter <15 ; byte_counter++)
- {
- for(int j = 3; j >= 0 ; j--)
- {
- if((short_beacon[byte_counter] & (uint8_t) pow(2.0,(j*2+1)))!= pow(2.0,(j*2+1)))
- {
- byte=0x00;
- }
- else
- {
- byte=0xF0;
- }
- if((short_beacon[byte_counter] & (uint8_t) pow(2.0,j*2))!= pow(2.0,j*2))
- {
- byte=byte | 0x00;
- }
- else
- {
- byte=byte | 0x0F;
- }
- spi.write(byte);
- }
- }
-
- cs = 1;
-
- //Set to Tx mode
- writereg(RF22_REG_07_OPERATING_MODE1,0x08);//*
- wait(0.1);
- //Check for fifoThresh
- while(timeout_count--)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x20) == 0x20)break;
- timeout_count=10e5;
-
- //Check for packet_sent
- while(timeout_count--)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x04) == 0x04)break;
-
- pc_bcn.printf("Short packet sent\r\n");
-
- writereg(RF22_REG_07_OPERATING_MODE1,0x00); //standby mode
-
-}
-void LONG_BCN_TX()
-{
- writereg(RF22_REG_6E_TX_DATA_RATE,0x08);
- writereg(RF22_REG_6F_TX_DATA_RATE,0x31);//1000 bps
- writereg(RF22_REG_3E_PACKET_LENGTH,LONG_TX_DATA); //long packet length
- wait(0.02);
- uint32_t timeout_count=10e5;
-
- //get long_beacon array
-
- uint8_t Long_beacon[125];
- for(int i = 0;i<125;i++)
- {
- Long_beacon[i] = 0xAA;
- /*changed*/
- //Long_beacon[i++]=L_BCN[i]; //should work if not then see the problem
- }
-
-
-
-
- //setModeIdle();
- clearTxBuf();
- //writing data first time
- cs = 0;
- spi.write(0xFF);
- for(int i=0; i<60;i++)
- {
- spi.write(Long_beacon[i]);
- }
- cs = 1;
-
- //Set to Tx mode
- writereg(RF22_REG_07_OPERATING_MODE1,0x08);//*
- wait(0.1);
-
- //Check for fifoThresh
- while(timeout_count--)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x20) == 0x20)break;
- timeout_count=10e5;
-
- cs = 0;
- spi.write(0xFF);
- for(int i=60; i<125;i++)
- {
- spi.write(Long_beacon[i]);
- }
- cs = 1;
- wait(0.1);
- //Check for fifoThresh
- while(timeout_count--)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x20) == 0x20)break;
- timeout_count=10e5;
-
- //Check for packetsent interrupt
- while(timeout_count--)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x04) == 0x04)break;
-
- pc_bcn.printf("Long packet sent\r\n");
-
- writereg(RF22_REG_07_OPERATING_MODE1,0x00); //standby mode
-}
-void reset_rfm()
-{
- FCTN_BCN_INIT();
-}
-void writereg(uint8_t reg,uint8_t val)
-{
- uint8_t count = 0;
- for(;;count++)
- {
- int read_val =0; cs = 0;spi.write(reg | 0x80);spi.write(val);cs = 1;
- if(reg != 0x7 && reg != 0x58 && reg != 0xF)
- {
- read_val = readreg(reg);
- if (read_val == val)
- {
- break;
- }
- else if(count == 5)
- {
- reset_rfm(), printf("reg = 0x%X\n",reg);break;
- }
- }
- else
- break;
- }
-}
-uint8_t readreg(uint8_t reg)
-{
- uint8_t val;cs = 0;spi.write(reg & ~0x80);val = spi.write(0);cs = 1;return val;
-}
-void clearTxBuf()
-{
- writereg(RF22_REG_08_OPERATING_MODE2,0x01);
- writereg(RF22_REG_08_OPERATING_MODE2,0x00);
-}
-uint8_t setFrequency(double centre)
-{
- uint8_t fbsel = 0x40;
- if (centre >= 480.0) {
- centre /= 2;
- fbsel |= 0x20;
- }
- centre /= 10.0;
- double integerPart = floor(centre);
- double fractionalPart = centre - integerPart;
-
- uint8_t fb = (uint8_t)integerPart - 24; // Range 0 to 23
- fbsel |= fb;
- uint16_t fc = fractionalPart * 64000;
- writereg(RF22_REG_73_FREQUENCY_OFFSET1, 0); // REVISIT
- writereg(RF22_REG_74_FREQUENCY_OFFSET2, 0);
- writereg(RF22_REG_75_FREQUENCY_BAND_SELECT, fbsel);
- writereg(RF22_REG_76_NOMINAL_CARRIER_FREQUENCY1, fc >> 8);
- writereg(RF22_REG_77_NOMINAL_CARRIER_FREQUENCY0, fc & 0xff);
- return 0;
-}
-
-
-void Init_BEACON_HW()
-{
- wait(0.1f);
- cs=1; // chip must be deselected
- wait(0.1f);
- spi.format(8,0);
- spi.frequency(10000000); //10MHz SCLK
-
- //should either have a flag for invalid SPI or discard this for actual case or add reset
- if (readreg(RF22_REG_00_DEVICE_TYPE) == 0x08)
- pc_bcn.printf("spi connection valid\r\n");
- else
- {pc_bcn.printf("error in spi connection\r\n");
- pc_bcn.printf("readreg(RF22_REG_00_DEVICE_TYPE = %x\r\n",readreg(RF22_REG_00_DEVICE_TYPE));
- reset_rfm();
- }
-
- writereg(RF22_REG_07_OPERATING_MODE1,0x80); //sw_reset
- wait(0.1); //takes time to reset
-
- clearTxBuf();
-
- writereg(RF22_REG_07_OPERATING_MODE1,0x00); //standby mode
-
- //txfifoalmostempty
- writereg(RF22_REG_7D_TX_FIFO_CONTROL2,30);
-
- //Packet-engine registers
- writereg(RF22_REG_30_DATA_ACCESS_CONTROL,0x00);
-
- writereg(RF22_REG_33_HEADER_CONTROL2,0x08);
- writereg(RF22_REG_34_PREAMBLE_LENGTH,0x00);
-
- writereg(RF22_REG_0B_GPIO_CONFIGURATION0,0x15); // TX state
- writereg(RF22_REG_0C_GPIO_CONFIGURATION1,0x12); // RX state
-
- setFrequency(435.0);
-
- if((readreg(RF22_REG_02_DEVICE_STATUS)& 0x08)!= 0x00)
- {
- pc_bcn.printf("frequency not set properly\r\n");
- reset_rfm();
- }
-
- //set Modem Configuration
- //writereg(RF22_REG_1C_IF_FILTER_BANDWIDTH,0xdf);
- //writereg(RF22_REG_1F_CLOCK_RECOVERY_GEARSHIFT_OVERRIDE,0x03);
- //writereg(RF22_REG_20_CLOCK_RECOVERY_OVERSAMPLING_RATE,0x39);
- //writereg(RF22_REG_21_CLOCK_RECOVERY_OFFSET2,0x20);
- //writereg(RF22_REG_22_CLOCK_RECOVERY_OFFSET1,0x68); //updated 20 to 25 reg values from excel sheet for 1.2 Khz freq. deviation,fsk
- //writereg(RF22_REG_23_CLOCK_RECOVERY_OFFSET0,0xdc);
- //writereg(RF22_REG_24_CLOCK_RECOVERY_TIMING_LOOP_GAIN1,0x00);
- //writereg(RF22_REG_25_CLOCK_RECOVERY_TIMING_LOOP_GAIN0,0x6B);
- //writereg(RF22_REG_2C_OOK_COUNTER_VALUE_1,0x2C);
- //writereg(RF22_REG_2D_OOK_COUNTER_VALUE_2,0x11); //not required for fsk (OOK counter value)
- //writereg(RF22_REG_2E_SLICER_PEAK_HOLD,0x2A); //??
- writereg(RF22_REG_58,0x80);
- //writereg(RF22_REG_69_AGC_OVERRIDE1,0x60);
-
- //Data rate set later
-
- writereg(RF22_REG_70_MODULATION_CONTROL1,0x20);
- writereg(RF22_REG_71_MODULATION_CONTROL2,0x21);//ook = 0x21
-
- //set tx power
- writereg(RF22_REG_6D_TX_POWER,0x07); //20dbm
-
- //TX_packet_length written later
-}
-bool Check_ACK_RECEIVED()
-{
- if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x04) == 0x04)
- {
- printf("Packet sent: ACK received\r\n");
- return 1;
- }
- else
- {
- pc_bcn.printf("Packet not sent\r\n");
- return 0;
- }
-}
-/*int main()
-{
- FCTN_BCN_INIT();
-
- loop.attach(&FCTN_BCN_TX_MAIN, 10.0);//in actual case its 30.0
-
- while(1);
-
-}*/
\ No newline at end of file
+#include "BCN.h"
+#include <stdio.h>
+#include "pin_config.h"
+//Check the pin names
+//Takes max 4.3 sec in void FCTN_BCN_TX_MAIN() (temp.calc. + long_beacon + short_beacon)
+
+Serial pc_bcn(USBTX, USBRX); //tx,rx
+SPI spi(D11, D12, D13); // mosi, miso, sclk
+DigitalOut cs(D10); //slave select or chip select
+//SPI spi(PIN16, PIN17, PIN15); // mosi, miso, sclk
+//DigitalOut cs(PIN6); //slave select or chip select
+Timer t_i;//timer for checking the time taken by (temp.calc. + long_beacon + short_beacon)
+//Timer t_is;//timer for short_beacon
+//Timer t_il;//timer for long_beacon
+Timeout rf_sl_timeout;//RF_silence timer
+Ticker loop;//for transmitting every 10 secs
+
+//GLOBAL VARIABLES
+uint8_t BCN_INIT_STATUS = 0;
+uint8_t BCN_TX_MAIN_STATUS = 0;
+uint8_t BCN_TX_STATUS = 0;
+uint8_t BCN_TX_ENABLE = 1; //hardcoding for now //check where is this variable toggled??
+uint8_t BCN_TX_SW_STATUS = 1;
+uint8_t BCN_FEN = 0; //hardcoding for now //write this value to flash
+uint8_t BCN_SPND_TX = 0; //hardcoding for now //check where is this variable toggled??
+uint8_t BCN_TMP = 0; // For Temperature
+uint8_t ERROR_CHECK = 0;
+uint8_t BCN_FAIL_COUNT = 0; //Flag for keeping count of no. of times of BCN failure in init or one transmission in 30 secs (failure in spi communication)
+ //This Flag when exceeds a threshold, uC should reset.
+uint16_t BCN_TX_MAIN_COUNTER = 0;
+
+void FCTN_BCN_INIT()
+{
+ pc_bcn.printf("FCTN_BCN_INIT\n");
+ BCN_INIT_STATUS = 1;
+ if( BCN_TX_SW_STATUS == 0b00000001 )
+ Init_BEACON_HW();
+ else Set_BCN_TX_STATUS(BCN_TX_DISABLED);
+ // if(BCN_FEN == 0)//BCN_FEN is in flash
+ // rf_sl_timeout.attach(&FCTN_BCN_FEN, RF_SILENCE_TIME);
+ BCN_INIT_STATUS = 0;
+}
+
+extern uint32_t FCTN_BAE_RD_FLASH_ENTITY(uint16_t);
+extern void FCTN_BAE_WR_FLASH(uint16_t ,uint32_t );
+
+void FCTN_BCN_FEN(const void*)
+{
+ pc_bcn.printf("FCTN_FEN\n\r");
+ BCN_FEN = 1;//write this value to flash
+ uint32_t FLASH_DATA;
+ FLASH_DATA = FCTN_BAE_RD_FLASH_ENTITY(0);
+ FLASH_DATA = (FLASH_DATA | 0x00001000);//see if uint8 to uint32 conversion works
+ FCTN_BAE_WR_FLASH(0,FLASH_DATA);
+}
+void FCTN_BCN_TX_MAIN()
+{
+ ERROR_CHECK=0;
+ pc_bcn.printf("\n\nFCTN_BCN_TX_MAIN\n\r");
+ t_i.start();
+ int begin = t_i.read_us();
+ //int begins,beginl,endl;
+ int begintx,endtx;
+ BCN_TX_MAIN_STATUS = 1;
+ BCN_TX_MAIN_COUNTER++;
+ if(BCN_FEN == 1)
+ {
+ if(BCN_TX_SW_STATUS == 0b00000001)
+ {
+ //Measure and store BCN temperature in BCN_TS_BUFFER
+ BCN_TMP = check_Temperature();
+ pc_bcn.printf("temperature = %d\n\r",BCN_TMP);
+ //Get BCN_HK data from BCN HW(SPI) //Store BCN_HK data in BCN_HK_BUFFER
+ if(BCN_SPND_TX == 1 )
+ {
+ Set_BCN_TX_STATUS(BCN_TX_STANDBY);
+ BCN_TX_MAIN_STATUS = 0;
+
+ // break;
+ }
+ else
+ {
+ //transmit short beacon and long beacon
+ begintx = t_i.read_us();
+ BCN_TX();
+ endtx = t_i.read_us();
+ /*
+ begins = t_i.read_us();
+ SHORT_BCN_TX();
+ //ends = t_i.read_us();
+
+ beginl = t_i.read_us();
+ LONG_BCN_TX();
+ endl = t_i.read_us();
+ */
+
+ if(Check_ACK_RECEIVED() == 1)
+ {
+ Set_BCN_TX_STATUS(BCN_TX_SUCCESS);
+ BCN_TX_MAIN_STATUS = 0;
+ }
+ else
+ {
+ Set_BCN_TX_STATUS(BCN_TX_FAILURE);
+ BCN_FAIL_COUNT++;
+ Init_BEACON_HW();
+ BCN_TX_MAIN_STATUS = 0;
+
+ }
+ }
+ }
+ else
+ {
+ Set_BCN_TX_STATUS(BCN_TX_DISABLED);
+ BCN_TX_MAIN_STATUS = 0;
+ }
+ }
+ else
+ {
+ Set_BCN_TX_STATUS(BCN_RF_SILENCE); //Window of RF Silence: None of the Txs should be on.
+ BCN_TX_MAIN_STATUS = 0;
+ }
+ t_i.stop();
+ int end = t_i.read_us();
+ pc_bcn.printf("The time required for FCTN_BCN_TX_MAIN is %d useconds\r\n", end-begin);
+ pc_bcn.printf("The time required for FCTN_BCN_TX is %d useconds\r\n", endtx-begintx);
+ /*
+ pc_bcn.printf("The time required for Short_BCN is %d useconds\r\n", beginl-begins);
+ pc_bcn.printf("The time required for Long_BCN is %d useconds\r\n", endtx-beginl);
+ */
+ ERROR_CHECK = 0;
+
+}
+
+void Set_BCN_TX_STATUS(uint8_t STATUS)
+{
+ BCN_TX_STATUS = STATUS;
+}
+
+uint8_t check_Temperature()
+{
+ uint8_t temperature;
+ writereg(RF22_REG_0F_ADC_CONFIGURATION,0x00);//set ADC to temp measurement
+ writereg(RF22_REG_12_Temperature_Sensor_Calibration,0x20);//measure in degree celsius
+ writereg(RF22_REG_0F_ADC_CONFIGURATION,0x80);//start adc
+ wait(0.1);
+ temperature = readreg(RF22_REG_11_ADC_Value);
+ temperature = (float)temperature*0.5 - 64;
+ return temperature;
+}
+#if 0
+void SHORT_BCN_TX()
+{
+ /*
+ writereg(RF22_REG_6E_TX_DATA_RATE,0x01);
+ writereg(RF22_REG_6F_TX_DATA_RATE,0x50);//160bps
+ */
+ writereg(RF22_REG_6E_TX_DATA_RATE,0x0A);
+ writereg(RF22_REG_6F_TX_DATA_RATE,0x7C);//1280bps
+
+ //writereg(RF22_REG_3E_PACKET_LENGTH,1); //short packet length
+ wait(0.02);
+
+ uint32_t timeout_count = 10e5;
+ //extract values from short_beacon[]
+
+ struct Short_beacon
+ {
+ uint8_t Voltage[1];
+ uint8_t AngularSpeed[2];
+ uint8_t SubsystemStatus[1];
+ uint8_t Temp[3];
+ uint8_t ErrorFlag[1];
+ }Shortbeacon = { {0xFF}, {0xFF, 0xFF} , {0xFF},{0xFF,0xFF,0xFF}, {0xFF} };
+
+ //filling hk data
+ //uint8_t short_beacon[] = { 0xAB, 0x8A, 0xE2, 0xBB, 0xB8, 0xA2, 0x8E,Shortbeacon.Voltage[0],Shortbeacon.AngularSpeed[0], Shortbeacon.AngularSpeed[1],Shortbeacon.SubsystemStatus[0],Shortbeacon.Temp[0],Shortbeacon.Temp[1],Shortbeacon.Temp[2],Shortbeacon.ErrorFlag[0]};
+ uint8_t short_beacon[] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,Shortbeacon.Voltage[0],Shortbeacon.AngularSpeed[0], Shortbeacon.AngularSpeed[1],Shortbeacon.SubsystemStatus[0],Shortbeacon.Temp[0],Shortbeacon.Temp[1],Shortbeacon.Temp[2],Shortbeacon.ErrorFlag[0]};
+
+ //writereg(RF22_REG_07_OPERATING_MODE1,0x01); //ready mode ??
+ clearTxBuf(); //writing data first time
+
+ int byte_count=0;
+ uint8_t onebyte[4] = {0x81,0xA6,0xBE,0x4E};
+ uint8_t zerobyte[4] = {0x7E,0x59,0x41,0xB1};
+ for (int byte_counter = 0; byte_counter <15 ; byte_counter++)
+ {
+ //pc_bcn.printf("byte-counter=%d\r\n", byte_counter);
+ /*
+ for(int j = 3; j >= 0 ; j--)
+ {
+ if((short_beacon[byte_counter] & (uint8_t) pow(2.0,(j*2+1)))!= pow(2.0,(j*2+1)))
+ {
+ byte=0x00;
+ }
+ else
+ {
+ byte=0xF0;
+ }
+ if((short_beacon[byte_counter] & (uint8_t) pow(2.0,j*2))!= pow(2.0,j*2))
+ {
+ byte=byte | 0x00;
+ }
+ else
+ {
+ byte=byte | 0x0F;
+ }
+ cs = 0;
+ spi.write(0xFF);
+ spi.write(byte);
+ cs = 1;1
+ }
+ */
+ for(int j = 7; j >= 0 ; j--)
+ {
+ cs = 0;
+ spi.write(0xFF);
+ if((short_beacon[byte_counter] & (uint8_t) pow(2.0,j))!= pow(2.0,j))
+ {
+ //byte=0x00;
+ spi.write(zerobyte[0]);
+ spi.write(zerobyte[1]);
+ spi.write(zerobyte[2]);
+ spi.write(zerobyte[3]);
+ }
+ else
+ {
+ //byte=0xFF;
+ spi.write(onebyte[0]);
+ spi.write(onebyte[1]);
+ spi.write(onebyte[2]);
+ spi.write(onebyte[3]);
+ }
+ cs = 1;
+ /*
+ spi.write(byte);
+ spi.write(byte);
+ spi.write(byte);
+ spi.write(byte); //Each bit is written 32 times
+ */
+ byte_count+=4;
+
+ }
+
+ if(byte_counter == 1)
+ {
+
+ //Set to Tx mode
+ writereg(RF22_REG_07_OPERATING_MODE1,0x08); //txon
+ wait(0.1);// takes time to set to tx mode hence the delay of 0.1.
+
+ }
+ //testing level
+ /*if(byte_counter > 0)
+ while(1)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x40) == 0x00)break;else
+ {
+ pc_bcn.printf("w_f_empty1\n\r");
+ //reset_rfm(1);
+ }*/
+
+
+ //Check for fifoThresh
+
+ if(byte_counter > 0)
+ {wait_ms(25);
+ while(1)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x20) == 0x20)break;else
+ {
+ //pc_bcn.printf("w_f_empty\n");
+ //reset_rfm(1);
+ }
+ }
+
+ /* if(byte_counter%2==0 && byte_counter)
+ while(1)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x40) == 0x00)break;else
+ {
+ pc_bcn.printf("W = %d\r\n",byte_counter);
+ }*/
+ pc_bcn.printf("W = %d\r\n",byte_counter);
+ }
+
+ //Check for fifoThresh
+ while(1)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x40) == 0x00)break;else
+ {
+ pc_bcn.printf("Waiting for fifo to empty\r\n");
+ }
+
+ //Check for packetsent interrupt
+ while(timeout_count--)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x04) == 0x04)break;else if(timeout_count == 1) reset_rfm(1);
+
+ pc_bcn.printf("Short packet sent, bytes written = %d\r\n",byte_count);
+
+ writereg(RF22_REG_07_OPERATING_MODE1,0x00); //standby mode
+
+}
+#endif
+void BCN_TX()
+{
+ printf("BCN_TX\n\r");
+ writereg(RF22_REG_6E_TX_DATA_RATE,0x0A);
+ writereg(RF22_REG_6F_TX_DATA_RATE,0x7C);//1280bps
+
+ wait(0.02);
+
+ uint32_t timeout_count = 10e5;
+ //extract values from short_beacon[]
+
+ uint8_t Long_beacon[LONG_TX_DATA];
+ for(int i = 0;i<LONG_TX_DATA;i++)
+ {
+ Long_beacon[i] = 0xFF;
+}
+
+ struct Short_beacon
+ {
+ uint8_t Voltage[1];
+ uint8_t AngularSpeed[2];
+ uint8_t SubsystemStatus[1];
+ uint8_t Temp[3];
+ uint8_t ErrorFlag[1];
+ }Shortbeacon = { {0xFF}, {0xFF, 0xFF} , {0xFF},{0xFF,0xFF,0xFF}, {0xFF} };
+
+ //filling hk data
+ //uint8_t short_beacon[] = { 0xAB, 0x8A, 0xE2, 0xBB, 0xB8, 0xA2, 0x8E,Shortbeacon.Voltage[0],Shortbeacon.AngularSpeed[0], Shortbeacon.AngularSpeed[1],Shortbeacon.SubsystemStatus[0],Shortbeacon.Temp[0],Shortbeacon.Temp[1],Shortbeacon.Temp[2],Shortbeacon.ErrorFlag[0]};
+ uint8_t short_beacon[] = { 0xF3, 0x02, 0xFA, 0xC6, 0xD4, 0x28, 0x8A,Shortbeacon.Voltage[0],Shortbeacon.AngularSpeed[0], Shortbeacon.AngularSpeed[1],Shortbeacon.SubsystemStatus[0],Shortbeacon.Temp[0],Shortbeacon.Temp[1],Shortbeacon.Temp[2],Shortbeacon.ErrorFlag[0]};
+
+ //writereg(RF22_REG_07_OPERATING_MODE1,0x01); //ready mode ??
+ clearTxBuf(); //writing data first time
+
+ int byte_count=0, byte_counter;
+ uint8_t onebyte[4] = {0x81,0xA6,0xBE,0x4E};
+ uint8_t zerobyte[4] = {0x7E,0x59,0x41,0xB1};
+ for (byte_counter = 0; byte_counter <15 ; byte_counter++)
+ {
+ for(int j = 7; j >= 0 ; j--)
+ {
+ cs = 0;
+ spi.write(0xFF);
+ if((short_beacon[byte_counter] & (uint8_t) pow(2.0,j))!= pow(2.0,j))
+ {
+ //byte=0x00;
+ spi.write(zerobyte[0]);
+ spi.write(zerobyte[1]);
+ spi.write(zerobyte[2]);
+ spi.write(zerobyte[3]);
+ }
+ else
+ {
+ //byte=0xFF;
+ spi.write(onebyte[0]);
+ spi.write(onebyte[1]);
+ spi.write(onebyte[2]);
+ spi.write(onebyte[3]);
+ }
+ cs = 1;
+ /*
+ spi.write(byte);
+ spi.write(byte);
+ spi.write(byte);
+ spi.write(byte); //Each bit is written 32 times
+ */
+ byte_count+=4;
+
+ }
+
+ if(byte_counter == 1)
+ {
+ //Set to Tx mode
+ writereg(RF22_REG_07_OPERATING_MODE1,0x08); //txon
+ wait(0.1);// takes time to set to tx mode hence the delay of 0.1.
+
+ }
+ //testing level
+ /*if(byte_counter > 0)
+ while(1)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x40) == 0x00)break;else
+ {
+ pc_bcn.printf("w_f_empty1\n\r");
+ //reset_rfm(1);
+ }*/
+
+
+ //Check for fifoThresh
+
+ if(byte_counter > 0)
+ {wait_ms(25);
+ while(1)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x20) == 0x20)break;else
+ {
+ //pc_bcn.printf("w_f_empty\n");
+ //reset_rfm(1);
+ }
+ }
+
+ /* if(byte_counter%2==0 && byte_counter)
+ while(1)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x40) == 0x00)break;else
+ {
+ pc_bcn.printf("W = %d\r\n",byte_counter);
+ }*/
+ //pc_bcn.printf("W = %d\r\n",byte_counter);
+ }
+
+ for(byte_counter = 15;byte_counter<142;byte_counter++)
+ {
+ cs = 0;
+ spi.write(0xFF);
+ spi.write(Long_beacon[byte_counter-15]);
+ cs = 1;
+
+ if((byte_counter-15)%32==0)
+ { //Check for fifoThresh
+ wait_ms(25);
+ while(1)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x20) == 0x20)break;else //if(timeout_count == 1)
+ {
+ //pc_bcn.printf("Reset\n");
+ //reset_rfm(1);
+ }
+ }
+
+ }
+ wait_ms(70);
+ //Check for fifoThresh
+ while(1)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x40) == 0x00)break;else
+ {
+ pc_bcn.printf("Waiting for fifo to empty\r\n");
+ }
+
+ //Check for packetsent interrupt
+ while(timeout_count--)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x04) == 0x04)break;else if(timeout_count == 1) reset_rfm(1);
+
+ //pc_bcn.printf("Short packet sent, bytes written = %d\r\n",byte_count);
+
+ writereg(RF22_REG_07_OPERATING_MODE1,0x00); //standby mode
+
+}
+#if 0
+void LONG_BCN_TX()
+{
+ /*
+ writereg(RF22_REG_6E_TX_DATA_RATE,0x04);
+ writereg(RF22_REG_6F_TX_DATA_RATE,0xEA);//600 bps
+ */
+ writereg(RF22_REG_3E_PACKET_LENGTH,LONG_TX_DATA); //long packet length
+ wait(0.02);
+ uint32_t timeout_count=10e5;
+
+ //get long_beacon array
+
+ uint8_t Long_beacon[LONG_TX_DATA];
+ for(int i = 0;i<LONG_TX_DATA;i++)
+ {
+ Long_beacon[i] = 0xFF;
+ }
+
+ clearTxBuf();
+ //writing data first time
+ cs = 0;
+ spi.write(0xFF);
+ for(int i=0; i<64;i++)
+ {
+ spi.write(Long_beacon[i]);
+ }
+ cs = 1;
+
+ //Set to Tx mode
+ writereg(RF22_REG_07_OPERATING_MODE1,0x08);
+ wait(0.1);//necessary
+
+ //Check for fifoThresh
+ while(timeout_count--)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x20) == 0x20)break;else if(timeout_count == 1)
+ {
+ pc_bcn.printf("Reset\n");
+ reset_rfm(1);
+ }
+ timeout_count=10e5;
+
+ cs = 0;
+ spi.write(0xFF);
+ for(int i=64; i<127;i++)
+ {
+ spi.write(Long_beacon[i]);
+ }
+ cs = 1;
+ wait(0.1);
+ //Check for fifoThresh
+ while(timeout_count--)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x20) == 0x20)break;else if(timeout_count == 1)
+ {
+ pc_bcn.printf("Reset\n");
+ reset_rfm(1);}
+ timeout_count=10e5;
+
+ //Check for packetsent interrupt
+ while(timeout_count--)if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x04) == 0x04)break;else if(timeout_count == 1) reset_rfm(1);
+
+ //pc_bcn.printf("Long packet sent\r\n");
+
+ writereg(RF22_REG_07_OPERATING_MODE1,0x00); //standby mode
+}
+#endif
+void reset_rfm(uint8_t fl)
+{
+ if (fl ==1 && ERROR_CHECK ==0)
+ { BCN_FAIL_COUNT++;
+ ERROR_CHECK=1;
+ printf("BCN_FAIL_COUNT++\n");
+ }
+ else if(fl == 0)
+ {
+ BCN_FAIL_COUNT = 0;
+ ERROR_CHECK=0;
+ }
+}
+void writereg(uint8_t reg,uint8_t val)
+{
+
+ uint8_t count = 0;
+ for(;;count++)
+ {
+ int read_val =0; cs = 0;spi.write(reg | 0x80);spi.write(val);cs = 1;
+ if(reg != 0x7 && reg != 0x58 && reg != 0xF)
+ {
+ read_val = readreg(reg);
+ if (read_val == val)
+ {
+ break;
+ }
+ else if(count == 5)
+ {
+ reset_rfm(1); printf("reg = 0x%X\n",reg);break;
+ }
+ else init_spi();
+ }
+ else
+ break;
+ }
+}
+uint8_t readreg(uint8_t reg)
+{
+ uint8_t val;cs = 0;spi.write(reg & ~0x80);val = spi.write(0);cs = 1;return val;
+}
+void clearTxBuf()
+{
+ writereg(RF22_REG_08_OPERATING_MODE2,0x01);
+ writereg(RF22_REG_08_OPERATING_MODE2,0x00);
+}
+uint8_t setFrequency(double centre)
+{
+ uint8_t fbsel = 0x40;
+ if (centre >= 480.0) {
+ centre /= 2;
+ fbsel |= 0x20;
+ }
+ centre /= 10.0;
+ double integerPart = floor(centre);
+ double fractionalPart = centre - integerPart;
+
+ uint8_t fb = (uint8_t)integerPart - 24; // Range 0 to 23
+ fbsel |= fb;
+ uint16_t fc = fractionalPart * 64000;
+ writereg(RF22_REG_73_FREQUENCY_OFFSET1, 0); // REVISIT
+ writereg(RF22_REG_74_FREQUENCY_OFFSET2, 0);
+ writereg(RF22_REG_75_FREQUENCY_BAND_SELECT, fbsel);
+ writereg(RF22_REG_76_NOMINAL_CARRIER_FREQUENCY1, fc >> 8);
+ writereg(RF22_REG_77_NOMINAL_CARRIER_FREQUENCY0, fc & 0xff);
+ return 0;
+}
+void init_spi()
+{
+ cs=1; // chip must be deselected
+ wait(0.1);
+ spi.format(8,0);
+ spi.frequency(10000000); //10MHz SCLK
+}
+void Init_BEACON_HW()
+{
+ printf("Init HW\n\r");
+ ERROR_CHECK=0;
+ wait(0.1);
+ int BCN_INIT_COUNTER = 1;
+ while(BCN_INIT_COUNTER)
+ {
+ init_spi();
+ printf("init spi\r\n");
+ //should either have a flag for invalid SPI or discard this for actual case or add reset
+ if (readreg(RF22_REG_00_DEVICE_TYPE) == 0x08)
+ {
+ pc_bcn.printf("spi connection valid\r\n");
+ reset_rfm(0);
+ Set_BCN_TX_STATUS(BCN_TX_INITIALIZED);
+ break;
+ }
+ else if (BCN_INIT_COUNTER == 1)
+ {
+ pc_bcn.printf("error in spi connection\r\n");
+ reset_rfm(1);
+ writereg(RF22_REG_07_OPERATING_MODE1,0x80); //sw_reset
+ wait(0.1); //takes time to reset
+ }
+ else if (BCN_INIT_COUNTER == 2)
+ {
+ pc_bcn.printf("error in spi connection\r\n");
+ reset_rfm(1);
+ BCN_TX_SW_STATUS = 0b00000011; //Device disabled
+ //reset BCN HW using switch here
+ }
+ else
+ {
+ pc_bcn.printf("BCN_TX_FAILURE\r\n");
+ Set_BCN_TX_STATUS(BCN_TX_FAILURE);
+ break;
+ }
+ BCN_INIT_COUNTER++;
+ }
+
+ if(BCN_TX_STATUS == BCN_TX_INITIALIZED)
+ {
+ writereg(RF22_REG_07_OPERATING_MODE1,0x80); //sw_reset
+ wait(0.1); //takes time to reset
+
+ clearTxBuf();
+
+ writereg(RF22_REG_07_OPERATING_MODE1,0x00); //standby mode
+
+ //txfifoalmostempty
+ writereg(RF22_REG_7D_TX_FIFO_CONTROL2,30);
+
+ //txfifoalmostfull
+ writereg(RF22_REG_7C_TX_FIFO_CONTROL1,50);
+
+
+ //Packet-engine registers
+ writereg(RF22_REG_30_DATA_ACCESS_CONTROL,0x00);
+
+ writereg(RF22_REG_33_HEADER_CONTROL2,0x08);
+ writereg(RF22_REG_34_PREAMBLE_LENGTH,0x00);
+
+ writereg(RF22_REG_0B_GPIO_CONFIGURATION0,0x15); // TX state
+ writereg(RF22_REG_0C_GPIO_CONFIGURATION1,0x12); // RX state
+
+ setFrequency(435.0);
+
+ int i=3;
+ while(i--)
+ if((readreg(RF22_REG_02_DEVICE_STATUS)& 0x08)!= 0x00)
+ {
+ setFrequency(435.0);
+ if (i==1)
+ {pc_bcn.printf("frequency not set properly\r\n");
+ reset_rfm(1);
+ }
+ }
+
+ //set Modem Configuration
+ writereg(RF22_REG_58,0x80);
+
+ //Set Data rate - same for both long and short beacon
+
+ writereg(RF22_REG_6E_TX_DATA_RATE,0x0A);
+ writereg(RF22_REG_6F_TX_DATA_RATE,0x7C);//1280bps
+
+
+ writereg(RF22_REG_70_MODULATION_CONTROL1,0x20);
+ writereg(RF22_REG_71_MODULATION_CONTROL2,0x21);//ook = 0x21
+
+ //set tx power
+ writereg(RF22_REG_6D_TX_POWER,0x07); //20dbm
+
+ //TX_packet_length written later
+ ERROR_CHECK = 0;
+ printf("Done Init HW\n\r");
+ }
+}
+bool Check_ACK_RECEIVED()
+{
+ if((readreg(RF22_REG_03_INTERRUPT_STATUS1) & 0x04) == 0x04)
+ {
+ printf("Packet sent: ACK received\r\n");
+ return 1;
+ }
+ else
+ {
+ pc_bcn.printf("Packet not sent\r\n");
+ return 0;
+ }
+}
+/*
+int main()
+{
+ FCTN_BCN_INIT();
+
+ loop.attach(&FCTN_BCN_TX_MAIN, 10.0);//in actual case its 30.0
+
+ while(1);
+
+}
+*/
\ No newline at end of file