Simon Hladek / Mbed 2 deprecated elevator1

Dependencies:   MMA8451Q mbed

main.cpp

Committer:
skirmish
Date:
2016-12-07
Revision:
1:998a963e2ead
Parent:
0:41e22e385908
Child:
2:3cb49ae40d02

File content as of revision 1:998a963e2ead:

#include "mbed.h"
#include "model.h"
#include "structures.h"
DigitalOut cervena(LED1);
DigitalOut zelena(LED2);

Serial pc(USBTX,USBRX);
Model *mModel =new Model();
void SerialCallBack();
int main()
{
  
    mModel->pc.baud(57600);
    mModel->pc.attach(&SerialCallBack);
    testData mtest;
    mtest.data[0]=0x41;
    mtest.data[1]=0x42;
    mtest.data[2]=0x43;
    mtest.data[3]=0x44;
    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);
//    packet1->data[0] = 0x2;
//    packet1->data[1] = 0xff;
//    packet1->data[2] = 0xff;
//    packet1->data[3] = 0xff;
//    packet1->data[4] = 0xfb;


       while(1){
           mModel->pc.attach(&SerialCallBack);
           mModel->doSomething(mModel->sourceAdd);
        //  if(mModel->sourceAdd==0xc3){
//           mModel->sendPacket(0xa0,0xd0,0x00,mModel->DataIn);
//           }
           };
   //  mModel->sendPacket(0xa0,0xd0,0x00,mModel->DataIn);
    
}


void SerialCallBack()
{

    mModel->startByteIn=mModel->pc.getc();
    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();}
    mModel->CrcIn=mModel->pc.getc();
   
}