Geht denn Folgendes?
motco_resetOdometry(20, 20);
motco_setPosition(0, 0, 20);