Robot now is in stand6 mode when not executing commands