Revision 0:04691de55153, committed 2015-10-02

Comitter:

JackB

Date:

Fri Oct 02 22:27:28 2015 +0000

Commit message:

Adafruit 64x32 RGB LED Matrix - 3mm pitch driver for Nucleo F446RE

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/RGB_Matrix.cpp	Fri Oct 02 22:27:28 2015 +0000
@@ -0,0 +1,647 @@
+/* mbed RGB Matrix Library
+ * Written for Nucleo-F446RE, v1.0, 03-10-2015
+ *
+ * Copyright (c) 2013-2015 JackB, cstyles
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to deal
+ * in the Software without restriction, including without limitation the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * 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.
+ */
+
+#include "RGB_Matrix.h"
+
+RGB_Matrix::RGB_Matrix(PinName Pin_R1, PinName Pin_R2,
+                       PinName Pin_G1, PinName Pin_G2,
+                       PinName Pin_B1, PinName Pin_B2,
+                       PinName Pin_CLK, PinName Pin_LAT, PinName Pin_OE,
+                       PinName Pin_A, PinName Pin_B, PinName Pin_C, PinName Pin_D) :
+    _Pin_R1(Pin_R1), _Pin_R2(Pin_R2),
+    _Pin_G1(Pin_G1), _Pin_G2(Pin_G2),
+    _Pin_B1(Pin_B1), _Pin_B2(Pin_B2),
+    _Pin_CLK(Pin_CLK), _Pin_LAT(Pin_LAT), _Pin_OE(Pin_OE),
+    _Pin_A(Pin_A), _Pin_B(Pin_B), _Pin_C(Pin_C), _Pin_D(Pin_D) {
+}
+
+void RGB_Matrix::Init(void) {
+//    uint8_t *ptr;
+
+    _Pin_CLK = 0; // Clock low
+    _Pin_OE  = 1; // Disable LED output during row/plane switchover
+    _Pin_LAT = 1; // Latch data loaded during *prior* interrupt
+
+    plane     = PLANES - 1;
+    row       = ROWS   - 1;
+
+    // Allocate and initialize matrix buffer:
+
+    int buffsize  = WIDTH * ROWS * PLANES,
+        allocsize = (DBUF == true) ? (buffsize * 2) : buffsize;
+
+    if(NULL == (matrixbuff[0] = (uint8_t *)malloc(allocsize)))
+        return;
+    memset(matrixbuff[0], 0, allocsize);
+
+    if(NULL == (matrixbuff[1] = (uint8_t *)malloc(allocsize)))
+        return;
+    memset(matrixbuff[1], 0, allocsize);
+
+    // If not double-buffered, both buffers then point to the same address:
+//    matrixbuff[1] = (DBUF == true) ? &matrixbuff[0][buffsize] : matrixbuff[0];
+
+    bufferDisplay = 0;
+    bufferWrite   = 0;
+//    buffptr       = matrixbuff[bufferDisplay]; // -> front buffer
+
+    /*
+        // Some data!
+        buffptr[0] = 0x11;
+        buffptr[1] = 0x22;
+        buffptr[2] = 0x44;
+        buffptr[0+PIXELS] = 0x11;
+        buffptr[1+PIXELS] = 0x22;
+        buffptr[2+PIXELS] = 0x44;
+        buffptr[0+PIXELS*2] = 0x11;
+        buffptr[1+PIXELS*2] = 0x22;
+        buffptr[2+PIXELS*2] = 0x44;
+        buffptr[0+PIXELS*3] = 0x11;
+        buffptr[1+PIXELS*3] = 0x22;
+        buffptr[2+PIXELS*3] = 0x44;
+        buffptr[0+PIXELS*4] = 0x11;
+        buffptr[1+PIXELS*4] = 0x22;
+        buffptr[2+PIXELS*4] = 0x44;
+        buffptr[0+PIXELS*5] = 0x11;
+        buffptr[1+PIXELS*5] = 0x22;
+        buffptr[2+PIXELS*5] = 0x44;
+        buffptr[0+PIXELS*6] = 0x11;
+        buffptr[1+PIXELS*6] = 0x22;
+        buffptr[2+PIXELS*6] = 0x44;
+
+        buffptr[0+WIDTH] = 0x00;
+        buffptr[1+WIDTH] = 0x00;
+        buffptr[2+WIDTH] = 0x00;
+        buffptr[0+WIDTH+PIXELS] = 0x11;
+        buffptr[1+WIDTH+PIXELS] = 0x22;
+        buffptr[2+WIDTH+PIXELS] = 0x44;
+        buffptr[0+WIDTH+PIXELS*2] = 0x11;
+        buffptr[1+WIDTH+PIXELS*2] = 0x22;
+        buffptr[2+WIDTH+PIXELS*2] = 0x44;
+        buffptr[0+WIDTH+PIXELS*3] = 0x11;
+        buffptr[1+WIDTH+PIXELS*3] = 0x22;
+        buffptr[2+WIDTH+PIXELS*3] = 0x44;
+        buffptr[0+WIDTH+PIXELS*4] = 0x11;
+        buffptr[1+WIDTH+PIXELS*4] = 0x22;
+        buffptr[2+WIDTH+PIXELS*4] = 0x44;
+        buffptr[0+WIDTH+PIXELS*5] = 0x11;
+        buffptr[1+WIDTH+PIXELS*5] = 0x22;
+        buffptr[2+WIDTH+PIXELS*5] = 0x44;
+        buffptr[0+WIDTH+PIXELS*6] = 0x11;
+        buffptr[1+WIDTH+PIXELS*6] = 0x22;
+        buffptr[2+WIDTH+PIXELS*6] = 0x44;
+
+        buffptr[0+WIDTH*2] = 0x00;
+        buffptr[1+WIDTH*2] = 0x00;
+        buffptr[2+WIDTH*2] = 0x00;
+        buffptr[0+WIDTH*2+PIXELS] = 0x00;
+        buffptr[1+WIDTH*2+PIXELS] = 0x00;
+        buffptr[2+WIDTH*2+PIXELS] = 0x00;
+        buffptr[0+WIDTH*2+PIXELS*2] = 0x11;
+        buffptr[1+WIDTH*2+PIXELS*2] = 0x22;
+        buffptr[2+WIDTH*2+PIXELS*2] = 0x44;
+        buffptr[0+WIDTH*2+PIXELS*3] = 0x11;
+        buffptr[1+WIDTH*2+PIXELS*3] = 0x22;
+        buffptr[2+WIDTH*2+PIXELS*3] = 0x44;
+        buffptr[0+WIDTH*2+PIXELS*4] = 0x11;
+        buffptr[1+WIDTH*2+PIXELS*4] = 0x22;
+        buffptr[2+WIDTH*2+PIXELS*4] = 0x44;
+        buffptr[0+WIDTH*2+PIXELS*5] = 0x11;
+        buffptr[1+WIDTH*2+PIXELS*5] = 0x22;
+        buffptr[2+WIDTH*2+PIXELS*5] = 0x44;
+        buffptr[0+WIDTH*2+PIXELS*6] = 0x11;
+        buffptr[1+WIDTH*2+PIXELS*6] = 0x22;
+        buffptr[2+WIDTH*2+PIXELS*6] = 0x44;
+
+        buffptr[0+WIDTH*3] = 0x00;
+        buffptr[1+WIDTH*3] = 0x00;
+        buffptr[2+WIDTH*3] = 0x00;
+        buffptr[0+WIDTH*3+PIXELS] = 0x00;
+        buffptr[1+WIDTH*3+PIXELS] = 0x00;
+        buffptr[2+WIDTH*3+PIXELS] = 0x00;
+        buffptr[0+WIDTH*3+PIXELS*2] = 0x00;
+        buffptr[1+WIDTH*3+PIXELS*2] = 0x00;
+        buffptr[2+WIDTH*3+PIXELS*2] = 0x00;
+        buffptr[0+WIDTH*3+PIXELS*3] = 0x11;
+        buffptr[1+WIDTH*3+PIXELS*3] = 0x22;
+        buffptr[2+WIDTH*3+PIXELS*3] = 0x44;
+        buffptr[0+WIDTH*3+PIXELS*4] = 0x11;
+        buffptr[1+WIDTH*3+PIXELS*4] = 0x22;
+        buffptr[2+WIDTH*3+PIXELS*4] = 0x44;
+        buffptr[0+WIDTH*3+PIXELS*5] = 0x11;
+        buffptr[1+WIDTH*3+PIXELS*5] = 0x22;
+        buffptr[2+WIDTH*3+PIXELS*5] = 0x44;
+        buffptr[0+WIDTH*3+PIXELS*6] = 0x11;
+        buffptr[1+WIDTH*3+PIXELS*6] = 0x22;
+        buffptr[2+WIDTH*3+PIXELS*6] = 0x44;
+
+        buffptr[0+WIDTH*4] = 0x00;
+        buffptr[1+WIDTH*4] = 0x00;
+        buffptr[2+WIDTH*4] = 0x00;
+        buffptr[0+WIDTH*4+PIXELS] = 0x00;
+        buffptr[1+WIDTH*4+PIXELS] = 0x00;
+        buffptr[2+WIDTH*4+PIXELS] = 0x00;
+        buffptr[0+WIDTH*4+PIXELS*2] = 0x00;
+        buffptr[1+WIDTH*4+PIXELS*2] = 0x00;
+        buffptr[2+WIDTH*4+PIXELS*2] = 0x00;
+        buffptr[0+WIDTH*4+PIXELS*3] = 0x00;
+        buffptr[1+WIDTH*4+PIXELS*3] = 0x00;
+        buffptr[2+WIDTH*4+PIXELS*3] = 0x00;
+        buffptr[0+WIDTH*4+PIXELS*4] = 0x11;
+        buffptr[1+WIDTH*4+PIXELS*4] = 0x22;
+        buffptr[2+WIDTH*4+PIXELS*4] = 0x44;
+        buffptr[0+WIDTH*4+PIXELS*5] = 0x11;
+        buffptr[1+WIDTH*4+PIXELS*5] = 0x22;
+        buffptr[2+WIDTH*4+PIXELS*5] = 0x44;
+        buffptr[0+WIDTH*4+PIXELS*6] = 0x11;
+        buffptr[1+WIDTH*4+PIXELS*6] = 0x22;
+        buffptr[2+WIDTH*4+PIXELS*6] = 0x44;
+
+        buffptr[0+WIDTH*5] = 0x00;
+        buffptr[1+WIDTH*5] = 0x00;
+        buffptr[2+WIDTH*5] = 0x00;
+        buffptr[0+WIDTH*5+PIXELS] = 0x00;
+        buffptr[1+WIDTH*5+PIXELS] = 0x00;
+        buffptr[2+WIDTH*5+PIXELS] = 0x00;
+        buffptr[0+WIDTH*5+PIXELS*2] = 0x00;
+        buffptr[1+WIDTH*5+PIXELS*2] = 0x00;
+        buffptr[2+WIDTH*5+PIXELS*2] = 0x00;
+        buffptr[0+WIDTH*5+PIXELS*3] = 0x00;
+        buffptr[1+WIDTH*5+PIXELS*3] = 0x00;
+        buffptr[2+WIDTH*5+PIXELS*3] = 0x00;
+        buffptr[0+WIDTH*5+PIXELS*4] = 0x00;
+        buffptr[1+WIDTH*5+PIXELS*4] = 0x00;
+        buffptr[2+WIDTH*5+PIXELS*4] = 0x00;
+        buffptr[0+WIDTH*5+PIXELS*5] = 0x11;
+        buffptr[1+WIDTH*5+PIXELS*5] = 0x22;
+        buffptr[2+WIDTH*5+PIXELS*5] = 0x44;
+        buffptr[0+WIDTH*5+PIXELS*6] = 0x11;
+        buffptr[1+WIDTH*5+PIXELS*6] = 0x22;
+        buffptr[2+WIDTH*5+PIXELS*6] = 0x44;
+
+        buffptr[0+WIDTH*6] = 0x00;
+        buffptr[1+WIDTH*6] = 0x00;
+        buffptr[2+WIDTH*6] = 0x00;
+        buffptr[0+WIDTH*6+PIXELS] = 0x00;
+        buffptr[1+WIDTH*6+PIXELS] = 0x00;
+        buffptr[2+WIDTH*6+PIXELS] = 0x00;
+        buffptr[0+WIDTH*6+PIXELS*2] = 0x00;
+        buffptr[1+WIDTH*6+PIXELS*2] = 0x00;
+        buffptr[2+WIDTH*6+PIXELS*2] = 0x00;
+        buffptr[0+WIDTH*6+PIXELS*3] = 0x00;
+        buffptr[1+WIDTH*6+PIXELS*3] = 0x00;
+        buffptr[2+WIDTH*6+PIXELS*3] = 0x00;
+        buffptr[0+WIDTH*6+PIXELS*4] = 0x00;
+        buffptr[1+WIDTH*6+PIXELS*4] = 0x00;
+        buffptr[2+WIDTH*6+PIXELS*4] = 0x00;
+        buffptr[0+WIDTH*6+PIXELS*5] = 0x00;
+        buffptr[1+WIDTH*6+PIXELS*5] = 0x00;
+        buffptr[2+WIDTH*6+PIXELS*5] = 0x00;
+        buffptr[0+WIDTH*6+PIXELS*6] = 0x11;
+        buffptr[1+WIDTH*6+PIXELS*6] = 0x22;
+        buffptr[2+WIDTH*6+PIXELS*6] = 0x44;
+    */
+    /*
+        buffptr[1] = 0x02;
+        buffptr[2] = 0x03;
+        buffptr[3] = 0x04;
+        buffptr[4] = 0x08;
+        buffptr[5] = 0x0c;
+        buffptr[6] = 0x10;
+        buffptr[7] = 0x20;
+        buffptr[8] = 0x30;
+        buffptr[WIDTH*ROWS+3] = 0x01;
+        buffptr[WIDTH*ROWS+4] = 0x04;
+        buffptr[WIDTH*ROWS+5] = 0x10;
+
+        drawPixel(2, 4, RGB(255, 128, 0)); // RRrrrGGg gggBBbbb
+    */
+
+    Update.attach(this, &RGB_Matrix::updateDisplay, INTTIME); // the address of the function to be attached (flip) and the interval (0.5 seconds)
+    char_x = 0;
+    char_y = 0;
+    foreground(RGB(0, 64, 0));
+    background(RGB(0, 0, 0));
+    SetOrientation(LANDSCAPE_B);
+}
+
+void RGB_Matrix::swap(int16_t &x, int16_t &y) {
+    int16_t temp = x;
+    x = y;
+    y = temp;
+}
+
+uint16_t RGB_Matrix::rgbToColor(uint8_t R, uint8_t G, uint8_t  B) {
+    return ((R >> 6) << 14) + ((G >> 6) << 9) + ((B >> 6) << 3); // RRrrrGGg gggBBbbb
+}
+
+void RGB_Matrix::drawPixel2(int16_t x, int16_t y, uint16_t c) {
+    uint8_t r, g, b, bit, limit, *ptr;
+
+    if((x < 0) || (x >= WIDTH) || (y < 0) || (y >= HEIGHT))
+        return;
+
+    switch(_orientation) {
+        case 1:
+            swap(x, y);
+            x = WIDTH  - 1 - x;
+            break;
+        case 2:
+            x = WIDTH  - 1 - x;
+            y = HEIGHT - 1 - y;
+            break;
+        case 3:
+            swap(x, y);
+            y = HEIGHT - 1 - y;
+            break;
+    }
+
+    // Adafruit_GFX uses 16-bit color in 5/6/5 format, while matrix needs
+    // 2/2/2.  Pluck out relevant bits while separating into R,G,B:
+    r =  c >> 14;        // RRrrrggggggbbbbb
+    g = (c >>  9) & 0x03; // rrrrrGGggggbbbbb
+    b = (c >>  3) & 0x03; // rrrrrggggggBBbbb
+
+    uint8_t color = r + (g << 2) + (b << 4);
+
+    buffptr = matrixbuff[bufferWrite]; // Set first buffer
+    buffptr[y * WIDTH + x] = color;
+}
+
+void RGB_Matrix::drawPixel(int16_t x, int16_t y, uint16_t c) {
+    uint8_t r, g, b, bit, limit, *ptr;
+
+    if((x < 0) || (x >= WIDTH) || (y < 0) || (y >= HEIGHT))
+        return;
+
+    switch(_orientation) {
+        case 1:
+            swap(x, y);
+            x = WIDTH  - 1 - x;
+            break;
+        case 2:
+            x = WIDTH  - 1 - x;
+            y = HEIGHT - 1 - y;
+            break;
+        case 3:
+            swap(x, y);
+            y = HEIGHT - 1 - y;
+            break;
+    }
+
+    // Adafruit_GFX uses 16-bit color in 5/6/5 format, while matrix needs
+    // 2/2/2.  Pluck out relevant bits while separating into R,G,B:
+    r =  c >> 13;         // RRRrrggggggbbbbb
+    g = (c >>  8) & 0x07; // rrrrrGGGgggbbbbb
+    b = (c >>  2) & 0x07; // rrrrrggggggBBBbb
+
+    uint8_t color = r + (g << 2) + (b << 4);
+
+
+    uint8_t *buffptr;
+    buffptr = matrixbuff[bufferWrite]; // Set first buffer
+
+    const uint8_t PixelR1[] = {
+        0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe,
+        0xfe, 0xfe, 0xfe, 0x01, 0xfe, 0xfe, 0xfe,
+        0xfe, 0x01, 0xfe, 0xfe, 0xfe, 0x01, 0xfe,
+        0xfe, 0x01, 0xfe, 0x01, 0xfe, 0x01, 0xfe,
+        0x01, 0x01, 0xfe, 0x01, 0xfe, 0x01, 0xfe,
+        0x01, 0x01, 0x01, 0xfe, 0x01, 0x01, 0xfe,
+        0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0xfe,
+        0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01
+    };
+
+    const uint8_t PixelR2[] = {
+        0xef, 0xef, 0xef, 0xef, 0xef, 0xef, 0xef,
+        0xef, 0xef, 0xef, 0x10, 0xef, 0xef, 0xef,
+        0xef, 0x10, 0xef, 0xef, 0xef, 0x10, 0xef,
+        0xef, 0x10, 0xef, 0x10, 0xef, 0x10, 0xef,
+        0x10, 0x10, 0xef, 0x10, 0xef, 0x10, 0xef,
+        0x10, 0x10, 0x10, 0xef, 0x10, 0x10, 0xef,
+        0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0xef,
+        0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10
+    };
+
+    const uint8_t PixelG1[] = {
+        0xfd, 0xfd, 0xfd, 0xfd, 0xfd, 0xfd, 0xfd,
+        0xfd, 0xfd, 0xfd, 0x02, 0xfd, 0xfd, 0xfd,
+        0xfd, 0x02, 0xfd, 0xfd, 0xfd, 0x02, 0xfd,
+        0xfd, 0x02, 0xfd, 0x02, 0xfd, 0x02, 0xfd,
+        0x02, 0x02, 0xfd, 0x02, 0xfd, 0x02, 0xfd,
+        0x02, 0x02, 0x02, 0xfd, 0x02, 0x02, 0xfd,
+        0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0xfd,
+        0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02
+    };
+
+    const uint8_t PixelG2[] = {
+        0xdf, 0xdf, 0xdf, 0xdf, 0xdf, 0xdf, 0xdf,
+        0xdf, 0xdf, 0xdf, 0x20, 0xdf, 0xdf, 0xdf,
+        0xdf, 0x20, 0xdf, 0xdf, 0xdf, 0x20, 0xdf,
+        0xdf, 0x20, 0xdf, 0x20, 0xdf, 0x20, 0xdf,
+        0x20, 0x20, 0xdf, 0x20, 0xdf, 0x20, 0xdf,
+        0x20, 0x20, 0x20, 0xdf, 0x20, 0x20, 0xdf,
+        0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0xdf,
+        0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20
+    };
+
+    const uint8_t PixelB1[] = {
+        0xfb, 0xfb, 0xfb, 0xfb, 0xfb, 0xfb, 0xfb,
+        0xfb, 0xfb, 0xfb, 0x04, 0xfb, 0xfb, 0xfb,
+        0xfb, 0x04, 0xfb, 0xfb, 0xfb, 0x04, 0xfb,
+        0xfb, 0x04, 0xfb, 0x04, 0xfb, 0x04, 0xfb,
+        0x04, 0x04, 0xfb, 0x04, 0xfb, 0x04, 0xfb,
+        0x04, 0x04, 0x04, 0xfb, 0x04, 0x04, 0xfb,
+        0x04, 0x04, 0x04, 0x04, 0x04, 0x04, 0xfb,
+        0x04, 0x04, 0x04, 0x04, 0x04, 0x04, 0x04
+    };
+
+    const uint8_t PixelB2[] = {
+        0xbf, 0xbf, 0xbf, 0xbf, 0xbf, 0xbf, 0xbf,
+        0xbf, 0xbf, 0xbf, 0x40, 0xbf, 0xbf, 0xbf,
+        0xbf, 0x40, 0xbf, 0xbf, 0xbf, 0x40, 0xbf,
+        0xbf, 0x40, 0xbf, 0x40, 0xbf, 0x40, 0xbf,
+        0x40, 0x40, 0xbf, 0x40, 0xbf, 0x40, 0xbf,
+        0x40, 0x40, 0x40, 0xbf, 0x40, 0x40, 0xbf,
+        0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0xbf,
+        0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40
+    };
+
+    // PWM planes
+    // xBGRxBGR
+
+    for (uint8_t p = 0; p < PLANES; p++) {
+        if (y < ROWS) {
+            if ((PixelR1[p+r*7] & 0x80) == 0)
+                buffptr[x+WIDTH*y+PIXELS*p] |= PixelR1[p+r*7];
+            else
+                buffptr[x+WIDTH*y+PIXELS*p] &= PixelR1[p+r*7];
+            if ((PixelG1[p+g*7] & 0x80) == 0)
+                buffptr[x+WIDTH*y+PIXELS*p] |= PixelG1[p+g*7];
+            else
+                buffptr[x+WIDTH*y+PIXELS*p] &= PixelG1[p+g*7];
+            if ((PixelB1[p+b*7] & 0x80) == 0)
+                buffptr[x+WIDTH*y+PIXELS*p] |= PixelB1[p+b*7];
+            else
+                buffptr[x+WIDTH*y+PIXELS*p] &= PixelB1[p+b*7];
+        } else {
+            if ((PixelR2[p+r*7] & 0x80) == 0)
+                buffptr[x+WIDTH*(y-ROWS)+PIXELS*p] |= PixelR2[p+r*7];
+            else
+                buffptr[x+WIDTH*(y-ROWS)+PIXELS*p] &= PixelR2[p+r*7];
+            if ((PixelG2[p+g*7] & 0x80) == 0)
+                buffptr[x+WIDTH*(y-ROWS)+PIXELS*p] |= PixelG2[p+g*7];
+            else
+                buffptr[x+WIDTH*(y-ROWS)+PIXELS*p] &= PixelG2[p+g*7];
+            if ((PixelB2[p+b*7] & 0x80) == 0)
+                buffptr[x+WIDTH*(y-ROWS)+PIXELS*p] |= PixelB2[p+b*7];
+            else
+                buffptr[x+WIDTH*(y-ROWS)+PIXELS*p] &= PixelB2[p+b*7];
+        }
+    }
+}
+
+void RGB_Matrix::set_font(unsigned char* f) {
+    font = f;
+}
+
+void RGB_Matrix::character(int x, int y, int c) {
+    unsigned int hor,vert,offset,bpl,j,i,b;
+    unsigned char* char_offset;
+    unsigned char z,w;
+
+    if ((c < 31) || (c > 127)) return;   // test char range
+
+    // read font parameter from start of array
+    offset = font[BYTESPERCHAR];                    // bytes / char
+    hor    = font[FONTWIDTH];                       // get hor size of font
+    vert   = font[FONTHEIGHT];                      // get vert size of font
+    bpl    = font[BYTESPERLINE];                    // bytes per vertical line
+
+    if (char_x + hor > width()) {
+        // the next character doesn't fit on the same line
+        char_x = 0;
+        char_y = char_y + vert;
+        if (char_y > height() - font[FONTHEIGHT]) {
+            // the next line doesn't fit at the bottom of the screen
+            char_y = 0;
+        }
+    }
+
+//    window(char_x, char_y,hor,vert); // char box
+
+    char_offset = &font[((c -32) * offset) + 4]; // start of char bitmap
+    w = char_offset[0];                          // width of actual char
+    for (j=0; j<vert; j++) {  //  vert line
+        for (i=0; i<hor; i++) {   //  horz line
+            z =  char_offset[bpl * i + ((j & 0xF8) >> 3)+1];
+            b = 1 << (j & 0x07);
+            if (( z & b ) == 0x00) {
+                drawPixel(char_x + i, char_y + j, _background); // background
+            } else {
+                drawPixel(char_x + i, char_y + j, _foreground); // foreground
+            }
+        }
+    }
+//    WindowMax();
+    if ((w + 2) < hor) {                   // x offset to next char
+        char_x += w + 2;
+    } else char_x += hor;
+}
+
+int RGB_Matrix::putc(int value) {
+    if (value == '\n') {    // new line
+        char_x = 0;
+        char_y = char_y + font[FONTHEIGHT];
+        if (char_y >= height() - font[FONTHEIGHT]) {
+            char_y = 0;
+        }
+    } else {
+        character(char_x, char_y, value);
+    }
+    return value;
+}
+
+void RGB_Matrix::printString(char *string) {
+    for (uint8_t i = 0; i < strlen(string); i++) {
+        putc(string[i]);
+    }
+}
+
+void RGB_Matrix::printStringCenter(char *string) {
+    uint8_t pwidth = strlen(string) * font[FONTWIDTH] - 1;
+    locatePixelX((width() - pwidth) / 2);
+    for (uint8_t i = 0; i < strlen(string); i++) {
+        putc(string[i]);
+    }
+}
+
+void RGB_Matrix::foreground(uint16_t colour) {
+    _foreground = colour;
+}
+
+void RGB_Matrix::background(uint16_t colour) {
+    _background = colour;
+}
+
+int RGB_Matrix::width() {
+    if (_orientation == 0 || _orientation == 2) return WIDTH;
+    else return HEIGHT;
+}
+
+int RGB_Matrix::height() {
+    if (_orientation == 0 || _orientation == 2) return HEIGHT;
+    else return WIDTH;
+}
+
+void RGB_Matrix::SetOrientation(uint8_t orientation) {
+    _orientation = orientation;
+}
+
+void RGB_Matrix::locate(uint8_t x, uint8_t y) {
+    char_x = x * font[FONTHEIGHT];
+    char_y = y * font[FONTHEIGHT];
+}
+
+void RGB_Matrix::locatePixelX(uint8_t x) {
+    char_x = x;
+}
+
+void RGB_Matrix::locatePixelY(uint8_t y) {
+    char_y = y;
+}
+
+int RGB_Matrix::columns() {
+    return width() / font[FONTHEIGHT];
+}
+
+int RGB_Matrix::rows() {
+    return height() / font[FONTHEIGHT];
+}
+
+void RGB_Matrix::setDisplayBuffer(uint8_t Buffer) {
+    bufferDisplay = Buffer;
+}
+
+void RGB_Matrix::setWriteBuffer(uint8_t Buffer) {
+    bufferWrite = Buffer;
+}
+
+void RGB_Matrix::updateDisplay2(void) {
+    _Pin_OE  = 1;  // Disable LED output during row/plane switchover
+    _Pin_LAT = 1; // Latch data loaded during *prior* interrupt
+    _Pin_A   = (row & 0x01);
+    _Pin_B   = (row & 0x02) >> 1;
+    _Pin_C   = (row & 0x04) >> 2;
+    _Pin_D   = (row & 0x08) >> 3;
+    _Pin_OE  = 0;   // Re-enable output
+    _Pin_LAT = 0;  // Latch down
+
+    if(++plane >= PLANES) {      // Advance plane counter.  Maxed out?
+        plane = 0;                // Yes, reset to plane 0, and
+    }
+    if(++row >= ROWS) {       // advance row counter.  Maxed out?
+        row = 0;              // Yes, reset row counter, then...
+    }
+
+    buffptr = matrixbuff[bufferDisplay]; // Set first buffer
+
+    for(int x = 0; x < WIDTH; x++) {
+        int16_t BufferIndex1 = x + row * WIDTH;
+        int16_t BufferIndex2 = BufferIndex1 + ROWS * WIDTH;
+
+        uint8_t PixelValueR1 =  buffptr[BufferIndex1] & 0x03;
+        uint8_t PixelValueG1 = (buffptr[BufferIndex1] >> 2) & 0x03;
+        uint8_t PixelValueB1 = (buffptr[BufferIndex1] >> 4) & 0x03;
+        uint8_t PixelValueR2 =  buffptr[BufferIndex2] & 0x03;
+        uint8_t PixelValueG2 = (buffptr[BufferIndex2] >> 2) & 0x03;
+        uint8_t PixelValueB2 = (buffptr[BufferIndex2] >> 4) & 0x03;
+
+        if (PixelValueR1 >= plane+1) {
+            _Pin_R1 = 1;
+        } else {
+            _Pin_R1 = 0;
+        }
+        if (PixelValueG1 >= plane+1) {
+            _Pin_G1 = 1;
+        } else {
+            _Pin_G1 = 0;
+        }
+        if (PixelValueB1 >= plane+1) {
+            _Pin_B1 = 1;
+        } else {
+            _Pin_B1 = 0;
+        }
+
+        if (PixelValueR2 >= plane+1) {
+            _Pin_R2 = 1;
+        } else {
+            _Pin_R2 = 0;
+        }
+        if (PixelValueG2 >= plane+1) {
+            _Pin_G2 = 1;
+        } else {
+            _Pin_G2 = 0;
+        }
+        if (PixelValueB2 >= plane+1) {
+            _Pin_B2 = 1;
+        } else {
+            _Pin_B2 = 0;
+        }
+
+        _Pin_CLK = 0; // Clock low
+        _Pin_CLK = 1; // Clock high
+    }
+}
+
+void RGB_Matrix::updateDisplay(void) {
+    _Pin_OE  = 1;  // Disable LED output during row/plane switchover
+    _Pin_LAT = 1; // Latch data loaded during *prior* interrupt
+    _Pin_A   =  row & 0x01;
+    _Pin_B   = (row >> 1) & 0x01;
+    _Pin_C   = (row >> 2) & 0x01;
+    _Pin_D   = (row >> 3) & 0x01;
+    _Pin_OE  = 0;   // Re-enable output
+    _Pin_LAT = 0;  // Latch down
+
+    if(++plane >= PLANES) {       // Advance plane counter.  Maxed out?
+        plane = 0;                // Yes, reset to plane 0, and
+        if(++row >= ROWS) {       // advance row counter.  Maxed out?
+            row = 0;              // Yes, reset row counter, then...
+        }
+    }
+
+    buffptr = matrixbuff[bufferDisplay]; // Set display buffer
+    for(uint8_t x = 0; x < WIDTH; x++) {
+        uint16_t BufferIndex = x + row * WIDTH + plane * PIXELS;
+        _Pin_R1  =  buffptr[BufferIndex] & 0x01;
+        _Pin_G1  = (buffptr[BufferIndex] >> 1) & 0x01;
+        _Pin_B1  = (buffptr[BufferIndex] >> 2) & 0x01;
+        _Pin_R2  = (buffptr[BufferIndex] >> 4) & 0x01;
+        _Pin_G2  = (buffptr[BufferIndex] >> 5) & 0x01;
+        _Pin_B2  = (buffptr[BufferIndex] >> 6) & 0x01;
+        _Pin_CLK = 0; // Clock low
+        _Pin_CLK = 1; // Clock high
+    }
+}

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/RGB_Matrix.h	Fri Oct 02 22:27:28 2015 +0000
@@ -0,0 +1,194 @@
+/* mbed RGB Matrix Library
+ * Written for Nucleo-F446RE, v1.0, 03-10-2015
+ *
+ * Copyright (c) 2013-2015 JackB, cstyles
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to deal
+ * in the Software without restriction, including without limitation the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * 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.
+ */
+  
+#ifndef MBED_RGB_MATRIX_H
+#define MBED_RGB_MATRIX_H
+ 
+#include "mbed.h"
+#include "math.h"
+//#include "GraphicsDisplay.h"
+
+/** RGB_Matrix calculation class
+ *
+ * Example:
+ * @code
+ * // Continuously sweep the RGB_Matrix through it's full range
+ * #include "mbed.h"
+ * #include "RGB_Matrix.h"
+ * 
+ * RGB_Matrix myRGB_Matrix(LED1,LED2,LED3);
+ *
+ * int main() {
+ *     myRGB_Matrix.SetS(1.0);
+ *     myRGB_Matrix.SetV(1.0);
+ *     while(1) {
+ *         for(int i=0; i<100; i++) {
+ *             myRGB_Matrix.SetH((float)i/100.0);
+ *             myRGB_Matrix.RGB_Matrix_to_RGB();
+ *             wait(0.01);
+ *         }
+ *     }
+ * }
+ * @endcode
+ */
+
+#define ROWS 16
+#define PLANES 7
+#define WIDTH 64
+#define HEIGHT 32
+#define PIXELS 2048 // WIDTH * HEIGHT
+#define DBUF true
+#define LANDSCAPE_T 0
+#define PORTRAIT_L 1
+#define LANDSCAPE_B 2
+#define PORTRAIT_R 3
+
+#define BYTESPERCHAR  0
+#define FONTWIDTH     1
+#define FONTHEIGHT    2
+#define BYTESPERLINE  3
+
+#define INTTIME 0.00012 // 0.0003 is slowest, 0.00007 is fastest, Nr2 0.000001 is fastest
+
+#define RGB(r,g,b)  (((r&0xF8)<<8)|((g&0xFC)<<3)|((b&0xF8)>>3)) //5 red | 6 green | 5 blue
+
+
+/* some RGB color definitions 
+                        
+                        RRRR RGGG GGGB BBBB
+*/
+#define Black           0x0000      /*   0,   0,   0 */
+#define Navy            0x000F      /*   0,   0, 128 */
+#define DarkBlue        0x000F      /*   0,   0, 255 */
+#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 Grey            0x7BEF      /* 128, 128, 128 */
+#define DarkGrey        0x4208      /*  64,  64,  64 01000 010000 01000 */
+#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 11111 111111 11111 */
+#define Orange          0xFD20      /* 255, 165,   0 11111 101001 00000 */
+#define GreenYellow     0xAFE5      /* 173, 255,  47 10101 111111 00101 */
+
+
+class RGB_Matrix 
+//class RGB_Matrix : public GraphicsDisplay
+{
+public:
+  
+  /** Create a RGB_Matrix object
+   *
+   * @param void 
+   */
+    RGB_Matrix(PinName Pin_R1, PinName Pin_R2, PinName Pin_G1, PinName Pin_G2, 
+             PinName Pin_B1, PinName Pin_B2, 
+             PinName Pin_CLK, PinName Pin_LAT, PinName Pin_OE, 
+             PinName Pin_A, PinName Pin_B, PinName Pin_C, PinName Pin_D);
+
+    void Init(void);
+    
+    void swap(int16_t &x, int16_t &y);
+    uint16_t rgbToColor(uint8_t R, uint8_t G, uint8_t  B);
+
+    void drawPixel2(int16_t x, int16_t y, uint16_t c);
+    void drawPixel(int16_t x, int16_t y, uint16_t c);
+
+    void set_font(unsigned char* f);
+    
+    void character(int x, int y, int c);
+
+    int putc(int value);
+    void printString(char *string);
+    void printStringCenter(char *string);
+    
+    void foreground(uint16_t colour);
+    void background(uint16_t colour);
+    int width();
+    int height();
+    void SetOrientation(uint8_t orientation);
+    void locate(uint8_t x, uint8_t y);
+    void locatePixelX(uint8_t x);
+    void locatePixelY(uint8_t y);
+
+    int columns();
+    int rows();
+
+    void setDisplayBuffer(uint8_t Buffer);
+    void setWriteBuffer(uint8_t Buffer);
+
+    void updateDisplay(void);
+    void updateDisplay2(void);
+
+private:
+
+    DigitalOut _Pin_R1; 
+    DigitalOut _Pin_R2; 
+    DigitalOut _Pin_G1; 
+    DigitalOut _Pin_G2; 
+    DigitalOut _Pin_B1; 
+    DigitalOut _Pin_B2; 
+    DigitalOut _Pin_CLK; 
+    DigitalOut _Pin_LAT; 
+    DigitalOut _Pin_OE; 
+    DigitalOut _Pin_A; 
+    DigitalOut _Pin_B; 
+    DigitalOut _Pin_C; 
+    DigitalOut _Pin_D; 
+
+    Ticker Update;
+
+  // Counters/pointers for interrupt handler:
+  uint8_t row, plane, bufferDisplay, bufferWrite;
+//  uint8_t PixelValueR1, PixelValueG1, PixelValueB1;
+//  uint8_t PixelValueR2, PixelValueG2, PixelValueB2;
+  uint8_t *buffptr;
+//  volatile uint8_t backindex;
+//  volatile bool swapflag;
+
+    uint8_t         *matrixbuff[2];
+//    uint8_t         pixelbuff0[WIDTH*HEIGHT*PLANES];
+//    uint8_t         pixelbuff1[WIDTH*ROWS*PLANES];
+
+  unsigned char* font;
+  uint8_t char_x;
+  uint8_t char_y;
+  uint16_t _foreground, _background;
+  uint8_t _orientation;
+
+// Code for matrix pixel pwm 
+
+
+
+};
+
+#endif
+