Added the scale allocation into the vehicle tools.
Changes to the KinematicModel and XYModel for navigation of the autonomous platform.
Updated the tritech message to reflect diver communication. Expanded the identification to hold the desired reference. Added acceleration variable to return acceleration measurements from the RBModel.