 
 /*
 	List of commands:
+
 	T#
 	- Test connection. 
 	- Outputs T#.
 	
 	V#
 	- Outputs version string (year.month.day.build_number). eg: 2019.05.10.0#.
+
+	// CREATE CONTROLLERS
 
 	CS n d1 s1 e1 d2 s2 e2 ... dn sn en# 
 	- Creates the stepper motors controller and set some of its parameters.

	- Outputs CA# when done.
	- Example: CA 3 18 19 20#

	CL creates LIDAR


	ASx n Py end1 end2 home direction Ak end1 end2 home direction # 
	- Attach to stepper motor x a list of n sensors (like Potentiometer y, Button z, AS5147 etc).

	}
}
//----------------------------------------------------------------------
void parse_and_execute_LiDAR_commands(char* tmp_str, byte str_length, byte &i, char *tmp_serial_out)
{
	tmp_serial_out[0] = 0;
	if (tmp_str[i + 1] == 'G' || tmp_str[i + 1] == 'g') {// LiDAR go
		tera_ranger_one_lidar->start();
		i += 3;
	}
	else
		if (tmp_str[i + 1] == 'H' || tmp_str[i + 1] == 'h') {// LiDAR halt
			tera_ranger_one_lidar->stop();
			sprintf(tmp_serial_out, "LH#");
			i += 3;
		}
		else
