motors dont balance correctly
refactoring and modularizing