Add examples
This commit is contained in:
59
2ch_bdc_driver/main.c
Normal file
59
2ch_bdc_driver/main.c
Normal file
@@ -0,0 +1,59 @@
|
||||
#include <wiringPi.h>
|
||||
|
||||
#define M1_IN1 8 // PIN 3
|
||||
#define M1_IN2 7 // PIN 7
|
||||
#define M2_IN1 9 // PIN 5
|
||||
#define M2_IN2 15 // PIN 8
|
||||
|
||||
// OUT1 -> OUT2
|
||||
void forward(int in1, int in2) {
|
||||
digitalWrite(in1, LOW);
|
||||
digitalWrite(in2, HIGH);
|
||||
}
|
||||
|
||||
// OUT2 -> OUT1
|
||||
void reverse(int in1, int in2) {
|
||||
digitalWrite(in1, HIGH);
|
||||
digitalWrite(in2, LOW);
|
||||
}
|
||||
|
||||
void brake(int in1, int in2) {
|
||||
digitalWrite(in1, LOW);
|
||||
digitalWrite(in2, LOW);
|
||||
}
|
||||
|
||||
void off(int in1, int in2) {
|
||||
digitalWrite(in1, HIGH);
|
||||
digitalWrite(in2, HIGH);
|
||||
}
|
||||
|
||||
int main(void) {
|
||||
wiringPiSetup();
|
||||
|
||||
pinMode(M1_IN1, OUTPUT);
|
||||
pinMode(M1_IN2, OUTPUT);
|
||||
pinMode(M2_IN1, OUTPUT);
|
||||
pinMode(M2_IN2, OUTPUT);
|
||||
|
||||
// FORWARD
|
||||
forward(M1_IN1, M1_IN2);
|
||||
forward(M2_IN1, M1_IN2);
|
||||
delay(1000);
|
||||
|
||||
// PARK
|
||||
brake(M1_IN1, M1_IN2);
|
||||
brake(M2_IN1, M2_IN2);
|
||||
delay(1000);
|
||||
|
||||
//REVERSE
|
||||
reverse(M1_IN1, M1_IN2);
|
||||
reverse(M2_IN1, M2_IN2);
|
||||
delay(1000);
|
||||
|
||||
// OFF
|
||||
off(M1_IN1, M1_IN2);
|
||||
off(M2_IN1, M2_IN2);
|
||||
delay(1000);
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user