start_node: -3.37 0.45 -1.5708
end_node: -2.86341 -0.05 0
max_kappa: 2
step_size: 0.1
seg_type:SLS
seg_length[0]: 0 seg_length[1]: 1.5708 seg_length[2]: 0.013187

x: -3.37 y: 0.45 phi: -1.5708 gear: 0
x: -3.36003 y: 0.549335 phi: -1.7708 gear: 0
x: -3.37 y: 0.45 phi: -1.5708 gear: 0
x: -3.36003 y: 0.350665 phi: -1.3708 gear: 1
x: -3.33053 y: 0.255291 phi: -1.1708 gear: 1
x: -3.28267 y: 0.167679 phi: -0.970796 gear: 1
x: -3.21835 y: 0.091322 phi: -0.770796 gear: 1
x: -3.14015 y: 0.0292645 phi: -0.570796 gear: 1
x: -3.05118 y: -0.0160195 phi: -0.370796 gear: 1
x: -2.95498 y: -0.0427249 phi: -0.170796 gear: 1
x: -2.86341 y: -0.05 phi: 0 gear: 1