Junichi Katsu / Mbed 2 deprecated JBB_Motor_test

It is a motor driver test program Jksoft Blue mbed Board. Jksoft Blue mbed Boardのモータードライバテストプログラムです。

Dependencies:   TB6612FNG2 mbed

Diff: main.cpp

Revision:
1:c49f6eb130b4
Parent:
0:effe57895c37
--- a/main.cpp	Mon May 12 10:56:42 2014 +0000
+++ b/main.cpp	Mon May 12 14:11:06 2014 +0000
@@ -1,15 +1,30 @@
 #include "mbed.h"
+#include "TB6612.h"
 
-DigitalOut myled(LED1);
-TB6612 motor_1(p21,p19,p20);    // PWM IN1 IN2
-DigitalIn sw_1(p25);
-DigitalIn sw_2(p26);
+TB6612 MOTOR_A(p21,p19,p20);            // PWM IN1 IN2
+TB6612 MOTOR_B(p22,p29,p30);            // PWM IN1 IN2
+DigitalIn SW1(p25);
+DigitalIn SW2(p26);
 
 int main() {
-    while(1) {
-        myled = 1;
-        wait(0.2);
-        myled = 0;
-        wait(0.2);
+    SW1.mode(PullUp);
+    SW2.mode(PullUp);
+    while(1)
+    {
+        if( SW1 == 0 )
+        {
+            MOTOR_A = 50;
+            MOTOR_B = 50;
+        }
+        else if( SW2 == 0 )
+        {
+            MOTOR_A = -50;
+            MOTOR_B = -50;  
+        }
+        else
+        {
+            MOTOR_A = 0;
+            MOTOR_B = 0;  
+        }
     }
 }