初始化提交

2024-07-20 22:09:06 +08:00
commit c247dd07a6
6876 changed files with 2743096 additions and 0 deletions
--- a/arduino-cli/libraries/QDPJoystick/QDPJoystick.cpp
+++ b/arduino-cli/libraries/QDPJoystick/QDPJoystick.cpp
@@ -0,0 +1,54 @@
+#include "QDPJoystick.h"
+
+void QDPJoystick::begin(int Enter_X, int Enter_Y) {
+  Enter_X_PIN = Enter_X;
+  Enter_Y_PIN = Enter_Y;
+}
+
+int QDPJoystick::Angle1() {
+  int angle = 0;
+  float abscissa = (map(analogRead(Enter_X_PIN), analogReadMax, 0, (-512), 512));
+  float ordinate = (map(analogRead(Enter_Y_PIN), 0, analogReadMax, 512, (-512)));
+  if(abs(abscissa)<offset && abs(ordinate)<offset)
+    return -1;
+  if (0 < abscissa && 0 < ordinate) {
+    angle = asin(ordinate / sqrt(sq(abscissa) + sq(ordinate))) / 3.14159 * 180;
+  }
+  if (0 > abscissa && 0 < ordinate) {
+    angle = 180 - asin(ordinate / sqrt(sq(abscissa) + sq(ordinate))) / 3.14159 * 180;
+  }
+  if (0 > abscissa && 0 > ordinate) {
+    angle = 180 - asin(ordinate / sqrt(sq(abscissa) + sq(ordinate))) / 3.14159 * 180;
+  }
+  if (0 < abscissa && 0 > ordinate) {
+    angle = 360 + asin(ordinate / sqrt(sq(abscissa) + sq(ordinate))) / 3.14159 * 180;
+  }
+  return angle;
+}
+
+int QDPJoystick::Angle2() {
+  return sqrt(sq(map(analogRead(Enter_X_PIN), analogReadMax, 0, (-512), 512)) + sq(map(analogRead(Enter_Y_PIN), 0, analogReadMax, 512, (-512))));
+}
+
+int QDPJoystick::Angle1_32() {
+  int angle = 0;
+  float abscissa = (map(analogRead(Enter_X_PIN), 4096, 0, (-512), 512));
+  float ordinate = (map(analogRead(Enter_Y_PIN), 4096, 0, (-512), 512));
+  if (0 < abscissa && 0 < ordinate) {
+    angle = asin(ordinate / sqrt(sq(abscissa) + sq(ordinate))) / 3.14159 * 180;
+  }
+  if (0 > abscissa && 0 < ordinate) {
+    angle = 180 - asin(ordinate / sqrt(sq(abscissa) + sq(ordinate))) / 3.14159 * 180;
+  }
+  if (0 > abscissa && 0 > ordinate) {
+    angle = 180 - asin(ordinate / sqrt(sq(abscissa) + sq(ordinate))) / 3.14159 * 180;
+  }
+  if (0 < abscissa && 0 > ordinate) {
+    angle = 360 + asin(ordinate / sqrt(sq(abscissa) + sq(ordinate))) / 3.14159 * 180;
+  }
+  return angle;
+}
+
+int QDPJoystick::Angle2_32() {
+  return sqrt(sq(map(analogRead(Enter_X_PIN), 4096, 0, (-512), 512)) + sq(map(analogRead(Enter_Y_PIN), 4096, 0, (-512), 512)));
+}
--- a/arduino-cli/libraries/QDPJoystick/QDPJoystick.h
+++ b/arduino-cli/libraries/QDPJoystick/QDPJoystick.h
@@ -0,0 +1,29 @@
+#ifndef _QDPJoystick_H_
+#define _QDPJoystick_H_
+
+#include <Arduino.h>
+
+#if defined ESP32
+    #define analogReadMax 4095
+    #define offset 100 
+#elif defined __AVR__
+    #define analogReadMax 1023
+    #define offset 25 
+#endif
+
+
+class QDPJoystick
+{
+private:
+    uint8_t Enter_X_PIN;
+    uint8_t Enter_Y_PIN;
+
+public:
+    int Angle1();
+    int Angle2();
+    int Angle1_32();
+    int Angle2_32();    
+    void begin(int Enter_X, int Enter_Y);
+};
+
+#endif