![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
semestralna praca
Diff: main.cpp
- Revision:
- 1:dbb18c6be96a
- Parent:
- 0:ce8ad4f285d3
- Child:
- 2:0c88bf3817fe
diff -r ce8ad4f285d3 -r dbb18c6be96a main.cpp --- 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