![](/media/cache/profiles/99E6D37B-BF62-4ED2-8CD4-003BF68D83CE.jpeg.50x50_q85.jpg)
123
Dependencies: mbed Grove_LCD_RGB_Backlight SX1272Lib
main.cpp
- Committer:
- aizakharov
- Date:
- 2022-05-11
- Revision:
- 0:cc2b234b6255
- Child:
- 1:30ce00fbab55
File content as of revision 0:cc2b234b6255:
#include "mbed.h" #include "main.h" #include "sx1272-hal.h" #include "debug.h" #include "Grove_LCD_RGB_Backlight.h" /* Set this flag to '1' to display debug messages on the console */ #define DEBUG_MESSAGE 1 /* Set this flag to '1' to use the LoRa modulation or to '0' to use FSK modulation */ #define USE_MODEM_LORA 1 #define USE_MODEM_FSK !USE_MODEM_LORA #define RF_FREQUENCY 868000000 // Hz #define TX_OUTPUT_POWER 14 // 14 dBm #if USE_MODEM_LORA == 1 #define LORA_BANDWIDTH 2 // [0: 125 kHz, // 1: 250 kHz, // 2: 500 kHz, // 3: Reserved] #define LORA_SPREADING_FACTOR 7 // [SF7..SF12] #define LORA_CODINGRATE 1 // [1: 4/5, // 2: 4/6, // 3: 4/7, // 4: 4/8] #define LORA_PREAMBLE_LENGTH 8 // Same for Tx and Rx #define LORA_SYMBOL_TIMEOUT 5 // Symbols #define LORA_FIX_LENGTH_PAYLOAD_ON false #define LORA_FHSS_ENABLED false #define LORA_NB_SYMB_HOP 4 #define LORA_IQ_INVERSION_ON false #define LORA_CRC_ENABLED true #elif USE_MODEM_FSK == 1 #define FSK_FDEV 25000 // Hz #define FSK_DATARATE 19200 // bps #define FSK_BANDWIDTH 50000 // Hz #define FSK_AFC_BANDWIDTH 83333 // Hz #define FSK_PREAMBLE_LENGTH 5 // Same for Tx and Rx #define FSK_FIX_LENGTH_PAYLOAD_ON false #define FSK_CRC_ENABLED true #else #error "Please define a modem in the compiler options." #endif #define RX_TIMEOUT_VALUE 35000 // in ms #define BUFFER_SIZE 60 // Define the payload size here #if( defined ( TARGET_KL25Z ) || defined ( TARGET_LPC11U6X ) ) DigitalOut led( LED2 ); #else DigitalOut led( LED1 ); #endif Serial pc(USBTX, USBRX); // tx, rx AnalogIn voltage(PC_5); AnalogIn current(A1); Ticker measure; Ticker lcd_print; Ticker send; Grove_LCD_RGB_Backlight lcd(I2C_SDA, I2C_SCL); //Grove_LCD_RGB_Backlight rgbLCD(I2C_SDA, I2C_SCL); /* * Global variables declarations */ typedef enum { LOWPOWER = 0, IDLE, RX, RX_TIMEOUT, RX_ERROR, TX, TX_TIMEOUT, CAD, CAD_DONE }AppStates_t; volatile AppStates_t State = LOWPOWER; /*! * Radio events function pointer */ static RadioEvents_t RadioEvents; /* * Global variables declarations */ SX1272MB2xAS Radio( NULL ); //const uint8_t Msg[]; uint16_t BufferSize = BUFFER_SIZE; uint8_t Buffer[BUFFER_SIZE]; int16_t RssiValue = 0.0; int8_t SnrValue = 0.0; //float measured_sinus = 0.0; int16_t j = 0; float voltage_sinus[200], current_sinus[200]; volatile float Vsum = 0,Vmax =0, Vmean = 0, Imax =0, Isum = 0, Imean = 0, P = 0, Ud = 0, U = 0, Id = 0, I = 0; uint16_t strSize = 0; char str[BUFFER_SIZE]; char monitor[20]="0", monitor1[20]="0"; void meas (void) { if (j>=200) { j = 0; Vmean=Vsum/(200); Imean = Isum/(200); Vsum=0; Isum=0; Ud=(Vmax-Vmean)/1.41; Id=(Imax-Imean)/1.41; Vsum = 0; Isum = 0; U = 0; I = 0; Vmax = 0; Imax = 0; } voltage_sinus[j] = voltage*2200; current_sinus[j] = current*5; if (voltage_sinus[j]>Vmax) Vmax=voltage_sinus[j]; if (current_sinus[j]>Imax) Imax=current_sinus[j]; P=P+(((voltage_sinus[j]-Vmean)*(current_sinus[j]-Imean))*(0.0002/3600000)); Vsum+=voltage_sinus[j]; Isum+=current_sinus[j]; j++; } int main( void ) { uint16_t count = 0; //uint8_t i; //bool isMaster = true; debug( "\n\n\r SX1272 Ping Pong Demo Application \n\n\r" ); // Initialize Radio driver RadioEvents.TxDone = OnTxDone; RadioEvents.RxDone = OnRxDone; RadioEvents.RxError = OnRxError; RadioEvents.TxTimeout = OnTxTimeout; RadioEvents.RxTimeout = OnRxTimeout; Radio.Init( &RadioEvents ); // verify the connection with the board while( Radio.Read( REG_VERSION ) == 0x00 ) { debug( "Radio could not be detected!\n\r", NULL ); wait( 1 ); } debug_if( ( DEBUG_MESSAGE & ( Radio.DetectBoardType( ) == SX1272MB2XAS ) ), "\n\r > Board Type: SX1272MB2xAS < \n\r" ); Radio.SetChannel( RF_FREQUENCY ); #if USE_MODEM_LORA == 1 debug_if( LORA_FHSS_ENABLED, "\n\n\r > LORA FHSS Mode < \n\n\r" ); debug_if( !LORA_FHSS_ENABLED, "\n\n\r > LORA Mode < \n\n\r" ); Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, LORA_CODINGRATE, LORA_PREAMBLE_LENGTH, LORA_FIX_LENGTH_PAYLOAD_ON, LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP, LORA_IQ_INVERSION_ON, 2000 ); Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH, LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, 0, LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP, LORA_IQ_INVERSION_ON, true ); #elif USE_MODEM_FSK == 1 debug("\n\n\r > FSK Mode < \n\n\r" ); Radio.SetTxConfig( MODEM_FSK, TX_OUTPUT_POWER, FSK_FDEV, 0, FSK_DATARATE, 0, FSK_PREAMBLE_LENGTH, FSK_FIX_LENGTH_PAYLOAD_ON, FSK_CRC_ENABLED, 0, 0, 0, 2000 ); Radio.SetRxConfig( MODEM_FSK, FSK_BANDWIDTH, FSK_DATARATE, 0, FSK_AFC_BANDWIDTH, FSK_PREAMBLE_LENGTH, 0, FSK_FIX_LENGTH_PAYLOAD_ON, 0, FSK_CRC_ENABLED, 0, 0, false, true ); #else #error "Please define a modem in the compiler options." #endif //debug_if( DEBUG_MESSAGE, "Starting Ping-Pong loop\r\n" ); led = 0; //Radio.Rx( RX_TIMEOUT_VALUE ); //int n = 0; measure.attach_us(&meas, 200); while( 1 ) { count++; if(count>=30) { strSize = sprintf ( str, "U=%3.0fV, I=%3.2fA, W=%10.4fkWh", Ud, Id, P); State = TX; } lcd.setRGB(0, 255, 0); sprintf(monitor, "U=%3.0fV, I=%3.2fA", Ud, Id); sprintf(monitor1, "P=%10.4f kWh", P); // Print a message to the LCD. lcd.locate(0, 0); lcd.print(monitor); lcd.locate(0, 1); lcd.print(monitor1); switch( State ) { case RX: /*if( isMaster == true ) { if( BufferSize > 0 ) { if( strncmp( ( const char* )Buffer, ( const char* )PongMsg, 4 ) == 0 ) { led = !led; debug( "...Pong\r\n" ); // Send the next PING frame strcpy( ( char* )Buffer, ( char* )PingMsg ); // We fill the buffer with numbers for the payload for( i = 4; i < BufferSize; i++ ) { Buffer[i] = i - 4; } wait_ms( 10 ); Radio.Send( Buffer, BufferSize ); } else if( strncmp( ( const char* )Buffer, ( const char* )PingMsg, 4 ) == 0 ) { // A master already exists then become a slave debug( "...Ping\r\n" ); led = !led; isMaster = false; // Send the next PONG frame strcpy( ( char* )Buffer, ( char* )PongMsg ); // We fill the buffer with numbers for the payload for( i = 4; i < BufferSize; i++ ) { Buffer[i] = i - 4; } wait_ms( 10 ); Radio.Send( Buffer, BufferSize ); } else // valid reception but neither a PING or a PONG message { // Set device as master ans start again isMaster = true; Radio.Rx( RX_TIMEOUT_VALUE ); } } } else { if( BufferSize > 0 ) { if( strncmp( ( const char* )Buffer, ( const char* )PingMsg, 4 ) == 0 ) { led = !led; debug( "...Ping\r\n" ); // Send the reply to the PING string strcpy( ( char* )Buffer, ( char* )PongMsg ); // We fill the buffer with numbers for the payload for( i = 4; i < BufferSize; i++ ) { Buffer[i] = i - 4; } wait_ms( 10 ); Radio.Send( Buffer, BufferSize ); } else // valid reception but not a PING as expected { // Set device as master and start again isMaster = true; Radio.Rx( RX_TIMEOUT_VALUE ); } } }*/ //Radio.Rx( RX_TIMEOUT_VALUE ); State = LOWPOWER; break; case TX: strcpy(( char* )Buffer, ( char* ) str); /*led = !led; if( isMaster == true ) { debug( "Ping...\r\n" ); } else { debug( "Pong...\r\n" ); }*/ /*for( i = strSize; i < BufferSize; i++ ) { Buffer[i] = i - strSize; }*/ wait_ms( 10 ); Radio.Send( Buffer, BUFFER_SIZE ); //Radio.Rx( RX_TIMEOUT_VALUE ); State = LOWPOWER; break; case RX_TIMEOUT: /*if( isMaster == true ) { // Send the next PING frame strcpy( ( char* )Buffer, ( char* )PingMsg ); for( i = 4; i < BufferSize; i++ ) { Buffer[i] = i - 4; } wait_ms( 10 ); Radio.Send( Buffer, BufferSize ); } else { Radio.Rx( RX_TIMEOUT_VALUE ); }*/ Radio.Rx( RX_TIMEOUT_VALUE ); State = LOWPOWER; break; case RX_ERROR: // We have received a Packet with a CRC error, send reply as if packet was correct /*if( isMaster == true ) { // Send the next PING frame strcpy( ( char* )Buffer, ( char* )PingMsg ); for( i = 4; i < BufferSize; i++ ) { Buffer[i] = i - 4; } wait_ms( 10 ); Radio.Send( Buffer, BufferSize ); } else { // Send the next PONG frame strcpy( ( char* )Buffer, ( char* )PongMsg ); for( i = 4; i < BufferSize; i++ ) { Buffer[i] = i - 4; } wait_ms( 10 ); Radio.Send( Buffer, BufferSize ); }*/ //Radio.Rx( RX_TIMEOUT_VALUE ); State = LOWPOWER; break; case TX_TIMEOUT: //Radio.Rx( RX_TIMEOUT_VALUE ); State = LOWPOWER; break; case LOWPOWER: break; default: State = LOWPOWER; break; } wait(1); } } void OnTxDone( void ) { Radio.Sleep( ); State = TX; debug_if( DEBUG_MESSAGE, "\r\n> OnTxDone\n\r" ); } void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr ) { Radio.Sleep( ); BufferSize = size; memcpy( Buffer, payload, BufferSize ); RssiValue = rssi; SnrValue = snr; State = RX; debug_if( DEBUG_MESSAGE, "\r\n> OnRxDone\n\r" ); } void OnTxTimeout( void ) { Radio.Sleep( ); State = TX_TIMEOUT; debug_if( DEBUG_MESSAGE, "\r\n> OnTxTimeout\n\r" ); } void OnRxTimeout( void ) { Radio.Sleep( ); Buffer[BufferSize] = 0; State = RX_TIMEOUT; debug_if( DEBUG_MESSAGE, "\r\n> OnRxTimeout\n\r" ); } void OnRxError( void ) { Radio.Sleep( ); State = RX_ERROR; debug_if( DEBUG_MESSAGE, "\r\n> OnRxError\n\r" ); }