Fix NewPing hang issue in firmware

https://code.google.com/p/arduino-new-ping/issues/detail?id=5