Lots of fixes. Added some code for use of both ping sensors