#include <Servo.h>
// Create servo objects
Servo leftFront;
Servo leftRear;
Servo rightFront;
Servo rightRear;
// Define pins (change if needed)
const int LF_PIN = 3; // PM1
const int LR_PIN = 5; // PM2
const int RF_PIN = 6; // PM3
const int RR_PIN = 9; // PM4
void setup() {
Serial.begin(9600);
// Attach servos
leftFront.attach(LF_PIN);
leftRear.attach(LR_PIN);
rightFront.attach(RF_PIN);
rightRear.attach(RR_PIN);
}
void loop() {
if (Serial.available()) {
char command = Serial.read();
handleCommand(command);
}
}
void handleCommand(char cmd) {
switch (cmd) {
case 'F': // Forward
setAll(180, 0);
break;
case 'B': // Backward
setAll(0, 180);
break;
case 'L': // Turn left
setAll(0, 0);
break;
case 'R': // Turn right
setAll(180, 180);
break;
case 'S': // Stop
setAll(90, 90);
break;
}
}
// Set speed for left and right side
void setAll(int leftSpeed, int rightSpeed) {
leftFront.write(leftSpeed);
leftRear.write(leftSpeed);
rightFront.write(rightSpeed);
rightRear.write(rightSpeed);
}
Παράθεση από: andag στις 06 Μαΐου 2025, 06:33:38 ΜΜΣε ευχαριστώ πολύ, βιαστική απάντηση έδωσαHi! Ναι αυτό θα δούλευε!![]()
Αν είχαμε 3 Για;;;;
Για k από 1 μέχρι 52
Για i από 1 μέχρι 600
Για j από 1 μέχρι 800
Αν ΟΝ[k] = Χ[i,j] τότε
ΑΘΡ[k] = ΑΘΡ[k] + Π[i,j]
........