Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define md1 1
- #define md2 2
- #define mg1 3
- #define mg2 4
- #define enD 10
- #define enG 9
- void setup() {
- // put your setup code here, to run once:
- pinMode(md1,OUTPUT);
- pinMode(md2,OUTPUT);
- pinMode(mg1,OUTPUT);
- pinMode(mg2,OUTPUT);
- pinMode(enD,OUTPUT);
- pinMode(enG,OUTPUT);
- }
- void marcheav() {
- digitalWrite(md1,1);digitalWrite(md2,0);//sens avant moteur droite
- digitalWrite(mg1,1);digitalWrite(mg2,0);//sens avant moteur gauche
- analogWrite(enD,70);//pwm vitesse 70 moteur D
- analogWrite(enG,70);//pwm vitesse 70 moteur G
- }
- void gauche90deg () {
- digitalWrite(md1,1);digitalWrite(md2,0);//sens avant moteur droite
- digitalWrite(mg1,1);digitalWrite(mg2,1);//stop moteur gauche
- analogWrite(enD,70);//pwm vitesse 70 moteur D
- }
- void droite90deg () {
- digitalWrite(mg1,1);digitalWrite(mg2,0);//sens avant moteur gauche
- digitalWrite(md1,1);digitalWrite(md2,1);//stop moteur droite
- analogWrite(enG,70);//pwm vitesse 70 moteur G
- }
- void stp() {
- digitalWrite(md1,1);digitalWrite(md2,1);//stop md
- digitalWrite(mg1,1);digitalWrite(mg2,1);//stop mg
- }
- void loop() {
- // put your main code here, to run repeatedly:
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement