From 3d0fd18e52a0691ab0be7c5d07bfc4d879a6204e Mon Sep 17 00:00:00 2001
From: Risto <rotorman@users.noreply.github.com>
Date: Sun, 13 Jun 2021 11:17:41 +0200
Subject: [PATCH] Match color radio for the RGB565 hookup

Uses upper bits for the display of lower bits of RGB565, that are not 0 on physical radio. Matches better the color display of radio.
---
 radio/src/simu.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/radio/src/simu.cpp b/radio/src/simu.cpp
index 2ba72bef6..fc663fc9f 100644
--- a/radio/src/simu.cpp
+++ b/radio/src/simu.cpp
@@ -527,7 +527,7 @@ void OpenTxSim::refreshDisplay()
             setPixel(x, y, FXRGB(255, 255, 255));
           }
           else {
-            FXColor color = FXRGB(255*((z&0xF800)>>11)/0x1f, 255*((z&0x07E0)>>5)/0x3F, 255*(z&0x001F)/0x01F);
+            FXColor color = FXRGB(((z & 0xF800) >> 8) + ((z & 0xE000) >> 13), ((z & 0x07E0) >> 3) + ((z & 0x0600) >> 9), (((z & 0x001F) << 3) & 0x00F8) + ((z & 0x001C) >> 2));
             setPixel(x, y, color);
           }
     	}