New navigation engine

New navigation engine using splines and a few fixes.