Nav tool box and updated INS Simulation