static void spi_send_data(unsigned int data)
{
unsigned int i;
CS_SET();
udelay(1);
CLK_SET();
TXD_SET();
CS_CLR();
udelay(1);
for (i = 0; i < 24; i++)
{
//udelay(1);
CLK_CLR();
udelay(1);
if (data & 0x00800000) {
TXD_SET();
} else {
TXD_CLR();
}
udelay(1);
CLK_SET();
udelay(1);
data <<= 1;
}
TXD_SET();
CS_SET();
}
void Spi_Write_data(unsigned char data)
{
int j;
CS_CLR();
TXD_SET();
udelay(UDELAY_TIME);
CLK_CLR();
udelay(3);
CLK_SET();
udelay(UDELAY_TIME);
TXD_CLR();
CLK_CLR();
for(j=0; j<8; j++)
{
if(data&0x80)
{
TXD_SET();
}
else
{
TXD_CLR();
}
data<<=1;
CLK_CLR();
udelay(UDELAY_TIME);
CLK_SET();
udelay(UDELAY_TIME);
}
CS_SET();
}
void Spi_Write_index(unsigned char index)
{
int j;
CS_CLR();
TXD_CLR(); //0
udelay(UDELAY_TIME);
CLK_CLR();
udelay(3);//
CLK_SET();
udelay(UDELAY_TIME);
TXD_CLR();
CLK_CLR();
for(j=0; j<8; j++)
{
if(index&0x80)
{
TXD_SET();
}
else
{
TXD_CLR();
}
index<<=1;
CLK_CLR();
udelay(UDELAY_TIME);
CLK_SET();
udelay(UDELAY_TIME);
}
CS_SET();
}
void spi_screenreg_set(u32 Addr, u32 Data)
{
u32 i;
TXD_OUT();
CLK_OUT();
CS_OUT();
DRVDelayUs(2);
DRVDelayUs(2);
CS_SET();
TXD_CLR();
CLK_CLR();
DRVDelayUs(2);
CS_CLR();
for(i = 0; i < 7; i++) //reg
{
if(Addr &(1<<(6-i)))
TXD_SET();
else
TXD_CLR();
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
}
TXD_CLR(); //write
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
for(i = 0; i < 8; i++) //data
{
if(Data &(1<<(7-i)))
TXD_SET();
else
TXD_CLR();
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
}
CS_SET();
CLK_CLR();
TXD_CLR();
DRVDelayUs(2);
}
void spi_screenreg_param(u8 Param)
{
u32 i;
u32 control_bit;
CS_CLR();
control_bit = 0x0100;
Param = (control_bit | Param);
//printk("data0 is 0x%x \n", Data);
for(i = 0; i < 9; i++) //data
{
if(Param &(1<<(8-i)))
TXD_SET();
else
TXD_CLR();
// \u6a21\u62dfCLK
CLK_SET();
DRVDelayUs(2);
CLK_CLR();
DRVDelayUs(2);
}
CS_SET();
CLK_CLR();
TXD_CLR();
DRVDelayUs(10);
}
unsigned char PS2X::_gamepad_shiftinout (char byte) {
SaveInterruptState; // *** KJE *** save away the current state of interrupts
unsigned char tmp = 0;
DisableInterrupts; // *** KJE *** disable for now
for(i=0;i<8;i++) {
if(CHK(byte,i)) CMD_SET();
else CMD_CLR();
CLK_CLR();
RestoreInterrupts; // *** *** KJE *** *** Interrupts may be enabled again
delayMicroseconds(CTRL_CLK);
DisableInterrupts; // *** KJE ***
if(DAT_CHK()) SET(tmp,i);
CLK_SET();
#if CTRL_CLK_HIGH
delayMicroseconds(CTRL_CLK_HIGH);
#endif
}
CMD_SET();
RestoreInterrupts; // *** *** KJE *** *** Interrupts may be enabled again
delayMicroseconds(CTRL_BYTE_DELAY);
return tmp;
}
static void _clock()
{
CLK_SET();
CLK_DELAY();
CLK_CLR();
CLK_DELAY();
}
/* spi write a data frame,type mean command or data */
int spi_write_9bit(u32 type, u32 value)
{
// if(type != 0 && type != 1)
// return -1;
/*make a data frame of 9 bits,the 8th bit 0:mean command,1:mean data*/
value &= 0xff;
value |= type;
type = 9;
CS_CLR();
//udelay(2);
while(type--) {
CLK_CLR();
if(value & 0x100)
TXD_SET();
else
TXD_CLR();
value <<= 1;
//udelay(2);
CLK_SET();
//udelay(2);
}
CS_SET();
TXD_SET();
return 0;
}
void WriteCommand( int Command)
{
unsigned char i,count1, count2,count3,count4;
count1= Command>>8;
count2= Command;
count3=0x20;//00100000 //写命令高位
count4=0x00;//00000000 //写命令低位======具体请看IC的Datasheet
CS_CLR();
for(i=0;i<8;i++)
{
CLK_CLR();
if (count3 & 0x80) TXD_SET();
else TXD_CLR();
CLK_SET();
count3<<=1;
}
for(i=0;i<8;i++)
{
CLK_CLR();
if (count1 & 0x80) TXD_SET();
else TXD_CLR();
CLK_SET();
count1<<=1;
}
for(i=0;i<8;i++)
{
CLK_CLR();
if (count4 & 0x80) TXD_SET();
else TXD_CLR();
CLK_SET();
count4<<=1;
}
for(i=0;i<8;i++)
{
CLK_CLR();
if (count2 & 0x80) TXD_SET();
else TXD_CLR();
CLK_SET();
count2<<=1;
}
CS_SET();
}
static void spi_recv_data(unsigned int* data)
{
unsigned int i = 0, temp = 0x73; //read data
CS_SET();
udelay(1);
CLK_SET();
TXD_SET();
CS_CLR();
udelay(1);
for(i = 0; i < 8; i++) // 8 bits Data
{
udelay(1);
CLK_CLR();
if (temp & 0x80)
TXD_SET();
else
TXD_CLR();
temp <<= 1;
udelay(1);
CLK_SET();
udelay(1);
}
udelay(1);
temp = 0;
for(i = 0; i < 16; i++) // 16 bits Data
{
udelay(1);
CLK_CLR();
udelay(1);
CLK_SET();
udelay(1);
temp <<= 1;
if(RXD_GET() == GPIO_HIGH)
temp |= 0x01;
}
TXD_SET();
CS_SET();
*data = temp;
}
unsigned char PS2X::_gamepad_shiftinout (char byte) {
unsigned char tmp = 0;
for(unsigned char i=0;i<8;i++) {
if(CHK(byte,i)) CMD_SET();
else CMD_CLR();
CLK_CLR();
delayMicroseconds(CTRL_CLK);
//if(DAT_CHK()) SET(tmp,i);
if(DAT_CHK()) bitSet(tmp,i);
CLK_SET();
#if CTRL_CLK_HIGH
delayMicroseconds(CTRL_CLK_HIGH);
#endif
}
CMD_SET();
delayMicroseconds(CTRL_BYTE_DELAY);
return tmp;
}
static int init(void)
{
if(gLcd_info)
gLcd_info->io_init();
TXD_OUT();
CLK_OUT();
CS_OUT();
RST_CLR();
CS_SET();
CLK_SET();
mdelay(5);
RST_SET();
mdelay(2);
Lcd_WriteSpi_initial3();
return 0;
}
void spi_screenreg_cmd(u8 Addr)
{
u32 i;
u32 control_bit;
TXD_OUT();
CLK_OUT();
CS_OUT();
DRVDelayUs(2);
DRVDelayUs(2);
CS_SET();
TXD_SET();
CLK_CLR();
DRVDelayUs(30);
CS_CLR();
control_bit = 0x0000;
Addr = (control_bit | Addr);//spi_screenreg_set(0x36, 0x0000, 0xffff);
//printk("addr is 0x%x \n", Addr);
for(i = 0; i < 9; i++) //reg
{
if(Addr &(1<<(8-i)))
TXD_SET();
else
TXD_CLR();
// \u6a21\u62dfCLK
CLK_SET();
DRVDelayUs(2);
CLK_CLR();
DRVDelayUs(2);
}
CS_SET();
TXD_SET();
CLK_CLR();
DRVDelayUs(10);
}
//void spi_screenreg_set(uint32 Addr, uint32 Data)
void spi_screenreg_set(u32 Data)
{
u32 i;
TXD_OUT();
CLK_OUT();
CS_OUT();
DRVDelayUs(2);
DRVDelayUs(2);
CS_SET();
TXD_SET();
CLK_SET();
DRVDelayUs(2);
CS_CLR();
for(i = 0; i < 16; i++) //reg
{
if(Data &(1<<(15-i)))
TXD_SET();
else
TXD_CLR();
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
}
/*
TXD_CLR(); //write
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
TXD_SET(); //highz
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
//for(i = 0; i < 8; i++) //data
for(i = 0; i < 16; i++)
{
if(Data &(1<<(15-i)))
TXD_SET();
else
TXD_CLR();
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
}
*/
CS_SET();
CLK_CLR();
TXD_CLR();
DRVDelayUs(2);
}
byte PS2X::config_gamepad(uint8_t clk, uint8_t cmd, uint8_t att, uint8_t dat, bool pressures, bool rumble)
{
byte temp[sizeof(type_read)];
_clk_mask = digitalPinToBitMask(clk);
_clk_oreg = portOutputRegister(digitalPinToPort(clk));
_cmd_mask = digitalPinToBitMask(cmd);
_cmd_oreg = portOutputRegister(digitalPinToPort(cmd));
_att_mask = digitalPinToBitMask(att);
_att_oreg = portOutputRegister(digitalPinToPort(att));
_dat_mask = digitalPinToBitMask(dat);
_dat_ireg = portInputRegister(digitalPinToPort(dat));
MC_SET_PIN_OUTPUT(PS2_PIN_CLK);
MC_SET_PIN_OUTPUT(PS2_PIN_CMD);
MC_SET_PIN_OUTPUT(PS2_PIN_SEL);
MC_SET_PIN_INPUT(PS2_PIN_DAT);
CMD_SET(); // SET(*_cmd_oreg,_cmd_mask);
CLK_SET();
//new error checking. First, read gamepad a few times to see if it's talking
read_gamepad();
read_gamepad();
//see if it talked - see if mode came back.
//If still anything but 41, 73 or 79, then it's not talking
if(PS2data[1] != 0x41 && PS2data[1] != 0x73 && PS2data[1] != 0x79)
{
return 1; //return error code 1
}
//try setting mode, increasing delays if need be.
read_delay = 1;
for(int y = 0; y <= 10; y++)
{
sendCommandString(enter_config, sizeof(enter_config)); //start config run
//read type
_delay_us(CTRL_BYTE_DELAY);
CMD_SET();
CLK_SET();
ATT_CLR(); // low enable joystick
_delay_us(CTRL_BYTE_DELAY);
for (int i = 0; i<9; i++)
{
temp[i] = _gamepad_shiftinout(type_read[i]);
}
ATT_SET(); // HI disable joystick
controller_type = temp[3];
sendCommandString(set_mode, sizeof(set_mode));
sendCommandString(exit_config, sizeof(exit_config));
read_gamepad();
if(pressures)
{
if(PS2data[1] == 0x79)
{
break;
}
if(PS2data[1] == 0x73)
{
return 3;
}
}
if(PS2data[1] == 0x73)
{
break;
}
if(y == 10)
{
return 2; //exit function with error
}
read_delay += 1; //add 1ms to read_delay
}
return 0; //no error if here
}
void spi_screenreg_set(u32 Addr, u32 Data)
{
#define DRVDelayUs(i) udelay(i*2)
u32 i;
TXD_OUT();
CLK_OUT();
CS_OUT();
DRVDelayUs(2);
DRVDelayUs(2);
CS_SET();
TXD_SET();
CLK_SET();
DRVDelayUs(2);
CS_CLR();
for(i = 0; i < 6; i++) //reg
{
if(Addr &(1<<(5-i)))
TXD_SET();
else
TXD_CLR();
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
}
TXD_CLR(); //write
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
TXD_SET(); //highz
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
for(i = 0; i < 8; i++) //data
{
if(Data &(1<<(7-i)))
TXD_SET();
else
TXD_CLR();
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
}
CS_SET();
CLK_CLR();
TXD_CLR();
DRVDelayUs(2);
}
void WriteParameter(char DH)
{
unsigned char i, count1, count2,count3,count4;
count1=DH>>8;
count2=DH;
count3=0x60;//写数据高位
count4=0x40;//写数据低位
CS_CLR();
/*
TXD_CLR(); CLK_CLR(); CLK_SET(); //WRITE
TXD_SET(); CLK_CLR(); CLK_SET(); //DATA
TXD_SET(); CLK_CLR(); CLK_SET(); //HIGH BYTE
TXD_CLR(); CLK_CLR(); CLK_SET();
TXD_CLR(); CLK_CLR(); CLK_SET();
TXD_CLR(); CLK_CLR(); CLK_SET();
TXD_CLR(); CLK_CLR(); CLK_SET();
TXD_CLR(); CLK_CLR(); CLK_SET();
*/
/*
//因为数据的高位基本是不用的，可以不传高位，直接传低位
for(i=0;i<8;i++)
{
CLK_CLR();
if (count3 & 0x80) TXD_SET();
else TXD_CLR();
CLK_SET();
count3<<=1;
}
for(i=0;i<8;i++)
{
CLK_CLR();
if (count1 & 0x80) TXD_SET();
else TXD_CLR();
CLK_SET();
count1<<=1;
}
*/
for(i=0;i<8;i++)
{
CLK_CLR();
if (count4 & 0x80) TXD_SET();
else TXD_CLR();
CLK_SET();
count4<<=1;
}
for(i=0;i<8;i++)
{
CLK_CLR();
if (count2 & 0x80) TXD_SET();
else TXD_CLR();
CLK_SET();
count2<<=1;
}
CS_SET();
}
void PS2X::read_gamepad(boolean motor1, byte motor2) {
double temp = millis() - last_read;
SaveInterruptState; // *** KJE **** save away the current state of interrupts - *** *** KJE *** ***
if (temp > 1500) //waited to long
reconfig_gamepad();
if(temp < read_delay) //waited too short
delay(read_delay - temp);
last_buttons = buttons; //store the previous buttons states
if(motor2 != 0x00)
motor2 = map(motor2,0,255,0x40,0xFF); //noting below 40 will make it spin
DisableInterrupts; //*** KJE ***
CMD_SET();
CLK_SET();
ATT_CLR(); // low enable joystick
RestoreInterrupts; // *** KJE *** - Interrupts may be enabled again
delayMicroseconds(CTRL_BYTE_DELAY);
//Send the command to send button and joystick data;
char dword[9] = {0x01,0x42,0,motor1,motor2,0,0,0,0};
byte dword2[12] = {0,0,0,0,0,0,0,0,0,0,0,0};
for (int i = 0; i<9; i++) {
PS2data[i] = _gamepad_shiftinout(dword[i]);
}
if(PS2data[1] == 0x79) { //if controller is in full data return mode, get the rest of data
for (int i = 0; i<12; i++) {
PS2data[i+9] = _gamepad_shiftinout(dword2[i]);
}
}
DisableInterrupts;
ATT_SET(); // HI disable joystick
RestoreInterrupts; // Interrupts may be enabled again
#ifdef PS2X_COM_DEBUG
Serial.println("OUT:IN");
for(int i=0; i<9; i++){
Serial.print(dword[i], HEX);
Serial.print(":");
Serial.print(PS2data[i], HEX);
Serial.print(" ");
}
for (int i = 0; i<12; i++) {
Serial.print(dword2[i], HEX);
Serial.print(":");
Serial.print(PS2data[i+9], HEX);
Serial.print(" ");
}
Serial.println("");
#endif
//buttons = *(uint16_t*)(PS2data+3); // FAULTS on chipkit!!! store as one value for multiple functions
buttons = (uint16_t)(PS2data[4] << 8) + PS2data[3]; //store as one value for multiple functions
last_read = millis();
}
byte PS2X::config_gamepad(uint8_t clk, uint8_t cmd, uint8_t att, uint8_t dat, bool pressures, bool rumble) {
SaveInterruptState; // *** KJE *** save away the current state of interrupts
byte temp[sizeof(type_read)];
#ifdef __AVR__
_clk_mask = maskToBitNum(digitalPinToBitMask(clk));
_clk_oreg = portOutputRegister(digitalPinToPort(clk));
_cmd_mask = Num(digitalPinToBitMask(cmd));
_cmd_oreg = portOutputRegister(digitalPinToPort(cmd));
_att_mask = maskToBitNum(digitalPinToBitMask(att));
_att_oreg = portOutputRegister(digitalPinToPort(att));
_dat_mask = maskToBitNum(digitalPinToBitMask(dat));
_dat_ireg = portInputRegister(digitalPinToPort(dat));
#else
_clk_mask = digitalPinToBitMask(clk);
_clk_lport = portOutputRegister(digitalPinToPort(clk));
_cmd_mask = digitalPinToBitMask(cmd);
_cmd_lport = portOutputRegister(digitalPinToPort(cmd));
_att_mask = digitalPinToBitMask(att);
_att_lport = portOutputRegister(digitalPinToPort(att));
_dat_mask = digitalPinToBitMask(dat);
_dat_lport = portInputRegister(digitalPinToPort(dat));
#endif
pinMode(clk, OUTPUT); //configure ports
pinMode(att, OUTPUT);
pinMode(cmd, OUTPUT);
pinMode(dat, INPUT);
#if defined(__AVR__)
digitalWrite(dat, HIGH); //enable pull-up
#endif
DisableInterrupts; // *** KJE *** disable for now
CMD_SET(); // SET(*_cmd_oreg,_cmd_mask);
CLK_SET();
RestoreInterrupts; // *** *** KJE *** *** Interrupts may be enabled again
//new error checking. First, read gamepad a few times to see if it's talking
read_gamepad();
read_gamepad();
//see if it talked
if(PS2data[1] != 0x41 && PS2data[1] != 0x73 && PS2data[1] != 0x79){ //see if mode came back. If still anything but 41, 73 or 79, then it's not talking
#ifdef PS2X_DEBUG
Serial.println("Controller mode not matched or no controller found");
Serial.print("Expected 0x41 or 0x73, got ");
Serial.println(PS2data[1], HEX);
#endif
return 1; //return error code 1
}
//try setting mode, increasing delays if need be.
read_delay = 1;
for(int y = 0; y <= 10; y++)
{
sendCommandString(enter_config, sizeof(enter_config)); //start config run
//read type
delayMicroseconds(CTRL_BYTE_DELAY);
DisableInterrupts; // *** KJE *** disable for now
CMD_SET();
CLK_SET();
ATT_CLR(); // low enable joystick
RestoreInterrupts; // *** *** KJE *** *** Interrupts may be enabled again
delayMicroseconds(CTRL_BYTE_DELAY);
for (int i = 0; i<9; i++) {
temp[i] = _gamepad_shiftinout(type_read[i]);
}
DisableInterrupts; // *** KJE *** disable for now
ATT_SET(); // HI disable joystick
RestoreInterrupts; // *** *** KJE *** *** Interrupts may be enabled again
controller_type = temp[3];
sendCommandString(set_mode, sizeof(set_mode));
if(rumble){ sendCommandString(enable_rumble, sizeof(enable_rumble)); en_Rumble = true; }
if(pressures){ sendCommandString(set_bytes_large, sizeof(set_bytes_large)); en_Pressures = true; }
sendCommandString(exit_config, sizeof(exit_config));
read_gamepad();
if(pressures){
if(PS2data[1] == 0x79)
break;
if(PS2data[1] == 0x73)
return 3;
}
if(PS2data[1] == 0x73)
break;
if(y == 10){
#ifdef PS2X_DEBUG
Serial.println("Controller not accepting commands");
Serial.print("mode stil set at");
Serial.println(PS2data[1], HEX);
#endif
return 2; //exit function with error
}
read_delay += 1; //add 1ms to read_delay
}
return 0; //no error if here
}
void spi_screenreg_set(u32 Addr, u32 Data)
{
#define DRVDelayUs(i) udelay(i*2)
u32 i;
u32 control_bit;
TXD_OUT();
CLK_OUT();
CS_OUT();
DRVDelayUs(2);
DRVDelayUs(2);
CS_SET();
TXD_SET();
CLK_SET();
DRVDelayUs(2);
CS_CLR();
control_bit = 0x70<<8;
Addr = (control_bit | Addr);
//printk("addr is 0x%x \n", Addr);
for(i = 0; i < 16; i++) //reg
{
if(Addr &(1<<(15-i)))
TXD_SET();
else
TXD_CLR();
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
}
CS_SET();
TXD_SET();
CLK_SET();
DRVDelayUs(2);
CS_CLR();
control_bit = 0x72<<8;
Data = (control_bit | Data);
//printk("data is 0x%x \n", Data);
for(i = 0; i < 16; i++) //data
{
if(Data &(1<<(15-i)))
TXD_SET();
else
TXD_CLR();
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
}
CS_SET();
CLK_CLR();
TXD_CLR();
DRVDelayUs(2);
}
boolean PS2X::read_gamepad(boolean motor1, byte motor2) {
double temp = millis() - last_read;
if (temp > 1500) //waited to long
reconfig_gamepad();
if(temp < read_delay) //waited too short
delay(read_delay - temp);
if(motor2 != 0x00)
motor2 = map(motor2,0,255,0x40,0xFF); //noting below 40 will make it spin
char dword[9] = {0x01,0x42,0,motor1,motor2,0,0,0,0};
byte dword2[12] = {0,0,0,0,0,0,0,0,0,0,0,0};
// Try a few times to get valid data...
for (byte RetryCnt = 0; RetryCnt < 5; RetryCnt++) {
CMD_SET();
CLK_SET();
ATT_CLR(); // low enable joystick
delayMicroseconds(CTRL_BYTE_DELAY);
//Send the command to send button and joystick data;
for (int i = 0; i<9; i++) {
PS2data[i] = _gamepad_shiftinout(dword[i]);
}
if(PS2data[1] == 0x79) { //if controller is in full data return mode, get the rest of data
for (int i = 0; i<12; i++) {
PS2data[i+9] = _gamepad_shiftinout(dword2[i]);
}
}
ATT_SET(); // HI disable joystick
// Check to see if we received valid data or not.
// We should be in analog mode for our data to be valid (analog == 0x7_)
if ((PS2data[1] & 0xf0) == 0x70)
break;
// If we got to here, we are not in analog mode, try to recover...
reconfig_gamepad(); // try to get back into Analog mode.
delay(read_delay);
}
// If we get here and still not in analog mode (=0x7_), try increasing the read_delay...
if ((PS2data[1] & 0xf0) != 0x70) {
if (read_delay < 10)
read_delay++; // see if this helps out...
}
#ifdef PS2X_COM_DEBUG
Serial.println("OUT:IN");
for(int i=0; i<9; i++){
Serial.print(dword[i], HEX);
Serial.print(":");
Serial.print(PS2data[i], HEX);
Serial.print(" ");
}
for (int i = 0; i<12; i++) {
Serial.print(dword2[i], HEX);
Serial.print(":");
Serial.print(PS2data[i+9], HEX);
Serial.print(" ");
}
Serial.println("");
#endif
last_buttons = buttons; //store the previous buttons states
#if defined(__AVR__)
buttons = *(uint16_t*)(PS2data+3); //store as one value for multiple functions
#else
buttons = (uint16_t)(PS2data[4] << 8) + PS2data[3]; //store as one value for multiple functions
#endif
last_read = millis();
return ((PS2data[1] & 0xf0) == 0x70); // 1 = OK = analog mode - 0 = NOK
}
void spi_screenreg_set(uint32 Addr, uint32 Data)
{
#define CS_OUT() GPIOSetPinDirection(GPIOPortB_Pin3, GPIO_OUT)
#define CS_SET() GPIOSetPinLevel(GPIOPortB_Pin3, GPIO_HIGH)
#define CS_CLR() GPIOSetPinLevel(GPIOPortB_Pin3, GPIO_LOW)
#define CLK_OUT() GPIOSetPinDirection(GPIOPortE_Pin5, GPIO_OUT) //I2C0_SCL
#define CLK_SET() GPIOSetPinLevel(GPIOPortE_Pin5, GPIO_HIGH)
#define CLK_CLR() GPIOSetPinLevel(GPIOPortE_Pin5, GPIO_LOW)
#define TXD_OUT() GPIOSetPinDirection(GPIOPortE_Pin4, GPIO_OUT) //I2C0_SDA
#define TXD_SET() GPIOSetPinLevel(GPIOPortE_Pin4, GPIO_HIGH)
#define TXD_CLR() GPIOSetPinLevel(GPIOPortE_Pin4, GPIO_LOW)
#define DRVDelayUs(i) udelay(i*2)
uint32 i;
TXD_OUT();
CLK_OUT();
CS_OUT();
DRVDelayUs(2);
DRVDelayUs(2);
CS_SET();
TXD_CLR();
CLK_CLR();
DRVDelayUs(2);
CS_CLR();
for(i = 0; i < 7; i++) //reg
{
if(Addr &(1<<(6-i)))
TXD_SET();
else
TXD_CLR();
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
}
TXD_CLR(); //write
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
for(i = 0; i < 8; i++) //data
{
if(Data &(1<<(7-i)))
TXD_SET();
else
TXD_CLR();
// \u6a21\u62dfCLK
CLK_CLR();
DRVDelayUs(2);
CLK_SET();
DRVDelayUs(2);
}
CS_SET();
CLK_CLR();
TXD_CLR();
DRVDelayUs(2);
}
