Professional Documents
Culture Documents
#include <Servo.h> {
pinMode(I4, OUTPUT);
s2.attach(15);
if (button == CIRCLE) {
void move_forward() {
angle2 = 0;
analogWrite(E1, 200);
}
digitalWrite(I1, LOW);
if (button == SQUARE) {
digitalWrite(I2, HIGH);
angle2 = 87;
}
analogWrite(E2, 200);
if (button == TRIANGLE) {
digitalWrite(I3, HIGH);
move_forward();
digitalWrite(I4, LOW);
delay(50);
}
}
if (button == CROSS) {
void move_backward() {
move_backward();
analogWrite(E1, 200);
delay(50);
digitalWrite(I1, HIGH);
}
digitalWrite(I2, LOW);
if (button == LEFT) {
turn_right();
analogWrite(E2, 200);
delay(50);
digitalWrite(I3, LOW);
}
digitalWrite(I4, HIGH);
if (button == RIGHT) {
}
turn_left();
delay(50);
void turn_right() {
}
analogWrite(E1, 130);
digitalWrite(I1, LOW); int angle1 = 40;
analogWrite(E1, 0);
void stop_motor() {
int E1 = 6; // Enable Pin for motor 1
analogWrite(E1, 0);
int I1 = 7; // Control pin 1 for motor 1
analogWrite(E2, 0);
int I2 = 8; // Control pin 2 for motor 1
}
int E2 = 5; // Enable Pin for motor 1
#include <Psx.h>
// Includes the Psx Library void setup()
{
// Any
pins can be used since it is done in
software
Serial.begin(9600);
Psx ps2;
Servo s1;
pinMode(E1, OUTPUT);
Servo s2;
pinMode(I1, OUTPUT);
pinMode(I2, OUTPUT);
pinMode(E2, OUTPUT); if (button == DOWN) {
pinMode(I4, OUTPUT); }
s1.attach(14); }
s2.attach(15);
s1.write(70);
move_forward();
} delay(50);
{ move_backward();
Serial.println(button); }
} delay(50);
} delay(50);
}
void turn_right() {
digitalWrite(I2, HIGH);
stop_motor();
s1.write(angle1);
analogWrite(E2, 0);
s2.write(angle2);
}
}
void turn_left() {
void move_forward() {
analogWrite(E1, 0);
analogWrite(E1, 200);
digitalWrite(I1, LOW);
analogWrite(E2,130);
digitalWrite(I2, HIGH);
digitalWrite(I3, HIGH);
digitalWrite(I4, LOW);
analogWrite(E2, 200);
}
digitalWrite(I3, HIGH);
digitalWrite(I4, LOW);
void stop_motor() {
}
analogWrite(E1, 0);
analogWrite(E2, 0);
void move_backward() {
}
analogWrite(E1, 200);
digitalWrite(I1, HIGH);
digitalWrite(I2, LOW);
analogWrite(E2, 200);
digitalWrite(I3, LOW);
digitalWrite(I4, HIGH);