From 9fd72b5ad55d330fe47fd780c0f5bb22cb762d16 Mon Sep 17 00:00:00 2001
From: goebish <goebish@gmail.com>
Date: Sat, 5 Oct 2019 19:02:59 +0200
Subject: [PATCH] Fix scaling for +125% (#280)

---
 Multiprotocol/AFHDS2A_Rx_a7105.ino | 4 +---
 1 file changed, 1 insertion(+), 3 deletions(-)

diff --git a/Multiprotocol/AFHDS2A_Rx_a7105.ino b/Multiprotocol/AFHDS2A_Rx_a7105.ino
index 1e1cf95..9ee15ba 100644
--- a/Multiprotocol/AFHDS2A_Rx_a7105.ino
+++ b/Multiprotocol/AFHDS2A_Rx_a7105.ino
@@ -45,10 +45,8 @@ static void __attribute__((unused)) AFHDS2A_Rx_build_telemetry_packet()
 		uint32_t val = packet[9+i*2] | (packet[10+i*2] << 8);
 		if (val < 860)
 			val = 860;
-		else if (val > 2139)
-			val = 2139;
 		// convert ppm (860-2140) to Multi (0-2047)
-		val = ((val-860)<<3)/5;
+		val = min(((val-860)<<3)/5, 2047);
 
 		bits |= val << bitsavailable;
 		bitsavailable += 11;