rewrite smooth move

smooth move rewrite to use angle step instead time.sleep()