lint code
This commit is contained in:
		
							parent
							
								
									f696673700
								
							
						
					
					
						commit
						b007b9cb60
					
				| @ -1,8 +1,256 @@ | ||||
| #include "flipper.h" | ||||
| #include "u8g2.h" | ||||
| #include <stdio.h> | ||||
| 
 | ||||
| #include "cc1101/cc1101.h" | ||||
| 
 | ||||
| #define MIN_DBM -120 | ||||
| #define STEP_DBM 10 | ||||
| #define RSSI_DELAY 600 //rssi delay in micro second
 | ||||
| 
 | ||||
| #define RSSI_THRESHOLD -60 | ||||
| 
 | ||||
| #define START_SUB_BAND 3 | ||||
| #define STOP_SUB_BAND 3 | ||||
| #define NUM_OF_SUB_BANDS 7 | ||||
| #define CAL_INT 20 //cal every 10 channels(every 1MHz)
 | ||||
| 
 | ||||
| //variables used to calculate rssi
 | ||||
| uint8_t rssi_dec; | ||||
| int16_t rssi_dBm; | ||||
| uint8_t rssi_offset[NUM_OF_SUB_BANDS] = {74, 74, 74, 74, 74, 74, 74}; | ||||
| 
 | ||||
| #define CHAN_SPA 0.05 //channel spacing
 | ||||
| 
 | ||||
| float base_freq[NUM_OF_SUB_BANDS] = {387, 399.8, 412.6, 425.4, 438.2, 451, 463.8}; | ||||
| //FREQ2,FREQ1,FREQ0
 | ||||
| uint8_t freqSettings[NUM_OF_SUB_BANDS][3] = { | ||||
|     {0x0E, 0xE2, 0x76}, //band0
 | ||||
|     {0x0F, 0x60, 0x76}, | ||||
|     {0x0F, 0xDE, 0x76}, //band1
 | ||||
|     {0x10, 0x5C, 0x76}, | ||||
|     {0x10, 0xDA, 0x76}, | ||||
|     {0x11, 0x58, 0x8F}, | ||||
|     {0x11, 0xD6, 0x8F}}; //band2
 | ||||
| //no change in TEST0 WHERE (>430.5MHz) one should change from TEST0=0x0B to 0x09
 | ||||
| uint16_t limitTest0Reg[NUM_OF_SUB_BANDS] = {256, 256, 256, 103, 0, 0, 0}; | ||||
| /* setting to use 50khz channel spacing whole band*****************************************/ | ||||
| 
 | ||||
| //int16_t rssiData[NUM_OF_SUB_BANDS][256];
 | ||||
| int16_t rssiTable[256]; | ||||
| uint16_t channelNumber[256]; | ||||
| uint8_t carrierSenseCounter = 0; //counter used to keep track on how many CS has been asserted
 | ||||
| 
 | ||||
| uint8_t firstChannel[NUM_OF_SUB_BANDS] = {0, 0, 0, 160, 0, 0, 0}; | ||||
| //stop channel in each subband
 | ||||
| uint8_t lastChannel[NUM_OF_SUB_BANDS] = {255, 255, 255, 180, 255, 255, 4}; | ||||
| //initialized to a value lower than the rssi threshold/ higher than channel number
 | ||||
| int16_t highRSSI[NUM_OF_SUB_BANDS] = | ||||
|     {MIN_DBM, MIN_DBM, MIN_DBM, MIN_DBM, MIN_DBM, MIN_DBM, MIN_DBM}; | ||||
| uint16_t selectedChannel[NUM_OF_SUB_BANDS] = {300, 300, 300, 300, 300, 300, 300}; | ||||
| 
 | ||||
| int8_t activeBand; //store subband that contains strongest signal
 | ||||
| uint16_t activeChannel; //
 | ||||
| 
 | ||||
| int16_t calRSSI(uint8_t rssi_dec, uint8_t rssiOffset) { | ||||
|     int16_t rssi; | ||||
| 
 | ||||
|     if(rssi_dec >= 128) { | ||||
|         rssi = (int16_t)((int16_t)(rssi_dec - 256) / 2) - rssiOffset; | ||||
|     } else { | ||||
|         rssi = (rssi_dec / 2) - rssiOffset; | ||||
|     } | ||||
| 
 | ||||
|     return rssi; | ||||
| } | ||||
| 
 | ||||
| void scanFreq(CC1101* cc1101) { | ||||
|     uint8_t calCounter; //to deterin when to calibrate
 | ||||
|     uint8_t subBand; | ||||
|     uint16_t channel; | ||||
|     uint16_t i; | ||||
| 
 | ||||
|     float freq; | ||||
| 
 | ||||
|     cc1101->SpiWriteReg(CC1101_MCSM0, 0x08); //disalbe FS_AUTOCAL
 | ||||
|     cc1101->SpiWriteReg(CC1101_AGCCTRL2, 0x43 | 0x0C); //MAX_DVGA_GAIN to 11 for fast rssi
 | ||||
|     cc1101->SpiWriteReg(CC1101_AGCCTRL0, 0xB0); //max AGC WAIT_TIME; 0 filter_length
 | ||||
|     cc1101->SetMod(GFSK); //set to GFSK for fast rssi measurement | +8 is dcfilter off
 | ||||
| 
 | ||||
|     // 1) loop through all sub bands
 | ||||
|     for(subBand = START_SUB_BAND; subBand < STOP_SUB_BAND + 1; subBand++) { | ||||
|         //1.1) set subBands freq by FREQ2, FREQ1, FREQ0
 | ||||
|         cc1101->SetFreq( | ||||
|             freqSettings[subBand][0], freqSettings[subBand][1], freqSettings[subBand][2]); | ||||
|         //1.2) set TEST0--maybe!
 | ||||
|         //1.3) reset calibration counter
 | ||||
|         calCounter = 0; | ||||
|         // 1.4) loop throuhg all channels
 | ||||
|         for(channel = firstChannel[subBand]; channel <= lastChannel[subBand]; channel++) { | ||||
|             uint8_t pktStatus; | ||||
|             //1.4.1) set channel register
 | ||||
|             cc1101->SetChannel(channel); | ||||
| 
 | ||||
|             //1.4.2)  set TEST0
 | ||||
|             if(channel == limitTest0Reg[subBand]) { | ||||
|                 //set test0 to 0x09
 | ||||
|                 cc1101->SpiWriteReg(CC1101_TEST0, 0x09); | ||||
|                 //set FSCAL2 to 0x2A to force VCO HIGH
 | ||||
|                 cc1101->SpiWriteReg(CC1101_FSCAL2, 0x2A); | ||||
|                 //clear calCounter to invoke mannual calibration
 | ||||
|                 calCounter = 0; | ||||
|             } | ||||
|             //1.4.3) calibrate every 1MHz
 | ||||
|             if(calCounter++ == 0) { | ||||
|                 //perform a manual calibration by issuing SCAL command
 | ||||
|                 cc1101->SpiStrobe(CC1101_SCAL); | ||||
|             } | ||||
|             //1.4.4) reset calCounter when 1MHz reached
 | ||||
|             if(calCounter == CAL_INT) { | ||||
|                 calCounter = 0; | ||||
|             } | ||||
|             // 1.4.5-6 enter rx mode
 | ||||
|             cc1101->SetReceive(); | ||||
|             //1.4.7 wait for RSSI to be valid: less than 1.5ms
 | ||||
|             delayMicroseconds(RSSI_DELAY); | ||||
|             // 1.4.8) read PKTSTATUS register while the radio is in RX state
 | ||||
|             pktStatus = cc1101->SpiReadStatus(CC1101_PKTSTATUS); | ||||
|             // 1.4.9) enter IDLE state by issuing a SIDLE command
 | ||||
|             cc1101->SpiStrobe(CC1101_SIDLE); | ||||
|             // 1.4.10) check if CS is assearted
 | ||||
|             // //read rssi value and converto to dBm form
 | ||||
|             rssi_dec = (uint8_t)cc1101->SpiReadStatus(CC1101_RSSI); | ||||
|             rssi_dBm = calRSSI(rssi_dec, rssi_offset[subBand]); | ||||
| 
 | ||||
|             //rssiData[subBand][channel]=rssi_dBm;
 | ||||
|             if(pktStatus & 0x40) { //CS assearted
 | ||||
|                 //store rssi value and corresponding channel number
 | ||||
|                 rssiTable[carrierSenseCounter] = rssi_dBm; | ||||
|                 channelNumber[carrierSenseCounter] = channel; | ||||
|                 carrierSenseCounter++; | ||||
|             } | ||||
| 
 | ||||
| #ifdef CC1101_DEBUG | ||||
|             printf("rssi_dBm: %d\n", rssi_dBm); | ||||
| #endif | ||||
|         } //end channel lop
 | ||||
| 
 | ||||
|         //1.5)before moving to next sub band, scan through rssiTable to find highest rssi value
 | ||||
|         for(i = 0; i < carrierSenseCounter; i++) { | ||||
|             if(rssiTable[i] > highRSSI[subBand]) { | ||||
|                 highRSSI[subBand] = rssiTable[i]; | ||||
|                 selectedChannel[subBand] = channelNumber[i]; | ||||
|             } | ||||
|         } | ||||
|         // Serial.print("subBand:------------------>");
 | ||||
|         // Serial.println(subBand);
 | ||||
|         // Serial.print("selectedChannel:");
 | ||||
|         // Serial.println(selectedChannel[subBand]);
 | ||||
|         // Serial.print("highRSSI:");
 | ||||
|         // Serial.println(highRSSI[subBand]);
 | ||||
| 
 | ||||
|         //1.6) reset carrierSenseCounter
 | ||||
|         carrierSenseCounter = 0; | ||||
|     } // end band loop
 | ||||
| 
 | ||||
|     //2) when all sub bands has been scanned , find best subband and channel
 | ||||
|     int16_t tempRssi = MIN_DBM; | ||||
|     for(subBand = 0; subBand < NUM_OF_SUB_BANDS; subBand++) { | ||||
|         if(highRSSI[subBand] > tempRssi) { | ||||
|             tempRssi = highRSSI[subBand]; | ||||
|             activeChannel = selectedChannel[subBand]; | ||||
|             activeBand = subBand; | ||||
|         } | ||||
|     } | ||||
| 
 | ||||
|     // printf("activeBand:**********> %d, activeChannel %d,\n", activeBand, activeChannel);
 | ||||
| 
 | ||||
|     cc1101->SpiWriteReg(CC1101_MCSM0, 0x18); //enable FS_AUTOCAL
 | ||||
|     cc1101->SpiWriteReg(CC1101_AGCCTRL2, 0x43); //back to recommended config
 | ||||
|     cc1101->SpiWriteReg(CC1101_AGCCTRL0, 0x91); //back to recommended config
 | ||||
| } | ||||
| 
 | ||||
| void jamming(CC1101* cc1101, uint8_t band, uint16_t channel, uint16_t miniSec) { | ||||
|     cc1101->SetFreq(freqSettings[band][0], freqSettings[band][1], freqSettings[band][2]); | ||||
|     cc1101->SetChannel(channel); | ||||
|     // digitalWrite(19,0);
 | ||||
|     cc1101->SetTransmit(); | ||||
|     delay(miniSec); | ||||
| 
 | ||||
|     cc1101->SpiStrobe(CC1101_SIDLE); | ||||
| } | ||||
| 
 | ||||
| extern QueueHandle_t event_queue; | ||||
| 
 | ||||
| bool jamm_on = false; | ||||
| 
 | ||||
| void set_jam(bool state) { | ||||
|     jamm_on = state; | ||||
| } | ||||
| 
 | ||||
| extern "C" void radio() { | ||||
|     CC1101 cc1101(SS_PIN, GDO0, GDO2); | ||||
| 
 | ||||
|     uint8_t address = cc1101.Init(); | ||||
| 
 | ||||
|     if(address > 0) { | ||||
|         printf("CC1101 init done: %d\n", address); | ||||
|     } else { | ||||
|         printf("CC1101 init fail\n"); | ||||
|     } | ||||
| 
 | ||||
|     /* setting to use 50khz channel spacing**************************************/ | ||||
|     cc1101.SpiWriteReg( | ||||
|         CC1101_MDMCFG4, 0xCD); // RX filter bandwidth 58.035714(0xFD) 100k(0xCD) 200k(0x8D)
 | ||||
|     cc1101.SpiWriteReg( | ||||
|         CC1101_MDMCFG3, 0x3B); //datarate config 250kBaud  for the purpose of fast rssi measurement
 | ||||
|     cc1101.SpiWriteReg(CC1101_MDMCFG1, 0x20); //FEC preamble etc. last 2 bits for channel spacing
 | ||||
|     cc1101.SpiWriteReg(CC1101_MDMCFG0, 0xF8); //50khz channel spacing
 | ||||
| 
 | ||||
|     Event event; | ||||
|     event.type = EventTypeRadio; | ||||
| 
 | ||||
|     while(1) { | ||||
|         for(uint8_t i = 0; i <= NUM_OF_SUB_BANDS; i++) { | ||||
|             highRSSI[i] = MIN_DBM; | ||||
|         } | ||||
| 
 | ||||
|         activeChannel = 300; | ||||
| 
 | ||||
|         scanFreq(&cc1101); | ||||
| 
 | ||||
|         if(activeChannel < 256 && highRSSI[activeBand] > RSSI_THRESHOLD) { | ||||
|             float freq = base_freq[activeBand] + CHAN_SPA * activeChannel; | ||||
| 
 | ||||
|             /*
 | ||||
|             printf( | ||||
|                 "channel: %d, freq: %d, RSSI: %d\n", | ||||
|                 activeChannel, | ||||
|                 (uint32_t)(freq * 1000), | ||||
|                 highRSSI[activeBand] | ||||
|             ); | ||||
|             */ | ||||
| 
 | ||||
|             event.value.radio.freq = freq; | ||||
|             event.value.radio.rssi_db = highRSSI[activeBand]; | ||||
|             xQueueSend(event_queue, (void*)&event, 0); | ||||
| 
 | ||||
|             if(jamm_on) { | ||||
|                 jamming(&cc1101, activeBand, activeChannel, 500); | ||||
|             } else { | ||||
|                 osDelay(1000); | ||||
|             } | ||||
|         } else { | ||||
|             // printf("0 carrier sensed\n");
 | ||||
|         } | ||||
| 
 | ||||
|         osDelay(1); | ||||
|     } | ||||
| } | ||||
| 
 | ||||
| void cc1101_workaround(void* p) { | ||||
|     FuriRecordSubscriber* fb_record = furi_open_deprecated("u8g2_fb", false, false, NULL, NULL, NULL); | ||||
|     FuriRecordSubscriber* fb_record = | ||||
|         furi_open_deprecated("u8g2_fb", false, false, NULL, NULL, NULL); | ||||
| 
 | ||||
|     if(fb_record == NULL) { | ||||
|         printf("[cc1101] cannot create fb record\n"); | ||||
|  | ||||
| @ -49,7 +49,8 @@ void fatfs_list(void* p) { | ||||
| 
 | ||||
|     furi_log = get_default_log(); | ||||
| 
 | ||||
|     FuriRecordSubscriber* fb_record = furi_open_deprecated("u8g2_fb", false, false, NULL, NULL, NULL); | ||||
|     FuriRecordSubscriber* fb_record = | ||||
|         furi_open_deprecated("u8g2_fb", false, false, NULL, NULL, NULL); | ||||
|     if(fb_record == NULL) { | ||||
|         fuprintf(furi_log, "[widget][fatfs_list] cannot create fb record\n"); | ||||
|         furiac_exit(NULL); | ||||
|  | ||||
| @ -5,7 +5,8 @@ void u8g2_example(void* p) { | ||||
|     FuriRecordSubscriber* log = get_default_log(); | ||||
| 
 | ||||
|     // open record
 | ||||
|     FuriRecordSubscriber* fb_record = furi_open_deprecated("u8g2_fb", false, false, NULL, NULL, NULL); | ||||
|     FuriRecordSubscriber* fb_record = | ||||
|         furi_open_deprecated("u8g2_fb", false, false, NULL, NULL, NULL); | ||||
| 
 | ||||
|     if(fb_record == NULL) { | ||||
|         fuprintf(log, "[widget] cannot create fb record\n"); | ||||
|  | ||||
| @ -14,7 +14,8 @@ void u8g2_qrcode(void* p) { | ||||
|     FuriRecordSubscriber* log = get_default_log(); | ||||
| 
 | ||||
|     // open record
 | ||||
|     FuriRecordSubscriber* fb_record = furi_open_deprecated("u8g2_fb", false, false, NULL, NULL, NULL); | ||||
|     FuriRecordSubscriber* fb_record = | ||||
|         furi_open_deprecated("u8g2_fb", false, false, NULL, NULL, NULL); | ||||
| 
 | ||||
|     // Allocate a chunk of memory to store the QR code
 | ||||
|     // https://github.com/ricmoo/QRCode
 | ||||
|  | ||||
| @ -72,7 +72,9 @@ const FlipperStartupApp FLIPPER_STARTUP[] = { | ||||
| #endif | ||||
| 
 | ||||
| #ifdef APP_CC1101 | ||||
|     {.app = cc1101_workaround, .name = "cc1101_workaround", .libs = {2, FURI_LIB{"display_u8g2", "input_task"}}}, | ||||
|     {.app = cc1101_workaround, | ||||
|      .name = "cc1101_workaround", | ||||
|      .libs = {2, FURI_LIB{"display_u8g2", "input_task"}}}, | ||||
| #endif | ||||
| 
 | ||||
| }; | ||||
|  | ||||
| @ -39,7 +39,6 @@ void test_furi_valuemutex() { | ||||
|     //read mutex blocking case
 | ||||
| } | ||||
| 
 | ||||
| 
 | ||||
| /*
 | ||||
| TEST: concurrent access | ||||
| 
 | ||||
|  | ||||
| @ -67,7 +67,6 @@ MU_TEST_SUITE(test_suite) { | ||||
|     MU_RUN_TEST(mu_test_furi_create_open); | ||||
|     MU_RUN_TEST(mu_test_furi_valuemutex); | ||||
|     MU_RUN_TEST(mu_test_furi_concurrent_access); | ||||
| 
 | ||||
| } | ||||
| 
 | ||||
| int run_minunit() { | ||||
|  | ||||
| @ -12,15 +12,10 @@ void COPY_COMPOSE(void* ctx, void* state) { | ||||
|     read_mutex((ValueMutex*)ctx, state, 0); | ||||
| } | ||||
| 
 | ||||
| typedef enum { | ||||
|     UiLayerBelowNotify | ||||
|     UiLayerNotify, | ||||
|     UiLayerAboveNotify | ||||
| } UiLayer; | ||||
| typedef enum { UiLayerBelowNotify UiLayerNotify, UiLayerAboveNotify } UiLayer; | ||||
| 
 | ||||
| ValueComposerHandle* add_compose_layer( | ||||
|     ValueComposer* composer, ValueComposerCallback cb, void* ctx, uint32_t layer | ||||
| ); | ||||
| ValueComposerHandle* | ||||
| add_compose_layer(ValueComposer* composer, ValueComposerCallback cb, void* ctx, uint32_t layer); | ||||
| 
 | ||||
| bool remove_compose_layer(ValueComposerHandle* handle); | ||||
| 
 | ||||
| @ -44,7 +39,6 @@ typedef struct { | ||||
|     PubSub pubsub; | ||||
| } ValueManager; | ||||
| 
 | ||||
| 
 | ||||
| /*
 | ||||
| acquire value, changes it and send notify with current value. | ||||
| */ | ||||
|  | ||||
| @ -17,13 +17,17 @@ For transmit/receive data use `spi_xfer` function. | ||||
| */ | ||||
| bool spi_xfer( | ||||
|     SPI_HandleTypeDef* spi, | ||||
|     uint8_t* tx_data, uint8_t* rx_data, size_t len, | ||||
|     PubSubCallback cb, void* ctx); | ||||
|     uint8_t* tx_data, | ||||
|     uint8_t* rx_data, | ||||
|     size_t len, | ||||
|     PubSubCallback cb, | ||||
|     void* ctx); | ||||
| 
 | ||||
| /*
 | ||||
| Blocking verison: | ||||
| */ | ||||
| static inline bool spi_xfer_block(SPI_HandleTypeDef* spi, uint8_t* tx_data, uint8_t* rx_data, size_t len) { | ||||
| static inline bool | ||||
| spi_xfer_block(SPI_HandleTypeDef* spi, uint8_t* tx_data, uint8_t* rx_data, size_t len) { | ||||
|     semaphoreInfo s; | ||||
|     osSemaphore block = createSemaphoreStatic(s); | ||||
|     if(!spi_xfer(spi, tx_data, rx_data, len, RELEASE_SEMAPHORE, (void*)block)) { | ||||
| @ -52,15 +56,15 @@ typedef struct { | ||||
|     ValueMutex* bus; ///< <SpiBus*>
 | ||||
| } SpiDevice; | ||||
| 
 | ||||
| ## SPI IRQ device | ||||
| ##SPI IRQ device | ||||
| 
 | ||||
| /*
 | ||||
|     /*
 | ||||
| Many devices (like CC1101 and NFC) present as SPI bus and IRQ line. | ||||
| For work with it there is special entity `SpiIrqDevice`. | ||||
| Use `subscribe_pubsub` for subscribinq to irq events. | ||||
| */ | ||||
| 
 | ||||
| typedef struct { | ||||
|     typedef struct { | ||||
|     ValueMutex* bus; ///< <SpiBus*>
 | ||||
|     PubSub* irq; | ||||
| } SpiIrqDevice; | ||||
| @ -75,7 +79,6 @@ typedef struct { | ||||
|     ValueMutex* spi; ///< <SPI_HandleTypeDef*>
 | ||||
| } DisplayBus; | ||||
| 
 | ||||
| 
 | ||||
| typedef struct { | ||||
|     ValueMutex* bus; ///< <DisplayBus*>
 | ||||
| } DisplayDevice; | ||||
|  | ||||
		Loading…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user
	 aanper
						aanper