Added reset cmd and set speed at init