diff --git a/Multiprotocol/Multi.txt b/Multiprotocol/Multi.txt index 230c17b..20b41cb 100644 --- a/Multiprotocol/Multi.txt +++ b/Multiprotocol/Multi.txt @@ -45,7 +45,7 @@ 45,E01X,E012,E015,E016H 46,V911S,V911S,E119 47,GD00x,GD_V1,GD_V2 -48,V761 +48,V761,3CH,4CH 49,KF606 50,Redpine,Fast,Slow 51,Potensic,A20 diff --git a/Multiprotocol/Multi_Names.ino b/Multiprotocol/Multi_Names.ino index 19cc5cd..f767605 100644 --- a/Multiprotocol/Multi_Names.ino +++ b/Multiprotocol/Multi_Names.ino @@ -138,7 +138,7 @@ const char STR_SUBTYPE_FRSKYL[] = "\x08""LR12\0 ""LR12 6ch"; const char STR_SUBTYPE_WFLY[] = "\x06""WFR0xS"; const char STR_SUBTYPE_HOTT[] = "\x07""Sync\0 ""No_Sync"; const char STR_SUBTYPE_PELIKAN[] = "\x04""Pro\0""Lite"; -const char STR_SUBTYPE_V761[] = "\x07""Std\0 ""Eachine"; +const char STR_SUBTYPE_V761[] = "\x03""3CH""4CH"; enum { diff --git a/Multiprotocol/Multiprotocol.h b/Multiprotocol/Multiprotocol.h index c651916..4257036 100644 --- a/Multiprotocol/Multiprotocol.h +++ b/Multiprotocol/Multiprotocol.h @@ -19,7 +19,7 @@ #define VERSION_MAJOR 1 #define VERSION_MINOR 3 #define VERSION_REVISION 1 -#define VERSION_PATCH_LEVEL 23 +#define VERSION_PATCH_LEVEL 24 //****************** // Protocols @@ -377,8 +377,8 @@ enum PELIKAN enum V761 { - V761_STD = 0, - V761_EACHINE= 1, + V761_3CH = 0, + V761_4CH = 1, }; #define NONE 0 @@ -974,8 +974,8 @@ Serial: 100000 Baud 8e2 _ xxxx xxxx p -- PELIKAN_PRO 0 PELIKAN_LITE 1 sub_protocol==V761 - V761_STD 0 - V761_EACHINE 1 + V761_3CH 0 + V761_4CH 1 Power value => 0x80 0=High/1=Low Stream[3] = option_protocol; diff --git a/Multiprotocol/V761_nrf24l01.ino b/Multiprotocol/V761_nrf24l01.ino index 6142341..f29b581 100644 --- a/Multiprotocol/V761_nrf24l01.ino +++ b/Multiprotocol/V761_nrf24l01.ino @@ -53,6 +53,8 @@ static void __attribute__((unused)) V761_set_checksum() static void __attribute__((unused)) V761_send_packet() { + static bool calib=false, prev_ch6=false; + if(phase != V761_DATA) { packet[0] = rx_tx_addr[0]; @@ -69,7 +71,7 @@ static void __attribute__((unused)) V761_send_packet() packet[0] = convert_channel_8b(THROTTLE); // Throttle packet[2] = convert_channel_8b(ELEVATOR)>>1; // Elevator - if(sub_protocol==V761_STD) + if(sub_protocol==V761_3CH) { packet[1] = convert_channel_8b(RUDDER)>>1; // Rudder packet[3] = convert_channel_8b(AILERON)>>1; // Aileron @@ -81,9 +83,8 @@ static void __attribute__((unused)) V761_send_packet() } packet[5] = (packet_count++ / 3)<<6; - packet[4] = (packet[5] == 0x40) ? 0x1a : 0x20; + packet[4] = (packet[5] == 0x40) ? 0x1a : 0x20; // ? - // Channel 5 - Gyro mode is packet 5 if(CH5_SW) // Mode Expert Gyro off flags = 0x0c; else @@ -91,14 +92,20 @@ static void __attribute__((unused)) V761_send_packet() flags = 0x08; // Beginer mode (Gyro on, yaw and pitch rate limited) else flags = 0x0a; // Mid Mode ( Gyro on no rate limits) + + if(!prev_ch6 && CH6_SW) // -100% -> 100% launch gyro calib + calib=!calib; + prev_ch6 = CH6_SW; + if(calib) + flags |= 0x01; // Gyro calibration + packet[5] |= flags; - if(sub_protocol==V761_STD) - packet[6] = 0x80; // unknown - else - { - packet[6] = GET_FLAG(CH5_SW, 0x20); // Flip - // RTH??? - } + + packet[6] = GET_FLAG(CH7_SW, 0x20) // Flip + |GET_FLAG(CH8_SW, 0x08) // RTH activation + |GET_FLAG(CH9_SW, 0x10); // RTH on/off + if(sub_protocol==V761_3CH) + packet[6] |= 0x80; // unknown, set on original V761-1 dump but not on eachine dumps, keeping for compatibility //packet counter if(packet_count >= 12) @@ -136,22 +143,30 @@ static void __attribute__((unused)) V761_init() static void __attribute__((unused)) V761_initialize_txid() { - // TODO: try arbitrary rx_tx_addr & frequencies (except hopping_frequency[0]) - switch(RX_num%3) + switch(RX_num%5) { case 1: //Dump from air on Protonus TX memcpy(rx_tx_addr,(uint8_t *)"\xE8\xE4\x45\x09",4); - memcpy(hopping_frequency,(uint8_t *)"\x0D\x21\x44",3); + memcpy(hopping_frequency,(uint8_t *)"\x0D\x21",2); break; case 2: //Dump from air on mshagg2 TX memcpy(rx_tx_addr,(uint8_t *)"\xAE\xD1\x45\x09",4); - memcpy(hopping_frequency,(uint8_t *)"\x13\x1D\x4A",3); + memcpy(hopping_frequency,(uint8_t *)"\x13\x1D",2); + break; + case 3: //Dump from air on MikeHRC Eachine TX + memcpy(rx_tx_addr,(uint8_t *)"\x08\x03\x00\xA0",4); // To be checked + memcpy(hopping_frequency,(uint8_t *)"\x0D\x21",2); // To be checked + break; + case 4: //Dump from air on Crashanium Eachine TX + memcpy(rx_tx_addr,(uint8_t *)"\x58\x08\x00\xA0",4); // To be checked + memcpy(hopping_frequency,(uint8_t *)"\x0D\x31",3); // To be checked break; default: //Dump from SPI memcpy(rx_tx_addr,(uint8_t *)"\x6f\x2c\xb1\x93",4); - memcpy(hopping_frequency,(uint8_t *)"\x14\x1e\x4b",3); + memcpy(hopping_frequency,(uint8_t *)"\x14\x1e",3); break; } + hopping_frequency[2]=hopping_frequency[0]+0x37; } uint16_t V761_callback() @@ -201,10 +216,14 @@ uint16_t V761_callback() uint16_t initV761(void) { - BIND_IN_PROGRESS; - bind_counter = V761_BIND_COUNT; V761_initialize_txid(); - phase = V761_BIND1; + if(IS_BIND_IN_PROGRESS) + { + bind_counter = V761_BIND_COUNT; + phase = V761_BIND1; + } + else + phase = V761_DATA; V761_init(); hopping_frequency_no = 0; packet_count = 0; diff --git a/Multiprotocol/_Config.h b/Multiprotocol/_Config.h index 2209b62..69740c6 100644 --- a/Multiprotocol/_Config.h +++ b/Multiprotocol/_Config.h @@ -715,8 +715,8 @@ const PPM_Parameters PPM_prot[14*NBR_BANKS]= { JXD506 V2X2_MR101 PROTO_V761 - V761_STD - V761_EACHINE + V761_3CH + V761_4CH PROTO_V911S V911S_STD V911S_E119