C3 does not always set waypoint to current pose on revive

[Kevin Allen]

• C3 sometimes (always?) does not reset the waypoint to the current pose when the sub is unkilled