[main] Fixed UART0 connection to PC. Created TEST_main function to contain most tests. Added Command 8, that reads the distance of 1 distance sensor (value show is from previous data, so the first measurement is not real).
[DIST] Added functionality to read Ultrasonic sensors. Implementation of calibration curves pending.