updated code for pingpair, servo works