Debugging autonomous and optimizing robot control