H29Ateam / PS4 Serial

Fork of PS4 by H29Ateam

Committer:
Suzutomo
Date:
Mon Nov 06 08:42:00 2017 +0000
Revision:
8:73810fa167a8
Parent:
7:ffa4066a789d
Child:
9:b98be6c2f23e
PS4 Serial Comunnication

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Suzutomo 6:0b7476f64352 1 #include "PS4.h"
yopcyuuu 0:51d821ea634c 2
Suzutomo 8:73810fa167a8 3 PS4::PS4(Serial *i)
yopcyuuu 3:c1318581351c 4 {
Suzutomo 8:73810fa167a8 5 serial = i;
Suzutomo 8:73810fa167a8 6 serial->baud(115200);
Suzutomo 7:ffa4066a789d 7 for(int i=0; i<23; i++) {
yopcyuuu 0:51d821ea634c 8 DATA_CONTROLLER[i] = 0;
yopcyuuu 0:51d821ea634c 9 DATA_CONTROLLER_OLD[i] = 0;
yopcyuuu 0:51d821ea634c 10 }
yopcyuuu 0:51d821ea634c 11 }
yopcyuuu 0:51d821ea634c 12
Suzutomo 6:0b7476f64352 13 bool PS4::UpDate()
yopcyuuu 0:51d821ea634c 14 {
Suzutomo 8:73810fa167a8 15
yopcyuuu 0:51d821ea634c 16 //Make backup
yopcyuuu 0:51d821ea634c 17 memcpy( DATA_CONTROLLER_OLD, DATA_CONTROLLER, sizeof(DATA_CONTROLLER) );
yopcyuuu 0:51d821ea634c 18
yopcyuuu 0:51d821ea634c 19 //Get data by I2C
Suzutomo 8:73810fa167a8 20 //int s = i2c->read((ADDR | 1), data, 17);
Suzutomo 8:73810fa167a8 21 if (serial->getc() == 0x80) {
Suzutomo 8:73810fa167a8 22 for (int i = 0; i<17; i++) {
Suzutomo 8:73810fa167a8 23 data[i] = serial->getc();
Suzutomo 8:73810fa167a8 24 }
Suzutomo 8:73810fa167a8 25 }
Suzutomo 8:73810fa167a8 26 if(/*s == 0*/1) {
yopcyuuu 0:51d821ea634c 27
yopcyuuu 4:cfef9ff2d209 28 //UpDate
Suzutomo 7:ffa4066a789d 29 DATA_CONTROLLER[CONNECTION] = (data[0] >> 0) & 0x01;
Suzutomo 7:ffa4066a789d 30 DATA_CONTROLLER[UP] = (data[1] >> 7) & 0x01;
Suzutomo 7:ffa4066a789d 31 DATA_CONTROLLER[RIGHT] = (data[1] >> 6) & 0x01;
Suzutomo 7:ffa4066a789d 32 DATA_CONTROLLER[DOWN] = (data[1] >> 5) & 0x01;
Suzutomo 7:ffa4066a789d 33 DATA_CONTROLLER[LEFT] = (data[1] >> 4) & 0x01;
Suzutomo 7:ffa4066a789d 34 DATA_CONTROLLER[TRIANGLE] = (data[1] >> 3) & 0x01;
Suzutomo 7:ffa4066a789d 35 DATA_CONTROLLER[CIRCLE] = (data[1] >> 2) & 0x01;
Suzutomo 7:ffa4066a789d 36 DATA_CONTROLLER[CROSS] = (data[1] >> 1) & 0x01;
Suzutomo 7:ffa4066a789d 37 DATA_CONTROLLER[SQUARE] = (data[1] >> 0) & 0x01;
Suzutomo 7:ffa4066a789d 38 DATA_CONTROLLER[L1] = (data[2] >> 7) & 0x01;
Suzutomo 7:ffa4066a789d 39 DATA_CONTROLLER[R1] = (data[2] >> 6) & 0x01;
Suzutomo 7:ffa4066a789d 40 DATA_CONTROLLER[SHARE] = (data[2] >> 5) & 0x01;
Suzutomo 7:ffa4066a789d 41 DATA_CONTROLLER[OPTIONS] = (data[2] >> 4) & 0x01;
Suzutomo 7:ffa4066a789d 42 DATA_CONTROLLER[L3] = (data[2] >> 3) & 0x01;
Suzutomo 7:ffa4066a789d 43 DATA_CONTROLLER[R3] = (data[2] >> 2) & 0x01;
Suzutomo 7:ffa4066a789d 44 DATA_CONTROLLER[PS] = (data[2] >> 1) & 0x01;
Suzutomo 7:ffa4066a789d 45 DATA_CONTROLLER[TOUCHPAD] = (data[2] >> 0) & 0x01;
Suzutomo 7:ffa4066a789d 46 DATA_CONTROLLER[LeftHatX] = data[3];
Suzutomo 7:ffa4066a789d 47 DATA_CONTROLLER[LeftHatY] = data[4];
Suzutomo 7:ffa4066a789d 48 DATA_CONTROLLER[RightHatX] = data[5];
Suzutomo 7:ffa4066a789d 49 DATA_CONTROLLER[RightHatY] = data[6];
Suzutomo 7:ffa4066a789d 50 DATA_CONTROLLER[L2] = data[7];
Suzutomo 7:ffa4066a789d 51 DATA_CONTROLLER[R2] = data[8];
Suzutomo 8:73810fa167a8 52 DATA_TP[X][0] = (data[9] << 8) + data[10];
Suzutomo 8:73810fa167a8 53 DATA_TP[Y][0] = (data[11] << 8) + data[12];
Suzutomo 8:73810fa167a8 54 DATA_TP[X][1] = (data[13] << 8) + data[14];
Suzutomo 8:73810fa167a8 55 DATA_TP[Y][1] = (data[15] << 8) + data[16];
Suzutomo 8:73810fa167a8 56
yopcyuuu 3:c1318581351c 57 } else {
Suzutomo 7:ffa4066a789d 58 for(int i = 0; i < 23; i++) {
yopcyuuu 4:cfef9ff2d209 59 DATA_CONTROLLER[i] = i >= 15 && i <= 18 ? 127 : 0;
yopcyuuu 4:cfef9ff2d209 60 }
yopcyuuu 0:51d821ea634c 61 }
Suzutomo 8:73810fa167a8 62 //return s;
Suzutomo 8:73810fa167a8 63 return 0;
yopcyuuu 0:51d821ea634c 64 }
yopcyuuu 0:51d821ea634c 65
Suzutomo 6:0b7476f64352 66 int PS4::getPress( CONTROLLER buttom )
yopcyuuu 0:51d821ea634c 67 {
Suzutomo 7:ffa4066a789d 68 if(buttom < 23) {
yopcyuuu 0:51d821ea634c 69 return DATA_CONTROLLER[buttom];
yopcyuuu 0:51d821ea634c 70 } else {
yopcyuuu 0:51d821ea634c 71 return 0;
yopcyuuu 0:51d821ea634c 72 }
yopcyuuu 0:51d821ea634c 73 }
yopcyuuu 0:51d821ea634c 74
Suzutomo 6:0b7476f64352 75 int PS4::getClick( CONTROLLER button, bool mode )
yopcyuuu 0:51d821ea634c 76 {
yopcyuuu 0:51d821ea634c 77 //mode:0 -> Rising
yopcyuuu 0:51d821ea634c 78 //mode:1 -> Falling
yopcyuuu 3:c1318581351c 79
yopcyuuu 3:c1318581351c 80 if(button <= 13) {
yopcyuuu 0:51d821ea634c 81 return mode*(DATA_CONTROLLER[button]*!DATA_CONTROLLER_OLD[button])
yopcyuuu 3:c1318581351c 82 + !mode*(!DATA_CONTROLLER[button]*DATA_CONTROLLER_OLD[button]);
yopcyuuu 0:51d821ea634c 83
yopcyuuu 3:c1318581351c 84 } else if( (19<=button) && (button<=20) ) {
yopcyuuu 0:51d821ea634c 85 return mode*((DATA_CONTROLLER[button]>127)*!(DATA_CONTROLLER_OLD[button]>127))
yopcyuuu 3:c1318581351c 86 + !mode*(!(DATA_CONTROLLER[button]>127)*(DATA_CONTROLLER_OLD[button]>127));
yopcyuuu 3:c1318581351c 87
yopcyuuu 3:c1318581351c 88 } else {
yopcyuuu 0:51d821ea634c 89 return 0;
yopcyuuu 0:51d821ea634c 90 }
yopcyuuu 0:51d821ea634c 91 }
Suzutomo 7:ffa4066a789d 92
Suzutomo 7:ffa4066a789d 93 int PS4::touchPad( TP direction, bool finger )
Suzutomo 7:ffa4066a789d 94 {
Suzutomo 7:ffa4066a789d 95 return DATA_TP[direction][finger];
Suzutomo 7:ffa4066a789d 96 }