Add branch StepMotorCST into develop