H29Ateam / PS4
Committer:
yopcyuuu
Date:
Fri Sep 08 13:14:41 2017 +0000
Revision:
4:cfef9ff2d209
Parent:
3:c1318581351c
Child:
5:51d531c885ba
fix controller data when i2c error

Who changed what in which revision?

UserRevisionLine numberNew contents of line
yopcyuuu 0:51d821ea634c 1 #include "PS3.h"
yopcyuuu 0:51d821ea634c 2
yopcyuuu 3:c1318581351c 3 PS3::PS3(I2C *i, char addr)
yopcyuuu 3:c1318581351c 4 {
yopcyuuu 0:51d821ea634c 5 i2c = i;
yopcyuuu 0:51d821ea634c 6 ADDR = addr;
yopcyuuu 0:51d821ea634c 7
yopcyuuu 3:c1318581351c 8 for(int i=0; i<21; i++) {
yopcyuuu 0:51d821ea634c 9 DATA_CONTROLLER[i] = 0;
yopcyuuu 0:51d821ea634c 10 DATA_CONTROLLER_OLD[i] = 0;
yopcyuuu 0:51d821ea634c 11 }
yopcyuuu 0:51d821ea634c 12 }
yopcyuuu 0:51d821ea634c 13
yopcyuuu 0:51d821ea634c 14 bool PS3::UpDate()
yopcyuuu 0:51d821ea634c 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
yopcyuuu 4:cfef9ff2d209 20 if(i2c->read((ADDR | 1), data, 8) == 0) {
yopcyuuu 0:51d821ea634c 21
yopcyuuu 4:cfef9ff2d209 22 //UpDate
yopcyuuu 4:cfef9ff2d209 23 DATA_CONTROLLER[CONNECTION] = (data[1] >> 1) & 0x01;
yopcyuuu 4:cfef9ff2d209 24 DATA_CONTROLLER[UP] = (data[0] >> 7) & 0x01;
yopcyuuu 4:cfef9ff2d209 25 DATA_CONTROLLER[RIGHT] = (data[0] >> 6) & 0x01;
yopcyuuu 4:cfef9ff2d209 26 DATA_CONTROLLER[DOWN] = (data[0] >> 5) & 0x01;
yopcyuuu 4:cfef9ff2d209 27 DATA_CONTROLLER[LEFT] = (data[0] >> 4) & 0x01;
yopcyuuu 4:cfef9ff2d209 28 DATA_CONTROLLER[TRIANGLE] = (data[0] >> 3) & 0x01;
yopcyuuu 4:cfef9ff2d209 29 DATA_CONTROLLER[CIRCLE] = (data[0] >> 2) & 0x01;
yopcyuuu 4:cfef9ff2d209 30 DATA_CONTROLLER[CROSS] = (data[0] >> 1) & 0x01;
yopcyuuu 4:cfef9ff2d209 31 DATA_CONTROLLER[SQUARE] = (data[0] >> 0) & 0x01;
yopcyuuu 4:cfef9ff2d209 32 DATA_CONTROLLER[L1] = (data[1] >> 7) & 0x01;
yopcyuuu 4:cfef9ff2d209 33 DATA_CONTROLLER[R1] = (data[1] >> 6) & 0x01;
yopcyuuu 4:cfef9ff2d209 34 DATA_CONTROLLER[SELECT] = (data[1] >> 5) & 0x01;
yopcyuuu 4:cfef9ff2d209 35 DATA_CONTROLLER[START] = (data[1] >> 4) & 0x01;
yopcyuuu 4:cfef9ff2d209 36 DATA_CONTROLLER[L3] = (data[1] >> 3) & 0x01;
yopcyuuu 4:cfef9ff2d209 37 DATA_CONTROLLER[R3] = (data[1] >> 2) & 0x01;
yopcyuuu 4:cfef9ff2d209 38 DATA_CONTROLLER[LeftHatX] = data[2];
yopcyuuu 4:cfef9ff2d209 39 DATA_CONTROLLER[LeftHatY] = data[3];
yopcyuuu 4:cfef9ff2d209 40 DATA_CONTROLLER[RightHatX] = data[4];
yopcyuuu 4:cfef9ff2d209 41 DATA_CONTROLLER[RightHatY] = data[5];
yopcyuuu 4:cfef9ff2d209 42 DATA_CONTROLLER[L2] = data[6];
yopcyuuu 4:cfef9ff2d209 43 DATA_CONTROLLER[R2] = data[7];
yopcyuuu 3:c1318581351c 44 } else {
yopcyuuu 4:cfef9ff2d209 45 for(int i = 0; i < 21; i++){
yopcyuuu 4:cfef9ff2d209 46 DATA_CONTROLLER[i] = i >= 15 && i <= 18 ? 127 : 0;
yopcyuuu 4:cfef9ff2d209 47 }
yopcyuuu 0:51d821ea634c 48 }
yopcyuuu 4:cfef9ff2d209 49 return DATA_CONTROLLER[CONNECTION];
yopcyuuu 0:51d821ea634c 50 }
yopcyuuu 0:51d821ea634c 51
yopcyuuu 0:51d821ea634c 52 int PS3::getPress( CONTROLLER buttom )
yopcyuuu 0:51d821ea634c 53 {
yopcyuuu 0:51d821ea634c 54 if(buttom < 21) {
yopcyuuu 0:51d821ea634c 55 return DATA_CONTROLLER[buttom];
yopcyuuu 0:51d821ea634c 56 } else {
yopcyuuu 0:51d821ea634c 57 return 0;
yopcyuuu 0:51d821ea634c 58 }
yopcyuuu 0:51d821ea634c 59 }
yopcyuuu 0:51d821ea634c 60
yopcyuuu 0:51d821ea634c 61 int PS3::getClick( CONTROLLER button, bool mode )
yopcyuuu 0:51d821ea634c 62 {
yopcyuuu 0:51d821ea634c 63 //mode:0 -> Rising
yopcyuuu 0:51d821ea634c 64 //mode:1 -> Falling
yopcyuuu 3:c1318581351c 65
yopcyuuu 3:c1318581351c 66 if(button <= 13) {
yopcyuuu 0:51d821ea634c 67 return mode*(DATA_CONTROLLER[button]*!DATA_CONTROLLER_OLD[button])
yopcyuuu 3:c1318581351c 68 + !mode*(!DATA_CONTROLLER[button]*DATA_CONTROLLER_OLD[button]);
yopcyuuu 0:51d821ea634c 69
yopcyuuu 3:c1318581351c 70 } else if( (19<=button) && (button<=20) ) {
yopcyuuu 0:51d821ea634c 71 return mode*((DATA_CONTROLLER[button]>127)*!(DATA_CONTROLLER_OLD[button]>127))
yopcyuuu 3:c1318581351c 72 + !mode*(!(DATA_CONTROLLER[button]>127)*(DATA_CONTROLLER_OLD[button]>127));
yopcyuuu 3:c1318581351c 73
yopcyuuu 3:c1318581351c 74 } else {
yopcyuuu 0:51d821ea634c 75 return 0;
yopcyuuu 0:51d821ea634c 76 }
yopcyuuu 0:51d821ea634c 77 }