second motors routine and start of corrections of ultrasonics
Integration of ultrasonic sensors in the main program.
Tested and running. Distance is left on global variables for each sensor.
Merge pull request #7 from jupacaza/master

Integration of ultrasonics to the main routine.