Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
PS3.cpp@4:cfef9ff2d209, 2017-09-08 (annotated)
- 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?
User | Revision | Line number | New 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 | } |