Convert Frenet states to Cartesian states
frenet2cart(
converts a 6-element vector of Frenet states planner
,frenetStates
)[s,
ds, dds, l,
dl, ddl]
, where s is
arc length from the first point in reference path, and l is normal
distance from the closest point at s on the reference path to a 6-element
vector of Cartesian states [x, y,
theta, kappa, speed,
acceleration]
.