Adds some test code for the ultra sonic sensor and __init__.py file