Updated uSonic test code to include battery readings