#include <stdio.h>
#include <errno.h>
#include <stdlib.h>
#include <wiringPi.h>
#include <iostream>

using namespace std;

#define SCK 0
#define SOUT 7
#define SIN 2

//存放收到的Byte
unsigned char b = 0;
//前八位为ACK，后八位表示一切OK的状态，每次数据包结束时发送
int ack[16] = {1, 0, 0, 0, 0, 0, 0, 1, 0,0,0,0,0,0,0,0};
//数据表序号
int packIndex=0;

//GameBoy packet基本信息
int dataLength = 0;
int byteIndex = 0;
int bitIndex = 0;
int checksum = 0;
bool waitForMagicByte = true;
int command;
int firstPrint=1;
int dataIndex = -1;

//Game Boy显示的行、块及坐标
int row,block,x,y=0;
//模拟Game Boy显存
string  VRAM[160][320];
//四阶灰度的代替字符
string  stringList[4] = {" ","░","▒","▓"};

//将像素表示写入模拟显存
void toVRAM(int sign){
	VRAM[row*8+y][block*16+x] = stringList[sign];
	VRAM[row*8+y][block*16+x+1] = stringList[sign];
	x+=2;
	if(x>=16){
		x=0;
		y++;
		if(y>=8){
			y=0;
			block++;
			if(block>=20){
				block=0;
				row++;
			}
		}
	}
}

//将模拟显存转化为字符图像输出到终端
void outputImage(){
	int mark1,mark2;
	int subList[8]={128,64,32,16,8,4,2,1};
	for(int i = 0; i < 9; i ++)
		{
			for(int j = 0; j < 640; j +=2)
			{
				for(int k=0;k<8;k++){
					mark1=data[i][j]&subList[k];
					mark2=data[i][j+1]&subList[k];
					if(mark1==0&&mark2==0){
						toVRAM(0);
					}else if(mark1==subList[k]&&mark2==0){
						toVRAM(1);
					}else if(mark1==0&&mark2==subList[k]){
						toVRAM(2);
					}else{
						toVRAM(3);
					}
				}
			}
			
	}
}

//处理每个字节
void handleByte(unsigned char b){

	//高字节长度位
	if(byteIndex==5){

		if(b>0){
			dataLength+=b*256;
		}
		return;
	}

	//低字节长度位
	if(byteIndex==4){
		if(b>0){
			dataLength+=b;
		}
		return;
	}

	if(byteIndex==7+dataLength){
		if(command==2&&b!=15){
			ack[16]=1;
		}
	}

	//命令位
	if(byteIndex==2){
		
		switch (b)
		{
			case 1:
				cout<<"Initialize "<<endl;
				break;
			case 4:
				command=4;
				dataIndex++;
				cout<<"Data "<<endl;
				break;
			case 2:
				//如果发送可打印指令，就把图像输出在命令行中
				//某些情况下Game Boy初始化前会发送一个打印指令，这里手动忽略掉
				if(firstPrint!=1){
					outputImage();
				for(int i = 1; i < 160; i ++)
				{
					for(int j = 0; j < 320; j ++)
					{
						cout<<VRAM[i][j];
					}
					cout << endl;
				}
				}else{
					firstPrint=0;
				}
				cout<<"Print "<<endl;
				break;
			case 15:
				cout<<"Inquiry "<<endl;
				break;
			default:
				cout<<"Unknown "<<(int)b<<endl;
				break;
		}
	}
	//记录数据正文
	if(byteIndex>=6&&byteIndex<=6+dataLength&&command==4){
		data[dataIndex][byteIndex-6] = b;
		return;
	}
}

//终端处理函数
void myInterrupt(void){
	b = b << 1;
	if (digitalRead(7)){
		b = b | 1;
		cout<<1;
	}else{
		cout<<0;
	}
	
	if(waitForMagicByte){
		//判断是否读到Magic Byte
		if((int)b==51){
			byteIndex = 2;
			bitIndex = 16;
			dataLength=0;
			ack[16]=0;
			command=0;
			waitForMagicByte=false;
			cout<<"found magic byte"<<endl;
		}
		return;

	}

	//发送ACK及自身状态
	if (bitIndex >= 63+dataLength*8 && bitIndex < 72+dataLength*8){
		digitalWrite(2, ack[(bitIndex - (63+dataLength*8))]);
	}


	//是否产生了新的Byte
	if((bitIndex+1)%8==0){
		handleByte(b);
		byteIndex++;
	}
	bitIndex++;

	//清空计数器，准备下一个新包
	if(byteIndex>=10+dataLength){
		byteIndex = 0;
		bitIndex = 0;
		dataLength=0;
		waitForMagicByte=true;
		checksum = 0;
		cout<<"Packet:"<<++packIndex<<endl;
	}

}

int main(void){
	
	if (wiringPiSetup() < 0)
	{
		fprintf(stderr, "Unable to setup wiringPi: %s\n", strerror(errno));
		return 1;
	}

	pinMode(7, INPUT);
	pinMode(0, INPUT);
	digitalWrite(2, HIGH);
	digitalWrite(7, HIGH);
	
	pullUpDnControl (BUTTON_PIN, PUD_DOWN);
	if (wiringPiISR(BUTTON_PIN, INT_EDGE_RISING, &myInterrupt) < 0)
	{
		fprintf(stderr, "Unable to setup ISR: %s\n", strerror(errno));
		return 1;
	}

	
	while (1){
		cout<<flush;
		delay(20000);
	}

	return 0;
}

#include <stdio.h>
#include <errno.h>
#include <stdlib.h>
#include <wiringPi.h>
#include <fstream>
#include <iostream>

using namespace std;


#define GBInitialize  0x01
#define GBData 0x04
#define GBPrint 0x02
#define GBInquiry 0x0f
#define DELAY_MS 40
#define GBClock  0
#define GBIn  7
#define GBOut  2
#define lowByte(w) ((uint8_t) ((w) & 0xff))
#define highByte(w) ((uint8_t) ((w) >> 8))

//发送一个字节
uint8_t  GBSendByte(unsigned char b){
	unsigned char reply=0;
	for (uint8_t bit_pos = 0; bit_pos < 8; ++bit_pos) {
		reply <<= 1;
		digitalWrite(GBClock, 0); // Send clock signal
		if ((b << bit_pos) & 0x80) {
			digitalWrite(GBOut, 1); // Write out to printer
		}else { 
			digitalWrite(GBOut, 0);
		}
		delayMicroseconds (DELAY_MS);
		digitalWrite(GBClock, 1);
		if (digitalRead(GBIn)){
		  reply |= 1;    // Fetch printer reply
		}
		delayMicroseconds (DELAY_MS);
	}
	return reply;
}

//发送一个包
uint16_t GBSendPacket(uint8_t command, uint16_t size,uint8_t data[],int start=0) {
	uint16_t status, checksum = 0x0000;
	// Send magic bytes
	GBSendByte(0x88);
	GBSendByte(0x33);
	// Send command
	GBSendByte(command);
	checksum += command;
	// Send compression
	GBSendByte(0x00);
	// Send size
	GBSendByte(lowByte(size));
	GBSendByte(highByte(size));
	checksum += lowByte(size);
	checksum += highByte(size);
	// Send data

		uint8_t b;
	for (uint16_t i = 0; i < size; ++i) {
		b = data[i+start];
		checksum += b;
		GBSendByte(b);

	}
	
	// Send checksum
	GBSendByte(lowByte(checksum));
	GBSendByte(highByte(checksum));
	// Read status
	status = GBSendByte(0x00);
	status = status << 8;
	status |= GBSendByte(0x00);
	return status;
}

//从文件读取要发送的数据
void readPicData(uint8_t* data){
	char rawData[5760];
	std::ifstream infile("pic.bin");
    infile.seekg(0, infile.end);
    size_t length = infile.tellg();
    infile.seekg(0, infile.beg);
	infile.read(rawData, length);
	memcpy( data, rawData, length);
}


int main(void)
{
	if (wiringPiSetup() < 0)
	{
		fprintf(stderr, "Unable to setup wiringPi: %s\n", strerror(errno));
		return 1;
	}

	pinMode(GBIn, INPUT);
	pinMode(GBClock, OUTPUT);
	pinMode(GBOut, OUTPUT);
	pullUpDnControl(GBIn,PUD_UP);      // turn on pullup resistors
	pullUpDnControl(GBOut,PUD_UP);      // turn on pullup resistors
	uint8_t data[8]={0,0,0,0,0,0,0,0};
	cout<<(int)GBSendPacket(GBInitialize,0,data)<<endl;
	uint8_t printData[8]={0x01,0x00,0xE4,0x40};
	uint8_t Data[5760];
	readPicData(Data);
	for(int i=0;i<9;i++){
		cout<<(int)GBSendPacket(GBData,640,Data,i*640)<<endl;
	}
	cout<<(int)GBSendPacket(GBData,0,printData)<<endl;
	cout<<(int)GBSendPacket(GBPrint,4,printData)<<endl;
	return 0;
}