Added readPing() function to rpiIO.c