Added method in Mapper to add Poses of robots to trace them.