Add gmapping nav and update primitives.