Navsafe SMART Algorithm