moving eigenToMatlab function to QPControllermex.cpp