| Serial.printf("LX: %d, LY: %d, RX: %d, RY: %d \r\n", psAxis[0], psAxis[1], psAxis[2], psAxis[5]); | Serial.printf("LX: %d, LY: %d, RX: %d, RY: %d \r\n", psAxis[0], psAxis[1], psAxis[2], psAxis[5]); | ||||
| Serial.printf("L-Trig: %d, R-Trig: %d\r\n", psAxis[3], psAxis[4]); | Serial.printf("L-Trig: %d, R-Trig: %d\r\n", psAxis[3], psAxis[4]); | ||||
| Serial.printf("Buttons: %x\r\n", buttons); | Serial.printf("Buttons: %x\r\n", buttons); | ||||
| Serial.printf("Battery Status: %d\n", ((psAxis[30] & (1 << 4)) - 1) * 10); | |||||
| Serial.printf("Battery Status: %d\n", ((psAxis[30] & (1 << 4) - 1)*10)); | |||||
| printAngles(); | printAngles(); | ||||
| Serial.println(); | Serial.println(); | ||||
| Serial.printf("Rumbling: %d, %d\r\n", ltv, rtv); | Serial.printf("Rumbling: %d, %d\r\n", ltv, rtv); | ||||
| joystick1.setRumble(ltv, rtv); | joystick1.setRumble(ltv, rtv); | ||||
| } | } | ||||
| if (buttons != buttons_prev) { | |||||
| uint8_t lr = 0; | |||||
| uint8_t lg = 0; | |||||
| uint8_t lb = 0; | |||||
| if(buttons == 0x10008){//Srq | |||||
| lr = 0xff; | |||||
| } | |||||
| if(buttons == 0x40008){//Circ | |||||
| lg = 0xff; | |||||
| } | |||||
| if(buttons == 0x80008){//Tri | |||||
| lb = 0xff; | |||||
| } | |||||
| Serial.print(buttons,HEX); Serial.print(", "); | |||||
| Serial.print(lr); Serial.print(", "); | |||||
| Serial.print(lg); Serial.print(", "); | |||||
| Serial.println(lb); | |||||
| joystick1.setLEDs(lr, lg, lb); | |||||
| buttons_prev = buttons; | |||||
| } | |||||
| /* Arrow Buttons (psAxis[0]): | |||||
| 0x08 is released, | |||||
| 0=N, 1=NE, 2=E, 3=SE, 4=S, | |||||
| 5=SW, 6=W, 7=NW) | |||||
| */ | |||||
| /* | |||||
| if (psAxis[5] != buttons_prev) { | |||||
| uint8_t lr = (psAxis[5] & 1) ? 0xff : 0; //Srq | |||||
| uint8_t lg = (psAxis[5] & 4) ? 0xff : 0; //Cir | |||||
| uint8_t lb = (psAxis[5] & 8) ? 0xff : 0; //Tri | |||||
| //Cross = 2 | |||||
| Serial.print(psAxis[5]); Serial.print(", "); | |||||
| Serial.print(lr); Serial.print(", "); | |||||
| Serial.print(lg); Serial.print(", "); | |||||
| Serial.println(lb); | |||||
| joystick1.setLEDs(lr, lg, lb); | |||||
| buttons_prev =psAxis[5]; | |||||
| } | |||||
| */ | |||||
| } | } | ||||
| void displayPS3Data() | void displayPS3Data() | ||||
| displayRawData(); | displayRawData(); | ||||
| } else { | } else { | ||||
| Serial.printf("LX: %d, LY: %d, RX: %d, RY: %d \r\n", psAxis[0], psAxis[1], psAxis[2], psAxis[5]); | Serial.printf("LX: %d, LY: %d, RX: %d, RY: %d \r\n", psAxis[0], psAxis[1], psAxis[2], psAxis[5]); | ||||
| Serial.printf("L-Trig: %d, R-Trig: %d\r\n", psAxis[18], psAxis[19]); | |||||
| Serial.printf("L-Trig: %d, R-Trig: %d\r\n", psAxis[3], psAxis[4]); | |||||
| Serial.printf("Buttons: %x\r\n", buttons); | Serial.printf("Buttons: %x\r\n", buttons); | ||||
| } | } | ||||
| uint8_t ltv; | uint8_t ltv; | ||||
| uint8_t rtv; | uint8_t rtv; | ||||
| ltv = psAxis[18]; | |||||
| rtv = psAxis[19]; | |||||
| ltv = psAxis[3]; | |||||
| rtv = psAxis[4]; | |||||
| if ((ltv != joystick_left_trigger_value) || (rtv != joystick_right_trigger_value)) { | if ((ltv != joystick_left_trigger_value) || (rtv != joystick_right_trigger_value)) { | ||||
| joystick_left_trigger_value = ltv; | joystick_left_trigger_value = ltv; |