make waypoint control gains into params, updated launch file