From ee9e7dbe63c48209a9cfc37dc1d4ee77c41be8fc Mon Sep 17 00:00:00 2001
From: prenticedavid <david.prentice@farming.co.uk>
Date: Fri, 19 Aug 2016 16:48:14 +0100
Subject: [PATCH] fix NL, GS on 240x400 controllers

---
 MCUFRIEND_kbv.cpp | 6 ++++--
 1 file changed, 4 insertions(+), 2 deletions(-)

diff --git a/MCUFRIEND_kbv.cpp b/MCUFRIEND_kbv.cpp
index b9b4740..d1d7c15 100644
--- a/MCUFRIEND_kbv.cpp
+++ b/MCUFRIEND_kbv.cpp
@@ -374,8 +374,10 @@ void MCUFRIEND_kbv::setRotation(uint8_t r)
 		case 0xB509:
             _MC = 0x200, _MP = 0x201, _MW = 0x202, _SC = 0x210, _EC = 0x211, _SP = 0x212, _EP = 0x213;
             GS = (val & 0x80) ? (1 << 15) : 0;
-            if (_lcd_ID == 0x9326) WriteCmdData(0x400, GS | 0x3100);
-            else WriteCmdData(0x400, GS | 0x6200);
+			uint16_t NL;
+			NL = ((HEIGHT / 8) - 1) << 9;
+            if (_lcd_ID == 0x9326) NL >>= 1;
+            WriteCmdData(0x400, GS | NL);
             goto common_SS;
         default:
             _MC = 0x20, _MP = 0x21, _MW = 0x22, _SC = 0x50, _EC = 0x51, _SP = 0x52, _EP = 0x53;