Fix log to file
add step button
Speed control for warehouse scenario
Fix last mistakes