added mexWholeBodyModel support