Relax requirement of being in POSITION_DIRECT control mode when calling setPosition

@EnricoMingo this should fix you problem.