Final calibration and PWM position tuning control optimized. Colision detection unabled