SHARP製の2.7インチHR-TFTメモリ液晶がうまく動かない件について

#include "mbed.h"
#include "SharpMemoryLCD.h"
SPI spi1(SPI_MOSI, SPI_MISO, SPI_SCK);
DigitalOut cs1(D2);
int main(){
	wait(5);
	SHARPmLCD lcd(&spi1, &cs1, true, 400, 240);
	lcd.init();
	wait(5);
	lcd.setPixel(128,105,1);
	lcd.setPixel(129,105,1);
	lcd.setPixel(130,105,1);
	lcd.setPixel(131,105,1);
	lcd.setPixel(132,105,1);
	lcd.setPixel(128,105,-1);
	lcd.setPixel(129,106,-1);
	lcd.setPixel(130,107,-1);
	lcd.setPixel(131,108,-1);
	lcd.setPixel(132,109,-1);
	wait(5);
	lcd.setPixel(28,115,0);
	lcd.setPixel(29,115,0);
	lcd.setPixel(30,115,0);
	lcd.setPixel(31,115,0);
	lcd.setPixel(32,115,0);
	lcd.setPixel(28,115,1);
	lcd.setPixel(29,116,1);
	lcd.setPixel(30,117,1);
	lcd.setPixel(31,118,1);
	lcd.setPixel(32,119,1);
}

#include 
#include 
#ifndef SHARPMLCDUTIL_H
#define SHARPMLCDUTIL_H
class SHARPmLCDutil{
private:
	bool invert;
	int curX, curY;
	int posX, posY;
	int spiCH;
	int cs_lcd;
	int cs_eep;
	bool flipVal;
public:
	SHARPmLCDutil(int SPIchannel, int SPIcs_eep, int SPIcs_lcd, bool initUnnecessary);
	void COM_flip();
	unsigned char lsbf(unsigned char data);
	void init();																//初期化
	void cls();																	//表示クリア
	void clear();																//表示クリア(alias)
	void mem_cls();																//メモリクリア
	void mem_clear();															//メモリクリア(alias)
	void writeLine(unsigned int lineNumber, const char *data);					//ゲートライン更新
	void setPixel(unsigned int x, unsigned int y, int mode);					//打点
	void drawLine(	//left, topの位置から、right, bottomの位置に1ドット幅の線を指定したmodeで描画
		unsigned int left, unsigned int top,
		unsigned int right, unsigned int bottom,
		unsigned int mode
	);
	void drawRect(	//left, topの位置からright, bottomの位置に対角線を持つ1ドット幅の短径を指定したmodeで描画
		unsigned int left, unsigned int top,
		unsigned int right, unsigned int bottom,
		unsigned int mode
	);
	void fillRect(	//left, topの位置からright, bottomの位置に対角線を持つ塗りつぶされた短径を指定したmodeで描画
		unsigned int left, unsigned int top,
		unsigned int right, unsigned int bottom,
		unsigned int mode
	);
};
#endif

#include "SHARPmLCDutil.h"
unsigned char SHARPmLCDutil::lsbf(unsigned char data){
	data = (data&0xAA)>>1 | (data&0x55)<<1;
	data = (data&0xCC)>>2 | (data&0x33)<<2;
	data = (data&0xF0)>>4 | (data&0x0F)<<4;
	return data;
}
SHARPmLCDutil::SHARPmLCDutil(int SPIchannel, int SPIcs_eep, int SPIcs_lcd, bool initUnnecessary):
spiCH(SPIchannel), cs_eep(SPIcs_eep), cs_lcd(SPIcs_lcd){
	if(!initUnnecessary){
		wiringPiSPISetup(spiCH, 500000);
	}
	wiringPiSetupGpio();
	pinMode(cs_eep, OUTPUT);
	pinMode(cs_lcd, OUTPUT);
	digitalWrite(cs_eep, 1);
	flipVal = false;
}
void SHARPmLCDutil::COM_flip(){
	digitalWrite(cs_lcd, 1);
	delayMicroseconds(3);
	unsigned char sData[2] = {flipVal?0x40:0x00, 0x00};
	wiringPiSPIDataRW(spiCH, sData, 2);
	delayMicroseconds(3);
	digitalWrite(cs_lcd, 0);
	flipVal = !flipVal;
}
void SHARPmLCDutil::init(){
	digitalWrite(cs_lcd, 1);
	delayMicroseconds(3);
	unsigned char aryData[12482] = {0};
	unsigned char *p;
	p = aryData;
	*p = 0x80;
	for(int line=1, idx=0;line<=240;line++){
		*(++p) = lsbf(line & 0xFF);
		for(int i=0;i<50;i++){
			*(++p) = 0b01011010;
		}
		*(++p) = 0x00;
	}
	*(++p) = 0x00;
	wiringPiSPIDataRW(spiCH, aryData, 12482) ;
	delayMicroseconds(3);
	digitalWrite(cs_lcd, 0);
	flipVal = !flipVal;
}
void SHARPmLCDutil::cls(){
	digitalWrite(cs_lcd, 1);
	delayMicroseconds(3);
	unsigned char sData[2] = {0x20|(flipVal?0x40:0x00), 0x00};
	wiringPiSPIDataRW(spiCH, sData, 2);
	delayMicroseconds(3);
	digitalWrite(cs_lcd, 0);
	flipVal = !flipVal;
}
void SHARPmLCDutil::clear(){
	cls();
}
void SHARPmLCDutil::mem_cls(){}
void SHARPmLCDutil::mem_clear(){}
void SHARPmLCDutil::writeLine(unsigned int lineNumber, const char *data){}
void SHARPmLCDutil::setPixel(unsigned int x, unsigned int y, int mode){}
void SHARPmLCDutil::drawLine(unsigned int left, unsigned int top, unsigned int right, unsigned int bottom, unsigned int mode){}
void SHARPmLCDutil::drawRect(unsigned int left, unsigned int top, unsigned int right, unsigned int bottom, unsigned int mode){}
void SHARPmLCDutil::fillRect(unsigned int left, unsigned int top, unsigned int right, unsigned int bottom, unsigned int mode){}

#ifndef GPIO_WIRINGPI_FOR_PI2
#define GPIO_WIRINGPI_FOR_PI2
#define IO_0 0
#define IO_1 1
#define IO_2 2
#define IO_3 3
#define IO_4 4
#define IO_5 5
#define IO_6 6
#define IO_7 7
#define IO_8 8
#define IO_9 9
#define IO_10 10
#define IO_11 11
#define IO_12 12
#define IO_13 13
#define IO_14 14
#define IO_15 15
#define IO_16 16
#define IO_17 17
#define IO_18 18
#define IO_19 19
#define IO_20 20
#define IO_21 21
#define IO_22 22
#define IO_23 23
#define IO_24 24
#define IO_25 25
#define IO_26 26
#define IO_27 27
#define IO_28 28
#define IO_29 29
#define I2C_SDA 8
#define I2C_DATA 8
#define I2C_CSL 9
#define I2C_CLK 9
#define SPI_CS 10
#define SPI_CS0 10
#define SPI_CS1 11
#define SPI_MOSI 12
#define SPI_SDO 12
#define SPI_MISO 13
#define SPI_SDI 13
#define SPI_SCK 14
#define SPI_CLK 14
#define UART_TX 15
#define UART_RX 16
#endif

#include 
#include 
#include "SHARPmLCDutil.h"
#include "wiringPinMap.h"
int main(){
	if (wiringPiSetupGpio() == -1) {
		printf("cannot setup gpio. \n");
		return 1;
	}
	printf("1秒待ち\n");
	delay(1000);
	SHARPmLCDutil lcd(0, IO_2, IO_3, false);
	printf("2秒待ち\n");
	delay(2000);
	printf("lcd.init();\n");
	lcd.init();
	printf("5秒待ち\n");
	delay(5000);
	printf("lcd.cls();\n");
	lcd.cls();
	printf("COM FLIP\n");
	for(int i=0;i<500;i++){
		delay(250);
		lcd.COM_flip();
	}
	printf("おわった\n");
	return 0;
}