Fixed lock for threading issue with get_param().
Fixed robot move speed.