rfm22 receive code for BAE
Embed:
(wiki syntax)
Show/hide line numbers
main.cpp
00001 #include "beacon.h" 00002 Serial pc(USBTX, USBRX); // tx, rx 00003 SPI spi(D11, D12, D13); // mosi, miso, sclk 00004 DigitalOut cs(D10); //slave select or chip select 00005 00006 void writereg(uint8_t reg,uint8_t val) 00007 { 00008 cs = 0;__disable_irq();spi.write(reg | 0x80);spi.write(val);__enable_irq();cs = 1; 00009 } 00010 uint8_t readreg(uint8_t reg) 00011 { 00012 int val;cs = 0;__disable_irq();spi.write(reg & ~0x80);val = spi.write(0);__enable_irq();cs = 1;return val; 00013 } 00014 void clearTxBuf() 00015 { 00016 writereg(RF22_REG_08_OPERATING_MODE2,0x01); 00017 writereg(RF22_REG_08_OPERATING_MODE2,0x00); 00018 } 00019 void clearRxBuf() 00020 { 00021 writereg(RF22_REG_08_OPERATING_MODE2,0x02); 00022 writereg(RF22_REG_08_OPERATING_MODE2,0x00); 00023 } 00024 int setFrequency(float centre,float afcPullInRange) 00025 { 00026 //freq setting begins 00027 uint8_t fbsel = 0x40; 00028 uint8_t afclimiter; 00029 if (centre >= 480.0) { 00030 centre /= 2; 00031 fbsel |= 0x20; 00032 afclimiter = afcPullInRange * 1000000.0 / 1250.0; 00033 } else { 00034 if (afcPullInRange < 0.0 || afcPullInRange > 0.159375) 00035 return false; 00036 afclimiter = afcPullInRange * 1000000.0 / 625.0; 00037 } 00038 centre /= 10.0; 00039 float integerPart = floor(centre); 00040 float fractionalPart = centre - integerPart; 00041 00042 uint8_t fb = (uint8_t)integerPart - 24; // Range 0 to 23 00043 fbsel |= fb; 00044 uint16_t fc = fractionalPart * 64000; 00045 writereg(RF22_REG_73_FREQUENCY_OFFSET1, 0); // REVISIT 00046 writereg(RF22_REG_74_FREQUENCY_OFFSET2, 0); 00047 writereg(RF22_REG_75_FREQUENCY_BAND_SELECT, fbsel); 00048 writereg(RF22_REG_76_NOMINAL_CARRIER_FREQUENCY1, fc >> 8); 00049 writereg(RF22_REG_77_NOMINAL_CARRIER_FREQUENCY0, fc & 0xff); 00050 writereg(RF22_REG_2A_AFC_LIMITER, afclimiter); 00051 return 0; 00052 } 00053 00054 void init() 00055 { 00056 //reset() 00057 writereg(RF22_REG_07_OPERATING_MODE1,0x80); //sw_reset 00058 wait(1); //takes time to reset 00059 00060 clearTxBuf(); 00061 clearRxBuf(); 00062 //txfifoalmostempty 00063 writereg(RF22_REG_7D_TX_FIFO_CONTROL2,10); 00064 //rxfifoalmostfull 00065 writereg(RF22_REG_7E_RX_FIFO_CONTROL,20); 00066 //Packet-engine registers 00067 writereg(RF22_REG_30_DATA_ACCESS_CONTROL,0x8E); //RF22_REG_30_DATA_ACCESS_CONTROL, RF22_ENPACRX | RF22_ENPACTX | RF22_ENCRC | RF22_CRC_CRC_16_IBM 00068 //&0x77 = diasable packet rx-tx handling 00069 writereg(RF22_REG_32_HEADER_CONTROL1,0x88); //RF22_REG_32_HEADER_CONTROL1, RF22_BCEN_HEADER3 | RF22_HDCH_HEADER3 00070 writereg(RF22_REG_33_HEADER_CONTROL2,0x42); //RF22_REG_33_HEADER_CONTROL2, RF22_HDLEN_4 | RF22_SYNCLEN_2 00071 writereg(RF22_REG_34_PREAMBLE_LENGTH,8); //RF22_REG_34_PREAMBLE_LENGTH, nibbles); preamble length = 8; 00072 writereg(RF22_REG_36_SYNC_WORD3,0x2D); //syncword3=2D 00073 writereg(RF22_REG_37_SYNC_WORD2,0xD4); //syncword2=D4 00074 writereg(RF22_REG_3F_CHECK_HEADER3,0); //RF22_REG_3F_CHECK_HEADER3, RF22_DEFAULT_NODE_ADDRESS 00075 writereg(RF22_REG_3A_TRANSMIT_HEADER3,0xab); //header_to 00076 writereg(RF22_REG_3B_TRANSMIT_HEADER2,0xbc); //header_from 00077 writereg(RF22_REG_3C_TRANSMIT_HEADER1,0xcd); //header_ids 00078 writereg(RF22_REG_3D_TRANSMIT_HEADER0,0xde); //header_flags 00079 writereg(RF22_REG_3F_CHECK_HEADER3,0xab); 00080 writereg(RF22_REG_40_CHECK_HEADER2,0xbc); 00081 writereg(RF22_REG_41_CHECK_HEADER1,0xcd); 00082 writereg(RF22_REG_42_CHECK_HEADER0,0xde); 00083 00084 //RSSI threshold for clear channel indicator 00085 writereg(RF22_REG_27_RSSI_THRESHOLD,0xA5); //55 for -80dBm, 2D for -100dBm, 7D for -60dBm, A5 for -40dBm, CD for -20 dBm 00086 00087 writereg(RF22_REG_0B_GPIO_CONFIGURATION0,0x15); // TX state ?? 00088 writereg(RF22_REG_0C_GPIO_CONFIGURATION1,0x12); // RX state ?? 00089 00090 //interrupts 00091 // spiWrite(RF22_REG_05_INTERRUPT_ENABLE1, RF22_ENTXFFAEM |RF22_ENRXFFAFULL | RF22_ENPKSENT |RF22_ENPKVALID| RF22_ENCRCERROR); 00092 // spiWrite(RF22_REG_06_INTERRUPT_ENABLE2, RF22_ENPREAVAL); 00093 00094 setFrequency(435.0, 0.05); 00095 00096 //return !(statusRead() & RF22_FREQERR); 00097 if((readreg(RF22_REG_02_DEVICE_STATUS)& 0x08)!= 0x00) 00098 pc.printf("frequency not set properly\n"); 00099 //frequency set 00100 00101 //setModemConfig(FSK_Rb2_4Fd36); FSK_Rb2_4Fd36, ///< FSK, No Manchester, Rb = 2.4kbs, Fd = 36kHz 00102 //setmodemregisters 00103 //0x1b, 0x03, 0x41, 0x60, 0x27, 0x52, 0x00, 0x07, 0x40, 0x0a, 0x1e, 0x80, 0x60, 0x13, 0xa9, 0x2c, 0x22, 0x3a = FSK_RB2_4FD36 00104 //0xc8, 0x03, 0x39, 0x20, 0x68, 0xdc, 0x00, 0x6b, 0x2a, 0x08, 0x2a, 0x80, 0x60, 0x13, 0xa9, 0x2c, 0x21, 0x08 = OOK,2.4, 335 00105 writereg(RF22_REG_1C_IF_FILTER_BANDWIDTH,0x2B); 00106 writereg(RF22_REG_1F_CLOCK_RECOVERY_GEARSHIFT_OVERRIDE,0x03); 00107 writereg(RF22_REG_20_CLOCK_RECOVERY_OVERSAMPLING_RATE,0x41); 00108 writereg(RF22_REG_21_CLOCK_RECOVERY_OFFSET2,0x60); 00109 writereg(RF22_REG_22_CLOCK_RECOVERY_OFFSET1,0x27); //updated 20 to 25 reg values from excel sheet for 1.2 Khz freq. deviation,fsk 00110 writereg(RF22_REG_23_CLOCK_RECOVERY_OFFSET0,0x52); 00111 writereg(RF22_REG_24_CLOCK_RECOVERY_TIMING_LOOP_GAIN1,0x00); 00112 writereg(RF22_REG_25_CLOCK_RECOVERY_TIMING_LOOP_GAIN0,0x51); 00113 /*writereg(RF22_REG_2C_OOK_COUNTER_VALUE_1,0x2a); 00114 writereg(RF22_REG_2D_OOK_COUNTER_VALUE_2,0x08);*/ //not required for fsk (OOK counter value) 00115 writereg(RF22_REG_2E_SLICER_PEAK_HOLD,0x1e); //?? 00116 writereg(RF22_REG_58,0x80); 00117 writereg(RF22_REG_69_AGC_OVERRIDE1,0x60); 00118 writereg(RF22_REG_6E_TX_DATA_RATE1,0x09); 00119 writereg(RF22_REG_6F_TX_DATA_RATE0,0xd5); 00120 writereg(RF22_REG_70_MODULATION_CONTROL1,0x2c); 00121 writereg(RF22_REG_71_MODULATION_CONTROL2,0x22);//ook = 0x21 //fsk = 0x22 00122 writereg(RF22_REG_72_FREQUENCY_DEVIATION,0x02); 00123 //set tx power 00124 writereg(RF22_REG_6D_TX_POWER,0x07); //20dbm 00125 writereg(RF22_REG_3E_PACKET_LENGTH,RX_DATA); //packet length 00126 00127 } 00128 int main() 00129 { 00130 wait(1); // wait for POR to complete //change the timing later 00131 cs=1; // chip must be deselected 00132 wait(1); //change the time later 00133 spi.format(8,0); 00134 spi.frequency(10000000); //10MHz SCLK 00135 if (readreg(RF22_REG_00_DEVICE_TYPE) == 0x08) pc.printf("spi connection valid\n"); 00136 else pc.printf("error in spi connection\n"); 00137 00138 init(); 00139 00140 //init complete 00141 pc.printf("init complete....\n"); 00142 00143 //******** 00144 00145 while(1)//pc.getc()=='r') 00146 { 00147 uint8_t data[255]; // for filling the received data 00148 int u=0,i=0; 00149 int bar = TIMES; 00150 //rf22.waitAvailable(); 00151 clearTxBuf(); 00152 clearRxBuf(); 00153 //setModeRx(); 00154 writereg(RF22_REG_07_OPERATING_MODE1,0x04);//rxon 00155 while((readreg(RF22_REG_04_INTERRUPT_STATUS2)& 0x10) != 0x10) ; 00156 //pc.printf("rssi?\n"); 00157 //preamble?? 00158 while(!(readreg(0x04)&0x40)) 00159 pc.printf("detecting preamble\n"); 00160 //checking syncword 00161 while(!(readreg(RF22_REG_04_INTERRUPT_STATUS2)& 0x80)) 00162 pc.printf("sync?\n"); 00163 //check for fifothreshold 00164 //while((readreg(0x03)& 0x10) != 0x10) 00165 // pc.printf("fifo1?\n"); 00166 while(u != RX_DATA)//fifo_thresh 00167 { 00168 pc.printf("1 \n"); 00169 if((RX_DATA - u) > TIMES) 00170 { 00171 //check for fifo_thresh 00172 while((readreg(RF22_REG_03_INTERRUPT_STATUS1)& 0x10) != 0x10) 00173 pc.printf("fifo2?\n"); 00174 bar = TIMES; 00175 //reading 00176 cs = 0; 00177 spi.write(0x7F); 00178 for(i=0; i<bar;i++){ 00179 data[u+i] = spi.write(0); 00180 //pc.printf("0x%X \n",data[u+i]); 00181 } 00182 u=u+i; 00183 pc.printf("u= %d \n",u); 00184 cs = 1; 00185 } 00186 else 00187 { 00188 pc.printf("2\n"); 00189 wait(0.15); 00190 bar = RX_DATA - u; 00191 //reading 00192 cs = 0; 00193 spi.write(0x7F); 00194 for(i=0; i<bar;i++){ 00195 data[u+i] = spi.write(0); 00196 //pc.printf("0x%X \n",data[u+i]); 00197 } 00198 u=u+i; 00199 cs = 1; 00200 pc.printf("u= %d \n",u); 00201 } 00202 } 00203 //packet valid?? 00204 while(!(readreg(RF22_REG_03_INTERRUPT_STATUS1)& 0x02)) 00205 pc.printf("checking if packet is valid\n"); 00206 00207 //while(1) 00208 // pc.printf("0x%X 0x%X *** ",readreg(0x03),readreg(0x04)); 00209 pc.printf("packet valid\n"); 00210 //4Breceived packet length 00211 //while(0x) 00212 00213 /*//Printing data 00214 for(int i=0; i<RX_DATA; i++) 00215 pc.printf("0x%X \n",data[i]); 00216 //for(int i = 0; i<12; i++) 00217 // pc.printf("%c ",data[i]); 00218 //while(!(readreg(0x04)&0x40)) 00219 //pc.printf("detecting preamble\n"); */ 00220 pc.printf("Received data:\n"); 00221 //for(int i=0;i<240;i++) pc.printf("0x%X",hk[i]); 00222 // converting uint_8 to bool 00223 bool shortbeacon[120]; 00224 for(int i = 0; i<120; i++) 00225 data[2*i] == 0xFF ? shortbeacon[i] = 1 :shortbeacon[i] = 0; 00226 /*for(int i = 0; i<120 ; i++) 00227 pc.printf(" %d \n",shortbeacon[i]);*/ 00228 00229 //converting bool to uint_8 00230 uint8_t s_beacon[15]; 00231 for(int i = 0, m =0 ; i < 15 ; i++ ) 00232 for(int n = 0; n < 8; n++,m++) 00233 { 00234 if(shortbeacon[m]) 00235 { 00236 s_beacon[i]<<=1; 00237 s_beacon[i] |= 0x01; 00238 } 00239 else 00240 s_beacon[i] <<= 1; 00241 } 00242 00243 00244 pc.printf("Call Sign : "); 00245 for(int i = 0; i<7 ; i++) 00246 pc.printf(" %X ",s_beacon[i]); 00247 00248 pc.printf("\n\nVoltage[0] : "); 00249 pc.printf(" 0x%X \n\n",s_beacon[7]); 00250 00251 pc.printf("AngularSpeed[0] : "); 00252 pc.printf(" 0x%X \n\n",s_beacon[8]); 00253 00254 pc.printf("AngularSpeed[1] : "); 00255 pc.printf(" 0x%X \n\n",s_beacon[9]); 00256 00257 pc.printf("SubsystemStatus[0] : "); 00258 pc.printf(" 0x%X \n\n",s_beacon[10]); 00259 00260 pc.printf("Temp[0] : "); 00261 pc.printf(" 0x%X \n\n",s_beacon[11]); 00262 00263 pc.printf("Temp[1] : "); 00264 pc.printf(" 0x%X \n\n",s_beacon[12]); 00265 00266 pc.printf("Temp[2] : "); 00267 pc.printf(" 0x%X \n\n",s_beacon[13]); 00268 00269 pc.printf("ErrorFlag[0] : "); 00270 pc.printf(" 0x%X \n\n",s_beacon[14]); 00271 pc.printf("received headers : \n"); 00272 pc.printf("header1 = 0x%X , header2 = 0x%X , header3 = 0x%X , header4 = 0x%X \n",readreg(0x47),readreg(0x48),readreg(0x49),readreg(0x4A)); 00273 } 00274 00275 }
Generated on Fri Jul 29 2022 11:37:06 by
1.7.2