CBF fixes

moved to Eigen3, no Eigen2 support anymore
fixed instantiation of subordinate controllers
fixed several build issues (in cmake and source) in optional code