new commit

motor and motion already added, prepare do algorithm