Created ActuatorMathHelper, which performs geometry calculations to help calculate feedforward commands.
Wrote JointController (name will change...).  This controller uses actual goemetric models for the joints and datasheet-based models for the valves to produce much more accurate predictions of control inputs.  In simulation it is a substantial improvement over pure PID based on angle.