A* implementation in OGRE 3D - C++