demo versie 16/05

Dependencies:   EthernetInterface mbed-rto mbed

Fork of ProjectVLC by Klaas Govaerts

Interpreter.cpp

Committer:
KlaasGovaerts
Date:
2018-05-15
Revision:
71:5e8ba1357442
Parent:
62:237e32fd3555

File content as of revision 71:5e8ba1357442:

#include "Interpreter.h"



Interpreter::Interpreter(Queue<int,1>* queue){
    Interpreter::queue=queue;
}

void Interpreter::executeCommand(char* command){
    for(int i=0;i<8;i++){
        LED[i]=4;
    } //Set all default on 4
    
    char *ID=strtok(command,"-");
    char *direction=strtok(NULL," ");
    while((ID!=NULL)&&(direction!=NULL)){
        int IDNumber=atoi(ID);
        int directionNumber=directionToNumber(direction);
        if((IDNumber>=0)&&(IDNumber<=11)&&(directionNumber>=0)&&(directionNumber<=4)){
            LED[IDNumber]=directionNumber;
        }
    ID=strtok(NULL,"-");
    direction=strtok(NULL," ");
    }
    
    for(int i=0;i<8;i++){
       printf("LED %i, richting: %i\r\n",i,LED[i]);   
    }
    
    int *toPush=(int*) malloc(8*sizeof(int));
    memcpy(toPush,LED,8*sizeof(int));
    queue->put(toPush);
    
    printf("Reached this code");   
}

int Interpreter::directionToNumber(char* direction){
    if(strcmp(direction,"left")==0)
        return 0;
    else if(strcmp(direction,"right")==0)
        return 1;
    else if(strcmp(direction,"up")==0)
        return 2;
    else if(strcmp(direction,"down")==0)
        return 3;
    else 
        return 4;
}