Programm for checking if the wings are properly calibrated

Dependencies:   Epos_control mbed-rtos mbed

Files at this revision

API Documentation at this revision

Comitter:
BramS23
Date:
Wed Aug 23 10:24:55 2017 +0000
Parent:
3:d404323036d5
Commit message:
ya know

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
diff -r d404323036d5 -r 6e11f0057362 main.cpp
--- a/main.cpp	Wed Aug 23 10:19:29 2017 +0000
+++ b/main.cpp	Wed Aug 23 10:24:55 2017 +0000
@@ -26,11 +26,7 @@
     can.frequency(250000);
     pc.printf("startup: \r\n");
     
-        epos1.Start_pos_mode();Thread::wait(10);
-    epos2.Start_pos_mode();Thread::wait(10);
-    epos3.Start_pos_mode();Thread::wait(10);
-    epos4.Start_pos_mode();Thread::wait(10);
-    epos5.Start_pos_mode();Thread::wait(10);
+    
     
     epos1.Setup_EPOS(1);
     epos2.Setup_EPOS(2);
@@ -38,6 +34,12 @@
     epos4.Setup_EPOS(4);
     epos5.Setup_EPOS(5);
     
+    epos1.Start_pos_mode();Thread::wait(10);
+    epos2.Start_pos_mode();Thread::wait(10);
+    epos3.Start_pos_mode();Thread::wait(10);
+    epos4.Start_pos_mode();Thread::wait(10);
+    epos5.Start_pos_mode();Thread::wait(10);
+    
     thread1.start(&epos1,&EPOS::Homing);
     Thread::wait(5);
     thread2.start(&epos2,&EPOS::Homing);