Fix AFHDS2A RX

This commit is contained in:
Pascal Langer 2021-01-12 14:02:13 +01:00
parent 30e3e84066
commit b516bb8d20
3 changed files with 2 additions and 5 deletions

View File

@ -392,7 +392,7 @@ void A7105_Init(void)
A7105_Regs=(uint8_t*)FLYSKY_A7105_regs; A7105_Regs=(uint8_t*)FLYSKY_A7105_regs;
#endif #endif
#if defined(AFHDS2A_A7105_INO) || defined(AFHDS2A_RX_A7105_INO) #if defined(AFHDS2A_A7105_INO) || defined(AFHDS2A_RX_A7105_INO)
if(protocol==PROTO_AFHDS2A) if(protocol==PROTO_AFHDS2A || protocol==PROTO_AFHDS2A_RX)
A7105_Regs=(uint8_t*)AFHDS2A_A7105_regs; A7105_Regs=(uint8_t*)AFHDS2A_A7105_regs;
#endif #endif
#ifdef KYOSHO_A7105_INO #ifdef KYOSHO_A7105_INO

View File

@ -114,7 +114,6 @@ uint16_t AFHDS2A_Rx_callback()
} }
} }
A7105_WriteReg(A7105_0F_PLL_I, (packet_count++ & 1) ? 0x0D : 0x8C); // bind channels A7105_WriteReg(A7105_0F_PLL_I, (packet_count++ & 1) ? 0x0D : 0x8C); // bind channels
A7105_SetTxRxMode(RX_EN);
A7105_Strobe(A7105_RX); A7105_Strobe(A7105_RX);
return 10000; return 10000;
@ -145,7 +144,6 @@ uint16_t AFHDS2A_Rx_callback()
packet[9] = 0x01; packet[9] = 0x01;
packet[10] = 0x00; packet[10] = 0x00;
memset(&packet[11], 0xFF, 26); memset(&packet[11], 0xFF, 26);
A7105_SetTxRxMode(TX_EN);
A7105_WriteData(AFHDS2A_RX_RXPACKET_SIZE, packet_count++ & 1 ? 0x0D : 0x8C); A7105_WriteData(AFHDS2A_RX_RXPACKET_SIZE, packet_count++ & 1 ? 0x0D : 0x8C);
phase |= AFHDS2A_RX_WAIT_WRITE; phase |= AFHDS2A_RX_WAIT_WRITE;
return 1700; return 1700;
@ -156,7 +154,6 @@ uint16_t AFHDS2A_Rx_callback()
while ((uint32_t)(micros() - pps_timer) < 700) // Wait max 700µs, using serial+telemetry exit in about 120µs while ((uint32_t)(micros() - pps_timer) < 700) // Wait max 700µs, using serial+telemetry exit in about 120µs
if (!(A7105_ReadReg(A7105_00_MODE) & 0x01)) if (!(A7105_ReadReg(A7105_00_MODE) & 0x01))
break; break;
A7105_SetTxRxMode(RX_EN);
A7105_Strobe(A7105_RX); A7105_Strobe(A7105_RX);
phase &= ~AFHDS2A_RX_WAIT_WRITE; phase &= ~AFHDS2A_RX_WAIT_WRITE;
return 10000; return 10000;

View File

@ -19,7 +19,7 @@
#define VERSION_MAJOR 1 #define VERSION_MAJOR 1
#define VERSION_MINOR 3 #define VERSION_MINOR 3
#define VERSION_REVISION 2 #define VERSION_REVISION 2
#define VERSION_PATCH_LEVEL 1 #define VERSION_PATCH_LEVEL 2
//****************** //******************
// Protocols // Protocols