Browse Source

sollte soweit das tun, was vorgesehen ist, allerdings nicht Glitch free

patch-3
Yves Ehrlich 5 years ago
parent
commit
03f42ed812
  1. 65
      Code/Joystick_ohne_float/Joystick_ohne_float.ino

65
Code/Joystick_ohne_float/Joystick_ohne_float.ino

@ -2,18 +2,26 @@
#define yPin A6
int16_t xValue = 0;
int16_t yValue = 0;
int16_t leftPWM = 0;
int16_t rightPWM = 0;
const int16_t deadZone = 10;
void setup() {
Serial.begin(9600);
Serial.begin(115200);
}
void loop() {
koordinaten(analogRead(xPin), analogRead(yPin));
Serial.println("X: ");
motorPWM();
Serial.print("X: ");
Serial.println(xValue);
Serial.println("Y: ");
Serial.print("Y: ");
Serial.println(yValue);
Serial.print("links: ");
Serial.println(leftPWM);
Serial.print("rechts: ");
Serial.println(rightPWM);
delay(200);
@ -26,3 +34,52 @@ void koordinaten(uint16_t x, uint16_t y) {
xValue = map(x, 0, 511, -255, 255);
yValue = map(y, 0, 511, 255, -255);
}
void motorPWM() {
if((abs(xValue) > deadZone) || (abs(yValue) > deadZone)) {
if(yValue >= 0) {
if(xValue >= 0) {
//+y , +x
leftPWM = yValue;
rightPWM = yValue - xValue;
if(xValue >= yValue) {
leftPWM = 255;
rightPWM = -255;
}
} else {
//+y , -x
leftPWM = yValue;
rightPWM = yValue + xValue;
if(abs(xValue) >= yValue) {
leftPWM = -255;
rightPWM = 255;
}
}
} else {
if(xValue >= 0) {
//-y , +x
leftPWM = yValue;
rightPWM = yValue + xValue;
if(xValue >= abs(yValue)) {
leftPWM = 255;
rightPWM = -255;
}
} else {
//-y , -x
leftPWM = yValue;
rightPWM = yValue - xValue;
if(abs(xValue) >= abs(yValue)) {
leftPWM = -255;
rightPWM = 255;
}
}
}
if(abs(xValue) < deadZone) {
leftPWM = yValue;
rightPWM = yValue;
}
} else {
leftPWM = 0;
rightPWM = 0;
}
}
Loading…
Cancel
Save