Diff: main.cpp

Revision:

0:12b41747ca26

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Fri Jun 04 14:43:00 2021 +0000
@@ -0,0 +1,252 @@
+#include "mbed.h"
+#include <PS5BT.h>
+#include <usbhub.h>
+
+Serial pc(USBTX, USBRX, 115200);
+
+//Nucleo f303k8用
+USB Usb(A6, A5, A4, A3, A2); // mosi, miso, sclk, ssel, intr
+BTD Btd(&Usb);
+PS5BT PS5(&Btd);
+
+int main()
+{
+    bool printAngle = false, printTouch = false;
+    uint8_t oldL2Value, oldR2Value;
+    bool reportChanged;
+    if(Usb.Init() == -1){
+        pc.printf("\r\nOSC did not start");
+        while(1); // Halt
+    }
+    pc.printf("\r\nPS5 USB Library Started");
+    
+    while(1){
+        Usb.Task();
+        if (PS5.connected()) {
+            lastMessageCounter = PS5.getMessageCounter();
+            if(PS5.getAnalogHat(LeftHatX) > 137 || PS5.getAnalogHat(LeftHatX) < 117 || PS5.getAnalogHat(LeftHatY) > 137 || PS5.getAnalogHat(LeftHatY) < 117 || PS5.getAnalogHat(RightHatX) > 137 || PS5.getAnalogHat(RightHatX) < 117 || PS4.getAnalogHat(RightHatY) > 137 || PS4.getAnalogHat(RightHatY) < 117) {
+                pc.printf("\tLeftHatX: %d",PS5.getAnalogHat(LeftHatX));
+                pc.printf("\tLeftHatY: %d",PS5.getAnalogHat(LeftHatY));
+                if(PS5.connected()) {
+                    pc.printf("\tRightHatX: %d",PS5.getAnalogHat(RightHatX));
+                    pc.printf("\tRightHatY: %d",PS5.getAnalogHat(RightHatY));
+                }
+            }
+            if(PS5.getAnalogButton(L2) != oldL2Value || PS5.getAnalogButton(R2) != oldR2Value) // Only write value if it's different
+                PS5.setRumbleOn(PS5.getAnalogButton(L2), PS5.getAnalogButton(R2));
+            oldL2Value = PS5.getAnalogButton(L2);
+            oldR2Value = PS5.getAnalogButton(R2);
+
+            if(PS5.getAnalogButton(L2))
+                pc.printf("\r\nL2");
+            if(PS5.getAnalogButton(R2))
+                pc.printf("\r\nR2");
+                
+         
+            if (PS5.getButtonClick(PS)){
+                PS5.disconnect();
+                pc.printf("\r\nPS");
+            }   
+    
+            if (PS5.getButtonClick(TRIANGLE))
+                pc.printf("\r\nTriangle");
+            if (PS5.getButtonClick(CIRCLE))
+                pc.printf("\r\nCircle");
+            if (PS5.getButtonClick(CROSS))
+                pc.printf("\r\nCross");
+            if (PS5.getButtonClick(SQUARE))
+                pc.printf("\r\nSquare"); 
+            
+            if (PS5.getButtonClick(UP)){
+                pc.printf("\r\nUp");
+                PS5.setLedOff();
+//              PS5.setLedOn(CONTROLLER_LED4);
+            }
+            if(PS5.getButtonClick(RIGHT)){
+                pc.printf("\r\nRight");
+                PS5.setLedOff();
+//              PS5.setLedOn(CONTROLLER_LED1);
+            }
+            if(PS5.getButtonClick(DOWN)){
+                pc.printf("\r\nDown");
+                PS5.setLedOff();
+ //             PS5.setLedOn(CONTROLLER_LED2);
+            }
+            if(PS5.getButtonClick(LEFT)){
+                pc.printf("\r\nLeft");
+                PS5.setLedOff();
+//              PS5.setLedOn(CONTROLLER_LED3);
+            }
+    
+            if(PS5.getButtonClick(L1))
+                pc.printf("\r\nL1");
+            if(PS5.getButtonClick(L3))
+                pc.printf("\r\nL3");
+            if(PS5.getButtonClick(R1))
+                pc.printf("\r\nR1");
+            if(PS5.getButtonClick(R3))
+                pc.printf("\r\nR3");
+/*    
+            if(PS5.getButtonClick(SELECT)){
+                pc.printf("\r\nSelect - ");
+                PS5.printStatusString();
+            }
+*/
+            if(PS5.getButtonClick(START)){
+                pc.printf("\r\nStart");
+                printAngle = !printAngle;
+            }
+        }
+        else{
+            pc.printf("not connect\n");
+        }
+    } 
+}
+
+
+/*
+
+#include <PS5USB.h>
+
+// Satisfy the IDE, which needs to see the include statment in the ino too.
+#ifdef dobogusinclude
+#include <spi4teensy3.h>
+#endif
+#include <SPI.h>
+
+USB Usb;
+PS5USB PS5(&Usb);
+
+bool printAngle = false, printTouch = false;
+uint16_t lastMessageCounter = -1;
+uint8_t player_led_mask = 0;
+bool microphone_led = false;
+
+void setup() {
+  Serial.begin(115200);
+#if !defined(__MIPSEL__)
+  while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection
+#endif
+  if (Usb.Init() == -1) {
+    Serial.print(F("\r\nOSC did not start"));
+    while (1); // Halt
+  }
+  Serial.print(F("\r\nPS5 USB Library Started"));
+}
+
+void loop() {
+  Usb.Task();
+
+  if (PS5.connected() && lastMessageCounter != PS5.getMessageCounter()) {
+    lastMessageCounter = PS5.getMessageCounter();
+
+    if (PS5.getAnalogHat(LeftHatX) > 137 || PS5.getAnalogHat(LeftHatX) < 117 || PS5.getAnalogHat(LeftHatY) > 137 || PS5.getAnalogHat(LeftHatY) < 117 || PS5.getAnalogHat(RightHatX) > 137 || PS5.getAnalogHat(RightHatX) < 117 || PS5.getAnalogHat(RightHatY) > 137 || PS5.getAnalogHat(RightHatY) < 117) {
+      Serial.print(F("\r\nLeftHatX: "));
+      Serial.print(PS5.getAnalogHat(LeftHatX));
+      Serial.print(F("\tLeftHatY: "));
+      Serial.print(PS5.getAnalogHat(LeftHatY));
+      Serial.print(F("\tRightHatX: "));
+      Serial.print(PS5.getAnalogHat(RightHatX));
+      Serial.print(F("\tRightHatY: "));
+      Serial.print(PS5.getAnalogHat(RightHatY));
+    }
+
+    if (PS5.getAnalogButton(L2) || PS5.getAnalogButton(R2)) { // These are the only analog buttons on the PS5 controller
+      Serial.print(F("\r\nL2: "));
+      Serial.print(PS5.getAnalogButton(L2));
+      Serial.print(F("\tR2: "));
+      Serial.print(PS5.getAnalogButton(R2));
+    }
+
+    // Set the left trigger to resist at the right trigger's level
+    static uint8_t oldR2Value = 0xFF;
+    if (PS5.getAnalogButton(R2) != oldR2Value) {
+      oldR2Value = PS5.getAnalogButton(R2);
+      PS5.leftTrigger.setTriggerForce(oldR2Value, 255);
+    }
+
+    if (PS5.getButtonClick(PS))
+      Serial.print(F("\r\nPS"));
+    if (PS5.getButtonClick(TRIANGLE)) {
+      Serial.print(F("\r\nTriangle"));
+      PS5.setRumbleOn(RumbleLow);
+    }
+    if (PS5.getButtonClick(CIRCLE)) {
+      Serial.print(F("\r\nCircle"));
+      PS5.setRumbleOn(RumbleHigh);
+    }
+    if (PS5.getButtonClick(CROSS)) {
+      Serial.print(F("\r\nCross"));
+
+      // Set the player LEDs
+      player_led_mask = (player_led_mask << 1) | 1;
+      if (player_led_mask > 0x1F)
+        player_led_mask = 0;
+      PS5.setPlayerLed(player_led_mask); // The bottom 5 bits set player LEDs
+    }
+    if (PS5.getButtonClick(SQUARE)) {
+      Serial.print(F("\r\nSquare"));
+      PS5.setRumbleOff();
+    }
+
+    if (PS5.getButtonClick(UP)) {
+      Serial.print(F("\r\nUp"));
+      PS5.setLed(Red);
+    } if (PS5.getButtonClick(RIGHT)) {
+      Serial.print(F("\r\nRight"));
+      PS5.setLed(Blue);
+    } if (PS5.getButtonClick(DOWN)) {
+      Serial.print(F("\r\nDown"));
+      PS5.setLed(Yellow);
+    } if (PS5.getButtonClick(LEFT)) {
+      Serial.print(F("\r\nLeft"));
+      PS5.setLed(Green);
+    } 
+
+    if (PS5.getButtonClick(L1))
+      Serial.print(F("\r\nL1"));
+    if (PS5.getButtonClick(L3))
+      Serial.print(F("\r\nL3"));
+    if (PS5.getButtonClick(R1))
+      Serial.print(F("\r\nR1"));
+    if (PS5.getButtonClick(R3))
+      Serial.print(F("\r\nR3"));
+
+    if (PS5.getButtonClick(CREATE))
+      Serial.print(F("\r\nCreate"));
+    if (PS5.getButtonClick(OPTIONS)) {
+      Serial.print(F("\r\nOptions"));
+      printAngle = !printAngle;
+    }
+    if (PS5.getButtonClick(TOUCHPAD)) {
+      Serial.print(F("\r\nTouchpad"));
+      printTouch = !printTouch;
+    }
+    if (PS5.getButtonClick(MICROPHONE)) {
+      Serial.print(F("\r\nMicrophone"));
+      microphone_led = !microphone_led;
+      PS5.setMicLed(microphone_led);
+    }
+
+    if (printAngle) { // Print angle calculated using the accelerometer only
+      Serial.print(F("\r\nPitch: "));
+      Serial.print(PS5.getAngle(Pitch));
+      Serial.print(F("\tRoll: "));
+      Serial.print(PS5.getAngle(Roll));
+    }
+
+    if (printTouch) { // Print the x, y coordinates of the touchpad
+      if (PS5.isTouching(0) || PS5.isTouching(1)) // Print newline and carriage return if any of the fingers are touching the touchpad
+        Serial.print(F("\r\n"));
+      for (uint8_t i = 0; i < 2; i++) { // The touchpad track two fingers
+        if (PS5.isTouching(i)) { // Print the position of the finger if it is touching the touchpad
+          Serial.print(F("X")); Serial.print(i + 1); Serial.print(F(": "));
+          Serial.print(PS5.getX(i));
+          Serial.print(F("\tY")); Serial.print(i + 1); Serial.print(F(": "));
+          Serial.print(PS5.getY(i));
+          Serial.print(F("\t"));
+        }
+      }
+    }
+  }
+}
\ No newline at end of file