Simon Hladek / Mbed 2 deprecated elevator1

Dependencies:   MMA8451Q mbed

Revision:
2:3cb49ae40d02
Parent:
1:998a963e2ead
Child:
3:9ee509852c9a
--- a/main.cpp	Wed Dec 07 22:17:39 2016 +0000
+++ b/main.cpp	Fri Dec 09 21:45:17 2016 +0000
@@ -3,15 +3,17 @@
 #include "structures.h"
 DigitalOut cervena(LED1);
 DigitalOut zelena(LED2);
-
+Ticker ticker;
+void calc();
 Serial pc(USBTX,USBRX);
 Model *mModel =new Model();
 void SerialCallBack();
+int pom=0;
 int main()
 {
-  
-    mModel->pc.baud(57600);
-    mModel->pc.attach(&SerialCallBack);
+
+  //  mModel->pc.baud(57600);
+    //mModel->pc.attach(&SerialCallBack,Serial::RxIrq);
     testData mtest;
     mtest.data[0]=0x41;
     mtest.data[1]=0x42;
@@ -20,27 +22,39 @@
     mtest.startByte=0xa0;
     mtest.targetAddress=0xd0;
     mtest.sourceAddress=0x00;
-  //  mModel->sendPacket(mtest.startByte,mtest.targetAddress,mtest.sourceAddress,mtest.data);
- cervena=1;
- zelena=1;
- char data[5]={0x2,0x00,0x00,0x00,0x14};
-  //mModel->sendPacket(0xA0,0xf1,0x00,data,5);
+    //  mModel->sendPacket(mtest.startByte,mtest.targetAddress,mtest.sourceAddress,mtest.data);
+    cervena=1;
+    zelena=1;
+    char data[5]= {0x2,0x00,0x00,0x00,0x14};
+    //mModel->sendPacket(0xA0,0xf1,0x00,data,5);
 //    packet1->data[0] = 0x2;
 //    packet1->data[1] = 0xff;
 //    packet1->data[2] = 0xff;
 //    packet1->data[3] = 0xff;
 //    packet1->data[4] = 0xfb;
-
+    ticker.attach(&calc,0.5);
 
-       while(1){
-           mModel->pc.attach(&SerialCallBack);
-           mModel->doSomething(mModel->sourceAdd);
+    while(1) {
+        mModel->pc.attach(&SerialCallBack,Serial::RxIrq);
+        mModel->doSomething(mModel->sourceAdd);
         //  if(mModel->sourceAdd==0xc3){
 //           mModel->sendPacket(0xa0,0xd0,0x00,mModel->DataIn);
 //           }
-           };
-   //  mModel->sendPacket(0xa0,0xd0,0x00,mModel->DataIn);
-    
+    };
+    //  mModel->sendPacket(0xa0,0xd0,0x00,mModel->DataIn);
+
+}
+void calc()
+{
+    pom++;
+    if (pom==1) {
+        zelena =0;
+        cervena=1;
+    } else {
+        zelena=1;
+        cervena=0;
+        pom=0;
+    }
 }
 
 
@@ -51,8 +65,9 @@
     mModel->targetAdd=mModel->pc.getc();
     mModel->sourceAdd=mModel->pc.getc();
     mModel->DataLength=mModel->pc.getc();
-    for (unsigned int i=0;i< mModel->DataLength;i++){
-    mModel->DataIn[i]=mModel->pc.getc();}
+    for (unsigned int i=0; i< mModel->DataLength; i++) {
+        mModel->DataIn[i]=mModel->pc.getc();
+    }
     mModel->CrcIn=mModel->pc.getc();
-   
+
 }
\ No newline at end of file