gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-07-02 19:37:52 +00:00
Code Issues Projects Releases Wiki Activity

Update SGF22_nrf24l01.ino

Browse Source
This commit is contained in:
pascallanger 2025-04-01 23:01:18 +02:00
parent 90fb2d745f
commit 13024e3816
1 changed files with 97 additions and 38 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

75
Multiprotocol/SGF22_nrf24l01.ino
View File

@ -48,6 +48,16 @@ Multiprotocol is distributed in the hope that it will be useful,
#define SGF22_FLAG_PHOTO 0x40 // #define SGF22_J20_FLAG_INVERT 0x40 #define SGF22_FLAG_PHOTO 0x40 // #define SGF22_J20_FLAG_INVERT 0x40
#define SGF22_J20_FLAG_FIXHEIGHT 0x80 #define SGF22_J20_FLAG_FIXHEIGHT 0x80
#define SGF22_WRITE_TIME 1000
//#define SGF22_HUB_TELEMETRY
enum {
SGF22_DATA1,
SGF22_DATA2,
SGF22_DATA3,
SGF22_RX,
};
static void __attribute__((unused)) SGF22_send_packet() static void __attribute__((unused)) SGF22_send_packet()
{ {
if(IS_BIND_IN_PROGRESS) if(IS_BIND_IN_PROGRESS)
@ -148,34 +158,80 @@ static void __attribute__((unused)) SGF22_RF_init()
{ {
XN297_Configure(XN297_CRCEN, XN297_SCRAMBLED, XN297_1M); XN297_Configure(XN297_CRCEN, XN297_SCRAMBLED, XN297_1M);
XN297_SetTXAddr((uint8_t*)"\xC7\x95\x3C\xBB\xA5", 5); XN297_SetTXAddr((uint8_t*)"\xC7\x95\x3C\xBB\xA5", 5);
#ifdef SGF22_HUB_TELEMETRY
XN297_SetRXAddr((uint8_t*)"\xC7\x95\x3C\xBB\xA5", SGF22_PAYLOAD_SIZE);
#endif
const uint8_t bind_chan[] = {SGF22_BIND_RF_CHANNEL, SGF22_F22S_BIND_RF_CHANNEL, SGF22_J20_BIND_RF_CHANNEL}; const uint8_t bind_chan[] = {SGF22_BIND_RF_CHANNEL, SGF22_F22S_BIND_RF_CHANNEL, SGF22_J20_BIND_RF_CHANNEL};
XN297_RFChannel(bind_chan[sub_protocol]); // Set bind channel XN297_RFChannel(bind_chan[sub_protocol]); // Set bind channel
} }
uint16_t SGF22_callback() uint16_t SGF22_callback()
{ {
if(phase == 0) #ifdef SGF22_HUB_TELEMETRY
bool rx = false;
#endif
switch(phase)
{ {
phase++; case SGF22_DATA1:
#ifdef MULTI_SYNC #ifdef MULTI_SYNC
telemetry_set_input_sync(SGF22_PACKET_PERIOD); telemetry_set_input_sync(SGF22_PACKET_PERIOD);
#endif #endif
#ifdef SGF22_HUB_TELEMETRY
rx = XN297_IsRX();
XN297_SetTxRxMode(TXRX_OFF);
#endif
SGF22_send_packet(); SGF22_send_packet();
if(IS_BIND_IN_PROGRESS) if(IS_BIND_IN_PROGRESS)
{ {
if(--bind_counter==0) if(--bind_counter==0)
BIND_DONE; BIND_DONE;
} }
#ifdef SGF22_HUB_TELEMETRY
if(rx)
{
uint8_t p_len = XN297_ReadEnhancedPayload(packet_in, SGF22_PAYLOAD_SIZE);
if(p_len == 3 && packet_in[0] == rx_tx_addr[2] && packet_in[1] == rx_tx_addr[3])
{//packets only received when battery is low: 00 0B 01
telemetry_link = 1;
v_lipo1 = packet_in[2] ? 0 : 255;
} }
else #if 0
{//send 3 times in total the same packet debug("L %d ",p_len);
debug("RX");
for(uint8_t i=0; i<SGF22_PAYLOAD_SIZE; i++)
debug(" %02X",packet_in[i]);
debugln("");
#endif
}
#endif
phase++;
break;
case SGF22_DATA2:
case SGF22_DATA3:
//send 3 times in total the same packet
XN297_ReSendPayload(); XN297_ReSendPayload();
phase++; phase++;
if(phase > 2) break;
default: //SGF22_RX
#ifdef SGF22_HUB_TELEMETRY
/*{ // Wait for packet to be sent before switching to receive mode
uint16_t start=(uint16_t)micros(), count=0;
while ((uint16_t)((uint16_t)micros()-(uint16_t)start) < 500)
{ {
phase = 0; if(XN297_IsPacketSent())
return SGF22_PACKET_PERIOD - 2*1550; break;
count++;
} }
debugln("%d",count);
}*/
//Switch to RX
XN297_SetTxRxMode(TXRX_OFF);
XN297_SetTxRxMode(RX_EN);
#endif
phase = SGF22_DATA1;
return SGF22_PACKET_PERIOD - 3*1550;
} }
return 1550; return 1550;
} }
@ -187,7 +243,10 @@ void SGF22_init()
SGF22_RF_init(); SGF22_RF_init();
bind_counter=SGF22_BIND_COUNT; bind_counter=SGF22_BIND_COUNT;
packet_sent = packet_count = 0x26; // TX2:26 TX3:26 packet_sent = packet_count = 0x26; // TX2:26 TX3:26
phase = 0; phase = SGF22_DATA1;
#ifdef SGF22_HUB_TELEMETRY
RX_RSSI = 100; // Dummy value
#endif
} }
#endif #endif