From 807a55fcdcb5b7280ea6d83bcd677ae03b7eb7f6 Mon Sep 17 00:00:00 2001
From: pascallanger <planger@mathworks.com>
Date: Thu, 20 Oct 2016 21:21:10 +0200
Subject: [PATCH] AFHDS2A: option value changed

Option value should be between 0 and 70 which gives a value between 50
and 400Hz (value in Hz = 50 + 5*option)
---
 Multiprotocol/AFHDS2A_a7105.ino | 13 +++----------
 1 file changed, 3 insertions(+), 10 deletions(-)

diff --git a/Multiprotocol/AFHDS2A_a7105.ino b/Multiprotocol/AFHDS2A_a7105.ino
index 9debf07..f49c80f 100644
--- a/Multiprotocol/AFHDS2A_a7105.ino
+++ b/Multiprotocol/AFHDS2A_a7105.ino
@@ -183,16 +183,9 @@ static void AFHDS2A_build_packet(uint8_t type)
 			packet[9] = 0xfd;
 			packet[10]= 0xff;
 			packet[12]= 0x00;
-			if(option==0)			//50Hz
-				packet[11]= 50;
-			else
-				if(option==2)		//5Hz
-					packet[11]= 50;
-				else				//400Hz
-				{
-					packet[11]= 400&0xFF;
-					packet[12]= 400>>8;
-				}
+			uint16_t a=5*option+50;	// option value should be between 0 and 70 which gives a value between 50 and 400Hz
+			packet[11]= a;
+			packet[12]= a >> 8;
 			if(sub_protocol == PPM_IBUS || sub_protocol == PPM_SBUS)
 				packet[13] = 0x01;	// PPM output enabled
 			else