Нахождение кратчайшего пути по матрице, или передвижение привидений в игре Пакмен

[Андрей!]

Подскажите пожалуйста как правильно реализовать? Имеются координаты x,y пакмана и приведения.

Я использую такой алгоритм:

void Enemy::move(Map* map, Puckman* Puckman, Enemy* en)
{
    if(Puckman -> posX > posX && map -> map[en->posY][en->posX+1]->iCanEatThat) en->posX++;
    else if(Puckman -> posX < posX && map -> map[en->posY][en->posX-1]->iCanEatThat) en->posX--;
    else if(Puckman -> posY > posY && map -> map[en->posY+1][en->posX]->iCanEatThat) en->posY++;
    else if(Puckman -> posY < posY && map -> map[en->posY-1][en->posX]->iCanEatThat) en->posY--;
}

posX, posY - координаты
iCanEatThat - переменная отвечающая за то, можно ли съесть объект

Подскажите как можно улучшить алгоритм при встрече со стенкой, потому что при попадание в угол - привидение не двигается адекватно