Ping Sensor Function Added

Ping sensor function was added to the functions file, along with the the
main program testing the function with three sensors.