adding robot position and angles detection