demo versie 16/05

Dependencies:   EthernetInterface mbed-rto mbed

Fork of ProjectVLC by Klaas Govaerts

Committer:
KlaasGovaerts
Date:
Tue May 15 16:53:09 2018 +0000
Revision:
71:5e8ba1357442
Parent:
62:237e32fd3555
Werkt niet2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
KlaasGovaerts 19:5ee34e60a31d 1 #include "Interpreter.h"
KlaasGovaerts 19:5ee34e60a31d 2
KlaasGovaerts 28:bf62c46acb3e 3
KlaasGovaerts 28:bf62c46acb3e 4
KlaasGovaerts 71:5e8ba1357442 5 Interpreter::Interpreter(Queue<int,1>* queue){
KlaasGovaerts 28:bf62c46acb3e 6 Interpreter::queue=queue;
KlaasGovaerts 19:5ee34e60a31d 7 }
KlaasGovaerts 19:5ee34e60a31d 8
KlaasGovaerts 19:5ee34e60a31d 9 void Interpreter::executeCommand(char* command){
KlaasGovaerts 28:bf62c46acb3e 10 for(int i=0;i<8;i++){
KlaasGovaerts 54:45207965e160 11 LED[i]=4;
KlaasGovaerts 54:45207965e160 12 } //Set all default on 4
KlaasGovaerts 28:bf62c46acb3e 13
KlaasGovaerts 21:fe6a58e84929 14 char *ID=strtok(command,"-");
KlaasGovaerts 19:5ee34e60a31d 15 char *direction=strtok(NULL," ");
KlaasGovaerts 19:5ee34e60a31d 16 while((ID!=NULL)&&(direction!=NULL)){
KlaasGovaerts 19:5ee34e60a31d 17 int IDNumber=atoi(ID);
KlaasGovaerts 19:5ee34e60a31d 18 int directionNumber=directionToNumber(direction);
KlaasGovaerts 54:45207965e160 19 if((IDNumber>=0)&&(IDNumber<=11)&&(directionNumber>=0)&&(directionNumber<=4)){
KlaasGovaerts 19:5ee34e60a31d 20 LED[IDNumber]=directionNumber;
KlaasGovaerts 19:5ee34e60a31d 21 }
KlaasGovaerts 21:fe6a58e84929 22 ID=strtok(NULL,"-");
KlaasGovaerts 19:5ee34e60a31d 23 direction=strtok(NULL," ");
KlaasGovaerts 19:5ee34e60a31d 24 }
KlaasGovaerts 28:bf62c46acb3e 25
KlaasGovaerts 28:bf62c46acb3e 26 for(int i=0;i<8;i++){
KlaasGovaerts 71:5e8ba1357442 27 printf("LED %i, richting: %i\r\n",i,LED[i]);
KlaasGovaerts 28:bf62c46acb3e 28 }
KlaasGovaerts 28:bf62c46acb3e 29
KlaasGovaerts 71:5e8ba1357442 30 int *toPush=(int*) malloc(8*sizeof(int));
KlaasGovaerts 71:5e8ba1357442 31 memcpy(toPush,LED,8*sizeof(int));
KlaasGovaerts 71:5e8ba1357442 32 queue->put(toPush);
KlaasGovaerts 71:5e8ba1357442 33
KlaasGovaerts 71:5e8ba1357442 34 printf("Reached this code");
KlaasGovaerts 19:5ee34e60a31d 35 }
KlaasGovaerts 19:5ee34e60a31d 36
KlaasGovaerts 19:5ee34e60a31d 37 int Interpreter::directionToNumber(char* direction){
KlaasGovaerts 21:fe6a58e84929 38 if(strcmp(direction,"left")==0)
KlaasGovaerts 19:5ee34e60a31d 39 return 0;
KlaasGovaerts 21:fe6a58e84929 40 else if(strcmp(direction,"right")==0)
KlaasGovaerts 19:5ee34e60a31d 41 return 1;
KlaasGovaerts 21:fe6a58e84929 42 else if(strcmp(direction,"up")==0)
KlaasGovaerts 19:5ee34e60a31d 43 return 2;
KlaasGovaerts 21:fe6a58e84929 44 else if(strcmp(direction,"down")==0)
KlaasGovaerts 19:5ee34e60a31d 45 return 3;
KlaasGovaerts 19:5ee34e60a31d 46 else
KlaasGovaerts 54:45207965e160 47 return 4;
KlaasGovaerts 19:5ee34e60a31d 48 }