Diff: main.cpp

Revision:

1:dbb18c6be96a

Parent:

0:ce8ad4f285d3

Child:

2:0c88bf3817fe

--- a/main.cpp	Mon Nov 27 15:44:43 2017 +0000
+++ b/main.cpp	Mon Dec 04 15:49:38 2017 +0000
@@ -1,10 +1,13 @@
 #include "mbed.h"
 #include "Adresar.h"
+#include "main.h"
 #define ARRAY_SIZE(array) sizeof(array)/sizeof(*array)
 
 Serial term(USBTX, USBRX);
 DigitalOut led1(LED2);
 
+
+
 int prijmi;
 
 int getCrc(int addrRx, int addrTx, int dataSize, int aData[])
@@ -60,27 +63,84 @@
 }
 
 
-
+void dajPoschodie()
+{
+    int poschodie;
+    if(adresa[2] == 0xE3)
+    {
+        int aDataIn[] = {0x1E};
+        int dataSize1 = ARRAY_SIZE(aDataIn);
+        posliSpravu(0xD0,0xAA,dataSize1,aDataIn);
+        }
+    }
 
 
 int main() {
     
     term.baud(57600);
     
-    //int aDataIn[] = {0x6C};
-      int adata[1] = {term.getc()};
-    int dataSize = ARRAY_SIZE(adata);
-    //for(int i = 0; i <= 10;i++){
-      //  posliSpravu(0xD0,0xAA,dataSize,aDataIn);
-        //}
-        //int aData[] = term.getc(); 
-      
-        posliSpravu(0xD0,0xAA,dataSize,adata);
-        
-        
-   // posliSpravu(0xD0,0xAA,3,aDataIn);
     
+     //int aDataIn[] = {0x01,0x50,0x31,0x32};
+     //int dataSize1 = ARRAY_SIZE(aDataIn);
+     //posliSpravu(C_LCD,0xAA,dataSize1,aDataIn);
+     
+     zamkniVytah();
+     wait(1);
+     odomkniVytah();
+     wait(1);
+     zamkniVytah();
+     wait(1);
+     smerDole();
+     wait(2);
+     dajPoschodie();
+     
+     if (term.getc() ==  SWITCH_3)
+     {
+         stop();
+         }
+     
     
     
 }
 
+
+void stop()
+{
+    int aDataIn[] = {0x1};
+     int dataSize1 = ARRAY_SIZE(aDataIn);
+    posliSpravu(MOTOR,0xAA,dataSize1,aDataIn);
+    }
+
+void smerHore()
+{
+    int aDataIn[] = {0x2, 0x64, 0x00, 0x00, 0x00};
+     int dataSize1 = ARRAY_SIZE(aDataIn);
+     posliSpravu(MOTOR,0xAA,dataSize1,aDataIn);
+}
+
+
+void smerDole()
+{
+    int aDataIn[] = {0x2, 0x9C, 0xff, 0xff, 0xff};
+    int dataSize1 = ARRAY_SIZE(aDataIn);
+     posliSpravu(MOTOR,0xAA,dataSize1,aDataIn);
+    
+}
+
+
+
+
+ void zamkniVytah()
+ {
+     int adata[1] = {0x01};
+    int dataSize = ARRAY_SIZE(adata);
+     posliSpravu(0xF0,0xAA,dataSize,adata);
+     
+}
+
+void odomkniVytah()
+{
+    int adata[1] = {0x00};
+    int dataSize = ARRAY_SIZE(adata);
+     posliSpravu(0xF0,0xAA,dataSize,adata);
+    }
\ No newline at end of file