Environment mapping with mobile robot guided by a markers vision system