Integration of ultrasonics to the main routine.

All 4 ultrasonics up and running.

Changed the pins of Motor 2 to PortE