<?php
	$fname = $argv[1];
	if(!($file_size = filesize($fname))) return;
	list($file_name,$file_type) = explode('.',$fname,);
	if (!($infp = fopen($fname,"rb"))) return;
	$outfile = $file_name.'.h';
	$outfp   = fopen($outfile,"w");

	fwrite($outfp, "const unsigned long ".$file_type."_len = ".$file_size.";\n");
	fwrite($outfp, "const unsigned char ".$file_type."_data[".$file_size."] = {\n");
	$i = 0; $cnt = 0;
	while (!feof($infp)) {
		$byte = fread($infp, 1);
		$hexChar = '0x'.bin2hex($byte);
		if ((++$cnt)==$file_size) {
			fwrite($outfp,$hexChar."\n};\n");
			break;
		} else {
			if ((++$i)%16) {
				fwrite($outfp,$hexChar.",");
			} else {
				fwrite($outfp,$hexChar.",\n");
			}
		}
	}
	fclose($outfp);
	fclose($infp);
?>

#include <SPI.h>
#include "YoRHa2B.h"

#define SPI_TFT_CS A2   // Chip Select
#define SPI_DC     A1   // Data/Command
#define SPI_RST    -1   // RESET

#define TFT_WIDTH   240
#define TFT_HEIGHT  240
//#define TFT_HEIGHT  320
#define ST77XX_BLACK  1

typedef struct {
	uint8_t idlength;
	uint8_t colourmaptype;
	uint8_t datatypecode;
	uint8_t colourmaporigin[2];
	uint8_t colourmaplength[2];
	uint8_t colourmapdepth;
	uint8_t x_origin[2];
	uint8_t y_origin[2];
	uint8_t width[2];
	uint8_t height[2];
	uint8_t bitsperpixel;
	uint8_t imagedescriptor;
} TGA_HEADER;

typedef struct {
	uint8_t  B;
	uint8_t  G;
	uint8_t  R;
} TGA_BGR;

TGA_BGR *BGRs;

typedef struct {
	uint32_t     Width;
	uint32_t     Height;
} IMAGE_INFO;

IMAGE_INFO *img;

#define HBYTE(u) ((u >> 8) & 0xFF)
#define LBYTE(u) (u & 0xFF)

SPISettings settingsST7789 = SPISettings(20000000, MSBFIRST, SPI_MODE3);

// TFTにコマンドを送信
void tftSendCommand(uint8_t command) {
	digitalWrite(SPI_TFT_CS, LOW);
	digitalWrite(SPI_DC, LOW); // Command mode
	SPI.transfer(command);
}

// TFTにコマンド+1バイトデータを送信
void tftSendCommand1(uint8_t command, uint8_t data1) {
	digitalWrite(SPI_TFT_CS, LOW);
	digitalWrite(SPI_DC, LOW);  // Command mode
	SPI.transfer(command);
	digitalWrite(SPI_DC, HIGH); // Data mode
	SPI.transfer(data1);
	digitalWrite(SPI_TFT_CS, HIGH);
}

// TFTにコマンド+2バイトデータを送信
void tftSendCommand2(uint8_t command, uint8_t data1, uint8_t data2) {
	digitalWrite(SPI_TFT_CS, LOW);
	digitalWrite(SPI_DC, LOW);  // Command mode
	SPI.transfer(command);
	digitalWrite(SPI_DC, HIGH); // Data mode
	SPI.transfer(data1);
	SPI.transfer(data2);
	digitalWrite(SPI_TFT_CS, HIGH);
}

// TFTにコマンド+3バイトデータを送信
void tftSendCommand3(uint8_t command, uint8_t data1, uint8_t data2, uint8_t data3) {
	digitalWrite(SPI_TFT_CS, LOW);
	digitalWrite(SPI_DC, LOW);  // Command mode
	SPI.transfer(command);
	digitalWrite(SPI_DC, HIGH); // Data mode
	SPI.transfer(data1);
	SPI.transfer(data2);
	SPI.transfer(data3);
	digitalWrite(SPI_TFT_CS, HIGH);
}

// TFTにコマンド+4バイトデータを送信
void tftSendCommand4(uint8_t command, uint8_t data1, uint8_t data2, uint8_t data3, uint8_t data4) {
	digitalWrite(SPI_TFT_CS, LOW);
	digitalWrite(SPI_DC, LOW);  // Command mode
	SPI.transfer(command);
	digitalWrite(SPI_DC, HIGH); // Data mode
	SPI.transfer(data1);
	SPI.transfer(data2);
	SPI.transfer(data3);
	SPI.transfer(data4);
	digitalWrite(SPI_TFT_CS, HIGH);
}

void drawRGBBitmap(uint16_t x, uint16_t y, uint16_t *color565, uint16_t width, uint16_t height) {
	uint8_t h, l;
	width--;
	h = (uint8_t)(width>>8);
	l = (uint8_t)(width&0x00ff);
	tftSendCommand4(0x2A,x,y,h,l); // Colmun Address
	height--;
	h = (uint8_t)(height>>8);
	l = (uint8_t)(height&0x00ff);
	tftSendCommand4(0x2B,x,y,h,l); // Row Address
	digitalWrite(SPI_TFT_CS, LOW);
	digitalWrite(SPI_DC, LOW);  // Command mode
	SPI.transfer(0x2C);
	digitalWrite(SPI_DC, HIGH); // Data mode
	SPI.transfer(color565, width*height*2);
	digitalWrite(SPI_TFT_CS, HIGH);
	digitalWrite(SPI_DC, LOW); // Command mode
}

// 表示開始ライン設定
void dispStartLine(uint16_t y) {
	uint8_t yH = (y >> 8) & 0xFF ;
	uint8_t yL = y & 0xFF ;

	digitalWrite(SPI_TFT_CS, LOW);
	digitalWrite(SPI_DC, LOW);  // Command mode
	SPI.transfer(0x37);
	digitalWrite(SPI_DC, HIGH); // Data mode
	SPI.transfer(yH);
	SPI.transfer(yL);
	digitalWrite(SPI_TFT_CS, HIGH);
}

void init_tft() {

	pinMode(SPI_TFT_CS,OUTPUT);
	pinMode(SPI_DC, OUTPUT);
//	pinMode(SPI_RST, OUTPUT);
//	digitalWrite(SPI_TFT_CS, HIGH);

	// --- HARD Ware Reset
	if (SPI_RST >= 0) {
		digitalWrite(SPI_RST, HIGH);
		delay(500);                  // VDD goes high at start, pause for 500 ms
		digitalWrite(SPI_RST, LOW);  // Bring reset low
		delay(100);                  // Wait 100 ms
		digitalWrite(SPI_RST, HIGH); // Bring out of reset
		delay(500);                  // Wait 500 ms, more then 120 ms
	}
	// --- SOFT Ware Reset
	tftSendCommand(0x01) ;       // SOFTWARE RESET
	delay(50);

	// --- Initial Comands
	tftSendCommand(0x28) ;            // Display OFF
	delay(500);

	tftSendCommand(0x11) ;            // Sleep Out
	delay(500);
	tftSendCommand1(0x3A,0x05) ;      // 16Bit Pixel Mode
	delay(10);
	tftSendCommand1(0x36,B00000000) ; // MX MY MV ML RGB MH x x:縦向き１
	tftSendCommand2(0xB6,0x15,0x02) ; // フレームレート設定

	tftSendCommand(0x13) ;            // Nomal Display Mode
	tftSendCommand(0x21) ;            // Display Inversion Off
	tftSendCommand(0x29) ;            // Display ON

	// tftSendCommand1(0x36,B10100000);// MX MY MV ML RGB MH x x:横向き１
	// tftSendCommand1(0x36,B01100000); // MX MY MV ML RGB MH x x：横向き２
	// tftSendCommand1(0x36,B00000000); // MX MY MV ML RGB MH x x：縦向き１
	tftSendCommand1(0x36,B11000000); // MX MY MV ML RGB MH x x：縦向き２

	dispStartLine(80);
}

uint16_t swap16(uint8_t *pt) {
	uint16_t ret;
	ret  = *pt;
	ret |= (*(pt+1)<<8)&0xff00;
	return ret;
}

boolean TGA2Pixel(const unsigned char *data, const unsigned long len) {

	FILE        *stream;
	TGA_HEADER  header;

	if((stream = fmemopen((void*)data, len, "rb"))==NULL) return false;

	if (fread(&header,sizeof(TGA_HEADER),1,stream)>0) {
		img->Width  = swap16(header.width);
		img->Height = swap16(header.height);
		BGRs = (TGA_BGR *)malloc(img->Width * img->Height * 3);
	} else {
		return false;
	}

	long pos = 0;

	while(fread(&BGRs[pos],3,1,stream)) pos++;

	fclose(stream);
	return true;
}

void setup() {

	uint16_t rgb565;
	uint16_t *color565, *imgpt;
	long     pos;

	SPI.begin();  //SPIを初期化、SCK、MOSI、SSの各ピンの動作は出力、SCK、MOSIはLOW、SSはHIGH
	SPI.beginTransaction(settingsST7789);

	init_tft();

	img = (IMAGE_INFO *)malloc(sizeof(IMAGE_INFO));
	TGA2Pixel(tga_data, tga_len);

	color565 = (uint16_t*)malloc(240*240*2);
	imgpt = color565;
	pos = 0;
	for(int y=0; y < img->Height; y++) {
		for(int x=0; x < img->Width; x++,pos++,imgpt++) {
			rgb565 = ((BGRs[pos].R>>3)<<11)|((BGRs[pos].G>>2)<<5)|(BGRs[pos].B>>3);
			*imgpt = (rgb565<<8)|(rgb565>>8);
		}
	}
	drawRGBBitmap(0,0,color565,240,240);
}

void loop() {}