File content as of revision 80:dbda5092950e:

#include "Interpreter.h"



Interpreter::Interpreter(Queue<int,8>* 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++){
        queue->put(&LED[i]);
    }
    
    for(int i=0;i<8;i++){
       printf("LED %i, richting: %i\r\n",i,LED[i]);   
    }
}

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;
}