Task space control framework in OpenSim