Routing and Guidance subsystems are very complicated. Nobody knows how they works. Even the authors. It will be much easier to write new navigation SW from scratch than fix/modify existing.