* fixing polarity * allocate motor on motorUsed only * perform sub-step integration step for better precision