Rotation of the Stick is working except checking of obstacles