Feature/i21 obstacle tracker
- Constant-velocity, constant-heading motion model used to predict future poses of obstacle vessel
- Calculation of covariance matrix representing uncertainty in predicted poses (to be used in future plotting of uncertainty ellipse on costmap)
- Predicted poses are rendered on the costmap with the vessel footprint and exclusion buffer as past of the GroundTruth Plugin