refactoring
refactoring
disabled debug output in motion controller
added echo_or_idle_or_improvise