Trajectory Planning For Feature-Based Localisation And Mapping