summaryrefslogtreecommitdiff
path: root/lib/usbhost/USB_Host_Shield_2.0/PS4Parser.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'lib/usbhost/USB_Host_Shield_2.0/PS4Parser.cpp')
-rw-r--r--lib/usbhost/USB_Host_Shield_2.0/PS4Parser.cpp116
1 files changed, 116 insertions, 0 deletions
diff --git a/lib/usbhost/USB_Host_Shield_2.0/PS4Parser.cpp b/lib/usbhost/USB_Host_Shield_2.0/PS4Parser.cpp
new file mode 100644
index 0000000000..ca6adce403
--- /dev/null
+++ b/lib/usbhost/USB_Host_Shield_2.0/PS4Parser.cpp
@@ -0,0 +1,116 @@
+/* Copyright (C) 2014 Kristian Lauszus, TKJ Electronics. All rights reserved.
+
+ This software may be distributed and modified under the terms of the GNU
+ General Public License version 2 (GPL2) as published by the Free Software
+ Foundation and appearing in the file GPL2.TXT included in the packaging of
+ this file. Please note that GPL2 Section 2[b] requires that all works based
+ on this software must also be made publicly available under the terms of
+ the GPL2 ("Copyleft").
+
+ Contact information
+ -------------------
+
+ Kristian Lauszus, TKJ Electronics
+ Web : http://www.tkjelectronics.com
+ e-mail : kristianl@tkjelectronics.com
+ */
+
+#include "PS4Parser.h"
+
+// To enable serial debugging see "settings.h"
+//#define PRINTREPORT // Uncomment to print the report send by the PS4 Controller
+
+bool PS4Parser::checkDpad(ButtonEnum b) {
+ switch (b) {
+ case UP:
+ return ps4Data.btn.dpad == DPAD_LEFT_UP || ps4Data.btn.dpad == DPAD_UP || ps4Data.btn.dpad == DPAD_UP_RIGHT;
+ case RIGHT:
+ return ps4Data.btn.dpad == DPAD_UP_RIGHT || ps4Data.btn.dpad == DPAD_RIGHT || ps4Data.btn.dpad == DPAD_RIGHT_DOWN;
+ case DOWN:
+ return ps4Data.btn.dpad == DPAD_RIGHT_DOWN || ps4Data.btn.dpad == DPAD_DOWN || ps4Data.btn.dpad == DPAD_DOWN_LEFT;
+ case LEFT:
+ return ps4Data.btn.dpad == DPAD_DOWN_LEFT || ps4Data.btn.dpad == DPAD_LEFT || ps4Data.btn.dpad == DPAD_LEFT_UP;
+ default:
+ return false;
+ }
+}
+
+bool PS4Parser::getButtonPress(ButtonEnum b) {
+ if (b <= LEFT) // Dpad
+ return checkDpad(b);
+ else
+ return ps4Data.btn.val & (1UL << pgm_read_byte(&PS4_BUTTONS[(uint8_t)b]));
+}
+
+bool PS4Parser::getButtonClick(ButtonEnum b) {
+ uint32_t mask = 1UL << pgm_read_byte(&PS4_BUTTONS[(uint8_t)b]);
+ bool click = buttonClickState.val & mask;
+ buttonClickState.val &= ~mask; // Clear "click" event
+ return click;
+}
+
+uint8_t PS4Parser::getAnalogButton(ButtonEnum b) {
+ if (b == L2) // These are the only analog buttons on the controller
+ return ps4Data.trigger[0];
+ else if (b == R2)
+ return ps4Data.trigger[1];
+ return 0;
+}
+
+uint8_t PS4Parser::getAnalogHat(AnalogHatEnum a) {
+ return ps4Data.hatValue[(uint8_t)a];
+}
+
+void PS4Parser::Parse(uint8_t len, uint8_t *buf) {
+ if (len > 1 && buf) {
+#ifdef PRINTREPORT
+ Notify(PSTR("\r\n"), 0x80);
+ for (uint8_t i = 0; i < len; i++) {
+ D_PrintHex<uint8_t > (buf[i], 0x80);
+ Notify(PSTR(" "), 0x80);
+ }
+#endif
+
+ if (buf[0] == 0x01) // Check report ID
+ memcpy(&ps4Data, buf + 1, min((uint8_t)(len - 1), sizeof(ps4Data)));
+ else if (buf[0] == 0x11) { // This report is send via Bluetooth, it has an offset of 2 compared to the USB data
+ if (len < 4) {
+#ifdef DEBUG_USB_HOST
+ Notify(PSTR("\r\nReport is too short: "), 0x80);
+ D_PrintHex<uint8_t > (len, 0x80);
+#endif
+ return;
+ }
+ memcpy(&ps4Data, buf + 3, min((uint8_t)(len - 3), sizeof(ps4Data)));
+ } else {
+#ifdef DEBUG_USB_HOST
+ Notify(PSTR("\r\nUnknown report id: "), 0x80);
+ D_PrintHex<uint8_t > (buf[0], 0x80);
+#endif
+ return;
+ }
+
+ if (ps4Data.btn.val != oldButtonState.val) { // Check if anything has changed
+ buttonClickState.val = ps4Data.btn.val & ~oldButtonState.val; // Update click state variable
+ oldButtonState.val = ps4Data.btn.val;
+
+ // The DPAD buttons does not set the different bits, but set a value corresponding to the buttons pressed, we will simply set the bits ourself
+ uint8_t newDpad = 0;
+ if (checkDpad(UP))
+ newDpad |= 1 << UP;
+ if (checkDpad(RIGHT))
+ newDpad |= 1 << RIGHT;
+ if (checkDpad(DOWN))
+ newDpad |= 1 << DOWN;
+ if (checkDpad(LEFT))
+ newDpad |= 1 << LEFT;
+ if (newDpad != oldDpad) {
+ buttonClickState.dpad = newDpad & ~oldDpad; // Override values
+ oldDpad = newDpad;
+ }
+ }
+ }
+
+ if (ps4Output.reportChanged)
+ sendOutputReport(&ps4Output); // Send output report
+}