Add xcos folder and simple motor implementation without torque disturbance.