Removed do to merge with navigator
fix motor speed
Removed unused