fix comments
added a function for initializing motor position
update motors test