Tueflerclub/Radio_FahrzeugV2
3
0
Fork 0
Code Issues Pull requests Packages Projects Releases Wiki Activity

Use map and a more complex function(Untestet)

Browse source
This commit is contained in:
DenialOfIntelligence 2023-07-21 15:08:17 +02:00
parent 83960a9fdc
commit 28568a72b6
1 changed files with 27 additions and 12 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

39
Receiver/Receiver.ino
View file

@ -34,17 +34,31 @@ void setup() {
pinMode(A5, OUTPUT); pinMode(A5, OUTPUT);
} }
int pwm(int x) {
int out;
if (x < 512) { //Check if joystick is above, below, or at the middle and calculate the unmapped output
x = 512 - x;
}
if (x > 512) {
x = x - 512;
}
if (x == 512) {
x = 0;
}
out = map(x, 0, 1023, 100, 255); //Map the output to a PWM value
Serial.println(x);
return out; //Return the value
}
void loop() { void loop() {
if (radio.available()) { if (radio.available()) {
radio.read( &myData, sizeof(myData) ); radio.read( &myData, sizeof(myData) );
Serial.print("Y Pos"); //Serial.print("Y Pos");
Serial.println(myData.Yposition); //Serial.println(myData.Yposition);
Serial.print("X Pos"); //Serial.print("X Pos");
Serial.println(myData.Xposition); //Serial.println(myData.Xposition);
pwmy=255-(myData.Yposition/4); pwmx=pwm(myData.Xposition);
pwmx=255-(myData.Xposition/4); pwmy=pwm(myData.Yposition);
if (myData.Yposition >= 700) { if (myData.Yposition >= 700) {
digitalWrite(3, 1); digitalWrite(3, 1);
@ -57,7 +71,7 @@ void loop() {
digitalWrite(A5, 1); digitalWrite(A5, 1);
analogWrite(10,pwmy); analogWrite(10,pwmy);
analogWrite(11,pwmx); analogWrite(11,pwmy);
} }
if (myData.Yposition <= 200) { if (myData.Yposition <= 200) {
@ -69,8 +83,9 @@ void loop() {
digitalWrite(A3, 0); digitalWrite(A3, 0);
digitalWrite(A5, 0); digitalWrite(A5, 0);
digitalWrite(A4, 1); digitalWrite(A4, 1);
analogWrite(10,pwmy); //Serial.println(pwmy);
analogWrite(11,pwmx); //analogWrite(10,pwmy);
//analogWrite(11,pwmy);
} }
if (myData.Xposition >= 700){ if (myData.Xposition >= 700){
digitalWrite(3, 1); digitalWrite(3, 1);
@ -81,7 +96,7 @@ void loop() {
digitalWrite(A2, 0); digitalWrite(A2, 0);
digitalWrite(A4, 1); digitalWrite(A4, 1);
digitalWrite(A5, 0); digitalWrite(A5, 0);
analogWrite(10,pwmy); analogWrite(10,pwmx);
analogWrite(11,pwmx); analogWrite(11,pwmx);
} }
if (myData.Xposition <= 200){ if (myData.Xposition <= 200){
@ -93,7 +108,7 @@ void loop() {
digitalWrite(A2, 1); digitalWrite(A2, 1);
digitalWrite(A4, 0); digitalWrite(A4, 0);
digitalWrite(A5, 1); digitalWrite(A5, 1);
analogWrite(10,pwmy); analogWrite(10,pwmx);
analogWrite(11,pwmx); analogWrite(11,pwmx);
} }