processPose takes a const reference instead of copying the Eigen object