Paweł Woźniak / Mbed 2 deprecated mbedcz2_5

MTM PPO mbed cz2

Dependencies:   LCD_DISCO_F429ZI mbed BSP_DISCO_F429ZI

main.cpp@0:5d432267a99f, 2020-06-15 (annotated)

Committer:
paweler
Date:
Mon Jun 15 14:47:01 2020 +0000
Revision:
0:5d432267a99f
mbed cz2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
paweler 0:5d432267a99f 1 #include "servo.h"
paweler 0:5d432267a99f 2 #include "command_decoder.h"
paweler 0:5d432267a99f 3 #include "uart.h"
paweler 0:5d432267a99f 4
paweler 0:5d432267a99f 5 Servo MyServo(0.01);
paweler 0:5d432267a99f 6 Decoder MyDecoder;
paweler 0:5d432267a99f 7
paweler 0:5d432267a99f 8 int main()
paweler 0:5d432267a99f 9 {
paweler 0:5d432267a99f 10 char cCommand[10];
paweler 0:5d432267a99f 11 while(1)
paweler 0:5d432267a99f 12 {
paweler 0:5d432267a99f 13 gets(cCommand, sizeof(cCommand));
paweler 0:5d432267a99f 14 MyDecoder.DecodeMsg(cCommand);
paweler 0:5d432267a99f 15 if((MyDecoder.ucTokenNr > 0)&&(MyDecoder.asToken[0].eType == KEYWORD)) {
paweler 0:5d432267a99f 16 switch(MyDecoder.asToken[0].uValue.eKeyword) {
paweler 0:5d432267a99f 17 case ID:
paweler 0:5d432267a99f 18 puts("Device ID: 0x01\n", sizeof("Device ID: 0x01\n"));
paweler 0:5d432267a99f 19 break;
paweler 0:5d432267a99f 20 case CLB:
paweler 0:5d432267a99f 21 MyServo.Callib();
paweler 0:5d432267a99f 22 puts("OK\n", sizeof("OK\n"));
paweler 0:5d432267a99f 23 break;
paweler 0:5d432267a99f 24 case GOTO:
paweler 0:5d432267a99f 25 if(MyDecoder.asToken[1].eType == NUMBER) {
paweler 0:5d432267a99f 26 MyServo.GoTo(MyDecoder.asToken[1].uValue.uiNumber);
paweler 0:5d432267a99f 27 puts("OK\n", sizeof("OK\n"));
paweler 0:5d432267a99f 28 }
paweler 0:5d432267a99f 29 break;
paweler 0:5d432267a99f 30 case STEP:
paweler 0:5d432267a99f 31 if(MyDecoder.asToken[1].eType == NUMBER) {
paweler 0:5d432267a99f 32 MyServo.Step(MyDecoder.asToken[1].uValue.uiNumber);
paweler 0:5d432267a99f 33 puts("OK\n", sizeof("OK\n"));
paweler 0:5d432267a99f 34 }
paweler 0:5d432267a99f 35 break;
paweler 0:5d432267a99f 36 default:
paweler 0:5d432267a99f 37 break;
paweler 0:5d432267a99f 38 }
paweler 0:5d432267a99f 39 } else {
paweler 0:5d432267a99f 40 puts("unknowncommand\n", sizeof("unknowncommand\n"));
paweler 0:5d432267a99f 41 }
paweler 0:5d432267a99f 42 }
paweler 0:5d432267a99f 43 }