123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606 |
- #include <string.h>
- #include <math.h>
- #include "platform.h"
- #if defined( USE_SX1276_RADIO )
- #include "radio.h"
- #include "sx1276-Hal.h"
- #include "sx1276.h"
- #include "sx1276-FskMisc.h"
- #include "sx1276-Fsk.h"
- tFskSettings FskSettings =
- {
- 870000000,
- 9600,
- 50000,
- 20,
- 100000,
- 150000,
- true,
- true,
- 255
- };
- tSX1276* SX1276;
- static uint8_t RFBuffer[RF_BUFFER_SIZE];
- static uint8_t DataChunkSize = 32;
- static uint8_t RFState = RF_STATE_IDLE;
- static uint32_t PacketTimeout;
- static uint32_t Preamble2SyncTimeout;
- static bool PreambleDetected = false;
- static bool SyncWordDetected = false;
- static bool PacketDetected = false;
- static uint16_t RxPacketSize = 0;
- static uint8_t RxBytesRead = 0;
- static uint8_t TxBytesSent = 0;
- static double RxPacketRssiValue;
- static uint32_t RxPacketAfcValue;
- static uint8_t RxGain = 1;
- static uint32_t RxTimeoutTimer = 0;
- static uint32_t Preamble2SyncTimer = 0;
- static uint16_t TxPacketSize = 0;
- static uint32_t TxTimeoutTimer = 0;
- void SX1276FskInit( void )
- {
- RFState = RF_STATE_IDLE;
- SX1276FskSetDefaults( );
-
- SX1276ReadBuffer( REG_OPMODE, SX1276Regs + 1, 0x70 - 1 );
-
- SX1276->RegOpMode = RF_OPMODE_MODULATIONTYPE_FSK | RF_OPMODE_SLEEP;
- SX1276Write( REG_OPMODE, SX1276->RegOpMode );
- SX1276->RegPaRamp = RF_PARAMP_MODULATIONSHAPING_01;
- SX1276Write( REG_PARAMP, SX1276->RegPaRamp );
- SX1276->RegLna = RF_LNA_GAIN_G1;
- SX1276Write( REG_LNA, SX1276->RegLna );
- if( FskSettings.AfcOn == true )
- {
- SX1276->RegRxConfig = RF_RXCONFIG_RESTARTRXONCOLLISION_OFF | RF_RXCONFIG_AFCAUTO_ON |
- RF_RXCONFIG_AGCAUTO_ON | RF_RXCONFIG_RXTRIGER_PREAMBLEDETECT;
- }
- else
- {
- SX1276->RegRxConfig = RF_RXCONFIG_RESTARTRXONCOLLISION_OFF | RF_RXCONFIG_AFCAUTO_OFF |
- RF_RXCONFIG_AGCAUTO_ON | RF_RXCONFIG_RXTRIGER_PREAMBLEDETECT;
- }
- SX1276->RegPreambleLsb = 8;
-
- SX1276->RegPreambleDetect = RF_PREAMBLEDETECT_DETECTOR_ON | RF_PREAMBLEDETECT_DETECTORSIZE_2 |
- RF_PREAMBLEDETECT_DETECTORTOL_10;
- SX1276->RegRssiThresh = 0xFF;
- SX1276->RegSyncConfig = RF_SYNCCONFIG_AUTORESTARTRXMODE_WAITPLL_ON | RF_SYNCCONFIG_PREAMBLEPOLARITY_AA |
- RF_SYNCCONFIG_SYNC_ON |
- RF_SYNCCONFIG_SYNCSIZE_4;
- SX1276->RegSyncValue1 = 0x69;
- SX1276->RegSyncValue2 = 0x81;
- SX1276->RegSyncValue3 = 0x7E;
- SX1276->RegSyncValue4 = 0x96;
- SX1276->RegPacketConfig1 = RF_PACKETCONFIG1_PACKETFORMAT_VARIABLE | RF_PACKETCONFIG1_DCFREE_OFF |
- ( FskSettings.CrcOn << 4 ) | RF_PACKETCONFIG1_CRCAUTOCLEAR_ON |
- RF_PACKETCONFIG1_ADDRSFILTERING_OFF | RF_PACKETCONFIG1_CRCWHITENINGTYPE_CCITT;
- SX1276FskGetPacketCrcOn( );
- SX1276->RegPayloadLength = FskSettings.PayloadLength;
-
- SX1276WriteBuffer( REG_OPMODE, SX1276Regs + 1, 0x70 - 1 );
-
- SX1276FskSetRFFrequency( FskSettings.RFFrequency );
- SX1276FskSetBitrate( FskSettings.Bitrate );
- SX1276FskSetFdev( FskSettings.Fdev );
- SX1276FskSetDccBw( &SX1276->RegRxBw, 0, FskSettings.RxBw );
- SX1276FskSetDccBw( &SX1276->RegAfcBw, 0, FskSettings.RxBwAfc );
- SX1276FskSetRssiOffset( 0 );
- #if( ( MODULE_SX1276RF1IAS == 1 ) || ( MODULE_SX1276RF1KAS == 1 ) )
- if( FskSettings.RFFrequency > 860000000 )
- {
- SX1276FskSetPAOutput( RF_PACONFIG_PASELECT_RFO );
- SX1276FskSetPa20dBm( false );
- FskSettings.Power = 14;
- SX1276FskSetRFPower( FskSettings.Power );
- }
- else
- {
- SX1276FskSetPAOutput( RF_PACONFIG_PASELECT_PABOOST );
- SX1276FskSetPa20dBm( true );
- FskSettings.Power = 20;
- SX1276FskSetRFPower( FskSettings.Power );
- }
- #elif( MODULE_SX1276RF1JAS == 1 )
- if( FskSettings.RFFrequency > 860000000 )
- {
- SX1276FskSetPAOutput( RF_PACONFIG_PASELECT_PABOOST );
- SX1276FskSetPa20dBm( true );
- FskSettings.Power = 20;
- SX1276FskSetRFPower( FskSettings.Power );
- }
- else
- {
- SX1276FskSetPAOutput( RF_PACONFIG_PASELECT_RFO );
- SX1276FskSetPa20dBm( false );
- FskSettings.Power = 14;
- SX1276FskSetRFPower( FskSettings.Power );
- }
- #endif
- SX1276FskSetOpMode( RF_OPMODE_STANDBY );
-
- SX1276FskRxCalibrate( );
- }
- void SX1276FskSetDefaults( void )
- {
-
- SX1276Read( REG_VERSION, &SX1276->RegVersion );
- }
- void SX1276FskSetOpMode( uint8_t opMode )
- {
- static uint8_t opModePrev = RF_OPMODE_STANDBY;
- static bool antennaSwitchTxOnPrev = true;
- bool antennaSwitchTxOn = false;
- opModePrev = SX1276->RegOpMode & ~RF_OPMODE_MASK;
- if( opMode != opModePrev )
- {
- if( opMode == RF_OPMODE_TRANSMITTER )
- {
- antennaSwitchTxOn = true;
- }
- else
- {
- antennaSwitchTxOn = false;
- }
- if( antennaSwitchTxOn != antennaSwitchTxOnPrev )
- {
- antennaSwitchTxOnPrev = antennaSwitchTxOn;
- RXTX( antennaSwitchTxOn );
- }
- SX1276->RegOpMode = ( SX1276->RegOpMode & RF_OPMODE_MASK ) | opMode;
- SX1276Write( REG_OPMODE, SX1276->RegOpMode );
- }
- }
- uint8_t SX1276FskGetOpMode( void )
- {
- SX1276Read( REG_OPMODE, &SX1276->RegOpMode );
-
- return SX1276->RegOpMode & ~RF_OPMODE_MASK;
- }
- int32_t SX1276FskReadFei( void )
- {
- SX1276ReadBuffer( REG_FEIMSB, &SX1276->RegFeiMsb, 2 );
- return ( int32_t )( double )( ( ( uint16_t )SX1276->RegFeiMsb << 8 ) | ( uint16_t )SX1276->RegFeiLsb ) * ( double )FREQ_STEP;
- }
- int32_t SX1276FskReadAfc( void )
- {
- SX1276ReadBuffer( REG_AFCMSB, &SX1276->RegAfcMsb, 2 );
- return ( int32_t )( double )( ( ( uint16_t )SX1276->RegAfcMsb << 8 ) | ( uint16_t )SX1276->RegAfcLsb ) * ( double )FREQ_STEP;
- }
- uint8_t SX1276FskReadRxGain( void )
- {
- SX1276Read( REG_LNA, &SX1276->RegLna );
- return( SX1276->RegLna >> 5 ) & 0x07;
- }
- double SX1276FskReadRssi( void )
- {
- SX1276Read( REG_RSSIVALUE, &SX1276->RegRssiValue );
- return -( double )( ( double )SX1276->RegRssiValue / 2.0 );
- }
- uint8_t SX1276FskGetPacketRxGain( void )
- {
- return RxGain;
- }
- double SX1276FskGetPacketRssi( void )
- {
- return RxPacketRssiValue;
- }
- uint32_t SX1276FskGetPacketAfc( void )
- {
- return RxPacketAfcValue;
- }
- void SX1276FskStartRx( void )
- {
- SX1276FskSetRFState( RF_STATE_RX_INIT );
- }
- void SX1276FskGetRxPacket( void *buffer, uint16_t *size )
- {
- *size = RxPacketSize;
- RxPacketSize = 0;
- memcpy( ( void * )buffer, ( void * )RFBuffer, ( size_t )*size );
- }
- void SX1276FskSetTxPacket( const void *buffer, uint16_t size )
- {
- TxPacketSize = size;
- memcpy( ( void * )RFBuffer, buffer, ( size_t )TxPacketSize );
- RFState = RF_STATE_TX_INIT;
- }
- uint16_t SX1276FskGetPacketPayloadSize( void )
- {
- uint16_t syncSize;
- uint16_t variableSize;
- uint16_t addressSize;
- uint16_t payloadSize;
- uint16_t crcSize;
- syncSize = ( SX1276->RegSyncConfig & 0x07 ) + 1;
- variableSize = ( ( SX1276->RegPacketConfig1 & 0x80 ) == 0x80 ) ? 1 : 0;
- addressSize = ( ( SX1276->RegPacketConfig1 & 0x06 ) != 0x00 ) ? 1 : 0;
- payloadSize = SX1276->RegPayloadLength;
- crcSize = ( ( SX1276->RegPacketConfig1 & 0x10 ) == 0x10 ) ? 2 : 0;
-
- return syncSize + variableSize + addressSize + payloadSize + crcSize;
- }
- uint16_t SX1276FskGetPacketHeaderSize( void )
- {
- uint16_t preambleSize;
- uint16_t syncSize;
- preambleSize = ( ( uint16_t )SX1276->RegPreambleMsb << 8 ) | ( uint16_t )SX1276->RegPreambleLsb;
- syncSize = ( SX1276->RegSyncConfig & 0x07 ) + 1;
-
- return preambleSize + syncSize;
- }
- uint8_t SX1276FskGetRFState( void )
- {
- return RFState;
- }
- void SX1276FskSetRFState( uint8_t state )
- {
- RFState = state;
- }
- uint32_t SX1276FskProcess( void )
- {
- uint32_t result = RF_BUSY;
- switch( RFState )
- {
- case RF_STATE_IDLE:
- break;
-
- case RF_STATE_RX_INIT:
-
- if( ( SX1276->RegPacketConfig1 & RF_PACKETCONFIG1_CRC_ON ) == RF_PACKETCONFIG1_CRC_ON )
- {
-
- SX1276->RegDioMapping1 = RF_DIOMAPPING1_DIO0_01 | RF_DIOMAPPING1_DIO1_00 | RF_DIOMAPPING1_DIO2_11 | RF_DIOMAPPING1_DIO3_00;
- }
- else
- {
-
- SX1276->RegDioMapping1 = RF_DIOMAPPING1_DIO0_00 | RF_DIOMAPPING1_DIO1_00 | RF_DIOMAPPING1_DIO2_11 | RF_DIOMAPPING1_DIO3_00;
- }
-
- SX1276->RegDioMapping2 = RF_DIOMAPPING2_DIO4_11 | RF_DIOMAPPING2_DIO5_10 | RF_DIOMAPPING2_MAP_PREAMBLEDETECT;
- SX1276WriteBuffer( REG_DIOMAPPING1, &SX1276->RegDioMapping1, 2 );
- SX1276FskSetOpMode( RF_OPMODE_RECEIVER );
-
- memset( RFBuffer, 0, ( size_t )RF_BUFFER_SIZE );
- PacketTimeout = ( uint16_t )( round( ( 8.0 * ( ( double )SX1276FskGetPacketPayloadSize( ) ) / ( double )FskSettings.Bitrate ) * 1000.0 ) + 1.0 );
- PacketTimeout = PacketTimeout + ( PacketTimeout >> 1 );
- Preamble2SyncTimeout = PacketTimeout;
- Preamble2SyncTimer = RxTimeoutTimer = GET_TICK_COUNT( );
- SX1276->RegFifoThresh = RF_FIFOTHRESH_TXSTARTCONDITION_FIFONOTEMPTY | 0x20;
- SX1276Write( REG_FIFOTHRESH, SX1276->RegFifoThresh );
- PreambleDetected = false;
- SyncWordDetected = false;
- PacketDetected = false;
- RxBytesRead = 0;
- RxPacketSize = 0;
- RFState = RF_STATE_RX_SYNC;
- break;
- case RF_STATE_RX_SYNC:
- if( ( DIO4 == 1 ) && ( PreambleDetected == false ) )
- {
- PreambleDetected = true;
- Preamble2SyncTimer = GET_TICK_COUNT( );
- }
- if( ( DIO2 == 1 ) && ( PreambleDetected == true ) && ( SyncWordDetected == false ) )
- {
- SyncWordDetected = true;
-
- RxPacketRssiValue = SX1276FskReadRssi( );
- RxPacketAfcValue = SX1276FskReadAfc( );
- RxGain = SX1276FskReadRxGain( );
-
- Preamble2SyncTimer = RxTimeoutTimer = GET_TICK_COUNT( );
- RFState = RF_STATE_RX_RUNNING;
- }
-
- if( ( SyncWordDetected == false ) && ( PreambleDetected == true ) && ( ( GET_TICK_COUNT( ) - Preamble2SyncTimer ) > Preamble2SyncTimeout ) )
- {
- RFState = RF_STATE_RX_INIT;
- SX1276Write( REG_RXCONFIG, SX1276->RegRxConfig | RF_RXCONFIG_RESTARTRXWITHPLLLOCK );
- }
- if( ( SyncWordDetected == false ) &&
- ( PreambleDetected == false ) &&
- ( PacketDetected == false ) &&
- ( ( GET_TICK_COUNT( ) - RxTimeoutTimer ) > PacketTimeout ) )
- {
- RFState = RF_STATE_RX_TIMEOUT;
- }
- break;
- case RF_STATE_RX_RUNNING:
- if( RxPacketSize > RF_BUFFER_SIZE_MAX )
- {
- RFState = RF_STATE_RX_LEN_ERROR;
- break;
- }
- #if 1
- if( DIO1 == 1 )
- {
- if( ( RxPacketSize == 0 ) && ( RxBytesRead == 0 ) )
- {
- if( ( SX1276->RegPacketConfig1 & RF_PACKETCONFIG1_PACKETFORMAT_VARIABLE ) == RF_PACKETCONFIG1_PACKETFORMAT_VARIABLE )
- {
- SX1276ReadFifo( ( uint8_t* )&RxPacketSize, 1 );
- }
- else
- {
- RxPacketSize = SX1276->RegPayloadLength;
- }
- }
- if( ( RxPacketSize - RxBytesRead ) > ( SX1276->RegFifoThresh & 0x3F ) )
- {
- SX1276ReadFifo( ( RFBuffer + RxBytesRead ), ( SX1276->RegFifoThresh & 0x3F ) );
- RxBytesRead += ( SX1276->RegFifoThresh & 0x3F );
- }
- else
- {
- SX1276ReadFifo( ( RFBuffer + RxBytesRead ), RxPacketSize - RxBytesRead );
- RxBytesRead += ( RxPacketSize - RxBytesRead );
- }
- }
- #endif
- if( DIO0 == 1 )
- {
- RxTimeoutTimer = GET_TICK_COUNT( );
- if( ( RxPacketSize == 0 ) && ( RxBytesRead == 0 ) )
- {
- if( ( SX1276->RegPacketConfig1 & RF_PACKETCONFIG1_PACKETFORMAT_VARIABLE ) == RF_PACKETCONFIG1_PACKETFORMAT_VARIABLE )
- {
- SX1276ReadFifo( ( uint8_t* )&RxPacketSize, 1 );
- }
- else
- {
- RxPacketSize = SX1276->RegPayloadLength;
- }
- SX1276ReadFifo( RFBuffer + RxBytesRead, RxPacketSize - RxBytesRead );
- RxBytesRead += ( RxPacketSize - RxBytesRead );
- PacketDetected = true;
- RFState = RF_STATE_RX_DONE;
- }
- else
- {
- SX1276ReadFifo( RFBuffer + RxBytesRead, RxPacketSize - RxBytesRead );
- RxBytesRead += ( RxPacketSize - RxBytesRead );
- PacketDetected = true;
- RFState = RF_STATE_RX_DONE;
- }
- }
-
-
- if( ( PacketDetected == false ) && ( ( GET_TICK_COUNT( ) - RxTimeoutTimer ) > PacketTimeout ) )
- {
- RFState = RF_STATE_RX_TIMEOUT;
- }
- break;
- case RF_STATE_RX_DONE:
- RxBytesRead = 0;
- RFState = RF_STATE_RX_INIT;
- result = RF_RX_DONE;
- break;
- case RF_STATE_RX_TIMEOUT:
- RxBytesRead = 0;
- RxPacketSize = 0;
- SX1276Write( REG_RXCONFIG, SX1276->RegRxConfig | RF_RXCONFIG_RESTARTRXWITHPLLLOCK );
- RFState = RF_STATE_RX_INIT;
- result = RF_RX_TIMEOUT;
- break;
- case RF_STATE_RX_LEN_ERROR:
- RxBytesRead = 0;
- RxPacketSize = 0;
- SX1276Write( REG_RXCONFIG, SX1276->RegRxConfig | RF_RXCONFIG_RESTARTRXWITHPLLLOCK );
- RFState = RF_STATE_RX_INIT;
- result = RF_LEN_ERROR;
- break;
-
- case RF_STATE_TX_INIT:
-
-
- SX1276->RegDioMapping1 = RF_DIOMAPPING1_DIO0_00 | RF_DIOMAPPING1_DIO1_00 | RF_DIOMAPPING1_DIO2_00 | RF_DIOMAPPING1_DIO3_01;
-
- SX1276->RegDioMapping2 = RF_DIOMAPPING2_DIO4_00 | RF_DIOMAPPING2_DIO5_10;
- SX1276WriteBuffer( REG_DIOMAPPING1, &SX1276->RegDioMapping1, 2 );
- SX1276->RegFifoThresh = RF_FIFOTHRESH_TXSTARTCONDITION_FIFONOTEMPTY | 0x18;
- SX1276Write( REG_FIFOTHRESH, SX1276->RegFifoThresh );
- SX1276FskSetOpMode( RF_OPMODE_TRANSMITTER );
- RFState = RF_STATE_TX_READY_WAIT;
- TxBytesSent = 0;
- break;
- case RF_STATE_TX_READY_WAIT:
- if( DIO3 == 1 )
- {
- if( ( SX1276->RegPacketConfig1 & RF_PACKETCONFIG1_PACKETFORMAT_VARIABLE ) == RF_PACKETCONFIG1_PACKETFORMAT_VARIABLE )
- {
- SX1276WriteFifo( ( uint8_t* )&TxPacketSize, 1 );
- }
-
- if( ( TxPacketSize > 0 ) && ( TxPacketSize <= 64 ) )
- {
- DataChunkSize = TxPacketSize;
- }
- else
- {
- DataChunkSize = 32;
- }
-
- SX1276WriteFifo( RFBuffer, DataChunkSize );
- TxBytesSent += DataChunkSize;
- TxTimeoutTimer = GET_TICK_COUNT( );
- RFState = RF_STATE_TX_RUNNING;
- }
- break;
- case RF_STATE_TX_RUNNING:
- if( DIO1 == 0 )
- {
- if( ( TxPacketSize - TxBytesSent ) > DataChunkSize )
- {
- SX1276WriteFifo( ( RFBuffer + TxBytesSent ), DataChunkSize );
- TxBytesSent += DataChunkSize;
- }
- else
- {
-
- SX1276WriteFifo( RFBuffer + TxBytesSent, TxPacketSize - TxBytesSent );
- TxBytesSent += TxPacketSize - TxBytesSent;
- }
- }
- if( DIO0 == 1 )
- {
- TxTimeoutTimer = GET_TICK_COUNT( );
- RFState = RF_STATE_TX_DONE;
- SX1276FskSetOpMode( RF_OPMODE_STANDBY );
- }
-
-
- if( ( GET_TICK_COUNT( ) - TxTimeoutTimer ) > TICK_RATE_MS( 1000 ) )
- {
- RFState = RF_STATE_TX_TIMEOUT;
- }
- break;
- case RF_STATE_TX_DONE:
- RFState = RF_STATE_IDLE;
- result = RF_TX_DONE;
- break;
- case RF_STATE_TX_TIMEOUT:
- RFState = RF_STATE_IDLE;
- result = RF_TX_TIMEOUT;
- break;
- default:
- break;
- }
- return result;
- }
- #endif
|