Finished HCSR-04 library and test code