#include <AccelStepper.h>
AccelStepper Drivemotors(1, 4, 7); // pin 4 = step, pin 7 = direction

String inputString = "";
char steering[] = { 'a', 'b', 'c'};
char throttle[] = { 'a', 'b', 'c'};
char function[] = { 'a', 'b', 'c'};

void setup()
{
Drivemotors.setMaxSpeed(500);
Serial.begin(9600);
}

void loop()
{
//delay(250);
//////////// Lue saapuva viesti /////////////////////////
inputString = Serial.readStringUntil("\n");

//////////// Tarkista viestin ensimmäinen kirjain /////////////////////////
char *check = inputString.charAt(0);

//////////// Jos viestin ensimmäinen kirjain on A /////////////////////////
if (check == 'A')
  {


            char steering[3];            //Char ohjaus = uusi 3 kirjaimen array
            char throttle[3];            //Char kaasu = uusi 3 kirjaimen array
            char function[3];            //Char toiminto = uusi 3 kirjaimen array

        //    char *steering = new char[3];            //Char ohjaus = uusi 3 kirjaimen array
        //    char *throttle = new char[3];            //Char kaasu = uusi 3 kirjaimen array
        //    char *function = new char[3];            //Char toiminto = uusi 3 kirjaimen array

            steering[0] = inputString.charAt(4);     //Array steering's first index = second character of inputString
            steering[1] = inputString.charAt(5);     //Array steering's second index = third character of inputString
            steering[2] = inputString.charAt(6);     //Array steering's third index = fourth character of inputString
            throttle[0] = inputString.charAt(1);     //Array throttle's first index = fifth character of inputString
            throttle[1] = inputString.charAt(2);     //Array throttle's second index = sixth character of inputString
            throttle[2] = inputString.charAt(3);     //Array throttle's third index = seventh character of inputString
            function[0] = inputString.charAt(7);     //Array function's first index = eight character of inputString
            function[1] = inputString.charAt(8);     //Array function's second index = ninth character of inputString
            function[2] = inputString.charAt(9);     //Array function's third index = tenth character of inputString

            int steeringVal = atoi(steering);        //Integer steeringVal = Char steering converted to integer
            int throttleVal = atoi(throttle);        //Integer throttleVal = Char throttle converted to integer
            int functionVal = atoi(function);        //Integer functionVal = Char function converted to integer



Serial.print("ImputString:");
Serial.println(inputString); //tulostaa input msg arvon.
Serial.print("CHAR_Steering:");
Serial.println(steering); //tulostaa input msg arvon.
Serial.print("CHAR_Throttle:");
Serial.println(throttle); //tulostaa input msg arvon.
Serial.print("CHAR_Function:");
Serial.println(function); //tulostaa input msg arvon.

Serial.print("Steering:");
Serial.println(steeringVal); //tulostaa input msg arvon.
Serial.print("Throttle:");
Serial.println(throttleVal); //tulostaa input msg arvon.
Serial.print("Function:");
Serial.println(functionVal); //tulostaa input msg arvon.
}
}