Preliminar code for robot positioning