18069996051/arduino-libs
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

初始化提交

Browse Source
This commit is contained in:
王立帮
2024-07-20 22:09:06 +08:00
commit c247dd07a6
6876 changed files with 2743096 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

54
arduino-cli/libraries/QDPJoystick/QDPJoystick.cpp Normal file
View File

@@ -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)));
}