Minor Changes to navigate.c

Changes to pid->pos invariants