Updated with all 6 ping sensors and new algorithm