Library for TFT via SPI

Dependents:   mbed_projekt_tetris Ejemplo_TFT

Files at this revision

API Documentation at this revision

Comitter:
2018US_HarisSoljic
Date:
Mon Jun 18 20:01:55 2018 +0000
Commit message:
revi?n;

Changed in this revision

GraphicsDisplay.cpp Show annotated file Show diff for this revision Revisions of this file
GraphicsDisplay.h Show annotated file Show diff for this revision Revisions of this file
SPI_TFT_ILI9341.cpp Show annotated file Show diff for this revision Revisions of this file
SPI_TFT_ILI9341.h Show annotated file Show diff for this revision Revisions of this file
SPI_TFT_ILI9341_NUCLEO.cpp Show annotated file Show diff for this revision Revisions of this file
SPI_TFT_ILI9341_NXP.cpp Show annotated file Show diff for this revision Revisions of this file
TextDisplay.cpp Show annotated file Show diff for this revision Revisions of this file
TextDisplay.h Show annotated file Show diff for this revision Revisions of this file
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/GraphicsDisplay.cpp	Mon Jun 18 20:01:55 2018 +0000
@@ -0,0 +1,176 @@
+/* mbed GraphicsDisplay Display Library Base Class
+ * Copyright (c) 2007-2009 sford
+ * Released under the MIT License: http://mbed.org/license/mit
+ */
+ 
+#include "GraphicsDisplay.h"
+
+const unsigned char FONT8x8[97][8] = {
+0x08,0x08,0x08,0x00,0x00,0x00,0x00,0x00, // columns, rows, num_bytes_per_char
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00, // space 0x20
+0x30,0x78,0x78,0x30,0x30,0x00,0x30,0x00, // !
+0x6C,0x6C,0x6C,0x00,0x00,0x00,0x00,0x00, // "
+0x6C,0x6C,0xFE,0x6C,0xFE,0x6C,0x6C,0x00, // #
+0x18,0x3E,0x60,0x3C,0x06,0x7C,0x18,0x00, // $
+0x00,0x63,0x66,0x0C,0x18,0x33,0x63,0x00, // %
+0x1C,0x36,0x1C,0x3B,0x6E,0x66,0x3B,0x00, // &
+0x30,0x30,0x60,0x00,0x00,0x00,0x00,0x00, // '
+0x0C,0x18,0x30,0x30,0x30,0x18,0x0C,0x00, // (
+0x30,0x18,0x0C,0x0C,0x0C,0x18,0x30,0x00, // )
+0x00,0x66,0x3C,0xFF,0x3C,0x66,0x00,0x00, // *
+0x00,0x30,0x30,0xFC,0x30,0x30,0x00,0x00, // +
+0x00,0x00,0x00,0x00,0x00,0x18,0x18,0x30, // ,
+0x00,0x00,0x00,0x7E,0x00,0x00,0x00,0x00, // -
+0x00,0x00,0x00,0x00,0x00,0x18,0x18,0x00, // .
+0x03,0x06,0x0C,0x18,0x30,0x60,0x40,0x00, // / (forward slash)
+0x3E,0x63,0x63,0x6B,0x63,0x63,0x3E,0x00, // 0 0x30
+0x18,0x38,0x58,0x18,0x18,0x18,0x7E,0x00, // 1
+0x3C,0x66,0x06,0x1C,0x30,0x66,0x7E,0x00, // 2
+0x3C,0x66,0x06,0x1C,0x06,0x66,0x3C,0x00, // 3
+0x0E,0x1E,0x36,0x66,0x7F,0x06,0x0F,0x00, // 4
+0x7E,0x60,0x7C,0x06,0x06,0x66,0x3C,0x00, // 5
+0x1C,0x30,0x60,0x7C,0x66,0x66,0x3C,0x00, // 6
+0x7E,0x66,0x06,0x0C,0x18,0x18,0x18,0x00, // 7
+0x3C,0x66,0x66,0x3C,0x66,0x66,0x3C,0x00, // 8
+0x3C,0x66,0x66,0x3E,0x06,0x0C,0x38,0x00, // 9
+0x00,0x18,0x18,0x00,0x00,0x18,0x18,0x00, // :
+0x00,0x18,0x18,0x00,0x00,0x18,0x18,0x30, // ;
+0x0C,0x18,0x30,0x60,0x30,0x18,0x0C,0x00, // <
+0x00,0x00,0x7E,0x00,0x00,0x7E,0x00,0x00, // =
+0x30,0x18,0x0C,0x06,0x0C,0x18,0x30,0x00, // >
+0x3C,0x66,0x06,0x0C,0x18,0x00,0x18,0x00, // ?
+0x3E,0x63,0x6F,0x69,0x6F,0x60,0x3E,0x00, // @ 0x40
+0x18,0x3C,0x66,0x66,0x7E,0x66,0x66,0x00, // A
+0x7E,0x33,0x33,0x3E,0x33,0x33,0x7E,0x00, // B
+0x1E,0x33,0x60,0x60,0x60,0x33,0x1E,0x00, // C
+0x7C,0x36,0x33,0x33,0x33,0x36,0x7C,0x00, // D
+0x7F,0x31,0x34,0x3C,0x34,0x31,0x7F,0x00, // E
+0x7F,0x31,0x34,0x3C,0x34,0x30,0x78,0x00, // F
+0x1E,0x33,0x60,0x60,0x67,0x33,0x1F,0x00, // G
+0x66,0x66,0x66,0x7E,0x66,0x66,0x66,0x00, // H
+0x3C,0x18,0x18,0x18,0x18,0x18,0x3C,0x00, // I
+0x0F,0x06,0x06,0x06,0x66,0x66,0x3C,0x00, // J
+0x73,0x33,0x36,0x3C,0x36,0x33,0x73,0x00, // K
+0x78,0x30,0x30,0x30,0x31,0x33,0x7F,0x00, // L
+0x63,0x77,0x7F,0x7F,0x6B,0x63,0x63,0x00, // M
+0x63,0x73,0x7B,0x6F,0x67,0x63,0x63,0x00, // N
+0x3E,0x63,0x63,0x63,0x63,0x63,0x3E,0x00, // O
+0x7E,0x33,0x33,0x3E,0x30,0x30,0x78,0x00, // P 0x50
+0x3C,0x66,0x66,0x66,0x6E,0x3C,0x0E,0x00, // Q
+0x7E,0x33,0x33,0x3E,0x36,0x33,0x73,0x00, // R
+0x3C,0x66,0x30,0x18,0x0C,0x66,0x3C,0x00, // S
+0x7E,0x5A,0x18,0x18,0x18,0x18,0x3C,0x00, // T
+0x66,0x66,0x66,0x66,0x66,0x66,0x7E,0x00, // U
+0x66,0x66,0x66,0x66,0x66,0x3C,0x18,0x00, // V
+0x63,0x63,0x63,0x6B,0x7F,0x77,0x63,0x00, // W
+0x63,0x63,0x36,0x1C,0x1C,0x36,0x63,0x00, // X
+0x66,0x66,0x66,0x3C,0x18,0x18,0x3C,0x00, // Y
+0x7F,0x63,0x46,0x0C,0x19,0x33,0x7F,0x00, // Z
+0x3C,0x30,0x30,0x30,0x30,0x30,0x3C,0x00, // [
+0x60,0x30,0x18,0x0C,0x06,0x03,0x01,0x00, // \ (back slash)
+0x3C,0x0C,0x0C,0x0C,0x0C,0x0C,0x3C,0x00, // ]
+0x08,0x1C,0x36,0x63,0x00,0x00,0x00,0x00, // ^
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xFF, // _
+0x18,0x18,0x0C,0x00,0x00,0x00,0x00,0x00, // ` 0x60
+0x00,0x00,0x3C,0x06,0x3E,0x66,0x3B,0x00, // a
+0x70,0x30,0x3E,0x33,0x33,0x33,0x6E,0x00, // b
+0x00,0x00,0x3C,0x66,0x60,0x66,0x3C,0x00, // c
+0x0E,0x06,0x3E,0x66,0x66,0x66,0x3B,0x00, // d
+0x00,0x00,0x3C,0x66,0x7E,0x60,0x3C,0x00, // e
+0x1C,0x36,0x30,0x78,0x30,0x30,0x78,0x00, // f
+0x00,0x00,0x3B,0x66,0x66,0x3E,0x06,0x7C, // g
+0x70,0x30,0x36,0x3B,0x33,0x33,0x73,0x00, // h
+0x18,0x00,0x38,0x18,0x18,0x18,0x3C,0x00, // i
+0x06,0x00,0x06,0x06,0x06,0x66,0x66,0x3C, // j
+0x70,0x30,0x33,0x36,0x3C,0x36,0x73,0x00, // k
+0x38,0x18,0x18,0x18,0x18,0x18,0x3C,0x00, // l
+0x00,0x00,0x66,0x7F,0x7F,0x6B,0x63,0x00, // m
+0x00,0x00,0x7C,0x66,0x66,0x66,0x66,0x00, // n
+0x00,0x00,0x3C,0x66,0x66,0x66,0x3C,0x00, // o
+0x00,0x00,0x6E,0x33,0x33,0x3E,0x30,0x78, // p
+0x00,0x00,0x3B,0x66,0x66,0x3E,0x06,0x0F, // q
+0x00,0x00,0x6E,0x3B,0x33,0x30,0x78,0x00, // r
+0x00,0x00,0x3E,0x60,0x3C,0x06,0x7C,0x00, // s
+0x08,0x18,0x3E,0x18,0x18,0x1A,0x0C,0x00, // t
+0x00,0x00,0x66,0x66,0x66,0x66,0x3B,0x00, // u
+0x00,0x00,0x66,0x66,0x66,0x3C,0x18,0x00, // v
+0x00,0x00,0x63,0x6B,0x7F,0x7F,0x36,0x00, // w
+0x00,0x00,0x63,0x36,0x1C,0x36,0x63,0x00, // x
+0x00,0x00,0x66,0x66,0x66,0x3E,0x06,0x7C, // y
+0x00,0x00,0x7E,0x4C,0x18,0x32,0x7E,0x00, // z
+0x0E,0x18,0x18,0x70,0x18,0x18,0x0E,0x00, // {
+0x0C,0x0C,0x0C,0x00,0x0C,0x0C,0x0C,0x00, // |
+0x70,0x18,0x18,0x0E,0x18,0x18,0x70,0x00, // }
+0x3B,0x6E,0x00,0x00,0x00,0x00,0x00,0x00, // ~
+0x1C,0x36,0x36,0x1C,0x00,0x00,0x00,0x00}; // DEL
+    
+GraphicsDisplay::GraphicsDisplay(const char *name):TextDisplay(name) {
+    foreground(0xFFFF);
+    background(0x0000);
+}
+    
+void GraphicsDisplay::character(int column, int row, int value) { 
+    blitbit(column * 8, row * 8, 8, 8, (char*)&(FONT8x8[value - 0x1F][0]));
+}
+
+void GraphicsDisplay::window(unsigned int x,unsigned  int y,unsigned  int w,unsigned  int h) {
+    // current pixel location
+    _x = x;
+    _y = y;
+    // window settings
+    _x1 = x;
+    _x2 = x + w - 1;
+    _y1 = y;
+    _y2 = y + h - 1;
+}
+    
+void GraphicsDisplay::putp(int colour) {
+    // put pixel at current pixel location
+    pixel(_x, _y, colour);
+    // update pixel location based on window settings
+    _x++;
+    if(_x > _x2) {
+        _x = _x1;
+        _y++;
+        if(_y > _y2) {
+            _y = _y1;
+        }
+    }
+}
+
+void GraphicsDisplay::fill(int x, int y, int w, int h, int colour) { 
+    window(x, y, w, h);
+    for(int i=0; i<w*h; i++) {
+        putp(colour);
+    }
+}
+    
+void GraphicsDisplay::cls() {
+    fill(0, 0, width(), height(), _background);
+}
+    
+void GraphicsDisplay::blit(int x, int y, int w, int h, const int *colour) { 
+    window(x, y, w, h);
+    for(int i=0; i<w*h; i++) {
+        putp(colour[i]);
+    }
+}
+    
+void GraphicsDisplay::blitbit(int x, int y, int w, int h, const char* colour) {
+    window(x, y, w, h);
+    for(int i = 0; i < w*h; i++) {
+        char byte = colour[i >> 3];
+        int offset = i & 0x7;
+        int c = ((byte << offset) & 0x80) ? _foreground : _background;
+        putp(c);
+    }
+}
+    
+int GraphicsDisplay::columns() { 
+    return width() / 8; 
+}
+
+int GraphicsDisplay::rows() { 
+    return height() / 8; 
+}
+
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/GraphicsDisplay.h	Mon Jun 18 20:01:55 2018 +0000
@@ -0,0 +1,55 @@
+/* mbed GraphicsDisplay Display Library Base Class
+ * Copyright (c) 2007-2009 sford
+ * Released under the MIT License: http://mbed.org/license/mit
+ *
+ * A library for providing a common base class for Graphics displays
+ * To port a new display, derive from this class and implement
+ * the constructor (setup the display), pixel (put a pixel
+ * at a location), width and height functions. Everything else
+ * (locate, printf, putc, cls, window, putp, fill, blit, blitbit) 
+ * will come for free. You can also provide a specialised implementation
+ * of window and putp to speed up the results
+ */
+
+#ifndef MBED_GRAPHICSDISPLAY_H
+#define MBED_GRAPHICSDISPLAY_H
+
+#include "TextDisplay.h"
+
+class GraphicsDisplay : public TextDisplay {
+
+public:         
+          
+    GraphicsDisplay(const char* name);
+     
+    virtual void pixel(int x, int y, int colour) = 0;
+    virtual int width() = 0;
+    virtual int height() = 0;
+        
+    virtual void window(unsigned int x,unsigned int y,unsigned int w,unsigned int h);
+    virtual void putp(int colour);
+    
+    virtual void cls();
+    virtual void fill(int x, int y, int w, int h, int colour);
+    virtual void blit(int x, int y, int w, int h, const int *colour);    
+    virtual void blitbit(int x, int y, int w, int h, const char* colour);
+    
+    virtual void character(int column, int row, int value);
+    virtual int columns();
+    virtual int rows();
+    
+protected:
+
+    // pixel location
+    short _x;
+    short _y;
+    
+    // window location
+    short _x1;
+    short _x2;
+    short _y1;
+    short _y2;
+
+};
+
+#endif
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/SPI_TFT_ILI9341.cpp	Mon Jun 18 20:01:55 2018 +0000
@@ -0,0 +1,807 @@
+/* mbed library for 240*320 pixel display TFT based on ILI9341 LCD Controller
+ * Copyright (c) 2013 Peter Drescher - DC2PD
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ */
+ 
+// 12.06.13 fork from SPI_TFT code because controller is different ...
+// 14.07.13 Test with real display and bugfix 
+// 18.10.13 Better Circle function from Michael Ammann
+// 22.10.13 Fixes for Kinetis Board - 8 bit spi
+// 26.01.14 Change interface for BMP_16 to also use SD-cards
+// 23.06.14 switch back to old Version - fork for L152 
+// 24.06.14 Add compiler flag for optimized L152 version
+// 25.06.14 Add optimized F103 version
+
+// exclude this file for platforms with optimized version
+#if defined TARGET_NUCLEO_L152RE || defined TARGET_NUCLEO_F103RB || defined TARGET_LPC1768
+// this platforms are supported by special version in different source file
+#else
+
+#include "SPI_TFT_ILI9341.h"
+#include "mbed.h"
+
+#define BPP         16                  // Bits per pixel    
+         
+//extern Serial pc;
+//extern DigitalOut xx;     // debug !!
+
+SPI_TFT_ILI9341::SPI_TFT_ILI9341(PinName mosi, PinName miso, PinName sclk, PinName cs, PinName reset, PinName dc, const char *name)
+    : GraphicsDisplay(name), SPI(mosi, miso, sclk,NC), _cs(cs), _reset(reset), _dc(dc)
+{
+    
+    orientation = 0;
+    char_x = 0;
+    SPI::format(8,3);                  // 8 bit spi mode 3
+    SPI::frequency(10000000);          // 10 Mhz SPI clock
+    tft_reset();
+}
+
+int SPI_TFT_ILI9341::width()
+{
+    if (orientation == 0 || orientation == 2) return 240;
+    else return 320;
+}
+
+
+int SPI_TFT_ILI9341::height()
+{
+    if (orientation == 0 || orientation == 2) return 320;
+    else return 240;
+}
+
+
+void SPI_TFT_ILI9341::set_orientation(unsigned int o)
+{
+    orientation = o;
+    wr_cmd(0x36);                     // MEMORY_ACCESS_CONTROL
+    switch (orientation) {
+        case 0:
+            SPI::write(0x48);
+            break;
+        case 1:
+            SPI::write(0x28);
+            break;
+        case 2:
+            SPI::write(0x88);
+            break;
+        case 3:
+            SPI::write(0xE8);
+            break;
+    }
+    _cs = 1; 
+    WindowMax();
+} 
+
+
+// write command to tft register
+
+void SPI_TFT_ILI9341::wr_cmd(unsigned char cmd)
+{
+    _dc = 0;
+    _cs = 0;
+    SPI::write(cmd);      // mbed lib
+    _dc = 1;
+}
+
+
+
+void SPI_TFT_ILI9341::wr_dat(unsigned char dat)
+{
+   SPI::write(dat);      // mbed lib
+}
+
+
+
+// the ILI9341 can read 
+
+char SPI_TFT_ILI9341::rd_byte(unsigned char cmd)
+{
+    char r;
+    _dc = 0;
+    _cs = 0;
+    SPI::write(cmd);      // mbed lib
+    _cs = 1;
+    r = SPI::write(0xff);
+    _cs = 1;    
+    return(r);
+}
+
+// read 32 bit
+int SPI_TFT_ILI9341::rd_32(unsigned char cmd)
+{
+    int d;
+    char r;
+    _dc = 0;
+    _cs = 0;
+    d = cmd;
+    d = d << 1;
+    SPI::format(9,3);    // we have to add a dummy clock cycle
+    SPI::write(d);
+    SPI::format(8,3);   
+    _dc = 1;
+    r = SPI::write(0xff);
+    d = r;
+    r = SPI::write(0xff);
+    d = (d << 8) | r;
+    r = SPI::write(0xff);
+    d = (d << 8) | r;
+    r = SPI::write(0xff);
+    d = (d << 8) | r;
+    _cs = 1;    
+    return(d);
+}
+
+int  SPI_TFT_ILI9341::Read_ID(void){
+    int r;
+    r = rd_byte(0x0A);
+    r = rd_byte(0x0A);
+    r = rd_byte(0x0A);
+    r = rd_byte(0x0A);
+    return(r);
+}
+
+
+// Init code based on MI0283QT datasheet
+
+void SPI_TFT_ILI9341::tft_reset()
+{
+    _cs = 1;                           // cs high
+    _dc = 1;                           // dc high 
+    _reset = 0;                        // display reset
+
+    wait_us(50);
+    _reset = 1;                       // end hardware reset
+    wait_ms(5);
+     
+    wr_cmd(0x01);                     // SW reset  
+    wait_ms(5);
+    wr_cmd(0x28);                     // display off  
+
+    /* Start Initial Sequence ----------------------------------------------------*/
+     wr_cmd(0xCF);                     
+     SPI::write(0x00);
+     SPI::write(0x83);
+     SPI::write(0x30);
+     _cs = 1;
+     
+     wr_cmd(0xED);                     
+     SPI::write(0x64);
+     SPI::write(0x03);
+     SPI::write(0x12);
+     SPI::write(0x81);
+     _cs = 1;
+     
+     wr_cmd(0xE8);                     
+     SPI::write(0x85);
+     SPI::write(0x01);
+     SPI::write(0x79);
+     _cs = 1;
+     
+     wr_cmd(0xCB);                     
+     SPI::write(0x39);
+     SPI::write(0x2C);
+     SPI::write(0x00);
+     SPI::write(0x34);
+     SPI::write(0x02);
+     _cs = 1;
+           
+     wr_cmd(0xF7);                     
+     SPI::write(0x20);
+     _cs = 1;
+           
+     wr_cmd(0xEA);                     
+     SPI::write(0x00);
+     SPI::write(0x00);
+     _cs = 1;
+     
+     wr_cmd(0xC0);                     // POWER_CONTROL_1
+     SPI::write(0x26);
+     _cs = 1;
+ 
+     wr_cmd(0xC1);                     // POWER_CONTROL_2
+     SPI::write(0x11);
+     _cs = 1;
+     
+     wr_cmd(0xC5);                     // VCOM_CONTROL_1
+     SPI::write(0x35);
+     SPI::write(0x3E);
+     _cs = 1;
+     
+     wr_cmd(0xC7);                     // VCOM_CONTROL_2
+     SPI::write(0xBE);
+     _cs = 1; 
+     
+     wr_cmd(0x36);                     // MEMORY_ACCESS_CONTROL
+     SPI::write(0x48);
+     _cs = 1; 
+     
+     wr_cmd(0x3A);                     // COLMOD_PIXEL_FORMAT_SET
+     SPI::write(0x55);                 // 16 bit pixel 
+     _cs = 1;
+     
+     wr_cmd(0xB1);                     // Frame Rate
+     SPI::write(0x00);
+     SPI::write(0x1B);               
+     _cs = 1;
+     
+     wr_cmd(0xF2);                     // Gamma Function Disable
+     SPI::write(0x08);
+     _cs = 1; 
+     
+     wr_cmd(0x26);                     
+     SPI::write(0x01);                 // gamma set for curve 01/2/04/08
+     _cs = 1; 
+     
+     wr_cmd(0xE0);                     // positive gamma correction
+     SPI::write(0x1F); 
+     SPI::write(0x1A); 
+     SPI::write(0x18); 
+     SPI::write(0x0A); 
+     SPI::write(0x0F); 
+     SPI::write(0x06); 
+     SPI::write(0x45); 
+     SPI::write(0x87); 
+     SPI::write(0x32); 
+     SPI::write(0x0A); 
+     SPI::write(0x07); 
+     SPI::write(0x02); 
+     SPI::write(0x07);
+     SPI::write(0x05); 
+     SPI::write(0x00);
+     _cs = 1;
+     
+     wr_cmd(0xE1);                     // negativ gamma correction
+     SPI::write(0x00); 
+     SPI::write(0x25); 
+     SPI::write(0x27); 
+     SPI::write(0x05); 
+     SPI::write(0x10); 
+     SPI::write(0x09); 
+     SPI::write(0x3A); 
+     SPI::write(0x78); 
+     SPI::write(0x4D); 
+     SPI::write(0x05); 
+     SPI::write(0x18); 
+     SPI::write(0x0D); 
+     SPI::write(0x38);
+     SPI::write(0x3A); 
+     SPI::write(0x1F);
+     _cs = 1;
+     
+     WindowMax ();
+     
+     //wr_cmd(0x34);                     // tearing effect off
+     //_cs = 1;
+     
+     //wr_cmd(0x35);                     // tearing effect on
+     //_cs = 1;
+      
+     wr_cmd(0xB7);                       // entry mode
+     SPI::write(0x07);
+     _cs = 1;
+     
+     wr_cmd(0xB6);                       // display function control
+     SPI::write(0x0A);
+     SPI::write(0x82);
+     SPI::write(0x27);
+     SPI::write(0x00);
+     _cs = 1;
+     
+     wr_cmd(0x11);                     // sleep out
+     _cs = 1;
+     
+     wait_ms(100);
+     
+     wr_cmd(0x29);                     // display on
+     _cs = 1;
+     
+     wait_ms(100);
+     
+ }
+
+
+void SPI_TFT_ILI9341::pixel(int x, int y, int color)
+{
+    wr_cmd(0x2A);
+    SPI::write(x >> 8);
+    SPI::write(x);
+    _cs = 1;
+    wr_cmd(0x2B);
+    SPI::write(y >> 8);
+    SPI::write(y);
+    _cs = 1;
+    wr_cmd(0x2C);  // send pixel
+    #if defined TARGET_KL25Z  // 8 Bit SPI
+    SPI::write(color >> 8);
+    SPI::write(color & 0xff);
+    #else 
+    SPI::format(16,3);                            // switch to 16 bit Mode 3
+    SPI::write(color);                              // Write D0..D15
+    SPI::format(8,3);
+    #endif
+    _cs = 1;
+}
+
+
+void SPI_TFT_ILI9341::window (unsigned int x, unsigned int y, unsigned int w, unsigned int h)
+{
+    wr_cmd(0x2A);
+    SPI::write(x >> 8);
+    SPI::write(x);
+    SPI::write((x+w-1) >> 8);
+    SPI::write(x+w-1);
+    
+    _cs = 1;
+    wr_cmd(0x2B);
+    SPI::write(y >> 8);
+    SPI::write(y);
+    SPI::write((y+h-1) >> 8);
+    SPI::write(y+h-1);
+    _cs = 1;
+}
+
+
+void SPI_TFT_ILI9341::WindowMax (void)
+{
+    window (0, 0, width(),  height());
+}
+
+
+
+void SPI_TFT_ILI9341::cls (void)
+{
+   // we can use the fillrect function 
+   fillrect(0,0,width()-1,height()-1,_background);
+}
+
+
+void SPI_TFT_ILI9341::circle(int x0, int y0, int r, int color)
+{
+
+    int x = -r, y = 0, err = 2-2*r, e2;
+    do {
+        pixel(x0-x, y0+y,color);
+        pixel(x0+x, y0+y,color);
+        pixel(x0+x, y0-y,color);
+        pixel(x0-x, y0-y,color);
+        e2 = err;
+        if (e2 <= y) {
+            err += ++y*2+1;
+            if (-x == y && e2 <= x) e2 = 0;
+        }
+        if (e2 > x) err += ++x*2+1;
+    } while (x <= 0);
+
+}
+
+void SPI_TFT_ILI9341::fillcircle(int x0, int y0, int r, int color)
+{
+    int x = -r, y = 0, err = 2-2*r, e2;
+    do {
+        vline(x0-x, y0-y, y0+y, color);
+        vline(x0+x, y0-y, y0+y, color);
+        e2 = err;
+        if (e2 <= y) {
+            err += ++y*2+1;
+            if (-x == y && e2 <= x) e2 = 0;
+        }
+        if (e2 > x) err += ++x*2+1;
+    } while (x <= 0);
+}
+
+
+void SPI_TFT_ILI9341::hline(int x0, int x1, int y, int color)
+{
+    int w;
+    w = x1 - x0 + 1;
+    window(x0,y,w,1);
+    wr_cmd(0x2C);  // send pixel
+    #if defined TARGET_KL25Z  // 8 Bit SPI
+    int j;
+    for (j=0; j<w; j++) {
+        SPI::write(color >> 8);
+        SPI::write(color & 0xff);
+    } 
+    #else 
+    SPI::format(16,3);                            // switch to 16 bit Mode 3
+    int j;
+    for (j=0; j<w; j++) {
+        SPI::write(color);
+    }
+    SPI::format(8,3);
+    #endif
+    _cs = 1;
+    WindowMax();
+    return;
+}
+
+void SPI_TFT_ILI9341::vline(int x, int y0, int y1, int color)
+{
+    int h;
+    h = y1 - y0 + 1;
+    window(x,y0,1,h);
+    wr_cmd(0x2C);  // send pixel
+    #if defined TARGET_KL25Z  // 8 Bit SPI
+    for (int y=0; y<h; y++) {
+        SPI::write(color >> 8);
+        SPI::write(color & 0xff);
+    } 
+    #else 
+    SPI::format(16,3);                            // switch to 16 bit Mode 3
+    for (int y=0; y<h; y++) {
+        SPI::write(color);
+    }
+    SPI::format(8,3);
+    #endif
+    _cs = 1;
+    WindowMax();
+    return;
+}
+
+
+
+void SPI_TFT_ILI9341::line(int x0, int y0, int x1, int y1, int color)
+{
+    //WindowMax();
+    int   dx = 0, dy = 0;
+    int   dx_sym = 0, dy_sym = 0;
+    int   dx_x2 = 0, dy_x2 = 0;
+    int   di = 0;
+
+    dx = x1-x0;
+    dy = y1-y0;
+
+    if (dx == 0) {        /* vertical line */
+        if (y1 > y0) vline(x0,y0,y1,color);
+        else vline(x0,y1,y0,color);
+        return;
+    }
+
+    if (dx > 0) {
+        dx_sym = 1;
+    } else {
+        dx_sym = -1;
+    }
+    if (dy == 0) {        /* horizontal line */
+        if (x1 > x0) hline(x0,x1,y0,color);
+        else  hline(x1,x0,y0,color);
+        return;
+    }
+
+    if (dy > 0) {
+        dy_sym = 1;
+    } else {
+        dy_sym = -1;
+    }
+
+    dx = dx_sym*dx;
+    dy = dy_sym*dy;
+
+    dx_x2 = dx*2;
+    dy_x2 = dy*2;
+
+    if (dx >= dy) {
+        di = dy_x2 - dx;
+        while (x0 != x1) {
+
+            pixel(x0, y0, color);
+            x0 += dx_sym;
+            if (di<0) {
+                di += dy_x2;
+            } else {
+                di += dy_x2 - dx_x2;
+                y0 += dy_sym;
+            }
+        }
+        pixel(x0, y0, color);
+    } else {
+        di = dx_x2 - dy;
+        while (y0 != y1) {
+            pixel(x0, y0, color);
+            y0 += dy_sym;
+            if (di < 0) {
+                di += dx_x2;
+            } else {
+                di += dx_x2 - dy_x2;
+                x0 += dx_sym;
+            }
+        }
+        pixel(x0, y0, color);
+    }
+    return;
+}
+
+
+void SPI_TFT_ILI9341::rect(int x0, int y0, int x1, int y1, int color)
+{
+
+    if (x1 > x0) hline(x0,x1,y0,color);
+    else  hline(x1,x0,y0,color);
+
+    if (y1 > y0) vline(x0,y0,y1,color);
+    else vline(x0,y1,y0,color);
+
+    if (x1 > x0) hline(x0,x1,y1,color);
+    else  hline(x1,x0,y1,color);
+
+    if (y1 > y0) vline(x1,y0,y1,color);
+    else vline(x1,y1,y0,color);
+
+    return;
+}
+
+
+
+void SPI_TFT_ILI9341::fillrect(int x0, int y0, int x1, int y1, int color)
+{
+
+    int h = y1 - y0 + 1;
+    int w = x1 - x0 + 1;
+    int pixel = h * w;
+    window(x0,y0,w,h);
+    wr_cmd(0x2C);  // send pixel 
+    #if defined TARGET_KL25Z  // 8 Bit SPI
+    for (int p=0; p<pixel; p++) {
+        SPI::write(color >> 8);
+        SPI::write(color & 0xff);
+    }
+   #else
+    SPI::format(16,3);                            // switch to 16 bit Mode 3
+    for (int p=0; p<pixel; p++) {
+        SPI::write(color);
+    }
+    SPI::format(8,3);
+    #endif
+    _cs = 1;
+    WindowMax();
+    return;
+}
+
+
+void SPI_TFT_ILI9341::locate(int x, int y)
+{
+    char_x = x;
+    char_y = y;
+}
+
+
+
+int SPI_TFT_ILI9341::columns()
+{
+    return width() / font[1];
+}
+
+
+
+int SPI_TFT_ILI9341::rows()
+{
+    return height() / font[2];
+}
+
+
+
+int SPI_TFT_ILI9341::_putc(int value)
+{
+    if (value == '\n') {    // new line
+        char_x = 0;
+        char_y = char_y + font[2];
+        if (char_y >= height() - font[2]) {
+            char_y = 0;
+        }
+    } else {
+        character(char_x, char_y, value);
+    }
+    return value;
+}
+
+
+void SPI_TFT_ILI9341::character(int x, int y, int c)
+{
+    unsigned int hor,vert,offset,bpl,j,i,b;
+    unsigned char* zeichen;
+    unsigned char z,w;
+
+    if ((c < 31) || (c > 127)) return;   // test char range
+
+    // read font parameter from start of array
+    offset = font[0];                    // bytes / char
+    hor = font[1];                       // get hor size of font
+    vert = font[2];                      // get vert size of font
+    bpl = font[3];                       // bytes per line
+
+    if (char_x + hor > width()) {
+        char_x = 0;
+        char_y = char_y + vert;
+        if (char_y >= height() - font[2]) {
+            char_y = 0;
+        }
+    }
+    window(char_x, char_y,hor,vert); // char box
+    wr_cmd(0x2C);  // send pixel
+    #ifndef TARGET_KL25Z  // 16 Bit SPI 
+    SPI::format(16,3);   
+    #endif                         // switch to 16 bit Mode 3
+    zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap
+    w = zeichen[0];                          // width of actual char
+     for (j=0; j<vert; j++) {  //  vert line
+        for (i=0; i<hor; i++) {   //  horz line
+            z =  zeichen[bpl * i + ((j & 0xF8) >> 3)+1];
+            b = 1 << (j & 0x07);
+            if (( z & b ) == 0x00) {
+               #ifndef TARGET_KL25Z  // 16 Bit SPI 
+                SPI::write(_background);
+               #else
+                SPI::write(_background >> 8);
+                SPI::write(_background & 0xff);
+                #endif
+            } else {
+                #ifndef TARGET_KL25Z  // 16 Bit SPI
+                SPI::write(_foreground);
+                #else
+                SPI::write(_foreground >> 8);
+                SPI::write(_foreground & 0xff);
+                #endif
+            }
+        }
+    }
+    _cs = 1;
+    #ifndef TARGET_KL25Z  // 16 Bit SPI
+    SPI::format(8,3);
+    #endif
+    WindowMax();
+    if ((w + 2) < hor) {                   // x offset to next char
+        char_x += w + 2;
+    } else char_x += hor;
+}
+
+
+void SPI_TFT_ILI9341::set_font(unsigned char* f)
+{
+    font = f;
+}
+
+
+
+void SPI_TFT_ILI9341::Bitmap(unsigned int x, unsigned int y, unsigned int w, unsigned int h,unsigned char *bitmap)
+{
+    unsigned int  j;
+    int padd;
+    unsigned short *bitmap_ptr = (unsigned short *)bitmap;
+    #if defined TARGET_KL25Z  // 8 Bit SPI
+        unsigned short pix_temp;
+    #endif
+    
+    unsigned int i;
+    
+    // the lines are padded to multiple of 4 bytes in a bitmap
+    padd = -1;
+    do {
+        padd ++;
+    } while (2*(w + padd)%4 != 0);
+    window(x, y, w, h);
+    bitmap_ptr += ((h - 1)* (w + padd));
+    wr_cmd(0x2C);  // send pixel
+    #ifndef TARGET_KL25Z  // 16 Bit SPI 
+    SPI::format(16,3);
+    #endif                            // switch to 16 bit Mode 3
+    for (j = 0; j < h; j++) {         //Lines
+        for (i = 0; i < w; i++) {     // one line
+            #if defined TARGET_KL25Z  // 8 Bit SPI
+                pix_temp = *bitmap_ptr;
+                SPI::write(pix_temp >> 8);
+                SPI::write(pix_temp);
+                bitmap_ptr++;
+            #else
+                SPI::write(*bitmap_ptr);    // one line
+                bitmap_ptr++;
+            #endif
+        }
+        bitmap_ptr -= 2*w;
+        bitmap_ptr -= padd;
+    }
+    _cs = 1;
+    #ifndef TARGET_KL25Z  // 16 Bit SPI 
+    SPI::format(8,3);
+    #endif
+    WindowMax();
+}
+
+
+// local filesystem is not implemented in kinetis board , but you can add a SD card
+
+int SPI_TFT_ILI9341::BMP_16(unsigned int x, unsigned int y, const char *Name_BMP)
+{
+
+#define OffsetPixelWidth    18
+#define OffsetPixelHeigh    22
+#define OffsetFileSize      34
+#define OffsetPixData       10
+#define OffsetBPP           28
+
+    char filename[50];
+    unsigned char BMP_Header[54];
+    unsigned short BPP_t;
+    unsigned int PixelWidth,PixelHeigh,start_data;
+    unsigned int    i,off;
+    int padd,j;
+    unsigned short *line;
+
+    // get the filename
+    i=0;
+    while (*Name_BMP!='\0') {
+        filename[i++]=*Name_BMP++;
+    }
+    filename[i] = 0;  
+    
+    FILE *Image = fopen((const char *)&filename[0], "rb");  // open the bmp file
+    if (!Image) {
+        return(0);      // error file not found !
+    }
+
+    fread(&BMP_Header[0],1,54,Image);      // get the BMP Header
+
+    if (BMP_Header[0] != 0x42 || BMP_Header[1] != 0x4D) {  // check magic byte
+        fclose(Image);
+        return(-1);     // error no BMP file
+    }
+
+    BPP_t = BMP_Header[OffsetBPP] + (BMP_Header[OffsetBPP + 1] << 8);
+    if (BPP_t != 0x0010) {
+        fclose(Image);
+        return(-2);     // error no 16 bit BMP
+    }
+
+    PixelHeigh = BMP_Header[OffsetPixelHeigh] + (BMP_Header[OffsetPixelHeigh + 1] << 8) + (BMP_Header[OffsetPixelHeigh + 2] << 16) + (BMP_Header[OffsetPixelHeigh + 3] << 24);
+    PixelWidth = BMP_Header[OffsetPixelWidth] + (BMP_Header[OffsetPixelWidth + 1] << 8) + (BMP_Header[OffsetPixelWidth + 2] << 16) + (BMP_Header[OffsetPixelWidth + 3] << 24);
+    if (PixelHeigh > height() + y || PixelWidth > width() + x) {
+        fclose(Image);
+        return(-3);      // to big
+    }
+
+    start_data = BMP_Header[OffsetPixData] + (BMP_Header[OffsetPixData + 1] << 8) + (BMP_Header[OffsetPixData + 2] << 16) + (BMP_Header[OffsetPixData + 3] << 24);
+
+    line = (unsigned short *) malloc (2 * PixelWidth); // we need a buffer for a line
+    if (line == NULL) {
+        return(-4);         // error no memory
+    }
+
+    // the bmp lines are padded to multiple of 4 bytes
+    padd = -1;
+    do {
+        padd ++;
+    } while ((PixelWidth * 2 + padd)%4 != 0);
+
+    window(x, y,PixelWidth ,PixelHeigh);
+    wr_cmd(0x2C);  // send pixel
+    #ifndef TARGET_KL25Z // only 8 Bit SPI 
+    SPI::format(16,3);  
+    #endif                          // switch to 16 bit Mode 3
+    for (j = PixelHeigh - 1; j >= 0; j--) {               //Lines bottom up
+        off = j * (PixelWidth  * 2 + padd) + start_data;   // start of line
+        fseek(Image, off ,SEEK_SET);
+        fread(line,1,PixelWidth * 2,Image);       // read a line - slow 
+        for (i = 0; i < PixelWidth; i++) {        // copy pixel data to TFT
+        #ifndef TARGET_KL25Z // only 8 Bit SPI
+            SPI::write(line[i]);                  // one 16 bit pixel
+        #else  
+            SPI::write(line[i] >> 8);
+            SPI::write(line[i]);
+        #endif    
+        } 
+     }
+    _cs = 1;
+    SPI::format(8,3);
+    free (line);
+    fclose(Image);
+    WindowMax();
+    return(1);
+}
+
+#endif
\ No newline at end of file
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/SPI_TFT_ILI9341.h	Mon Jun 18 20:01:55 2018 +0000
@@ -0,0 +1,410 @@
+/* mbed library for 240*320 pixel display TFT based on ILI9341 LCD Controller
+ * Copyright (c) 2013 Peter Drescher - DC2PD
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ */
+ 
+ /* change the char position handling
+  * use pixel (x,y) instadt of colum row */
+ 
+#ifndef MBED_SPI_TFT_ILI9341_H
+#define MBED_SPI_TFT_ILI9341_H
+
+#include "mbed.h"
+#include "GraphicsDisplay.h"
+
+#define RGB(r,g,b)  (((r&0xF8)<<8)|((g&0xFC)<<3)|((b&0xF8)>>3)) //5 red | 6 green | 5 blue
+
+
+/* some RGB color definitions                                                 */
+#define Black           0x0000      /*   0,   0,   0 */
+#define Navy            0x000F      /*   0,   0, 128 */
+#define DarkGreen       0x03E0      /*   0, 128,   0 */
+#define DarkCyan        0x03EF      /*   0, 128, 128 */
+#define Maroon          0x7800      /* 128,   0,   0 */
+#define Purple          0x780F      /* 128,   0, 128 */
+#define Olive           0x7BE0      /* 128, 128,   0 */
+#define LightGrey       0xC618      /* 192, 192, 192 */
+#define DarkGrey        0x7BEF      /* 128, 128, 128 */
+#define Blue            0x001F      /*   0,   0, 255 */
+#define Green           0x07E0      /*   0, 255,   0 */
+#define Cyan            0x07FF      /*   0, 255, 255 */
+#define Red             0xF800      /* 255,   0,   0 */
+#define Magenta         0xF81F      /* 255,   0, 255 */
+#define Yellow          0xFFE0      /* 255, 255,   0 */
+#define White           0xFFFF      /* 255, 255, 255 */
+#define Orange          0xFD20      /* 255, 165,   0 */
+#define GreenYellow     0xAFE5      /* 173, 255,  47 */
+
+
+/** Display control class, based on GraphicsDisplay and TextDisplay
+ *
+ * Example:
+ * @code
+ * #include "stdio.h"
+ * #include "mbed.h"
+ * #include "SPI_TFT_ILI9341.h"
+ * #include "string"
+ * #include "Arial12x12.h"
+ * #include "Arial24x23.h"
+ * 
+ *
+ *
+ * // the TFT is connected to SPI pin 5-7 and IO's 8-10
+ * SPI_TFT_ILI9341 TFT(p5, p6, p7, p8, p9, p10,"TFT"); // mosi, miso, sclk, cs, reset, dc
+ * If your display need a signal for switch the backlight use a aditional IO pin in your program 
+ *
+ * int main() {
+ *     TFT.claim(stdout);      // send stdout to the TFT display 
+ *     //TFT.claim(stderr);      // send stderr to the TFT display
+ *
+ *     TFT.background(Black);    // set background to black
+ *     TFT.foreground(White);    // set chars to white
+ *     TFT.cls();                // clear the screen
+ *     TFT.set_font((unsigned char*) Arial12x12);  // select the font
+ *     
+ *     TFT.set_orientation(0);
+ *     printf("  Hello Mbed 0");
+ *     TFT.set_font((unsigned char*) Arial24x23);  // select font 2
+ *     TFT.locate(48,115);
+ *     TFT.printf("Bigger Font");
+ *  }
+ * @endcode
+ */
+ class SPI_TFT_ILI9341 : public GraphicsDisplay , public SPI {
+ public:
+
+  /** Create a SPI_TFT object connected to SPI and three pins
+   *
+   * @param mosi pin connected to SDO of display
+   * @param miso pin connected to SDI of display
+   * @param sclk pin connected to RS of display 
+   * @param cs pin connected to CS of display
+   * @param reset pin connected to RESET of display
+   * @param dc pin connected to WR of display
+   * the IM pins have to be set to 1110 (3-0) 
+   */ 
+  SPI_TFT_ILI9341(PinName mosi, PinName miso, PinName sclk, PinName cs, PinName reset, PinName dc, const char* name ="TFT");
+    
+  /** Get the width of the screen in pixel
+   *
+   * @returns width of screen in pixel
+   *
+   */    
+  virtual int width();
+
+  /** Get the height of the screen in pixel
+   *
+   * @returns height of screen in pixel 
+   *
+   */     
+  virtual int height();
+    
+  /** Draw a pixel at x,y with color 
+   *  
+   * @param x horizontal position
+   * @param y vertical position
+   * @param color 16 bit pixel color
+   */    
+  virtual void pixel(int x, int y,int colour);
+    
+  /** draw a circle
+   *
+   * @param x0,y0 center
+   * @param r radius
+   * @param color 16 bit color                                                                 *
+   *
+   */    
+  void circle(int x, int y, int r, int colour); 
+  
+  /** draw a filled circle
+   *
+   * @param x0,y0 center
+   * @param r radius
+   * @param color 16 bit color                                                                 *
+   */    
+  void fillcircle(int x, int y, int r, int colour); 
+ 
+    
+  /** draw a 1 pixel line
+   *
+   * @param x0,y0 start point
+   * @param x1,y1 stop point
+   * @param color 16 bit color
+   *
+   */    
+  void line(int x0, int y0, int x1, int y1, int colour);
+    
+  /** draw a rect
+   *
+   * @param x0,y0 top left corner
+   * @param x1,y1 down right corner
+   * @param color 16 bit color
+   *                                                   *
+   */    
+  void rect(int x0, int y0, int x1, int y1, int colour);
+    
+  /** draw a filled rect
+   *
+   * @param x0,y0 top left corner
+   * @param x1,y1 down right corner
+   * @param color 16 bit color
+   *
+   */    
+  void fillrect(int x0, int y0, int x1, int y1, int colour);
+    
+  /** setup cursor position
+   *
+   * @param x x-position (top left)
+   * @param y y-position 
+   */   
+  virtual void locate(int x, int y);
+    
+  /** Fill the screen with _backgroun color
+   *
+   */   
+  virtual void cls (void);   
+    
+  /** calculate the max number of char in a line
+   *
+   * @returns max columns
+   * depends on actual font size
+   *
+   */    
+  virtual int columns(void);
+    
+  /** calculate the max number of columns
+   *
+   * @returns max column
+   * depends on actual font size
+   *
+   */   
+  virtual int rows(void);
+    
+  /** put a char on the screen
+   *
+   * @param value char to print
+   * @returns printed char
+   *
+   */
+  virtual int _putc(int value);
+    
+  /** draw a character on given position out of the active font to the TFT
+   *
+   * @param x x-position of char (top left) 
+   * @param y y-position
+   * @param c char to print
+   *
+   */    
+  virtual void character(int x, int y, int c);
+    
+  /** paint a bitmap on the TFT 
+   *
+   * @param x,y : upper left corner 
+   * @param w width of bitmap
+   * @param h high of bitmap
+   * @param *bitmap pointer to the bitmap data
+   *
+   *   bitmap format: 16 bit R5 G6 B5
+   * 
+   *   use Gimp to create / load , save as BMP, option 16 bit R5 G6 B5            
+   *   use winhex to load this file and mark data stating at offset 0x46 to end
+   *   use edit -> copy block -> C Source to export C array
+   *   paste this array into your program
+   * 
+   *   define the array as static const unsigned char to put it into flash memory
+   *   cast the pointer to (unsigned char *) :
+   *   tft.Bitmap(10,40,309,50,(unsigned char *)scala);
+   */    
+  void Bitmap(unsigned int x, unsigned int y, unsigned int w, unsigned int h,unsigned char *bitmap);
+    
+    
+   /** paint a 16 bit BMP from filesytem on the TFT (slow) 
+   *
+   * @param x,y : position of upper left corner 
+   * @param *Name_BMP name of the BMP file with drive: "/local/test.bmp"
+   *
+   * @returns 1 if bmp file was found and painted
+   * @returns  0 if bmp file was found not found
+   * @returns -1 if file is no bmp
+   * @returns -2 if bmp file is no 16 bit bmp
+   * @returns -3 if bmp file is to big for screen 
+   * @returns -4 if buffer malloc go wrong
+   *
+   *   bitmap format: 16 bit R5 G6 B5
+   * 
+   *   use Gimp to create / load , save as BMP, option 16 bit R5 G6 B5
+   *   copy to internal file system or SD card           
+   */      
+    
+  int BMP_16(unsigned int x, unsigned int y, const char *Name_BMP);  
+    
+    
+    
+  /** select the font to use
+   *
+   * @param f pointer to font array 
+   *                                                                              
+   *   font array can created with GLCD Font Creator from http://www.mikroe.com
+   *   you have to add 4 parameter at the beginning of the font array to use: 
+   *   - the number of byte / char
+   *   - the vertial size in pixel
+   *   - the horizontal size in pixel
+   *   - the number of byte per vertical line
+   *   you also have to change the array to char[]
+   *
+   */  
+  void set_font(unsigned char* f);
+   
+  /** Set the orientation of the screen
+   *  x,y: 0,0 is always top left 
+   *
+   * @param o direction to use the screen (0-3)  
+   *
+   */  
+  void set_orientation(unsigned int o);
+  
+  
+  /** read out the manufacturer ID of the LCD
+   *  can used for checking the connection to the display
+   *  @returns ID
+   */ 
+  int Read_ID(void);
+  
+  DigitalOut _cs; 
+  DigitalOut _reset;
+  DigitalOut _dc;
+  unsigned char* font;
+  
+  
+  
+   
+protected:
+
+  /** Set draw window region to whole screen
+   *
+   */  
+  void WindowMax (void);
+
+
+  /** draw a horizontal line
+   *
+   * @param x0 horizontal start
+   * @param x1 horizontal stop
+   * @param y vertical position
+   * @param color 16 bit color                                               
+   *
+   */
+  void hline(int x0, int x1, int y, int colour);
+    
+  /** draw a vertical line
+   *
+   * @param x horizontal position
+   * @param y0 vertical start 
+   * @param y1 vertical stop
+   * @param color 16 bit color
+   */
+  void vline(int y0, int y1, int x, int colour);
+    
+  /** Set draw window region
+   *
+   * @param x horizontal position
+   * @param y vertical position
+   * @param w window width in pixel
+   * @param h window height in pixels
+   */    
+  virtual void window (unsigned int x,unsigned int y, unsigned int w, unsigned int h);
+    
+ 
+    
+  /** Init the ILI9341 controller 
+   *
+   */    
+  void tft_reset();
+    
+   /** Write data to the LCD controller
+   *
+   * @param dat data written to LCD controller
+   * 
+   */   
+  //void wr_dat(unsigned int value);
+  void wr_dat(unsigned char value);
+    
+  /** Write a command the LCD controller 
+   *
+   * @param cmd: command to be written   
+   *
+   */   
+  void wr_cmd(unsigned char value);
+    
+   /** Start data sequence to the LCD controller
+   * 
+   */   
+  //void wr_dat_start();
+    
+  /** Stop of data writing to the LCD controller
+   *   
+   */  
+  //void wr_dat_stop();
+    
+  /** write data to the LCD controller
+   *
+   * @param data to be written 
+   *                                           *
+   */    
+  //void wr_dat_only(unsigned short dat);
+    
+  /** Read byte from the LCD controller
+   *
+   * @param cmd comand to controller
+   * @returns data from LCD controller
+   *  
+   */    
+   char rd_byte(unsigned char cmd);
+    
+  
+  int rd_32(unsigned char cmd);  
+    
+    
+  /** Write a value to the to a LCD register
+   *
+   * @param reg register to be written
+   * @param val data to be written
+   */   
+  //void wr_reg (unsigned char reg, unsigned char val);
+    
+  /** Read a LCD register
+   *
+   * @param reg register to be read
+   * @returns value of the register 
+   */    
+  //unsigned short rd_reg (unsigned char reg);
+    
+  #if defined TARGET_NUCLEO_L152RE || defined TARGET_NUCLEO_F103RB || defined TARGET_LPC1768
+  /** fast SPI write function for optimized versions 
+   *
+   * @param data  data written to SPI
+   *
+   */
+  virtual void f_write(int data);
+  virtual void spi_bsy(void);
+  virtual void spi_16(bool s);
+  
+  #endif  
+    
+  unsigned char spi_port; 
+  unsigned int orientation;
+  unsigned int char_x;
+  unsigned int char_y;
+  unsigned char spi_num;
+  
+    
+};
+
+#endif
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/SPI_TFT_ILI9341_NUCLEO.cpp	Mon Jun 18 20:01:55 2018 +0000
@@ -0,0 +1,1048 @@
+/* mbed library for 240*320 pixel display TFT based on ILI9341 LCD Controller
+ * Copyright (c) 2013, 2014 Peter Drescher - DC2PD
+ * Special version for STM Nucleo -L152
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ */
+
+ // 24.06.14   initial version
+ // 25.06.14   add Nucleo F103RB 
+
+// only include this file if target is L152 or F103RB : 
+#if defined TARGET_NUCLEO_L152RE || defined TARGET_NUCLEO_F103RB
+
+#include "SPI_TFT_ILI9341.h"
+#include "mbed.h"
+
+#if defined TARGET_NUCLEO_L152RE
+#include "stm32l1xx_dma.h"
+#define use_ram
+#endif
+
+#if defined TARGET_NUCLEO_F103RB
+#include "stm32f10x_dma.h"
+#endif
+
+#define BPP         16                  // Bits per pixel
+
+//extern Serial pc;
+//extern DigitalOut xx;     // debug !!
+
+DMA_InitTypeDef DMA_InitStructure; 
+
+
+SPI_TFT_ILI9341::SPI_TFT_ILI9341(PinName mosi, PinName miso, PinName sclk, PinName cs, PinName reset, PinName dc, const char *name)
+    : GraphicsDisplay(name), SPI(mosi,miso,sclk,NC), _cs(cs), _reset(reset), _dc(dc)
+{
+
+    format(8,3);                 // 8 bit spi mode 3
+    frequency(10000000);         // 10 Mhz SPI clock : result 2 / 4 = 8
+    orientation = 0;
+    char_x = 0;
+    if(_spi.spi == SPI_1){       // test which SPI is in use
+         spi_num = 1;
+    }
+    if(_spi.spi == SPI_2){
+         spi_num = 2;
+    }
+    #ifdef SPI_3                // there is no SPI 3 on all devices
+    if(_spi.spi == SPI_3){
+         spi_num = 3;
+    }
+    #endif
+    tft_reset();
+}
+
+// we define a fast write to the SPI port
+// we use the bit banding address to get the flag without masking
+
+#define bit_SPI1_txe  *((volatile unsigned int *)0x42260104)
+#define SPI1_DR       *((volatile unsigned int *)0x4001300C)
+#define bit_SPI2_txe  *((volatile unsigned int *)0x42070104)
+#define SPI2_DR       *((volatile unsigned int *)0x4000380C)
+#define bit_SPI3_txe  *((volatile unsigned int *)0x42078104)
+#define SPI3_DR       *((volatile unsigned int *)0x40003C0C)
+
+void SPI_TFT_ILI9341::f_write(int data){
+
+switch(spi_num){  // used SPI port
+case (1):
+    while(bit_SPI1_txe == 0);  // wait for SPI1->SR TXE flag
+    SPI1_DR = data;
+    break;
+
+case (2):
+    while( bit_SPI2_txe  == 0);  // wait for SPI2->SR TXE flag
+    SPI2_DR = data;
+    break;
+
+case (3):
+    while( bit_SPI3_txe == 0);  // wait for SPI3->SR TXE flag
+    SPI3_DR = data;
+    break;
+
+    }
+}
+
+// wait for SPI not busy
+// we have to wait for the last bit to switch the cs off
+// we use the bit banding address to get the flag without masking
+
+#define bit_SPI1_bsy  *((volatile unsigned int *)0x4226011C)
+#define bit_SPI2_bsy  *((volatile unsigned int *)0x4207011C)
+#define bit_SPI3_bsy  *((volatile unsigned int *)0x4207811C)
+
+void inline SPI_TFT_ILI9341::spi_bsy(void){    
+switch(spi_num){        // decide which SPI is to use
+case (1):
+    while(bit_SPI1_bsy == 1);   // SPI1->SR bit 7
+    break;
+
+case (2):
+    while(bit_SPI2_bsy == 1);   // SPI2->SR bit 7
+    break;
+
+case (3):
+    while(bit_SPI3_bsy == 1);   // SPI2->SR bit 7
+    break;
+    }
+}
+
+
+// switch fast between 8 and 16 bit mode
+#define bit_SPI1_dff  *((volatile unsigned int *)0x4226002C)
+#define bit_SPI2_dff  *((volatile unsigned int *)0x4207002C)
+#define bit_SPI3_dff  *((volatile unsigned int *)0x4207802C)
+void SPI_TFT_ILI9341::spi_16(bool s){
+switch(spi_num){        // decide which SPI is to use
+case(1):
+    if(s) bit_SPI1_dff = 1; // switch to 16 bit Mode
+    else  bit_SPI1_dff = 0; // switch to 8  bit Mode
+    break;
+
+case(2):
+    if(s) bit_SPI2_dff = 1; // switch to 16 bit Mode
+    else  bit_SPI2_dff = 0; // switch to 8  bit Mode
+    break;
+
+case(3):
+    if(s) bit_SPI3_dff = 1; // switch to 16 bit Mode
+    else  bit_SPI3_dff = 0; // switch to 8  bit Mode
+    break;
+    }
+}
+
+
+int SPI_TFT_ILI9341::width()
+{
+    if (orientation == 0 || orientation == 2) return 240;
+    else return 320;
+}
+
+
+int SPI_TFT_ILI9341::height()
+{
+    if (orientation == 0 || orientation == 2) return 320;
+    else return 240;
+}
+
+
+void SPI_TFT_ILI9341::set_orientation(unsigned int o)
+{
+    orientation = o;
+    wr_cmd(0x36);                     // MEMORY_ACCESS_CONTROL
+    switch (orientation) {
+        case 0:
+            f_write(0x48);
+            break;
+        case 1:
+            f_write(0x28);
+            break;
+        case 2:
+            f_write(0x88);
+            break;
+        case 3:
+            f_write(0xE8);
+            break;
+    }
+    spi_bsy();    // wait for end of transfer
+    _cs = 1;
+    WindowMax();
+}
+
+
+// write command to tft register
+// use fast command
+void SPI_TFT_ILI9341::wr_cmd(unsigned char cmd)
+{
+    _dc = 0;
+    _cs = 0;
+    f_write(cmd);
+    spi_bsy();
+    _dc = 1;
+}
+
+void SPI_TFT_ILI9341::wr_dat(unsigned char dat)
+{
+   f_write(dat);
+   spi_bsy();  // wait for SPI send
+}
+
+// the ILI9341 can read
+char SPI_TFT_ILI9341::rd_byte(unsigned char cmd)
+{
+    // has to change !!
+    return(0);
+}
+
+// read 32 bit
+int SPI_TFT_ILI9341::rd_32(unsigned char cmd)
+{
+    // has to change !!!
+    return(0);
+}
+
+int  SPI_TFT_ILI9341::Read_ID(void){
+    int r;
+    r = rd_byte(0x0A);
+    r = rd_byte(0x0A);
+    r = rd_byte(0x0A);
+    r = rd_byte(0x0A);
+    return(r);
+}
+
+
+// Init code based on MI0283QT datasheet
+// this code is called only at start
+// no need to be optimized
+
+void SPI_TFT_ILI9341::tft_reset()
+{
+    _cs = 1;                           // cs high
+    _dc = 1;                           // dc high
+    _reset = 0;                        // display reset
+
+    wait_us(50);
+    _reset = 1;                       // end hardware reset
+    wait_ms(5);
+
+    wr_cmd(0x01);                     // SW reset
+    wait_ms(5);
+    wr_cmd(0x28);                     // display off
+
+    /* Start Initial Sequence ----------------------------------------------------*/
+    wr_cmd(0xCF);
+    f_write(0x00);
+    f_write(0x83);
+    f_write(0x30);
+    spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xED);
+     f_write(0x64);
+     f_write(0x03);
+     f_write(0x12);
+     f_write(0x81);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xE8);
+     f_write(0x85);
+     f_write(0x01);
+     f_write(0x79);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xCB);
+     f_write(0x39);
+     f_write(0x2C);
+     f_write(0x00);
+     f_write(0x34);
+     f_write(0x02);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xF7);
+     f_write(0x20);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xEA);
+     f_write(0x00);
+     f_write(0x00);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xC0);                     // POWER_CONTROL_1
+     f_write(0x26);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xC1);                     // POWER_CONTROL_2
+     f_write(0x11);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xC5);                     // VCOM_CONTROL_1
+     f_write(0x35);
+     f_write(0x3E);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xC7);                     // VCOM_CONTROL_2
+     f_write(0xBE);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0x36);                     // MEMORY_ACCESS_CONTROL
+     f_write(0x48);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0x3A);                     // COLMOD_PIXEL_FORMAT_SET
+     f_write(0x55);                 // 16 bit pixel
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xB1);                     // Frame Rate
+     f_write(0x00);
+     f_write(0x1B);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xF2);                     // Gamma Function Disable
+     f_write(0x08);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0x26);
+     f_write(0x01);                 // gamma set for curve 01/2/04/08
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xE0);                     // positive gamma correction
+     f_write(0x1F);
+     f_write(0x1A);
+     f_write(0x18);
+     f_write(0x0A);
+     f_write(0x0F);
+     f_write(0x06);
+     f_write(0x45);
+     f_write(0x87);
+     f_write(0x32);
+     f_write(0x0A);
+     f_write(0x07);
+     f_write(0x02);
+     f_write(0x07);
+     f_write(0x05);
+     f_write(0x00);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xE1);                     // negativ gamma correction
+     f_write(0x00);
+     f_write(0x25);
+     f_write(0x27);
+     f_write(0x05);
+     f_write(0x10);
+     f_write(0x09);
+     f_write(0x3A);
+     f_write(0x78);
+     f_write(0x4D);
+     f_write(0x05);
+     f_write(0x18);
+     f_write(0x0D);
+     f_write(0x38);
+     f_write(0x3A);
+     f_write(0x1F);
+     spi_bsy();
+     _cs = 1;
+
+     WindowMax ();
+
+     //wr_cmd(0x34);                     // tearing effect off
+     //_cs = 1;
+
+     //wr_cmd(0x35);                     // tearing effect on
+     //_cs = 1;
+
+     wr_cmd(0xB7);                       // entry mode
+     f_write(0x07);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0xB6);                       // display function control
+     f_write(0x0A);
+     f_write(0x82);
+     f_write(0x27);
+     f_write(0x00);
+     spi_bsy();
+     _cs = 1;
+
+     wr_cmd(0x11);                     // sleep out
+     spi_bsy();
+     _cs = 1;
+
+     wait_ms(100);
+
+     wr_cmd(0x29);                     // display on
+     spi_bsy();
+     _cs = 1;
+
+     wait_ms(100);
+
+    //    Configure the DMA controller init-structure
+    DMA_StructInit(&DMA_InitStructure);
+    switch(spi_num){        // decide which SPI is to use
+    case (1):
+        RCC_AHBPeriphClockCmd(RCC_AHBPeriph_DMA1, ENABLE);    // SPI1 and SPI2 are using DMA 1
+        DMA_InitStructure.DMA_PeripheralBaseAddr  = (uint32_t) &(SPI1->DR);
+        break;
+    case (2):
+        RCC_AHBPeriphClockCmd(RCC_AHBPeriph_DMA1, ENABLE);    // SPI1 and SPI2 are using DMA 1
+        DMA_InitStructure.DMA_PeripheralBaseAddr  = (uint32_t) &(SPI2->DR);
+        break;
+    case (3):
+        RCC_AHBPeriphClockCmd(RCC_AHBPeriph_DMA2, ENABLE);    // SPI3 is using DMA 2
+        DMA_InitStructure.DMA_PeripheralBaseAddr  = (uint32_t) &(SPI3->DR);
+        break;
+    }
+    DMA_InitStructure.DMA_DIR = DMA_DIR_PeripheralDST;
+    DMA_InitStructure.DMA_M2M = DMA_M2M_Disable;
+    DMA_InitStructure.DMA_BufferSize  = 0;
+    DMA_InitStructure.DMA_PeripheralInc  = DMA_PeripheralInc_Disable;
+    DMA_InitStructure.DMA_PeripheralDataSize  = DMA_PeripheralDataSize_HalfWord;
+    DMA_InitStructure.DMA_MemoryDataSize  = DMA_MemoryDataSize_HalfWord;
+    DMA_InitStructure.DMA_Mode  = DMA_Mode_Normal;
+    DMA_InitStructure.DMA_Priority  = DMA_Priority_High;
+ }
+
+
+// speed optimized
+// write direct to SPI1 register !
+void SPI_TFT_ILI9341::pixel(int x, int y, int color)
+{
+    wr_cmd(0x2A);
+    spi_16(1);         // switch to 8 bit Mode
+    f_write(x);
+    spi_bsy();
+    _cs = 1;
+
+    spi_16(0);        // switch to 8 bit Mode
+    wr_cmd(0x2B);
+    spi_16(1);
+    f_write(y);
+    spi_bsy();
+    _cs = 1;
+    spi_16(0);
+
+    wr_cmd(0x2C); // send pixel
+    spi_16(1);
+    f_write(color);
+    spi_bsy();
+    _cs = 1;
+    spi_16(0);
+}
+
+// optimized
+// write direct to SPI1 register !
+void SPI_TFT_ILI9341::window (unsigned int x, unsigned int y, unsigned int w, unsigned int h)
+{
+    wr_cmd(0x2A);
+    spi_16(1);
+    f_write(x);
+    f_write(x+w-1);
+    spi_bsy();
+    _cs = 1;
+    spi_16(0);
+
+    wr_cmd(0x2B);
+    spi_16(1);
+    f_write(y) ;
+    f_write(y+h-1);
+    spi_bsy();
+    _cs = 1;
+    spi_16(0);
+}
+
+
+void SPI_TFT_ILI9341::WindowMax (void)
+{
+    window (0, 0, width(),  height());
+}
+
+// optimized
+// use DMA to transfer pixel data to the screen
+void SPI_TFT_ILI9341::cls (void)
+{
+    // we can use the fillrect function 
+   fillrect(0,0,width()-1,height()-1,_background);
+}    
+
+void SPI_TFT_ILI9341::circle(int x0, int y0, int r, int color)
+{
+
+    int x = -r, y = 0, err = 2-2*r, e2;
+    do {
+        pixel(x0-x, y0+y,color);
+        pixel(x0+x, y0+y,color);
+        pixel(x0+x, y0-y,color);
+        pixel(x0-x, y0-y,color);
+        e2 = err;
+        if (e2 <= y) {
+            err += ++y*2+1;
+            if (-x == y && e2 <= x) e2 = 0;
+        }
+        if (e2 > x) err += ++x*2+1;
+    } while (x <= 0);
+}
+
+void SPI_TFT_ILI9341::fillcircle(int x0, int y0, int r, int color)
+{
+    int x = -r, y = 0, err = 2-2*r, e2;
+    do {
+        vline(x0-x, y0-y, y0+y, color);
+        vline(x0+x, y0-y, y0+y, color);
+        e2 = err;
+        if (e2 <= y) {
+            err += ++y*2+1;
+            if (-x == y && e2 <= x) e2 = 0;
+        }
+        if (e2 > x) err += ++x*2+1;
+    } while (x <= 0);
+}
+
+
+// optimized for speed
+void SPI_TFT_ILI9341::hline(int x0, int x1, int y, int color)
+{
+    int w,j;
+    w = x1 - x0 + 1;
+    window(x0,y,w,1);
+    _dc = 0;
+    _cs = 0;
+    f_write(0x2C); // send pixel
+    spi_bsy();
+    _dc = 1;
+    spi_16(1);
+
+    for (j=0; j<w; j++) {
+        f_write(color);
+    }
+    spi_bsy();
+    spi_16(0);
+    _cs = 1;
+    WindowMax();
+    return;
+}
+
+// optimized for speed
+void SPI_TFT_ILI9341::vline(int x, int y0, int y1, int color)
+{
+    int h,y;
+    h = y1 - y0 + 1;
+    window(x,y0,1,h);
+    _dc = 0;
+    _cs = 0;
+    f_write(0x2C); // send pixel
+    spi_bsy();
+    _dc = 1;
+    spi_16(1);
+                // switch to 16 bit Mode 3
+    for (y=0; y<h; y++) {
+        f_write(color);
+    }
+    spi_bsy();
+    spi_16(0);
+    _cs = 1;
+    WindowMax();
+    return;
+}
+
+
+void SPI_TFT_ILI9341::line(int x0, int y0, int x1, int y1, int color)
+{
+    //WindowMax();
+    int   dx = 0, dy = 0;
+    int   dx_sym = 0, dy_sym = 0;
+    int   dx_x2 = 0, dy_x2 = 0;
+    int   di = 0;
+
+    dx = x1-x0;
+    dy = y1-y0;
+
+    if (dx == 0) {        /* vertical line */
+        if (y1 > y0) vline(x0,y0,y1,color);
+        else vline(x0,y1,y0,color);
+        return;
+    }
+
+    if (dx > 0) {
+        dx_sym = 1;
+    } else {
+        dx_sym = -1;
+    }
+    if (dy == 0) {        /* horizontal line */
+        if (x1 > x0) hline(x0,x1,y0,color);
+        else  hline(x1,x0,y0,color);
+        return;
+    }
+
+    if (dy > 0) {
+        dy_sym = 1;
+    } else {
+        dy_sym = -1;
+    }
+
+    dx = dx_sym*dx;
+    dy = dy_sym*dy;
+
+    dx_x2 = dx*2;
+    dy_x2 = dy*2;
+
+    if (dx >= dy) {
+        di = dy_x2 - dx;
+        while (x0 != x1) {
+
+            pixel(x0, y0, color);
+            x0 += dx_sym;
+            if (di<0) {
+                di += dy_x2;
+            } else {
+                di += dy_x2 - dx_x2;
+                y0 += dy_sym;
+            }
+        }
+        pixel(x0, y0, color);
+    } else {
+        di = dx_x2 - dy;
+        while (y0 != y1) {
+            pixel(x0, y0, color);
+            y0 += dy_sym;
+            if (di < 0) {
+                di += dx_x2;
+            } else {
+                di += dx_x2 - dy_x2;
+                x0 += dx_sym;
+            }
+        }
+        pixel(x0, y0, color);
+    }
+    return;
+}
+
+
+void SPI_TFT_ILI9341::rect(int x0, int y0, int x1, int y1, int color)
+{
+
+    if (x1 > x0) hline(x0,x1,y0,color);
+    else  hline(x1,x0,y0,color);
+
+    if (y1 > y0) vline(x0,y0,y1,color);
+    else vline(x0,y1,y0,color);
+
+    if (x1 > x0) hline(x0,x1,y1,color);
+    else  hline(x1,x0,y1,color);
+
+    if (y1 > y0) vline(x1,y0,y1,color);
+    else vline(x1,y1,y0,color);
+
+    return;
+}
+
+
+
+// optimized for speed
+// use DMA
+void SPI_TFT_ILI9341::fillrect(int x0, int y0, int x1, int y1, int color)
+{
+
+    int h = y1 - y0 + 1;
+    int w = x1 - x0 + 1;
+    int pixel = h * w;
+    unsigned int dma_transfer;
+    window(x0,y0,w,h);
+
+    wr_cmd(0x2C);  // send pixel
+    spi_16(1);
+    DMA_InitStructure.DMA_MemoryBaseAddr  = (uint32_t) &color;
+    DMA_InitStructure.DMA_MemoryInc  = DMA_MemoryInc_Disable;
+
+    switch(spi_num){        // decide which SPI is to use
+    case (1):
+        DMA_Init(DMA1_Channel3, &DMA_InitStructure);  // init the DMA
+        do{
+            if(pixel < 0x10000) {
+                dma_transfer = pixel;
+                pixel = 0;
+            }
+            else {
+                dma_transfer = 0xffff;
+                pixel = pixel - 0xffff;
+            }
+            DMA_SetCurrDataCounter(DMA1_Channel3, dma_transfer);
+            SPI_I2S_DMACmd(SPI1, SPI_I2S_DMAReq_Tx,ENABLE);
+            DMA_Cmd(DMA1_Channel3, ENABLE);
+            while(DMA_GetCurrDataCounter(DMA1_Channel3) != 0);     // wait for end of transfer
+            DMA_Cmd(DMA1_Channel3, DISABLE);
+        }while(pixel > 0);
+        break;
+
+    case (2):
+        DMA_Init(DMA1_Channel5, &DMA_InitStructure);  // init the DMA
+        do{
+            if(pixel < 0x10000) {
+                dma_transfer = pixel;
+                pixel = 0;
+            }
+            else {
+                dma_transfer = 0xffff;
+                pixel = pixel - 0xffff;
+            }
+            DMA_SetCurrDataCounter(DMA1_Channel5, dma_transfer);
+            SPI_I2S_DMACmd(SPI2, SPI_I2S_DMAReq_Tx,ENABLE);
+            DMA_Cmd(DMA1_Channel5, ENABLE);
+            while(DMA_GetCurrDataCounter(DMA1_Channel5) != 0);     // wait for end of transfer
+            DMA_Cmd(DMA1_Channel5, DISABLE);
+        }while(pixel > 0);
+        break;
+
+    case (3):
+        DMA_Init(DMA2_Channel2, &DMA_InitStructure);  // init the DMA
+        do{
+            if(pixel < 0x10000) {
+                dma_transfer = pixel;
+                pixel = 0;
+            }
+            else {
+                dma_transfer = 0xffff;
+                pixel = pixel - 0xffff;
+            }
+            DMA_SetCurrDataCounter(DMA2_Channel2, dma_transfer);
+            SPI_I2S_DMACmd(SPI3, SPI_I2S_DMAReq_Tx,ENABLE);
+            DMA_Cmd(DMA2_Channel2, ENABLE);
+            while(DMA_GetCurrDataCounter(DMA2_Channel2) != 0);     // wait for end of transfer
+            DMA_Cmd(DMA2_Channel2, DISABLE);
+        }while(pixel > 0);
+        break;
+    }
+    spi_bsy();
+    spi_16(0);
+    _cs = 1;
+    WindowMax();
+    return;
+}
+
+void SPI_TFT_ILI9341::locate(int x, int y)
+{
+    char_x = x;
+    char_y = y;
+}
+
+int SPI_TFT_ILI9341::columns()
+{
+    return width() / font[1];
+}
+
+
+int SPI_TFT_ILI9341::rows()
+{
+    return height() / font[2];
+}
+
+
+int SPI_TFT_ILI9341::_putc(int value)
+{
+    if (value == '\n') {    // new line
+        char_x = 0;
+        char_y = char_y + font[2];
+        if (char_y >= height() - font[2]) {
+            char_y = 0;
+        }
+    } else {
+        character(char_x, char_y, value);
+    }
+    return value;
+}
+
+
+// speed optimized
+// will use dma
+void SPI_TFT_ILI9341::character(int x, int y, int c)
+{
+    unsigned int hor,vert,offset,bpl,j,i,b;
+    unsigned char* zeichen;
+    unsigned char z,w;
+    #ifdef use_ram
+    unsigned int pixel;
+    unsigned int p;
+    unsigned int dma_count,dma_off;
+    uint16_t *buffer;
+    #endif
+
+    if ((c < 31) || (c > 127)) return;   // test char range
+
+    // read font parameter from start of array
+    offset = font[0];                    // bytes / char
+    hor = font[1];                       // get hor size of font
+    vert = font[2];                      // get vert size of font
+    bpl = font[3];                       // bytes per line
+
+    if (char_x + hor > width()) {
+        char_x = 0;
+        char_y = char_y + vert;
+        if (char_y >= height() - font[2]) {
+            char_y = 0;
+        }
+    }
+    window(char_x, char_y,hor,vert);           // setup char box
+    wr_cmd(0x2C);
+    spi_16(1);                                 // switch to 16 bit Mode
+    #ifdef use_ram
+    pixel = hor * vert;                        // calculate buffer size
+    buffer = (uint16_t *) malloc (2*pixel);    // we need a buffer for the font
+    if(buffer != NULL) {                       // there is memory space -> use dma
+        zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap
+        w = zeichen[0];                          // width of actual char
+        p = 0;
+        // construct the font into the buffer
+        for (j=0; j<vert; j++) {            //  vert line
+            for (i=0; i<hor; i++) {         //  horz line
+                z =  zeichen[bpl * i + ((j & 0xF8) >> 3)+1];
+                b = 1 << (j & 0x07);
+                if (( z & b ) == 0x00) {
+                    buffer[p] = _background;
+                } else {
+                    buffer[p] = _foreground;
+                }
+                p++;
+            }
+        }
+        // copy the buffer with DMA SPI to display
+        dma_off = 0;  // offset for DMA transfer
+        DMA_InitStructure.DMA_MemoryBaseAddr  = (uint32_t)  (buffer + dma_off);
+        DMA_InitStructure.DMA_MemoryInc  = DMA_MemoryInc_Enable;
+
+        switch(spi_num){        // decide which SPI is to use
+        case (1):
+        DMA_Init(DMA1_Channel3, &DMA_InitStructure);  // init the DMA
+        // start DMA
+         do {
+            if (pixel > 0X10000) {         // this is a giant font !
+                dma_count = 0Xffff;
+                pixel = pixel - 0Xffff;
+            } else {
+                dma_count = pixel;
+                pixel = 0;
+            }
+            DMA_SetCurrDataCounter(DMA1_Channel3, dma_count);
+            SPI_I2S_DMACmd(SPI1, SPI_I2S_DMAReq_Tx,ENABLE);
+            DMA_Cmd(DMA1_Channel3, ENABLE);
+            while(DMA_GetCurrDataCounter(DMA1_Channel3) != 0);     // wait for end of transfer
+            DMA_Cmd(DMA1_Channel3, DISABLE);
+        }while(pixel > 0);
+        break;
+
+        case (2):
+        DMA_Init(DMA1_Channel5, &DMA_InitStructure);  // init the DMA
+        // start DMA
+         do {
+            if (pixel > 0X10000) {         // this is a giant font !
+                dma_count = 0Xffff;
+                pixel = pixel - 0Xffff;
+            } else {
+                dma_count = pixel;
+                pixel = 0;
+            }
+            DMA_SetCurrDataCounter(DMA1_Channel5, dma_count);
+            SPI_I2S_DMACmd(SPI2, SPI_I2S_DMAReq_Tx,ENABLE);
+            DMA_Cmd(DMA1_Channel5, ENABLE);
+            while(DMA_GetCurrDataCounter(DMA1_Channel5) != 0);     // wait for end of transfer
+            DMA_Cmd(DMA1_Channel5, DISABLE);
+        }while(pixel > 0);
+        break;
+
+        case (3):
+        DMA_Init(DMA2_Channel2, &DMA_InitStructure);  // init the DMA
+        // start DMA
+         do {
+            if (pixel > 0X10000) {         // this is a giant font !
+                dma_count = 0Xffff;
+                pixel = pixel - 0Xffff;
+            } else {
+                dma_count = pixel;
+                pixel = 0;
+            }
+            DMA_SetCurrDataCounter(DMA2_Channel2, dma_count);
+            SPI_I2S_DMACmd(SPI3, SPI_I2S_DMAReq_Tx,ENABLE);
+            DMA_Cmd(DMA2_Channel2, ENABLE);
+            while(DMA_GetCurrDataCounter(DMA2_Channel2) != 0);     // wait for end of transfer
+            DMA_Cmd(DMA2_Channel2, DISABLE);
+        }while(pixel > 0);
+        break;
+
+        }
+        spi_bsy();
+        free ((uint16_t *) buffer);
+        spi_16(0);
+    }
+    
+    else{
+        #endif
+        zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap
+        w = zeichen[0];                          // width of actual char
+        for (j=0; j<vert; j++) {  //  vert line
+            for (i=0; i<hor; i++) {   //  horz line
+                z =  zeichen[bpl * i + ((j & 0xF8) >> 3)+1];
+                b = 1 << (j & 0x07);
+                if (( z & b ) == 0x00) {
+                  f_write(_background);
+                } else {
+                  f_write(_foreground);
+                }
+            }
+        }
+        spi_bsy();
+        _cs = 1;
+        spi_16(0);
+    #ifdef use_ram   
+    }
+    #endif    
+    _cs = 1;
+    WindowMax();
+    if ((w + 2) < hor) {                   // x offset to next char
+        char_x += w + 2;
+    } else char_x += hor;
+}
+
+
+void SPI_TFT_ILI9341::set_font(unsigned char* f)
+{
+    font = f;
+}
+
+
+void SPI_TFT_ILI9341::Bitmap(unsigned int x, unsigned int y, unsigned int w, unsigned int h,unsigned char *bitmap)
+{
+    unsigned int  j;
+    int padd;
+    unsigned short *bitmap_ptr = (unsigned short *)bitmap;
+
+    unsigned int i;
+
+    // the lines are padded to multiple of 4 bytes in a bitmap
+    padd = -1;
+    do {
+        padd ++;
+    } while (2*(w + padd)%4 != 0);
+    window(x, y, w, h);
+    bitmap_ptr += ((h - 1)* (w + padd));
+    wr_cmd(0x2C);  // send pixel
+    spi_16(1);
+    for (j = 0; j < h; j++) {         //Lines
+        for (i = 0; i < w; i++) {     // one line
+                f_write(*bitmap_ptr);    // one line
+                bitmap_ptr++;
+        }
+        bitmap_ptr -= 2*w;
+        bitmap_ptr -= padd;
+    }
+    spi_bsy();
+    _cs = 1;
+    spi_16(0);
+    WindowMax();
+}
+
+
+// local filesystem is not implemented but you can add a SD card to a different SPI
+
+int SPI_TFT_ILI9341::BMP_16(unsigned int x, unsigned int y, const char *Name_BMP)
+{
+
+#define OffsetPixelWidth    18
+#define OffsetPixelHeigh    22
+#define OffsetFileSize      34
+#define OffsetPixData       10
+#define OffsetBPP           28
+
+    char filename[50];
+    unsigned char BMP_Header[54];
+    unsigned short BPP_t;
+    unsigned int PixelWidth,PixelHeigh,start_data;
+    unsigned int    i,off;
+    int padd,j;
+    unsigned short *line;
+
+    // get the filename
+    i=0;
+    while (*Name_BMP!='\0') {
+        filename[i++]=*Name_BMP++;
+    }
+    filename[i] = 0;
+
+    FILE *Image = fopen((const char *)&filename[0], "rb");  // open the bmp file
+    if (!Image) {
+        return(0);      // error file not found !
+    }
+
+    fread(&BMP_Header[0],1,54,Image);      // get the BMP Header
+
+    if (BMP_Header[0] != 0x42 || BMP_Header[1] != 0x4D) {  // check magic byte
+        fclose(Image);
+        return(-1);     // error no BMP file
+    }
+
+    BPP_t = BMP_Header[OffsetBPP] + (BMP_Header[OffsetBPP + 1] << 8);
+    if (BPP_t != 0x0010) {
+        fclose(Image);
+        return(-2);     // error no 16 bit BMP
+    }
+
+    PixelHeigh = BMP_Header[OffsetPixelHeigh] + (BMP_Header[OffsetPixelHeigh + 1] << 8) + (BMP_Header[OffsetPixelHeigh + 2] << 16) + (BMP_Header[OffsetPixelHeigh + 3] << 24);
+    PixelWidth = BMP_Header[OffsetPixelWidth] + (BMP_Header[OffsetPixelWidth + 1] << 8) + (BMP_Header[OffsetPixelWidth + 2] << 16) + (BMP_Header[OffsetPixelWidth + 3] << 24);
+    if (PixelHeigh > height() + y || PixelWidth > width() + x) {
+        fclose(Image);
+        return(-3);      // to big
+    }
+
+    start_data = BMP_Header[OffsetPixData] + (BMP_Header[OffsetPixData + 1] << 8) + (BMP_Header[OffsetPixData + 2] << 16) + (BMP_Header[OffsetPixData + 3] << 24);
+
+    line = (unsigned short *) malloc (2 * PixelWidth); // we need a buffer for a line
+    if (line == NULL) {
+        return(-4);         // error no memory
+    }
+
+    // the bmp lines are padded to multiple of 4 bytes
+    padd = -1;
+    do {
+        padd ++;
+    } while ((PixelWidth * 2 + padd)%4 != 0);
+
+    window(x, y,PixelWidth ,PixelHeigh);
+    wr_cmd(0x2C);  // send pixel
+    spi_16(1);
+    for (j = PixelHeigh - 1; j >= 0; j--) {               //Lines bottom up
+        off = j * (PixelWidth  * 2 + padd) + start_data;   // start of line
+        fseek(Image, off ,SEEK_SET);
+        fread(line,1,PixelWidth * 2,Image);       // read a line - slow
+        for (i = 0; i < PixelWidth; i++) {        // copy pixel data to TFT
+            f_write(line[i]);                  // one 16 bit pixel
+        }
+     }
+    spi_bsy();
+    _cs = 1;
+    spi_16(0);
+    free (line);
+    fclose(Image);
+    WindowMax();
+    return(1);
+}
+
+#endif
+
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/SPI_TFT_ILI9341_NXP.cpp	Mon Jun 18 20:01:55 2018 +0000
@@ -0,0 +1,914 @@
+/* mbed library for 240*320 pixel display TFT based on ILI9341 LCD Controller
+ * Copyright (c) 2014 Peter Drescher - DC2PD
+ * Special version for NXP LPC1768
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ */
+
+// 25.06.14   initial version
+
+// only include this file if target is LPC1768
+#if defined TARGET_LPC1768
+
+#include "SPI_TFT_ILI9341.h"
+#include "mbed.h"
+
+#if defined TARGET_LPC1768
+#define use_ram
+#endif
+
+// some defines for the DMA use
+#define DMA_CHANNEL_ENABLE      1
+#define DMA_TRANSFER_TYPE_M2P   (1UL << 11)
+#define DMA_CHANNEL_TCIE        (1UL << 31)
+#define DMA_CHANNEL_SRC_INC     (1UL << 26)
+#define DMA_MASK_IE             (1UL << 14)
+#define DMA_MASK_ITC            (1UL << 15)
+#define DMA_SSP1_TX             (1UL << 2)
+#define DMA_SSP0_TX             (0)
+#define DMA_DEST_SSP1_TX        (2UL << 6)
+#define DMA_DEST_SSP0_TX        (0UL << 6)
+
+#define BPP         16                  // Bits per pixel
+
+//extern Serial pc;
+//extern DigitalOut xx;     // debug !!
+
+
+SPI_TFT_ILI9341::SPI_TFT_ILI9341(PinName mosi, PinName miso, PinName sclk, PinName cs, PinName reset, PinName dc, const char *name)
+    : GraphicsDisplay(name), SPI(mosi,miso,sclk), _cs(cs), _reset(reset), _dc(dc)
+{
+
+    format(8,3);                 // 8 bit spi mode 3
+    frequency(10000000);         // 10 Mhz SPI clock : result 2 / 4 = 8
+    orientation = 0;
+    char_x = 0;
+    if((int)_spi.spi == SPI_0) {      // test which SPI is in use
+        spi_num = 0;
+    }
+    if((int)_spi.spi == SPI_1) {
+        spi_num = 1;
+    }
+    tft_reset();
+}
+
+// we define a fast write to the SPI port
+void inline SPI_TFT_ILI9341::f_write(int data)
+{
+    while(((_spi.spi->SR) & 0x02) == 0);
+    _spi.spi->DR = data;
+}
+
+// wait for SPI not busy
+// we have to wait for the last bit to switch the cs off
+void inline SPI_TFT_ILI9341::spi_bsy(void)
+{
+    while ((_spi.spi->SR & 0x10) == 0x10);       // SPI not idle
+}
+
+
+// switch fast between 8 and 16 bit mode
+void SPI_TFT_ILI9341::spi_16(bool s)
+{
+    if(s) _spi.spi->CR0 |= 0x08;  // switch to 16 bit Mode
+    else  _spi.spi->CR0 &= ~(0x08);  // switch to 8  bit Mode
+
+}
+
+
+int SPI_TFT_ILI9341::width()
+{
+    if (orientation == 0 || orientation == 2) return 240;
+    else return 320;
+}
+
+
+int SPI_TFT_ILI9341::height()
+{
+    if (orientation == 0 || orientation == 2) return 320;
+    else return 240;
+}
+
+
+void SPI_TFT_ILI9341::set_orientation(unsigned int o)
+{
+    orientation = o;
+    wr_cmd(0x36);                     // MEMORY_ACCESS_CONTROL
+    switch (orientation) {
+        case 0:
+            f_write(0x48);
+            break;
+        case 1:
+            f_write(0x28);
+            break;
+        case 2:
+            f_write(0x88);
+            break;
+        case 3:
+            f_write(0xE8);
+            break;
+    }
+    spi_bsy();    // wait for end of transfer
+    _cs = 1;
+    WindowMax();
+}
+
+
+// write command to tft register
+// use fast command
+void SPI_TFT_ILI9341::wr_cmd(unsigned char cmd)
+{
+    _dc = 0;
+    _cs = 0;
+    f_write(cmd);
+    spi_bsy();
+    _dc = 1;
+}
+
+void SPI_TFT_ILI9341::wr_dat(unsigned char dat)
+{
+    f_write(dat);
+    spi_bsy();  // wait for SPI send
+}
+
+// the ILI9341 can read
+char SPI_TFT_ILI9341::rd_byte(unsigned char cmd)
+{
+    // has to change !!
+    return(0);
+}
+
+// read 32 bit
+int SPI_TFT_ILI9341::rd_32(unsigned char cmd)
+{
+    // has to change !!!
+    return(0);
+}
+
+int  SPI_TFT_ILI9341::Read_ID(void)
+{
+    int r;
+    r = rd_byte(0x0A);
+    r = rd_byte(0x0A);
+    r = rd_byte(0x0A);
+    r = rd_byte(0x0A);
+    return(r);
+}
+
+
+// Init code based on MI0283QT datasheet
+// this code is called only at start
+// no need to be optimized
+
+void SPI_TFT_ILI9341::tft_reset()
+{
+    _cs = 1;                           // cs high
+    _dc = 1;                           // dc high
+    _reset = 0;                        // display reset
+
+    wait_us(50);
+    _reset = 1;                       // end hardware reset
+    wait_ms(5);
+
+    wr_cmd(0x01);                     // SW reset
+    wait_ms(5);
+    wr_cmd(0x28);                     // display off
+
+    /* Start Initial Sequence ----------------------------------------------------*/
+    wr_cmd(0xCF);
+    f_write(0x00);
+    f_write(0x83);
+    f_write(0x30);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xED);
+    f_write(0x64);
+    f_write(0x03);
+    f_write(0x12);
+    f_write(0x81);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xE8);
+    f_write(0x85);
+    f_write(0x01);
+    f_write(0x79);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xCB);
+    f_write(0x39);
+    f_write(0x2C);
+    f_write(0x00);
+    f_write(0x34);
+    f_write(0x02);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xF7);
+    f_write(0x20);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xEA);
+    f_write(0x00);
+    f_write(0x00);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xC0);                     // POWER_CONTROL_1
+    f_write(0x26);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xC1);                     // POWER_CONTROL_2
+    f_write(0x11);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xC5);                     // VCOM_CONTROL_1
+    f_write(0x35);
+    f_write(0x3E);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xC7);                     // VCOM_CONTROL_2
+    f_write(0xBE);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0x36);                     // MEMORY_ACCESS_CONTROL
+    f_write(0x48);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0x3A);                     // COLMOD_PIXEL_FORMAT_SET
+    f_write(0x55);                 // 16 bit pixel
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xB1);                     // Frame Rate
+    f_write(0x00);
+    f_write(0x1B);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xF2);                     // Gamma Function Disable
+    f_write(0x08);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0x26);
+    f_write(0x01);                 // gamma set for curve 01/2/04/08
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xE0);                     // positive gamma correction
+    f_write(0x1F);
+    f_write(0x1A);
+    f_write(0x18);
+    f_write(0x0A);
+    f_write(0x0F);
+    f_write(0x06);
+    f_write(0x45);
+    f_write(0x87);
+    f_write(0x32);
+    f_write(0x0A);
+    f_write(0x07);
+    f_write(0x02);
+    f_write(0x07);
+    f_write(0x05);
+    f_write(0x00);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xE1);                     // negativ gamma correction
+    f_write(0x00);
+    f_write(0x25);
+    f_write(0x27);
+    f_write(0x05);
+    f_write(0x10);
+    f_write(0x09);
+    f_write(0x3A);
+    f_write(0x78);
+    f_write(0x4D);
+    f_write(0x05);
+    f_write(0x18);
+    f_write(0x0D);
+    f_write(0x38);
+    f_write(0x3A);
+    f_write(0x1F);
+    spi_bsy();
+    _cs = 1;
+
+    WindowMax ();
+
+    //wr_cmd(0x34);                     // tearing effect off
+    //_cs = 1;
+
+    //wr_cmd(0x35);                     // tearing effect on
+    //_cs = 1;
+
+    wr_cmd(0xB7);                       // entry mode
+    f_write(0x07);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0xB6);                       // display function control
+    f_write(0x0A);
+    f_write(0x82);
+    f_write(0x27);
+    f_write(0x00);
+    spi_bsy();
+    _cs = 1;
+
+    wr_cmd(0x11);                     // sleep out
+    spi_bsy();
+    _cs = 1;
+
+    wait_ms(100);
+
+    wr_cmd(0x29);                     // display on
+    spi_bsy();
+    _cs = 1;
+
+    wait_ms(100);
+
+    // setup DMA channel 0
+    LPC_SC->PCONP |= (1UL << 29);       // Power up the GPDMA.
+    LPC_GPDMA->DMACConfig = 1;          // enable DMA controller
+    LPC_GPDMA->DMACIntTCClear = 0x1;    // Reset the Interrupt status
+    LPC_GPDMA->DMACIntErrClr = 0x1;
+    LPC_GPDMACH0->DMACCLLI   = 0;
+}
+
+
+// speed optimized
+// write direct to SPI1 register !
+void SPI_TFT_ILI9341::pixel(int x, int y, int color)
+{
+    wr_cmd(0x2A);
+    spi_16(1);         // switch to 8 bit Mode
+    f_write(x);
+    spi_bsy();
+    _cs = 1;
+
+    spi_16(0);        // switch to 8 bit Mode
+    wr_cmd(0x2B);
+    spi_16(1);
+    f_write(y);
+    spi_bsy();
+    _cs = 1;
+    spi_16(0);
+
+    wr_cmd(0x2C); // send pixel
+    spi_16(1);
+    f_write(color);
+    spi_bsy();
+    _cs = 1;
+    spi_16(0);
+}
+
+// optimized
+// write direct to SPI1 register !
+void SPI_TFT_ILI9341::window (unsigned int x, unsigned int y, unsigned int w, unsigned int h)
+{
+    wr_cmd(0x2A);
+    spi_16(1);
+    f_write(x);
+    f_write(x+w-1);
+    spi_bsy();
+    _cs = 1;
+    spi_16(0);
+
+    wr_cmd(0x2B);
+    spi_16(1);
+    f_write(y) ;
+    f_write(y+h-1);
+    spi_bsy();
+    _cs = 1;
+    spi_16(0);
+}
+
+
+void SPI_TFT_ILI9341::WindowMax (void)
+{
+    window (0, 0, width(),  height());
+}
+
+// optimized
+// use DMA to transfer pixel data to the screen
+void SPI_TFT_ILI9341::cls (void)
+{
+    // we can use the fillrect function
+    fillrect(0,0,width()-1,height()-1,_background);
+}
+
+void SPI_TFT_ILI9341::circle(int x0, int y0, int r, int color)
+{
+
+    int x = -r, y = 0, err = 2-2*r, e2;
+    do {
+        pixel(x0-x, y0+y,color);
+        pixel(x0+x, y0+y,color);
+        pixel(x0+x, y0-y,color);
+        pixel(x0-x, y0-y,color);
+        e2 = err;
+        if (e2 <= y) {
+            err += ++y*2+1;
+            if (-x == y && e2 <= x) e2 = 0;
+        }
+        if (e2 > x) err += ++x*2+1;
+    } while (x <= 0);
+}
+
+void SPI_TFT_ILI9341::fillcircle(int x0, int y0, int r, int color)
+{
+    int x = -r, y = 0, err = 2-2*r, e2;
+    do {
+        vline(x0-x, y0-y, y0+y, color);
+        vline(x0+x, y0-y, y0+y, color);
+        e2 = err;
+        if (e2 <= y) {
+            err += ++y*2+1;
+            if (-x == y && e2 <= x) e2 = 0;
+        }
+        if (e2 > x) err += ++x*2+1;
+    } while (x <= 0);
+}
+
+
+// optimized for speed
+void SPI_TFT_ILI9341::hline(int x0, int x1, int y, int color)
+{
+    int w,j;
+    w = x1 - x0 + 1;
+    window(x0,y,w,1);
+    _dc = 0;
+    _cs = 0;
+    f_write(0x2C); // send pixel
+    spi_bsy();
+    _dc = 1;
+    spi_16(1);
+
+    for (j=0; j<w; j++) {
+        f_write(color);
+    }
+    spi_bsy();
+    spi_16(0);
+    _cs = 1;
+    WindowMax();
+    return;
+}
+
+// optimized for speed
+void SPI_TFT_ILI9341::vline(int x, int y0, int y1, int color)
+{
+    int h,y;
+    h = y1 - y0 + 1;
+    window(x,y0,1,h);
+    _dc = 0;
+    _cs = 0;
+    f_write(0x2C); // send pixel
+    spi_bsy();
+    _dc = 1;
+    spi_16(1);
+    // switch to 16 bit Mode 3
+    for (y=0; y<h; y++) {
+        f_write(color);
+    }
+    spi_bsy();
+    spi_16(0);
+    _cs = 1;
+    WindowMax();
+    return;
+}
+
+
+void SPI_TFT_ILI9341::line(int x0, int y0, int x1, int y1, int color)
+{
+    //WindowMax();
+    int   dx = 0, dy = 0;
+    int   dx_sym = 0, dy_sym = 0;
+    int   dx_x2 = 0, dy_x2 = 0;
+    int   di = 0;
+
+    dx = x1-x0;
+    dy = y1-y0;
+
+    if (dx == 0) {        /* vertical line */
+        if (y1 > y0) vline(x0,y0,y1,color);
+        else vline(x0,y1,y0,color);
+        return;
+    }
+
+    if (dx > 0) {
+        dx_sym = 1;
+    } else {
+        dx_sym = -1;
+    }
+    if (dy == 0) {        /* horizontal line */
+        if (x1 > x0) hline(x0,x1,y0,color);
+        else  hline(x1,x0,y0,color);
+        return;
+    }
+
+    if (dy > 0) {
+        dy_sym = 1;
+    } else {
+        dy_sym = -1;
+    }
+
+    dx = dx_sym*dx;
+    dy = dy_sym*dy;
+
+    dx_x2 = dx*2;
+    dy_x2 = dy*2;
+
+    if (dx >= dy) {
+        di = dy_x2 - dx;
+        while (x0 != x1) {
+
+            pixel(x0, y0, color);
+            x0 += dx_sym;
+            if (di<0) {
+                di += dy_x2;
+            } else {
+                di += dy_x2 - dx_x2;
+                y0 += dy_sym;
+            }
+        }
+        pixel(x0, y0, color);
+    } else {
+        di = dx_x2 - dy;
+        while (y0 != y1) {
+            pixel(x0, y0, color);
+            y0 += dy_sym;
+            if (di < 0) {
+                di += dx_x2;
+            } else {
+                di += dx_x2 - dy_x2;
+                x0 += dx_sym;
+            }
+        }
+        pixel(x0, y0, color);
+    }
+    return;
+}
+
+
+void SPI_TFT_ILI9341::rect(int x0, int y0, int x1, int y1, int color)
+{
+
+    if (x1 > x0) hline(x0,x1,y0,color);
+    else  hline(x1,x0,y0,color);
+
+    if (y1 > y0) vline(x0,y0,y1,color);
+    else vline(x0,y1,y0,color);
+
+    if (x1 > x0) hline(x0,x1,y1,color);
+    else  hline(x1,x0,y1,color);
+
+    if (y1 > y0) vline(x1,y0,y1,color);
+    else vline(x1,y1,y0,color);
+
+    return;
+}
+
+
+
+// optimized for speed
+// use DMA
+void SPI_TFT_ILI9341::fillrect(int x0, int y0, int x1, int y1, int color)
+{
+    int h = y1 - y0 + 1;
+    int w = x1 - x0 + 1;
+    int pixel = h * w;
+    unsigned int dma_count;
+    window(x0,y0,w,h);
+
+    wr_cmd(0x2C);  // send pixel
+    spi_16(1);
+
+    LPC_GPDMACH0->DMACCSrcAddr = (uint32_t)&color;
+
+    switch(spi_num) {       // decide which SPI is to use
+        case (0):
+            LPC_GPDMACH0->DMACCDestAddr = (uint32_t)&LPC_SSP0->DR; // we send to SSP0
+            LPC_SSP0->DMACR = 0x2;
+            break;
+        case (1):
+            LPC_GPDMACH0->DMACCDestAddr = (uint32_t)&LPC_SSP1->DR; // we send to SSP1
+            LPC_SSP1->DMACR = 0x2;
+            break;
+    }
+
+    // start DMA
+    do {
+        if (pixel > 4095) {
+            dma_count = 4095;
+            pixel = pixel - 4095;
+        } else {
+            dma_count = pixel;
+            pixel = 0;
+        }
+        LPC_GPDMA->DMACIntTCClear = 0x1;
+        LPC_GPDMA->DMACIntErrClr = 0x1;
+        LPC_GPDMACH0->DMACCControl = dma_count | (1UL << 18) | (1UL << 21) | (1UL << 31) ; // 16 bit transfer , no address increment, interrupt
+        LPC_GPDMACH0->DMACCConfig  = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | (spi_num ? DMA_DEST_SSP1_TX : DMA_DEST_SSP0_TX);
+        LPC_GPDMA->DMACSoftSReq = 0x1;   // DMA request
+        do {
+        } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
+    } while (pixel > 0);
+
+    spi_bsy();    // wait for end of transfer
+    spi_16(0);
+    _cs = 1;
+    WindowMax();
+    return;
+}
+
+void SPI_TFT_ILI9341::locate(int x, int y)
+{
+    char_x = x;
+    char_y = y;
+}
+
+int SPI_TFT_ILI9341::columns()
+{
+    return width() / font[1];
+}
+
+
+int SPI_TFT_ILI9341::rows()
+{
+    return height() / font[2];
+}
+
+
+int SPI_TFT_ILI9341::_putc(int value)
+{
+    if (value == '\n') {    // new line
+        char_x = 0;
+        char_y = char_y + font[2];
+        if (char_y >= height() - font[2]) {
+            char_y = 0;
+        }
+    } else {
+        character(char_x, char_y, value);
+    }
+    return value;
+}
+
+
+// speed optimized
+// will use dma
+void SPI_TFT_ILI9341::character(int x, int y, int c)
+{
+    unsigned int hor,vert,offset,bpl,j,i,b;
+    unsigned char* zeichen;
+    unsigned char z,w;
+#ifdef use_ram
+    unsigned int pixel;
+    unsigned int p;
+    unsigned int dma_count,dma_off;
+    uint16_t *buffer;
+#endif
+
+    if ((c < 31) || (c > 127)) return;   // test char range
+
+    // read font parameter from start of array
+    offset = font[0];                    // bytes / char
+    hor = font[1];                       // get hor size of font
+    vert = font[2];                      // get vert size of font
+    bpl = font[3];                       // bytes per line
+
+    if (char_x + hor > width()) {
+        char_x = 0;
+        char_y = char_y + vert;
+        if (char_y >= height() - font[2]) {
+            char_y = 0;
+        }
+    }
+    window(char_x, char_y,hor,vert);           // setup char box
+    wr_cmd(0x2C);
+    spi_16(1);                                 // switch to 16 bit Mode
+#ifdef use_ram
+    pixel = hor * vert;                        // calculate buffer size
+    buffer = (uint16_t *) malloc (2*pixel);    // we need a buffer for the font
+    if(buffer != NULL) {                       // there is memory space -> use dma
+        zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap
+        w = zeichen[0];                          // width of actual char
+        p = 0;
+        // construct the font into the buffer
+        for (j=0; j<vert; j++) {            //  vert line
+            for (i=0; i<hor; i++) {         //  horz line
+                z =  zeichen[bpl * i + ((j & 0xF8) >> 3)+1];
+                b = 1 << (j & 0x07);
+                if (( z & b ) == 0x00) {
+                    buffer[p] = _background;
+                } else {
+                    buffer[p] = _foreground;
+                }
+                p++;
+            }
+        }
+        // copy the buffer with DMA SPI to display
+        dma_off = 0;  // offset for DMA transfer
+
+        switch(spi_num) {       // decide which SPI is to use
+            case (0):
+                LPC_GPDMACH0->DMACCDestAddr = (uint32_t)&LPC_SSP0->DR; // we send to SSP0
+                LPC_SSP0->DMACR = 0x2;
+                break;
+            case (1):
+                LPC_GPDMACH0->DMACCDestAddr = (uint32_t)&LPC_SSP1->DR; // we send to SSP1
+                LPC_SSP1->DMACR = 0x2;
+                break;
+        }
+        // start DMA
+        do {
+            if (pixel > 4095) {         // this is a giant font !
+                dma_count = 4095;
+                pixel = pixel - 4095;
+            } else {
+                dma_count = pixel;
+                pixel = 0;
+            }
+            LPC_GPDMA->DMACIntTCClear = 0x1;
+            LPC_GPDMA->DMACIntErrClr = 0x1;
+            LPC_GPDMACH0->DMACCSrcAddr = (uint32_t) (buffer + dma_off);
+            LPC_GPDMACH0->DMACCControl = dma_count | (1UL << 18) | (1UL << 21) | (1UL << 31) |  DMA_CHANNEL_SRC_INC ; // 16 bit transfer , address increment, interrupt
+            LPC_GPDMACH0->DMACCConfig  = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | (spi_num ? DMA_DEST_SSP1_TX : DMA_DEST_SSP0_TX);
+            LPC_GPDMA->DMACSoftSReq = 0x1;
+            do {
+            } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
+            dma_off = dma_off + dma_count;
+        } while (pixel > 0);
+
+
+        spi_bsy();
+        free ((uint16_t *) buffer);
+        spi_16(0);
+    }
+
+    else {
+#endif
+        zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap
+        w = zeichen[0];                          // width of actual char
+        for (j=0; j<vert; j++) {  //  vert line
+            for (i=0; i<hor; i++) {   //  horz line
+                z =  zeichen[bpl * i + ((j & 0xF8) >> 3)+1];
+                b = 1 << (j & 0x07);
+                if (( z & b ) == 0x00) {
+                    f_write(_background);
+                } else {
+                    f_write(_foreground);
+                }
+            }
+        }
+        spi_bsy();
+        _cs = 1;
+        spi_16(0);
+#ifdef use_ram
+    }
+#endif
+    _cs = 1;
+    WindowMax();
+    if ((w + 2) < hor) {                   // x offset to next char
+        char_x += w + 2;
+    } else char_x += hor;
+}
+
+
+void SPI_TFT_ILI9341::set_font(unsigned char* f)
+{
+    font = f;
+}
+
+
+void SPI_TFT_ILI9341::Bitmap(unsigned int x, unsigned int y, unsigned int w, unsigned int h,unsigned char *bitmap)
+{
+    unsigned int  j;
+    int padd;
+    unsigned short *bitmap_ptr = (unsigned short *)bitmap;
+
+    unsigned int i;
+
+    // the lines are padded to multiple of 4 bytes in a bitmap
+    padd = -1;
+    do {
+        padd ++;
+    } while (2*(w + padd)%4 != 0);
+    window(x, y, w, h);
+    bitmap_ptr += ((h - 1)* (w + padd));
+    wr_cmd(0x2C);  // send pixel
+    spi_16(1);
+    for (j = 0; j < h; j++) {         //Lines
+        for (i = 0; i < w; i++) {     // one line
+            f_write(*bitmap_ptr);    // one line
+            bitmap_ptr++;
+        }
+        bitmap_ptr -= 2*w;
+        bitmap_ptr -= padd;
+    }
+    spi_bsy();
+    _cs = 1;
+    spi_16(0);
+    WindowMax();
+}
+
+
+// local filesystem is not implemented but you can add a SD card to a different SPI
+
+int SPI_TFT_ILI9341::BMP_16(unsigned int x, unsigned int y, const char *Name_BMP)
+{
+
+#define OffsetPixelWidth    18
+#define OffsetPixelHeigh    22
+#define OffsetFileSize      34
+#define OffsetPixData       10
+#define OffsetBPP           28
+
+    char filename[50];
+    unsigned char BMP_Header[54];
+    unsigned short BPP_t;
+    unsigned int PixelWidth,PixelHeigh,start_data;
+    unsigned int    i,off;
+    int padd,j;
+    unsigned short *line;
+
+    // get the filename
+    i=0;
+    while (*Name_BMP!='\0') {
+        filename[i++]=*Name_BMP++;
+    }
+    filename[i] = 0;
+
+    FILE *Image = fopen((const char *)&filename[0], "rb");  // open the bmp file
+    if (!Image) {
+        return(0);      // error file not found !
+    }
+
+    fread(&BMP_Header[0],1,54,Image);      // get the BMP Header
+
+    if (BMP_Header[0] != 0x42 || BMP_Header[1] != 0x4D) {  // check magic byte
+        fclose(Image);
+        return(-1);     // error no BMP file
+    }
+
+    BPP_t = BMP_Header[OffsetBPP] + (BMP_Header[OffsetBPP + 1] << 8);
+    if (BPP_t != 0x0010) {
+        fclose(Image);
+        return(-2);     // error no 16 bit BMP
+    }
+
+    PixelHeigh = BMP_Header[OffsetPixelHeigh] + (BMP_Header[OffsetPixelHeigh + 1] << 8) + (BMP_Header[OffsetPixelHeigh + 2] << 16) + (BMP_Header[OffsetPixelHeigh + 3] << 24);
+    PixelWidth = BMP_Header[OffsetPixelWidth] + (BMP_Header[OffsetPixelWidth + 1] << 8) + (BMP_Header[OffsetPixelWidth + 2] << 16) + (BMP_Header[OffsetPixelWidth + 3] << 24);
+    if (PixelHeigh > height() + y || PixelWidth > width() + x) {
+        fclose(Image);
+        return(-3);      // to big
+    }
+
+    start_data = BMP_Header[OffsetPixData] + (BMP_Header[OffsetPixData + 1] << 8) + (BMP_Header[OffsetPixData + 2] << 16) + (BMP_Header[OffsetPixData + 3] << 24);
+
+    line = (unsigned short *) malloc (2 * PixelWidth); // we need a buffer for a line
+    if (line == NULL) {
+        return(-4);         // error no memory
+    }
+
+    // the bmp lines are padded to multiple of 4 bytes
+    padd = -1;
+    do {
+        padd ++;
+    } while ((PixelWidth * 2 + padd)%4 != 0);
+
+    window(x, y,PixelWidth ,PixelHeigh);
+    wr_cmd(0x2C);  // send pixel
+    spi_16(1);
+    for (j = PixelHeigh - 1; j >= 0; j--) {               //Lines bottom up
+        off = j * (PixelWidth  * 2 + padd) + start_data;   // start of line
+        fseek(Image, off ,SEEK_SET);
+        fread(line,1,PixelWidth * 2,Image);       // read a line - slow
+        for (i = 0; i < PixelWidth; i++) {        // copy pixel data to TFT
+            f_write(line[i]);                  // one 16 bit pixel
+        }
+    }
+    spi_bsy();
+    _cs = 1;
+    spi_16(0);
+    free (line);
+    fclose(Image);
+    WindowMax();
+    return(1);
+}
+
+#endif
+
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/TextDisplay.cpp	Mon Jun 18 20:01:55 2018 +0000
@@ -0,0 +1,77 @@
+/* mbed TextDisplay Display Library Base Class
+ * Copyright (c) 2007-2009 sford
+ * Released under the MIT License: http://mbed.org/license/mit
+ */
+ 
+#include "TextDisplay.h"
+
+TextDisplay::TextDisplay(const char *name) : Stream(name){
+    _row = 0;
+    _column = 0;
+    if (name == NULL) {
+        _path = NULL;
+    } else {
+        _path = new char[strlen(name) + 2];
+        sprintf(_path, "/%s", name);
+    }
+}
+    
+int TextDisplay::_putc(int value) {
+    if(value == '\n') {
+        _column = 0;
+        _row++;
+        if(_row >= rows()) {
+            _row = 0;
+        }
+    } else {
+        character(_column, _row, value);
+        _column++;
+        if(_column >= columns()) {
+            _column = 0;
+            _row++;
+            if(_row >= rows()) {
+                _row = 0;
+            }
+        }
+    }
+    return value;
+}
+
+// crude cls implementation, should generally be overwritten in derived class
+void TextDisplay::cls() {
+    locate(0, 0);
+    for(int i=0; i<columns()*rows(); i++) {
+        putc(' ');
+    }
+}
+
+void TextDisplay::locate(int column, int row) {
+    _column = column;
+    _row = row;
+}
+
+int TextDisplay::_getc() {
+    return -1;
+}
+        
+void TextDisplay::foreground(uint16_t colour) {
+    _foreground = colour;
+}
+
+void TextDisplay::background(uint16_t colour) {
+    _background = colour;
+}
+
+bool TextDisplay::claim (FILE *stream) {
+    if ( _path == NULL) {
+        fprintf(stderr, "claim requires a name to be given in the instantioator of the TextDisplay instance!\r\n");
+        return false;
+    }
+    if (freopen(_path, "w", stream) == NULL) {
+        // Failed, should not happen
+        return false;
+    }
+    // make sure we use line buffering
+    setvbuf(stdout, NULL, _IOLBF, columns());
+    return true;
+} 
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/TextDisplay.h	Mon Jun 18 20:01:55 2018 +0000
@@ -0,0 +1,80 @@
+/* mbed TextDisplay Library Base Class
+ * Copyright (c) 2007-2009 sford
+ * Released under the MIT License: http://mbed.org/license/mit
+ *
+ * A common base class for Text displays
+ * To port a new display, derive from this class and implement
+ * the constructor (setup the display), character (put a character
+ * at a location), rows and columns (number of rows/cols) functions.
+ * Everything else (locate, printf, putc, cls) will come for free
+ *
+ * The model is the display will wrap at the right and bottom, so you can
+ * keep writing and will always get valid characters. The location is 
+ * maintained internally to the class to make this easy
+ */
+
+#ifndef MBED_TEXTDISPLAY_H
+#define MBED_TEXTDISPLAY_H
+
+#include "mbed.h"
+
+class TextDisplay : public Stream {
+public:
+
+  // functions needing implementation in derived implementation class
+  /** Create a TextDisplay interface
+     *
+     * @param name The name used in the path to access the strean through the filesystem
+     */
+    TextDisplay(const char *name = NULL);
+
+    /** output a character at the given position
+     *
+     * @param column column where charater must be written
+     * @param  row where character must be written
+     * @param c the character to be written to the TextDisplay
+     */
+    virtual void character(int column, int row, int c) = 0;
+
+    /** return number if rows on TextDisplay
+     * @result number of rows
+     */
+    virtual int rows() = 0;
+
+    /** return number if columns on TextDisplay
+    * @result number of rows
+    */
+    virtual int columns() = 0;
+    
+    // functions that come for free, but can be overwritten
+
+    /** redirect output from a stream (stoud, sterr) to  display
+    * @param stream stream that shall be redirected to the TextDisplay
+    */
+    virtual bool claim (FILE *stream);
+
+    /** clear screen
+    */
+    virtual void cls();
+    virtual void locate(int column, int row);
+    virtual void foreground(uint16_t colour);
+    virtual void background(uint16_t colour);
+    // putc (from Stream)
+    // printf (from Stream)
+    
+protected:
+
+    virtual int _putc(int value);
+    virtual int _getc();
+
+    // character location
+    uint16_t _column;
+    uint16_t _row;
+
+    // colours
+    uint16_t _foreground;
+    uint16_t _background;
+    char *_path;
+};
+
+#endif