Robot successfully working with velocity forward commands