Sumobotsclass
Jump to navigation
Jump to search
Motor control code
- define motor1dir 8 //direction motor 2
- define motor1speed 9 //pwm control motor 1
- define motor2dir 11 //direction motor 2
- define motor2speed 10 //pwm control motor 2
- define ledpin 13
void setup() {
// put your setup code here, to run once:
pinMode(motor1dir, OUTPUT);
pinMode(motor1speed, OUTPUT);
pinMode(motor2dir, OUTPUT);
pinMode(motor2speed, OUTPUT);
pinMode(ledpin, OUTPUT);
digitalWrite(ledpin, HIGH);
delay(3000);
digitalWrite(ledpin, LOW);
}
void loop() {
// put your main code here, to run repeatedly:
analogWrite(motor2speed,255); //go all out
analogWrite(motor1speed,255);
digitalWrite(motor1dir, HIGH); //go this way
digitalWrite(motor2dir, HIGH);
delay(3000);
digitalWrite(motor1dir, LOW); //go opposite way
digitalWrite(motor2dir, LOW);
delay(3000);
analogWrite(motor1speed,0); //stop
analogWrite(motor2speed,0);
delay(3000);
}
Need a Mechapad or some Protoboard and Patience