31 lines
798 B
C++
31 lines
798 B
C++
#include "Command.h"
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
void Command::run(char* str){
|
|
for(int i=0; i < call_count; i++){
|
|
if(isSentinel(call_ids[i],str)){ // case : call_ids = "T2" str = "T215.15"
|
|
call_list[i](str+strlen(call_ids[i])); // get 15.15 input function
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
void Command::add(char* id, CommandCallback onCommand){
|
|
call_list[call_count] = onCommand;
|
|
call_ids[call_count] = id;
|
|
call_count++;
|
|
}
|
|
void Command::scalar(float* value, char* user_cmd){
|
|
*value = atof(user_cmd);
|
|
}
|
|
bool Command::isSentinel(char* ch,char* str)
|
|
{
|
|
char s[strlen(ch)+1];
|
|
strncpy(s,str,strlen(ch));
|
|
s[strlen(ch)] = '\0'; //strncpy need add end '\0'
|
|
if(strcmp(ch, s) == 0)
|
|
return true;
|
|
else
|
|
return false;
|
|
}
|