added pickup and deliver completion sensor (checked with joint angles now)