足立 快仁
program_of_Monday
Diff: main.cpp
- Revision:
- 0:2da7c2bc2ed5
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Thu Nov 18 21:30:45 2021 +0000
@@ -0,0 +1,42 @@
+#include "mbed.h"
+PwmOut pinAFin(D10);
+PwmOut pinARin(A1);
+PwmOut pinBFin(D11);
+PwmOut pinBRin(D12);
+
+void driveMotor(int speedA,int speedB) {
+ float outputA = abs(speedA);
+ float outputB = abs(speedB);
+ if (speedA > 0) {
+ pinAFin=outputA;
+ pinARin=0;
+ } else if (speedA < 0) {
+ pinAFin=0;
+ pinARin=outputA;
+ } else {
+ pinAFin=0;
+ pinARin=0;
+ }
+ if (speedB > 0) {
+ pinBFin=outputB;
+ pinBRin=0;
+ } else if (speedB < 0) {
+ pinBFin=0;
+ pinBRin=outputB;
+ } else {
+ pinBFin=0;
+ pinBRin=0;
+ }
+}
+
+int main()
+{
+
+ wait(10);
+ driveMotor(1,1);
+ wait(10);
+ driveMotor(0,0);
+ return 0;
+
+}
+