Refactor compute() by splitting off two smaller private methods.
Refactor compute() by splitting off two smaller private methods.

robustrobotics/eigen,robustrobotics/eigen,robustrobotics/eigen,robustrobotics/eigen