Sorry @zenta I have been a little MIA here.
Been busy playing with other things. I have not done much in a long time with Visual Studio, but at times I do use it when I feel like playing with some debug stuff.
As others mentioned, the first thing I did was run through the LSS Config program and update all of the servos firmware to the latest and set a few other things like baud rate and the like. Later I added some test sketch which allows me to update baud rate.
Wondering why things are hanging.
If you are trying the LSSTestServos.
The setup code calls the FindServos function.
I would tend to instrument the code more to see if anything looks obvious, like:
void FindServos(void) {
g_count_servos_found = 0;
int32_t pos;
Serial.println("\nSearch for all servos");
// Initialize to no servos...
for (int i = 0; i < MAX_SERVO_NUM; i++) {
myLSS.setServoID(i);
Serial.println(i, DEC);
pos = myLSS.getPosition();
if (myLSS.getLastCommStatus() == LSS_CommStatus_ReadSuccess) {
g_ids[g_count_servos_found++] = i;
Serial.print(" ");
Serial.print(i, DEC);
Serial.print(" - ");
Serial.println(pos, DEC);
}
}
Serial.println(" Done");
}
Sorry sort of going blank on knowing how to set text color and the like in this forumā¦ So simply added print out which index is being done nextā¦ To see if/were it is hanging. Sometimes I will add Serial.flush();
After that to force it to output if it looks like processor totally hangs hard or resets, as to make sure I have the absolute latest text.
Question might be how do you have the Servos connected to T4.1?
Kinda late nowā¦ 
It still worked.
