Add examples

This commit is contained in:
2025-04-24 11:44:37 +09:00
commit c9b5ac93ba
2 changed files with 81 additions and 0 deletions

59
2ch_bdc_driver/main.c Normal file
View 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;
}