Gracias por vuestra ayuda.
La idea que llevaba en mente yo es similar. Quería crear una parrilla sobre el suelo del mundo 3d, de modo que al marcar con el ratón un punto determinado , este punto se aproximase al punto de la rejilla mas cercano. Después supongo que aplicando el algoritmo citado más o menos ya tendré medio problema resuelto.
Ahora solo me falta pelearme con Java para implementar esto... :rolleyes: ... y con los problemas que me vayan surgiendo.

 Hola:

Estoy desarrollando mi proyecto de final de carrera y tengo algunos problemas. Tengo que implementar la navegación de un robot bibliotecario por un entorno 3d que es la biblioteca. Tengo que evitar colisiones y sobre todo conseguir que al indicar un punto determinado con el ratón desde una vista superior, el robot se desplace hasta el punto indicado eligiendo su trayectoria a partir de un algoritmo.
El robot y la biblioteca estan ya creados, pero el algoritmo en cuestión no lo tengo muy claro, tengo alguna  que otra idea. Me gustaría que si alguien conoce alguna solución a un problema similar o algún algoritmo empleado en algún juego me facilitase algo de información. El tema de las colisiones en si no me preocupa, lo que si me preocupa es como hacer que el robot decida hacia donde se desplaza y como evitar los obstaculos siguiendo la ruta mas corta.

Bueno espero que alguien me pueda aportar alguna idea, gracias.