Ensuring to have zero output matrices before running algorithms in icubWholeBodyModel