changed launch file and added topics to set gains and goal position