start_position 0.030045831948312826 0.009747887968120456 -0.02
goal_position 2.392346723586199 1.1967341677266043 -0.03849277595680256
start_yaw 0.4319884256998091
goal_yaw 0.4399147384917845
