Diff: ST_DUO.cpp

Revision:

34:0dee9a606869

Parent:

33:de144094bdd1

Child:

35:758191d5c6e1

--- a/ST_DUO.cpp	Mon Apr 22 11:56:38 2019 +0000
+++ b/ST_DUO.cpp	Wed Apr 24 21:08:27 2019 +0000
@@ -2,17 +2,48 @@
 
 
 int StatusDUO=DUO_DEFAULT;
+extern volatile bool buttonSTART_pressed;
+extern volatile bool buttonSTART_enabled;
+extern PwmOut Servo;
+
+void EntryDuoStart()
+{   
+     gotoxy(1,1);
+     DisplaySendeString("Modus: DUO-Betrieb");
+     gotoxy(1,3);
+     DisplaySendeString("Betrieb gestartet");
+     
+     SpleisserMotorFWD();
+     
+     //Test pwm 
+    ServoAusschuss(0.001, 0.5);
+    
+    StatusDUO=DUO_START;
+}
+
 
 void EntryDUO()
 {
     switch(StatusDUO)
     {     
        case DUO_DEFAULT:
-       printf("DUO_MODUS\n\r");
-       Thread::wait(1000);
+       printf("DUO_MODUS\r\n");
+      // SpleisserMotorFWD();
+       
+       
+       if(buttonSTART_pressed==true)
+       {    
+            buttonSTART_pressed=false;
+            buttonSTART_diable_cb();
+            EntryDuoStart();   
+            
+        }
+       
        break;
        
        case DUO_START:
+       printf("DUO_START\r\n");
+       
        break;
        
        case DUO_FilamentIN: