Adapt planner to support odometry from multiple actors

[mcorah]

Add multiple odometry sources to the planning system. The group model could be simplified... i.e. averaging position and orientation. Later tasks will focus on developing multi-actor models.