stewartplatform

Dependencies:   mbed

Fork of PwmOut_HelloWorld by Mbed

Revision:
3:c5ea5b6a7460
Parent:
2:50062ac8646d
--- a/main.cpp	Sat May 07 12:27:09 2016 +0000
+++ b/main.cpp	Sat Aug 20 12:06:14 2016 +0000
@@ -1,10 +1,10 @@
 #include "mbed.h"
-//#include "motor.h"
+#include "motor.h"
 #include "usart.h"
 //#include "file.h"
 
 
-//extern PwmOut motor[6];
+extern PwmOut motor[6];
 extern Serial usart;
 
 extern char position[6];
@@ -13,15 +13,15 @@
 int main() {
         int baud = 9600;                                                                        //baud rate
         usart_init(baud);                                                                       //serial port initialize
-//        motor_init();
+        motor_init();
         usart.printf("new test!");
     
     while(1) {
         if (instructionReceived) {
             instructionReceived = false;
             usart.printf("0 \n" );
-            //usart.printf("pos(%d,%d,%d,%d,%d,%d) \n", position[0], position[1], position[2], position[3], position[4], position[5]);
-//            motor_drive();
+            usart.printf("pos(%d,%d,%d,%d,%d,%d) \n", position[0], position[1], position[2], position[3], position[4], position[5]);
+            motor_drive();
         }
     }
 }