#include <Arduino.h>
#include "SerialCommands.h"
//input buffer size
char serial_command_buffer_[32];
//add the stream, buffer, size of the buffer, normal string termination, delimiter
SerialCommands serial_commands_(&Serial, serial_command_buffer_, sizeof(serial_command_buffer_), "\r\n", " ");
//This is the default handler, and gets called when no other command matches.
void cmd_unrecognized(SerialCommands* sender, const char* cmd)
{
sender->GetSerial()->print(F("Unrecognized command ["));
sender->GetSerial()->print(cmd);
sender->GetSerial()->println(F("]"));
}
float* process_float_command(SerialCommands* sender, float *arr)
{
char* arg = sender->Next();
if (arg == NULL)
{
sender->GetSerial()->println(F("FIRST ARG NULL"));
}
else
{
arr[0] = atof(arg);
}
arg = sender->Next();
if (arg == NULL)
{
sender->GetSerial()->println(F("SECOND ARG NULL"));
}
else
{
arr[1] = atof(arg);
}
arg = sender->Next();
if (arg == NULL)
{
sender->GetSerial()->println(F("THIRD ARG NULL"));
}
else
{
arr[2] = atof(arg);
}
arg = sender->Next();
if (arg == NULL)
{
sender->GetSerial()->println(F("FOURTH ARG NULL"));
}
else
{
arr[3] = atof(arg);
}
return arr;
}
unsigned long* process_unsigned_long_command(SerialCommands* sender, unsigned long *arr)
{
char* arg = sender->Next();
if (arg == NULL)
{
sender->GetSerial()->println(F("FIRST ARG NULL"));
}
else
{
arr[0] = strtoul(arg, NULL, 10);
}
arg = sender->Next();
if (arg == NULL)
{
sender->GetSerial()->println(F("SECOND ARG NULL"));
}
else
{
arr[1] = strtoul(arg, NULL, 10);
}
arg = sender->Next();
if (arg == NULL)
{
sender->GetSerial()->println(F("THIRD ARG NULL"));
}
else
{
arr[2] = strtoul(arg, NULL, 10);
}
arg = sender->Next();
if (arg == NULL)
{
sender->GetSerial()->println(F("FOURTH ARG NULL"));
}
else
{
arr[3] = strtoul(arg, NULL, 10);
}
return arr;
}
void test_float(SerialCommands* sender)
{
float arr[4] = {0, 0, 0, 0};
float* arr_ptr = process_float_command(sender, arr);
Serial.println();
Serial.println(arr[0]);
Serial.println(arr[1]);
Serial.println(arr[2]);
Serial.println(arr[3]);
}
void test_ul(SerialCommands* sender)
{
unsigned long ul_arr[4] = {0, 0, 0, 0};
unsigned long* ul_arr_ptr = process_unsigned_long_command(sender, ul_arr);
Serial.println();
Serial.println(ul_arr[0]);
Serial.println(ul_arr[1]);
Serial.println(ul_arr[2]);
Serial.println(ul_arr[3]);
}
SerialCommand cmd_test_float_("test_float", test_float);
SerialCommand cmd_test_ul_("test_ul", test_ul);
void setup()
{
Serial.begin(500000);
serial_commands_.SetDefaultHandler(cmd_unrecognized);
serial_commands_.AddCommand(&cmd_test_float_);
serial_commands_.AddCommand(&cmd_test_ul_);
Serial.println(F("Ready!"));
}
void loop()
{
serial_commands_.ReadSerial();
}
