New Hubsan Upgraded Version on the way

case DATA_1:
case DATA_2:
case DATA_3:
case DATA_4:
case DATA_5:
    if( txState == 0) // send frame
    {
        if(state == DATA_1)
            A7105_SetPower(Model.tx_power); //Keep transmit power in sync
        hubsan_build_packet();
        A7105_Strobe(A7105_STANDBY);
        A7105_WriteData(packet, 16, state == DATA_5 ? channel + 0x23 : channel);
        if (state == DATA_5)
            state = DATA_1;
        else
            state++;
        delay=3000;
    }
    else 
    {
        if( txState == 1) // switch to rx mode 3ms after packet sent
        {
            A7105_Strobe(A7105_RX);
            A7105_Strobe(A7105_RX); // 0xc0 appears twice in the dump 
        }

        for( i=0; i<20; i++)
            if(!(A7105_ReadReg(A7105_00_MODE) & 0x01)) // data received ?
            {
                A7105_ReadData(packet, 16); // A7105_RST_RDPTR + 16x A7105_05_FIFO_DATA
                Telemetry.p.hubsan4.volt = packet[13];
                A7105_Strobe(A7105_RX);
                break;
            }
        delay=1000;
    }

    if (++txState == 8) // 3ms + 7*1ms
        txState = 0;
            
    return delay;