Some readbility defines and comment updates
Reduced the number og sensor timeouts
Some additional commenting and more status information for the test program