Speed up Eigen calculations and clean up

For explanation on the usage of noalias() see http://eigen.tuxfamily.org/dox/TopicWritingEfficientProductExpression.html