From ef4b4dfba1e2a81ee9ed51ee2d9ba95556c585e2 Mon Sep 17 00:00:00 2001
From: Richard Li <richard.li@ces.hk>
Date: Sat, 14 Jan 2023 16:47:22 +0800
Subject: [PATCH] FX9630 : Can bind properly, more work need to be done.

---
 Multiprotocol/FX_nrf24l01.ino  | 94 ++++++++++++++++++++++++++++------
 Multiprotocol/Multi.txt        |  2 +-
 Multiprotocol/Multi_Protos.ino |  4 +-
 Multiprotocol/Multiprotocol.h  |  1 +
 Multiprotocol/_Config.h        |  1 +
 5 files changed, 82 insertions(+), 20 deletions(-)

diff --git a/Multiprotocol/FX_nrf24l01.ino b/Multiprotocol/FX_nrf24l01.ino
index 512710f..50f8ecc 100644
--- a/Multiprotocol/FX_nrf24l01.ino
+++ b/Multiprotocol/FX_nrf24l01.ino
@@ -33,29 +33,58 @@ Multiprotocol is distributed in the hope that it will be useful,
 #define FX620_PAYLOAD_SIZE			7
 #define FX620_CH_OFFSET				1
 
+#define FX9630_PACKET_PERIOD		8124
+#define FX9630_BIND_PACKET_PERIOD	8124
+#define FX9630_BIND_CHANNEL			51
+#define FX9630_PAYLOAD_SIZE			8
+#define FX9630_NUM_CHANNELS			3
+
 //#define FORCE_FX620_ID
+#define FORCE_FX9630_ID
 
 static void __attribute__((unused)) FX_send_packet()
 {
 	//Hopp
 	if(IS_BIND_DONE)
 	{
-		XN297_Hopping(hopping_frequency_no++);
-		hopping_frequency_no &= 0x03;
+		if(sub_protocol == FX9630)
+		{
+			XN297_SetTXAddr(rx_tx_addr, 4);
+			XN297_Hopping(hopping_frequency_no++);
+			if (hopping_frequency_no > FX9630_NUM_CHANNELS)
+				hopping_frequency_no = 0;
+		}
+		else // FX816 and FX620
+		{
+			XN297_Hopping(hopping_frequency_no++);
+			hopping_frequency_no &= 0x03;
+		}
 	}
 
 	memset(packet,0x00,packet_length);
 
 	//Channels
-	uint8_t offset=sub_protocol == FX816 ? FX816_CH_OFFSET:FX620_CH_OFFSET;
-	uint8_t val=convert_channel_8b(AILERON);
-	if(val>127+FX_SWITCH)
-		packet[offset] = sub_protocol == FX816 ? 1:0xFF;
-	else if(val<127-FX_SWITCH)
-		packet[offset] = sub_protocol == FX816 ? 2:0x00;
+	uint8_t val;
+	if (sub_protocol == FX9630)
+	{
+		packet[0] = convert_channel_8b(THROTTLE);
+		packet[1] = convert_channel_8b(AILERON);
+		packet[2] = 0xFF - convert_channel_8b(ELEVATOR);
+		packet[3] = convert_channel_8b(RUDDER);
+		packet[4] = 0x20;
+	}
 	else
-		packet[offset] = sub_protocol == FX816 ? 0:0x7F;
-	packet[offset+1] = convert_channel_16b_limit(THROTTLE,0,100);	//FX816:0x00..0x63, FX620:0x00..0x5E but that should work
+	{
+		uint8_t offset=sub_protocol == FX816 ? FX816_CH_OFFSET:FX620_CH_OFFSET;
+		val=convert_channel_8b(AILERON);
+		if(val>127+FX_SWITCH)
+			packet[offset] = sub_protocol == FX816 ? 1:0xFF;
+		else if(val<127-FX_SWITCH)
+			packet[offset] = sub_protocol == FX816 ? 2:0x00;
+		else
+			packet[offset] = sub_protocol == FX816 ? 0:0x7F;
+		packet[offset+1] = convert_channel_16b_limit(THROTTLE,0,100);	//FX816:0x00..0x63, FX620:0x00..0x5E but that should work
+	}
 
 	//Bind and specifics
 	if(sub_protocol == FX816)
@@ -67,7 +96,7 @@ static void __attribute__((unused)) FX_send_packet()
 		packet[1] = rx_tx_addr[0];
 		packet[2] = rx_tx_addr[1];
 	}
-	else //FX620
+	else if(sub_protocol == FX620)
 	{
 		if(IS_BIND_IN_PROGRESS)
 		{
@@ -82,12 +111,29 @@ static void __attribute__((unused)) FX_send_packet()
 			packet[5] = 0xAB;	// Is it based on ID??
 		}
 	}
+	else
+	{
+		if(IS_BIND_IN_PROGRESS)
+		{
+			memcpy(packet,rx_tx_addr, 4);
+			packet[4] = hopping_frequency[1];
+			packet[5] = hopping_frequency[2];
+			packet[6] = 0xA0;
+			packet[7] = 0x55;
+		}
+	}  // FX9630
 
 	//Check
-	val=0;
-	for(uint8_t i=0;i<packet_length-1;i++)
-		val+=packet[i];
-	packet[packet_length-1]=val;
+	if (sub_protocol != FX9630 || IS_BIND_DONE)
+	{
+		val=0;
+		for(uint8_t i=0;i<packet_length-1;i++)
+			val+=packet[i];
+		if (sub_protocol == FX9630)
+			val = val ^ 0xFF;
+	}
+		packet[packet_length-1]=val;
+	}
 
 	//Debug
 	#if 0
@@ -112,13 +158,20 @@ static void __attribute__((unused)) FX_RF_init()
 		packet_period = FX816_PACKET_PERIOD;
 		packet_length = FX816_PAYLOAD_SIZE;
 	}
-	else //FX620
+	else if(sub_protocol == FX620)
 	{
 		XN297_SetTXAddr((uint8_t *)"\xaa\xbb\xcc", 3);
 		XN297_RFChannel(FX620_BIND_CHANNEL);
 		packet_period = FX620_BIND_PACKET_PERIOD;
 		packet_length = FX620_PAYLOAD_SIZE;
 	}
+	else
+	{
+		XN297_SetTXAddr((uint8_t *)"\x56\x78\x90\x12", 4);
+		XN297_RFChannel(FX9630_BIND_CHANNEL);
+		packet_period = FX9630_BIND_PACKET_PERIOD;
+		packet_length = FX9630_PAYLOAD_SIZE;
+	} // FX9630
 }
 
 static void __attribute__((unused)) FX_initialize_txid()
@@ -133,7 +186,7 @@ static void __attribute__((unused)) FX_initialize_txid()
 		for(uint8_t i=0;i<FX_NUM_CHANNELS;i++)
 			hopping_frequency[i]+=rx_tx_addr[3]&0x07;
 	}
-	else//FX620
+	else if(sub_protocol == FX620)
 	{
 		rx_tx_addr[0] = rx_tx_addr[3];
 		hopping_frequency[0] = 0x18 + rx_tx_addr[3]&0x07;	// just to try something
@@ -144,6 +197,13 @@ static void __attribute__((unused)) FX_initialize_txid()
 		for(uint8_t i=1;i<FX_NUM_CHANNELS;i++)
 			hopping_frequency[i] = i*10 + hopping_frequency[0];
 	}
+	else // FX9630
+	{
+		#ifdef FORCE_FX9630_ID
+			memcpy(rx_tx_addr,(uint8_t*)"\xCE\x31\x9B\x73", 4);
+		#endif
+		memcpy(hopping_frequency,"\x13\x1A\x38", FX9630_NUM_CHANNELS);		//Original dump=19=0x13,26=0x1A,56=0x38
+	}
 }
 
 uint16_t FX_callback()
diff --git a/Multiprotocol/Multi.txt b/Multiprotocol/Multi.txt
index a547ce5..5e4c96f 100644
--- a/Multiprotocol/Multi.txt
+++ b/Multiprotocol/Multi.txt
@@ -55,7 +55,7 @@
 55,Frsky_RX,Multi,CloneTX,EraseTX,CPPM
 56,AFHDS2A_RX,Multi,CPPM
 57,HoTT,Sync,No_Sync
-58,FX,816,620
+58,FX,816,620,9630
 59,Bayang_RX,Multi,CPPM
 60,Pelikan,Pro,Lite,SCX24
 61,Tiger
diff --git a/Multiprotocol/Multi_Protos.ino b/Multiprotocol/Multi_Protos.ino
index 9097782..cfe97f7 100644
--- a/Multiprotocol/Multi_Protos.ino
+++ b/Multiprotocol/Multi_Protos.ino
@@ -173,7 +173,7 @@ const char STR_SUBTYPE_JJRC345[] =    "\x08""JJRC345\0""SkyTmblr";
 const char STR_SUBTYPE_MOULKG[] =     "\x06""Analog""Digit\0";
 const char STR_SUBTYPE_KF606[] =      "\x06""KF606\0""MIG320";
 const char STR_SUBTYPE_E129[] =       "\x04""E129""C186";
-const char STR_SUBTYPE_FX[] =         "\x03""816""620";
+const char STR_SUBTYPE_FX[] =         "\x04""816\0""620\0""9630";
 #define NO_SUBTYPE		nullptr
 
 #ifdef SEND_CPPM
@@ -315,7 +315,7 @@ const mm_protocol_definition multi_protocols[] = {
 		{PROTO_FUTABA,     STR_FUTABA,    STR_SUBTYPE_FUTABA,    1, OPTION_RFTUNE,  1, 1, SW_CC2500, SFHSS_init,      SFHSS_callback      },
 	#endif
 	#if defined(FX_NRF24L01_INO)
-		{PROTO_FX,         STR_FX,        STR_SUBTYPE_FX,        2, OPTION_NONE,    0, 0, SW_NRF,    FX_init,         FX_callback         },
+		{PROTO_FX,         STR_FX,        STR_SUBTYPE_FX,        3, OPTION_NONE,    0, 0, SW_NRF,    FX_init,         FX_callback         },
 	#endif
 	#if defined(FY326_NRF24L01_INO)
 		{PROTO_FY326,      STR_FY326,     STR_SUBTYPE_FY326,     2, OPTION_NONE,    0, 0, SW_NRF,    FY326_init,      FY326_callback      },
diff --git a/Multiprotocol/Multiprotocol.h b/Multiprotocol/Multiprotocol.h
index d866fd0..fabe96c 100644
--- a/Multiprotocol/Multiprotocol.h
+++ b/Multiprotocol/Multiprotocol.h
@@ -460,6 +460,7 @@ enum FX
 {
 	FX816			= 0,
 	FX620			= 1,
+    FX9630          = 2,
 };
 
 #define NONE 		0
diff --git a/Multiprotocol/_Config.h b/Multiprotocol/_Config.h
index c64a023..b257bcb 100644
--- a/Multiprotocol/_Config.h
+++ b/Multiprotocol/_Config.h
@@ -670,6 +670,7 @@ const PPM_Parameters PPM_prot[14*NBR_BANKS]=	{
 	PROTO_FX
 		FX816
 		FX620
+		FX9630
 	PROTO_FY326
 		FY326
 		FY319