-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathmotordriver.h
50 lines (34 loc) · 918 Bytes
/
motordriver.h
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
#include<Arduino.h>
//function control motor by use motor Driver
//----------------motor A==============//
void m1_ltr(int N1,int N2,int PWM1,int v){//left to rigth
analogWrite(PWM1,v);
digitalWrite(N1,LOW);
digitalWrite(N2,HIGH);
}
void m1_rtl(int N1,int N2,int PWM1,int v){//rigth to left
analogWrite(PWM1,v);
digitalWrite(N1,HIGH);
digitalWrite(N2,LOW);
}
void m1_stop(int N1,int N2,int PWM1){//stop
analogWrite(PWM1,0);
digitalWrite(N1,LOW);
digitalWrite(N2,LOW);
}
//-----------motor B---------//
void m2_ltr(int N3,int N4,int PWM2,int v){//left to rigth
analogWrite(PWM2,v);
digitalWrite(N3,LOW);
digitalWrite(N4,HIGH);
}
void m2_rtl(int N3,int N4,int PWM2,int v){//rigth to left
analogWrite(PWM2,v);
digitalWrite(N3,HIGH);
digitalWrite(N4,LOW);
}
void m2_stop(int N3,int N4,int PWM2){//stop
analogWrite(PWM2,0);
digitalWrite(N3,LOW);
digitalWrite(N4,LOW);
}