123
Dependencies: mbed Grove_LCD_RGB_Backlight SX1272Lib
Diff: main.cpp
- Revision:
- 0:cc2b234b6255
- Child:
- 1:30ce00fbab55
diff -r 000000000000 -r cc2b234b6255 main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Wed May 11 14:56:17 2022 +0000 @@ -0,0 +1,449 @@ +#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" ); +}