Sarkazm załapny
Poniżej kod
Narazie nic się nie dzieje. Problem w tym że nie wiem jak przypisać wartości suwaka x do serwa (jeszcze nie ma w kodzie) i y do silnika. Aplikacja jak w załączniku.
Poniżej kod
Kod:
#define enA 9
#define in1 4
#define in2 5
#define enB 10
#define in3 6
#define in4 7
int xAxis, yAxis;
unsigned int X = 0;
unsigned int Y = 0;
int motorSpeedA = 0;
int motorSpeedB = 0;
void setup() {
pinMode(enA, OUTPUT);
pinMode(enB, OUTPUT);
pinMode(in1, OUTPUT);
pinMode(in2, OUTPUT);
pinMode(in3, OUTPUT);
pinMode(in4, OUTPUT);
Serial.begin(38400); // komunikacja
}
void loop() {
// stop
X = 512; // 4;
Y = 512; // 4;
//
while (Serial.available() >= 2) {
X = Serial.read();
delay(10);
Y = Serial.read();
}
delay(10);
yAxis = Y;//*4;
// y tyl
if (yAxis < 470) {
// motor B tyl
digitalWrite(in3, HIGH);
digitalWrite(in4, LOW);
// y map tyl
motorSpeedA = map(yAxis, 470, 0, 0, 255);
}
else if (yAxis > 550) {
// potor B przod
digitalWrite(in3, LOW);
digitalWrite(in4, HIGH);
// y map przod
motorSpeedB = map(yAxis, 550, 1023, 0, 255);
}
// stop
else {
motorSpeedB = 0;
}
analogWrite(enA, motorSpeedA); // PWM serwo A
analogWrite(enB, motorSpeedB); // PWM motor B
}