MBL1330 Arduino Serial Connection

void setup() {
  // put your setup code here, to run once:

  Serial.begin(115200);  //set serial baud to 115200 bps

  Serial.println("^rwd 1 0"); //disable motor controller serial watchdog
}

void loop() {
  // put your main code here, to run repeatedly:
  delay(5000); //hold 5 sec
  Serial.println("!G 1 500"); //forward @ 50% power
  delay(5000); //run for 5 sec
  Serial.println("!G 1 0"); //stop
}

#include "Arduino.h"
#include "Wire.h"
#include "Stream.h"

//The setup function is called once at startup of the sketch

String inputString; // a string to hold incoming data
String echo;
boolean stringComplete = false;

void setup()
{
	// put your setup code here, to run once:
	Serial.begin(9600);
	Serial1.begin(115200);  //set serial baud to 115200 bps
	inputString.reserve(128);
	stringComplete = false;

	 Serial1.println("^rwd 1 0"); //disable motor controller watchdog
	Serial.println("Setup done");
}

void loop()
{
	Serial.println("Loop begin");
	// put your main code here, to run repeatedly:
	delay(5000); //hold 5 sec
	Serial1.println("!G 500"); //forward
	echo = Serial1.readString();
	Serial.println(echo);
	delay(5000); //run for 5 sec
	Serial1.println("!G 0"); //stop
	echo = Serial1.readString();
	Serial.println(echo);

	// I use arduino Mega, Serial1 to connect to the RoboteQ and Serial to see the results on the Serial Monitor of the Arduino IDE
	Serial1.println("?A"); // Here I am requesting some telemetry elements to the roboteq and I am using Serial1 on arduino Mega
	unsigned long recTime = millis(); // Here I am starting to compose the incoming string
	while (Serial1.available() > 0 || millis() - recTime < 50)
	{
		char inChar = (char) Serial1.read();     // get the new byte:
		inputString += inChar;
		if (inputString.indexOf("A=") < inputString.lastIndexOf('\r'))
			stringComplete = true;
	}

if(stringComplete)
{
	Serial.println(inputString); // Print entire string from controller on the Serial Monitor of your IDE

}

}