gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-02-04 20:58:10 +00:00
Code Issues Projects Releases Wiki Activity

Update MLINK_cyrf6936.ino

Browse Source
This commit is contained in:
Pascal Langer 2021-02-05 16:20:42 +01:00
parent 89c00e8f17
commit 7bfaee8b4f
1 changed files with 14 additions and 29 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

43
Multiprotocol/MLINK_cyrf6936.ino
View File

@ -29,11 +29,9 @@ enum {
MLINK_BIND_RX, MLINK_BIND_RX,
MLINK_PREP_DATA, MLINK_PREP_DATA,
MLINK_SEND1, MLINK_SEND1,
MLINK_BUILD1,
MLINK_SEND2, MLINK_SEND2,
MLINK_BUILD2,
MLINK_SEND3, MLINK_SEND3,
MLINK_BUILD3, MLINK_CHECK3,
MLINK_RX, MLINK_RX,
MLINK_BUILD4, MLINK_BUILD4,
}; };
@ -155,7 +153,7 @@ static void __attribute__((unused)) MLINK_send_bind_packet()
CYRF_WriteDataPacketLen(packet, MLINK_PACKET_SIZE); CYRF_WriteDataPacketLen(packet, MLINK_PACKET_SIZE);
} }
static void __attribute__((unused)) MLINK_build_data_packet() static void __attribute__((unused)) MLINK_send_data_packet()
{ {
static uint8_t tog=0; static uint8_t tog=0;
if(hopping_frequency_no==0) if(hopping_frequency_no==0)
@ -205,6 +203,9 @@ static void __attribute__((unused)) MLINK_build_data_packet()
crc8_update(bit_reverse(packet[i])); crc8_update(bit_reverse(packet[i]));
packet[7] = bit_reverse(crc8); // CRC reflected out packet[7] = bit_reverse(crc8); // CRC reflected out
//Send
CYRF_WriteDataPacketLen(packet, MLINK_PACKET_SIZE);
//Debug //Debug
#if 0 #if 0
debug("P(%02d):",hopping_frequency_no); debug("P(%02d):",hopping_frequency_no);
@ -338,38 +339,23 @@ uint16_t ReadMLINK()
telemetry_lost = 1; telemetry_lost = 1;
#endif #endif
phase++; phase++;
MLINK_build_data_packet();
case MLINK_SEND1: case MLINK_SEND1:
CYRF_WriteRegister(CYRF_02_TX_CTRL, 0x40); MLINK_send_data_packet();
CYRF_WriteRegisterMulti(CYRF_20_TX_BUFFER, packet, MLINK_PACKET_SIZE);
CYRF_WriteRegister(CYRF_02_TX_CTRL, 0x82);
phase++; phase++;
return 4880; return 4880+1111;
case MLINK_BUILD1:
phase++;
MLINK_build_data_packet();
return 1111;
case MLINK_SEND2: case MLINK_SEND2:
CYRF_WriteRegister(CYRF_02_TX_CTRL, 0x40); MLINK_send_data_packet();
CYRF_WriteRegisterMulti(CYRF_20_TX_BUFFER, packet, MLINK_PACKET_SIZE);
CYRF_WriteRegister(CYRF_02_TX_CTRL, 0x82);
phase++; phase++;
return 4617;
case MLINK_BUILD2:
phase++;
MLINK_build_data_packet();
if(hopping_frequency_no%5==0) if(hopping_frequency_no%5==0)
return 1017; return 4617+1017;
return 1422; return 4617+1422;
case MLINK_SEND3: case MLINK_SEND3:
CYRF_WriteRegister(CYRF_02_TX_CTRL, 0x40); MLINK_send_data_packet();
CYRF_WriteRegisterMulti(CYRF_20_TX_BUFFER, packet, MLINK_PACKET_SIZE);
CYRF_WriteRegister(CYRF_02_TX_CTRL, 0x82);
phase++; phase++;
return 4611; return 4611;
case MLINK_BUILD3: case MLINK_CHECK3:
//Switch to next channel //Switch to next channel
hopping_frequency_no++; hopping_frequency_no++;
if(hopping_frequency_no>=MLINK_NUM_FREQ) if(hopping_frequency_no>=MLINK_NUM_FREQ)
@ -387,7 +373,6 @@ uint16_t ReadMLINK()
else else
CYRF_SetPower(0x38); CYRF_SetPower(0x38);
phase=MLINK_SEND1; phase=MLINK_SEND1;
MLINK_build_data_packet();
return 4470; return 4470;
case MLINK_RX: case MLINK_RX:
#ifdef MLINK_HUB_TELEMETRY #ifdef MLINK_HUB_TELEMETRY
@ -402,7 +387,7 @@ uint16_t ReadMLINK()
telemetry_counter = 0; telemetry_counter = 0;
} }
#endif #endif
status=CYRF_ReadRegister(CYRF_05_RX_CTRL);//CYRF_07_RX_IRQ_STATUS); status=CYRF_ReadRegister(CYRF_05_RX_CTRL);
debug("T(%02X):",status); debug("T(%02X):",status);
if( (status&0x80) == 0 ) if( (status&0x80) == 0 )
{//Packet received {//Packet received
@ -436,7 +421,6 @@ uint16_t ReadMLINK()
CYRF_WriteRegister(CYRF_29_RX_ABORT, 0x00); // Disable RX abort CYRF_WriteRegister(CYRF_29_RX_ABORT, 0x00); // Disable RX abort
CYRF_SetTxRxMode(TX_EN); // Transmit mode CYRF_SetTxRxMode(TX_EN); // Transmit mode
phase=MLINK_SEND2; phase=MLINK_SEND2;
MLINK_build_data_packet();
return 1000; return 1000;
} }
return 1000; return 1000;
@ -504,6 +488,7 @@ uint16_t initMLINK()
} }
else else
phase = MLINK_PREP_DATA; phase = MLINK_PREP_DATA;
return 10000; return 10000;
} }