Не знаю что все-таки имел введу
YVitaliy, но тем не менее решил сделать кое-что свое.
Не смотря на простоту задачи, в некоторых местах пришлось попотеть а именно когда идет столкновение с несколькими стенами. Вроде получилось неплохо.
Как пользоваться:
1. Рисуем линии в 2D редакторе(это собственно стены), путем нажатия правой кнопки мышки, и проведением в другое место.
2. Далее переключаемся в 3D сцену, и ходим наслаждаемся.
З.Ы. Работу алгоритма так же можно проверить в 2D редакторе, т.е. управляем клавой, только единственное он ходит за мышкой
Прога