SoloCodigo

Por lo que veo, no es un tema fasil.
Bueno les cuento lo que voy pensando asi me ayudan, si pueden.
Mi idea es formar una matris un plano con coordenadas X e Y luego hace funcionar el robot, una ves que este en mobimiento comparar el punto en el que estaba con el punto donde se encuentra ahora y fijarce si se hacerco o se alejo de las coordenadas de origen o el punto 0. El problema que se me platena antes de empesar a programar es que no va por la distancia mas serca, sino que este se moberia siempre acercandoce pero no por la ruta mas corta.
Mi problema son las ecuaciones que debe regir este sistema para que se hacer que siempre valla por el camino mas corto y no que me valla sigsagueando sin sentido por el mapa, hacercandoce pero no por la ruta mas corta.

Espero se entienda porque no se como poner un grafico aca :S para poder ser mas espesifico.

En resumen:
mi problema no es el codigo ya que eso lo diceño yo, el problema son las ecuaciones que deben regir el dispositivo para que este tome siempre el camino mas corto, como ejemplo una matris 10x10  estoy en la coordenada [5,5] y tengo que llegar al [0,0] el camino mas corto seria ir hacia el [4,4], luego al[3,3] para despues pasar por el[2,2] y luego al [1,1] y por ultimo llegar a destino [0,0]

El problema que se me hace es que por ejemplo si tomo un vector de hacercamiento este se iria hacia por ejemplo matris 10x10 me situo en el punto [5,5] para llegar al [0,0] si hago por vector de comparacion, para que este se hacerque o doble, a lo mejor este me pasaria por los putnos [5,5] luego [4,5] luego [3,4] luego [2,4] luego [1,3] luego [0,3] luego [0,2] luego [0,1] y finalmente [0,0] y esta no es la ruta mas corta.

necesito saber las ecuaciones que rigen este proceso para luego programarlas y quemarlas en el pic.

alguna data por ahi de alguien que tenga algo parecido, se agradece en demacia!!!!

nos vemos

costeleta