/*******************************************************************************
*
* Loadable Driver for 64 x 32 RGB LED panels in RGB333 mode for MX470
* RGB222 for MX170
*
* Author: Peter Mather 2016 with acknowledgements to Geoff Graham
*
*
* This CFunction MUST be compiled with Optimization Level 1, -O1
* -O2,-O3,-Os will compile successfully, but generate exceptions at runtime.
*
* When Generating the CFunction, use MERGE CFunction mode, and name the CFunction
* RGBled
*
* Entry point is function void main( long long *latpin,
* long long *clkpin
* long long *oepin
*
* V1.0 2016-06-29 Peter Mather
******************************************************************************/
#include <stdarg.h>

#define Version 200 //Version 2.00
#define _SUPPRESS_PLIB_WARNING // required for XC1.33 Later compiler versions will need PLIB to be installed
#include <plib.h> // the pre Harmony peripheral libraries
#include "../cfunctions.h"
#define MX470_100 //uncomment to compile for MX470_100
//#define MX470_64 //uncomment to compile for MX470_64
//#define MX170_44 //uncomment to compile for MX170_44
#define screenwidth 64
#define screenheight 32
#define update screenwidth*screenheight*3 //location for status to force screen write
#define xsize screenwidth*6
#define memsize update+256
#define magic update+1
#define nextrow update+2
#define nextbit update+3
#define lat Option->LCD_CD
#define clk Option->LCD_CS
#define oe Option->LCD_Reset
#define cport *(volatile unsigned int *)(0xbf886230) //latch registers
#define cclrport *(volatile unsigned int *)(0xbf886234) //latch registers
#define csetport *(volatile unsigned int *)(0xbf886238) //latch registers
#define eport *(volatile unsigned int *)(0xbf886430) //latch registers
#define eclrport *(volatile unsigned int *)(0xbf886434) //latch registers
#define esetport *(volatile unsigned int *)(0xbf886438) //latch registers
#define CLKLo (*(volatile unsigned int *)CLKclrport)=CLKpin
#define CLKHi (*(volatile unsigned int *)CLKsetport)=CLKpin
#define DEVID (*(volatile unsigned int *)0xBF80F220)

#ifdef MX170_44
void updatedisplay(void){
int n, endpos, build, CLKpin, CLKsetport, CLKclrport, bitmask;
unsigned char* p=(void *)(unsigned int)CFuncRam[0];
CLKpin=1<<GetPinBit(clk);
CLKsetport=(unsigned int)GetPortAddr(clk,LATSET);
CLKclrport=(unsigned int)GetPortAddr(clk,LATCLR);
if(p[nextbit]<2)bitmask=0x80;
if(p[nextbit]==2)bitmask=0x40;
build=p[nextrow]<<6;
n=(int)p[nextrow]*xsize;
endpos=n+xsize;
PinSetBit(oe,LATSET);
if(p[magic]==0xF5){
while (n<endpos){
build &= 0b1111000000;
if(p[n++] & bitmask)build|=1;
if(p[n++] & bitmask)build|=2;
if(p[n++] & bitmask)build|=4;
if(p[n++] & bitmask)build|=8;
if(p[n++] & bitmask)build|=16;
if(p[n++] & bitmask)build|=32;
cport=build;
CLKHi; CLKLo;
}
PinSetBit(lat,LATSET);PinSetBit(lat,LATCLR);
}
PinSetBit(oe,LATCLR);
p[nextrow]=(p[nextrow]+1) & 0xF; //16 rows
if(!p[nextrow]){
p[nextbit]++;
if(p[nextbit]==4)p[nextbit]=0;
}
}
#endif
#ifdef MX470_64
void updatedisplay(void){
int n, j,endpos, build, CLKpin, CLKsetport, CLKclrport, bitmask;
unsigned char* p=(void *)(unsigned int)CFuncRam[0];
CLKpin=1<<GetPinBit(clk);
CLKsetport=(unsigned int)GetPortAddr(clk,LATSET);
CLKclrport=(unsigned int)GetPortAddr(clk,LATCLR);
if(p[nextbit]==0){
bitmask=0x80;
PR5 = 700;
}
if(p[nextbit]==1){
bitmask=0x40;
PR5 = 350;
}
if(p[nextbit]==2){
bitmask=0x20;
PR5 = 280;
}
if(p[nextbit]==3){
bitmask=0x00;
PR5 = 400;
}
build=p[nextrow]<<6;
n=(int)p[nextrow]*xsize;
endpos=n+xsize;
PinSetBit(oe,LATSET);
if(p[magic]==0xF5){
p[nextrow]&0x4?PinSetBit(27,LATSET):PinSetBit(27,LATCLR);
p[nextrow]&0x8?PinSetBit(24,LATSET):PinSetBit(24,LATCLR);
while (n<endpos){
build &= 0b11000000;
if(p[n++] & bitmask)build|=1;
if(p[n++] & bitmask)build|=2;
if(p[n++] & bitmask)build|=4;
if(p[n++] & bitmask)build|=8;
if(p[n++] & bitmask)build|=16;
if(p[n++] & bitmask)build|=32;
eport=build;
CLKHi; j=DEVID;CLKLo; //wait state needed for clock
}
PinSetBit(lat,LATSET);PinSetBit(lat,LATCLR);
}
PinSetBit(oe,LATCLR);
p[nextrow]=(p[nextrow]+1) & 0xF; //16 rows
if(!p[nextrow]){
p[nextbit]++;
if(p[nextbit]==4)p[nextbit]=0;
}
}
#endif
#ifdef MX470_100
void updatedisplay(void){
int n, j,endpos, build, CLKpin, CLKsetport, CLKclrport, bitmask;
unsigned char* p=(void *)(unsigned int)CFuncRam[0];
CLKpin=1<<GetPinBit(clk);
CLKsetport=(unsigned int)GetPortAddr(clk,LATSET);
CLKclrport=(unsigned int)GetPortAddr(clk,LATCLR);
if(p[nextbit]==0){
bitmask=0x80;
PR5 = 700;
}
if(p[nextbit]==1){
bitmask=0x40;
PR5 = 350;
}
if(p[nextbit]==2){
bitmask=0x20;
PR5 = 280;
}
if(p[nextbit]==3){
bitmask=0x00;
PR5 = 400;
}
build=p[nextrow]<<6;
n=(int)p[nextrow]*xsize;
endpos=n+xsize;
PinSetBit(oe,LATSET);
if(p[magic]==0xF5){
while (n<endpos){
build &= 0b1111000000;
if(p[n++] & bitmask)build|=1;
if(p[n++] & bitmask)build|=2;
if(p[n++] & bitmask)build|=4;
if(p[n++] & bitmask)build|=8;
if(p[n++] & bitmask)build|=16;
if(p[n++] & bitmask)build|=32;
eport=build;
CLKHi; j=DEVID;CLKLo; //wait state needed for clock
}
PinSetBit(lat,LATSET);PinSetBit(lat,LATCLR);
}
PinSetBit(oe,LATCLR);
p[nextrow]=(p[nextrow]+1) & 0xF; //16 rows
if(!p[nextrow]){
p[nextbit]++;
if(p[nextbit]==4)p[nextbit]=0;
}
}
#endif

long long DrawRectangleMEM(int x1, int y1, int x2, int y2, int c){
unsigned char* p=(void *)(unsigned int)CFuncRam[0];
if(p[magic]!=0xF5){
p = GetMemory(memsize);
//Save the address for other CFunctions
CFuncRam[0]=(unsigned int)(p);
p[magic]=0xF5;
}
int i,j,t,r,g,b;
if(x2 <= x1) { t = x1; x1 = x2; x2 = t; }
if(y2 <= y1) { t = y1; y1 = y2; y2 = t; }
if(x1 < 0) x1 = 0; if(x1 >= screenwidth) x1 = screenwidth - 1;
if(x2 < 0) x2 = 0; if(x2 >= screenwidth) x2 = screenwidth - 1;
if(y1 < 0) y1 = 0; if(y1 >= screenheight) y1 = screenheight - 1;
if(y2 < 0) y2 = 0; if(y2 >= screenheight) y2 = screenheight - 1;
r=(c & 0xFF0000)>>16;
g=(c & 0xFF00)>>8;
b=c & 0xFF;
for(i=x1;i<=x2;i++){
for(j=y1;j<=y2;j++){
if(j<16){
p[i*6+j*xsize]=r;
p[i*6+j*xsize+1]=g;
p[i*6+j*xsize+2]=b;
} else {
p[i*6+(j-16)*xsize+3]=r;
p[i*6+(j-16)*xsize+4]=g;
p[i*6+(j-16)*xsize+5]=b;
}
}
}
}
void DrawBitmapMEM(int x1, int y1, int width, int height, int scale, int fc, int bc, unsigned char *bitmap){
int i, j, k, m, x, y;
unsigned char* p=(void *)(unsigned int)CFuncRam[0];
unsigned char rf,gf,bf,rb,gb,bb;
if(p[magic]!=0xF5){
p = GetMemory(memsize);

//Save the address for other CFunctions
CFuncRam[0]=(unsigned int)(p);
p[magic]=0xF5;
}
rf=(fc & 0xFF0000)>>16;
gf=(fc & 0xFF00)>>8;
bf=fc & 0xFF;
rb=(bc & 0xFF0000)>>16;
gb=(bc & 0xFF00)>>8;
bb=bc & 0xFF;

for(i = 0; i < height; i++) { // step thru the font scan line by line
for(j = 0; j < scale; j++) { // repeat lines to scale the font
for(k = 0; k < width; k++) { // step through each bit in a scan line
for(m = 0; m < scale; m++) { // repeat pixels to scale in the x axis
x=x1 + k * scale + m ;
y=y1 + i * scale + j ;
if(x >= 0 && x < screenwidth && y >= 0 && y < screenheight) { // if the coordinates are valid
if((bitmap[((i * width) + k)/8] >> (((height * width) - ((i * width) + k) - 1) %8)) & 1) {
if(y<16){
p[x*6+y*xsize]=rf;
p[x*6+y*xsize+1]=gf;
p[x*6+y*xsize+2]=bf;
} else {
p[x*6+(y-16)*xsize+3]=rf;
p[x*6+(y-16)*xsize+4]=gf;
p[x*6+(y-16)*xsize+5]=bf;
}
} else {
if(y<16){
p[x*6+y*xsize]=rb;
p[x*6+y*xsize+1]=gb;
p[x*6+y*xsize+2]=bb;
} else {
p[x*6+(y-16)*xsize+3]=rb;
p[x*6+(y-16)*xsize+4]=gb;
p[x*6+(y-16)*xsize+5]=bb;
}
}
}
}
}
}
}
}
__attribute__((noinline)) void getFPC(void *a, void *b, volatile unsigned int *c)
{
*c = (unsigned int) (__builtin_return_address (0) - (b -a)) ;
}
void pstring(const char *s){
volatile unsigned int libAddr ;
getFPC(NULL,&&getFPCLab,&libAddr) ; // warning can be ignored, stupid editor
getFPCLab: { }
unsigned char * testData = (unsigned char *)((void *)s + libAddr );
MMPrintString(testData);
}
//CFunction Driver RGBLed

long long main(long long *latpin, long long *clkpin, long long *oepin){

volatile unsigned int libAddr ;
getFPC(NULL,&&getFPCLab,&libAddr) ; // warning can be ignored, stupid editor
getFPCLab: { }
unsigned int j,pn[10];
lat=*latpin;
clk=*clkpin;
oe=*oepin;
#ifdef MX170_44
pn[0]=25;
pn[1]=26;
pn[2]=27;
pn[3]=36;
pn[4]=37;
pn[5]=38;
pn[6]=2;
pn[7]=3;
pn[8]=4;
pn[9]=5;
#endif

#ifdef MX470_64
pn[0]=60;
pn[1]=61;
pn[2]=62;
pn[3]=63;
pn[4]=64;
pn[5]=1;
pn[6]=2;
pn[7]=3;
pn[8]=27;
pn[9]=24;
#endif
#ifdef MX470_100
pn[0]=93;
pn[1]=94;
pn[2]=98;
pn[3]=99;
pn[4]=100;
pn[5]=3;
pn[6]=4;
pn[7]=5;
pn[8]=18;
pn[9]=19;
#endif
for(j=0;j<10;j++){
ExtCfg(pn[j],EXT_DIG_OUT,0);ExtCfg(pn[j],EXT_BOOT_RESERVED,0);
PinSetBit(pn[j],LATCLR);
}
HRes=screenwidth;VRes=screenheight;
//Get some persistent memory
unsigned char * p = GetMemory(memsize);
//Save the address for other CFunctions
CFuncRam[0]=(unsigned int)(p);
p[magic]=0xF5;
PinSetBit(oe, LATCLR);
ExtCfg(oe,EXT_DIG_OUT,0);ExtCfg(oe,EXT_BOOT_RESERVED,0);
PinSetBit(clk, LATCLR);
ExtCfg(clk,EXT_DIG_OUT,0);ExtCfg(clk,EXT_BOOT_RESERVED,0);
PinSetBit(lat, LATSET);
ExtCfg(lat,EXT_DIG_OUT,0);ExtCfg(lat,EXT_BOOT_RESERVED,0);
//Set the DrawRectangle vector to point to our function
p[nextrow]=0;
p[nextbit]=0;
for(j=0;j<update;j++)p[j]=0; //clear the display memory

DrawRectangleVector= (unsigned int)&DrawRectangleMEM + libAddr;

//Set the DrawBitmap vector to point to our function
DrawBitmapVector=(unsigned int)&DrawBitmapMEM + libAddr;

#ifdef MX170_44
CFuncT1=(unsigned int)&updatedisplay + libAddr; // using T1 which conflicts with IR
PR1 = 800;
T1CON = 0x8010 ; // T1 on, 8x prescaler as input
mT1SetIntPriority(1); // high priority
mT1ClearIntFlag(); // clear interrupt flag
mT1IntEnable(1);
#endif
#ifdef MX470_64
CFuncT5=(unsigned int)&updatedisplay + libAddr; //using T5, no conflicts on MX470
PR5 = 800;
T5CON = 0x8030 ; // T5 on, 8x prescaler as input
mT5SetIntPriority(1); // high priority
mT5ClearIntFlag(); // clear interrupt flag
mT5IntEnable(1);
#endif
#ifdef MX470_100
CFuncT5=(unsigned int)&updatedisplay + libAddr; //using T5, no conflicts on MX470
PR5 = 800;
T5CON = 0x8030 ; // T5 on, 8x prescaler as input
mT5SetIntPriority(1); // high priority
mT5ClearIntFlag(); // clear interrupt flag
mT5IntEnable(1);
#endif
static const char startup[]="RGB Led driver loaded\r\n";
pstring(startup);
}