Integration of changes in motors and ultrasonic. Motors are supposed to work, ultrasonics are still on test.
Merge pull request #3 from jupacaza/master

Integration of changes in motors and ultrasonic. Motors are supposed to work, ultrasonics are still on test