#include "ssd1289_lld.h"

#ifdef LCD_USE_SSD1289

uint8_t orientation;
uint16_t DeviceCode;
extern uint16_t lcd_width, lcd_height;

static __inline void lcdWriteIndex(uint16_t index) {
    Clr_RS;
    Set_RD;
  
    palWritePort(LCD_DATA_PORT, index);

    Clr_WR;
    Set_WR;
}

static __inline void lcdWriteData(uint16_t data) {
	Set_RS;

	palWritePort(LCD_DATA_PORT, data);

	Clr_WR;
	Set_WR;
}

static __inline void lcdWriteReg(uint16_t lcdReg,uint16_t lcdRegValue) { 
    Clr_CS;
    lcdWriteIndex(lcdReg);    
    lcdWriteData(lcdRegValue);  
    Set_CS; 
}

static __inline uint16_t lcdReadData(void) {
	uint16_t value;

	Set_RS;
	Set_WR;
	Clr_RD;

	// change pin mode to digital input
	LCD_DATA_PORT->CRH = 0x44444444;
	LCD_DATA_PORT->CRL = 0x44444444;

    value = palReadPort(LCD_DATA_PORT); // dummy
    value = palReadPort(LCD_DATA_PORT); 

    // change pin mode back to digital output
    LCD_DATA_PORT->CRH = 0x33333333;
    LCD_DATA_PORT->CRL = 0x33333333;

    Set_RD;

	return value;
}

static __inline uint16_t lcdReadReg(uint16_t lcdReg) {
    uint16_t lcdRAM;

    Clr_CS;
    lcdWriteIndex(lcdReg);
    lcdRAM = lcdReadData();
                 
    Set_CS;

    return lcdRAM;
}

static __inline void lcdDelay(uint16_t us) {
	chThdSleepMicroseconds(us);
}

void lld_lcdSetCursor(uint16_t x, uint16_t y) {
	if(PORTRAIT) {
		lcdWriteReg(0x004e, x); 
		lcdWriteReg(0x004f, y); 
	} else if(LANDSCAPE) {
		lcdWriteReg(0x004e, y); 
		lcdWriteReg(0x004f, x); 
	} 
}

void lld_lcdSetOrientation(uint8_t newOrientation) {
    orientation = newOrientation;

    switch(orientation) {
        case portrait:
            lcdWriteReg(0x0001, 0x2B3F); 
            lcdWriteReg(0x0011, 0x6070);
            lcd_height = SCREEN_HEIGHT;
            lcd_width = SCREEN_WIDTH;
            break;
        case landscape:
            lcdWriteReg(0x0001, 0x293F);
            lcdWriteReg(0x0011, 0x6078);
            lcd_height = SCREEN_WIDTH;
            lcd_width = SCREEN_HEIGHT;
            break;
        case portraitInv:
            lcdWriteReg(0x0001, 0x693F);
            lcdWriteReg(0x0011, 0x6040);
            lcd_height = SCREEN_HEIGHT;
            lcd_width = SCREEN_WIDTH;
            break;
        case landscapeInv:
            lcdWriteReg(0x0001, 0x6B3F);
            lcdWriteReg(0x0011, 0x6048);
            lcd_height = SCREEN_WIDTH;
            lcd_width = SCREEN_HEIGHT;
            break;
    }
}

void lld_lcdSetWindow(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1) {
    lcdSetCursor(x0, y0);

    switch(lcdGetOrientation()) {
        case portrait:
            lcdWriteReg(0x44, ((x0+x1-1) << 8) | x0);
            lcdWriteReg(0x45, y0);
            lcdWriteReg(0x46, y0+y1-1);
            break;
        case landscape:
            lcdWriteReg(0x44, ((y0+y1-1) << 8) | y1);
            lcdWriteReg(0x45, x0);
            lcdWriteReg(0x46, x0+x1-1);
            break;
        case portraitInv:
            lcdWriteReg(0x44, ((x0+x1-1) << 8) | x0);
            lcdWriteReg(0x45, y0);
            lcdWriteReg(0x46, y0+y1-1);
            break;
        case landscapeInv:
            lcdWriteReg(0x44, ((y0+y1-1) << 8) | y1);
            lcdWriteReg(0x45, x0);
            lcdWriteReg(0x46, x0+x1-1);
            break;
    }
}

void lld_lcdClear(uint16_t color) {
    uint32_t index = 0;

    lld_lcdSetCursor(0,0);
    Clr_CS;
    lcdWriteIndex(0x0022);
    for(index = 0; index < SCREEN_WIDTH * SCREEN_HEIGHT; index++)
        lcdWriteData(color);
    Set_CS;
}

uint16_t lld_lcdGetPixelColor(uint16_t x, uint16_t y) {
    uint16_t dummy;

    lld_lcdSetCursor(x,y);
    Clr_CS;
    lcdWriteIndex(0x0022);
    dummy = lcdReadData();
    dummy = lcdReadData();
    Set_CS;

	return dummy;
}

void lld_lcdDrawPixel(uint16_t x, uint16_t y, uint16_t color) {
    lld_lcdSetCursor(x, y);
    lcdWriteReg(0x0022, color);
}

void lld_lcdInit(void) {
	DeviceCode = lcdReadReg(0x0000);

	lcdWriteReg(0x0000,0x0001);		lcdDelay(5);
    lcdWriteReg(0x0003,0xA8A4);    	lcdDelay(5);   
    lcdWriteReg(0x000C,0x0000);    	lcdDelay(5);   
    lcdWriteReg(0x000D,0x080C);    	lcdDelay(5);   
    lcdWriteReg(0x000E,0x2B00);    	lcdDelay(5);   
    lcdWriteReg(0x001E,0x00B0);    	lcdDelay(5);  
	lcdWriteReg(0x0001,0x2B3F);		lcdDelay(5);
    lcdWriteReg(0x0002,0x0600);    	lcdDelay(5);
    lcdWriteReg(0x0010,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x0011,0x6070);    	lcdDelay(5);
    lcdWriteReg(0x0005,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x0006,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x0016,0xEF1C);    	lcdDelay(5);
    lcdWriteReg(0x0017,0x0003);    	lcdDelay(5);
    lcdWriteReg(0x0007,0x0133);    	lcdDelay(5);         
    lcdWriteReg(0x000B,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x000F,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x0041,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x0042,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x0048,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x0049,0x013F);    	lcdDelay(5);
    lcdWriteReg(0x004A,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x004B,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x0044,0xEF00);    	lcdDelay(5);
    lcdWriteReg(0x0045,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x0046,0x013F);    	lcdDelay(5);
    lcdWriteReg(0x0030,0x0707);    	lcdDelay(5);
    lcdWriteReg(0x0031,0x0204);    	lcdDelay(5);
    lcdWriteReg(0x0032,0x0204);    	lcdDelay(5);
    lcdWriteReg(0x0033,0x0502);    	lcdDelay(5);
    lcdWriteReg(0x0034,0x0507);    	lcdDelay(5);
    lcdWriteReg(0x0035,0x0204);    	lcdDelay(5);
    lcdWriteReg(0x0036,0x0204);    	lcdDelay(5);
    lcdWriteReg(0x0037,0x0502);    	lcdDelay(5);
    lcdWriteReg(0x003A,0x0302);    	lcdDelay(5);
    lcdWriteReg(0x003B,0x0302);    	lcdDelay(5);
    lcdWriteReg(0x0023,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x0024,0x0000);    	lcdDelay(5);
    lcdWriteReg(0x0025,0x8000);    	lcdDelay(5);
    lcdWriteReg(0x004f,0x0000);		lcdDelay(5);      
    lcdWriteReg(0x004e,0x0000);		lcdDelay(5);
}

uint16_t lld_lcdGetOrientation(void) {
	return orientation;
}

uint16_t lld_lcdGetHeight(void) {
	return lcd_height;
}

uint16_t lld_lcdGetWidth(void) {
	return lcd_width;
}

#endif