Coordinate transformation from Cartesian to Frenet Frame

33 次查看（过去 30 天）
Suvo Ganguli
Suvo Ganguli 2021-3-9
回答： Cameron Stabile 2023-1-26
Can anyone tell me how to convert from Cartesian to Frenet Frame for a vehicle driving on a curved road? In other words how do I convert from (x,y) -> (s,d) where is along the curve and d is perpendicular to the curve?
Is there a Matlab code someone can share?
For example if the vehicle is 1 m off centerline and driving along the arc of a circle at speed 1 m/s, then the coordinates at every 1 sec in Cartesian and Frenet frame are given by:
x = cos(theta) ... [with the appropriate scalings for radius and speed]
y = sin(theta) ... [with the appropriate scalings for radius and speed]
s = (0, 1, 2, ...)
d = (1, 1, 1, ...)
I have been looking into Matlab codes but the solutions I got are in the form of (T, N, B) - the tangent, normal and binormal. How do I convert them to distance along the centerline and perpendicular to the centerline?
Thanks.

请先登录，再回答此问题。

采纳的回答

Cameron Stabile
Cameron Stabile 2023-1-26
Hi Suvo,
The referencePathFrenet feature from the Navigation Toolbox might be of use to you. The feature fits a piece-wise clothoid spline between a set of or waypoints, after which you can convert between Cartesian and Frenet space.
There are a number of tools at your disposal, which loosely fall into the following categories:
Projection XY point to Curve:
Conversion between Cartesian and Frenet
Evaluating Curve at Arclength (S)
There are also a number of examples that show how this can be applied to road-based planners, a good one to get you started could be Highway Trajectory Planning Using Frenet Reference Path.
Hope this helps,
Cameron

更多回答（0 个）

类别

在 Help Center 和 File Exchange 中查找有关 Motion Planning 的更多信息

标签

Community Treasure Hunt

Find the treasures in MATLAB Central and discover how the community can help you!

Start Hunting!

Translated by