Fixed robot stop issue