Adds linear & angular factors for rigid body velocities, closes #35