//Motor 1 -> 10,9 speed -> 11 //Motor 2 -> 8,7 speed -> 6 int motor[4] = {10,9,8,7}; int sped[2] = {11,6}; void setup() { //Motor Setup for(int i = 0; i<6; i++){ pinMode(motor[i], OUTPUT); digitalWrite(motor[i], LOW); } } void loop() { setSpeedAll(255); vw(0); delay(500); stopall(); delay(100); vw(1); delay(500); stopall(); delay(100); rw(0); rw(1); delay(1000); stopall(); delay(10); vw(0); for(int i = 0;i<255;i++){ setSpeet(0,i); delay(20); } delay(100); for(int i = 255;i > 0;i--){ setSpeet(0,i); delay(20); } } //set speed for motor n with value s void setSpeet(int n,int s){ analogWrite((sped[n]),s); } //set speed for all motors with value s void setSpeedAll(int s){ for( int i = 0; i<2; i++){ setSpeet(i,s); } } // turn motor n forward void vw(int n){ digitalWrite(motor[n*2], LOW); digitalWrite(motor[n*2+1], HIGH); } //turn motor n backwards void rw(int n){ digitalWrite(motor[n*2], HIGH); digitalWrite(motor[n*2+1], LOW); } // stop Motor n void st(int n){ digitalWrite(motor[n*2], LOW); digitalWrite(motor[n*2+1], LOW); } //stop all motors void stopall(){ for( int i = 0; i<2; i++){ st(i); } }