Finish switching to full C++ for the whole-body control part + Error is no longer an attribute of the wbc class