Page 111 - 2
P. 111
d=0;
}
forward();
}else{
stop();
m=0.7;
m1=-0.7;
pwm_on = 0;
pwm_off = 0;
}
}
void forward(){
// 모든 모터의 구동 설정---------------------------------
d++;
//Serial.print(d);
digitalWrite(in3_motor_right, HIGH);
digitalWrite(in4_motor_right, LOW);
digitalWrite(in1_motor_left, LOW);
digitalWrite(in2_motor_left, HIGH);
delay(pwm_on);
digitalWrite(in3_motor_right, LOW);
digitalWrite(in4_motor_right, LOW);
digitalWrite(in1_motor_left, LOW);
digitalWrite(in2_motor_left, LOW);
delay(pwm_off);
}
void backward(){
c++;
digitalWrite(in3_motor_right, LOW);
digitalWrite(in4_motor_right,HIGH);
digitalWrite(in1_motor_left, HIGH);
digitalWrite(in2_motor_left, LOW);
delay(pwm_on);
digitalWrite(in3_motor_right, LOW);
digitalWrite(in4_motor_right, LOW);
digitalWrite(in1_motor_left, LOW);
digitalWrite(in2_motor_left, LOW);
delay(pwm_off);
}
- 111 -