maybe consider having m_fw_msgs and m_bw_msgs as std::vector< Eigen::VectorXf > ? Would probably make some of the expression quite a bit more understandable. Or alternatively use the shogun vector alternatives