How to Transform of coordinate of actors from vehicle coordinate to world coordinate or refference coordinate system (ADAS toolbox) ...?
5 views (last 30 days)
Show older comments
How to Transform of coordinate of actors from vehicle coordinate to world coordinate or refference coordinate system (ADAS toolbox) ...?
egoWaypoints = ; % ego vehicle waypoints wrt world coordinate.
egoAngle = atan(diff(egoWaypoints(:,1))./diff(egoWaypoints(:,2)));
egoAngle(end+1) = egoAngle(end);
tempX = ; % X coordinate wrt to Vehicle coordinate system from sensor fusion
tempY = ; % Y coordinate wrt to Vehicle coordinate system from sensor fusion
relX = tempX.*sin(abs(egoAngle(1:length(tempX))))-tempY.*cos(abs(egoAngle(1:length(tempX))));
relY = -tempX.*cos(abs(egoAngle(1:length(tempX))))-tempY.*sin(abs(egoAngle(1:length(tempX))));
absX = egoWaypoints(1:length(tempX),1)+relX;
absY = egoWaypoints(1:length(tempX),2)+relY;
0 Comments
Accepted Answer
Qu Cao
on 16 Jan 2020
The following documenation page explains the vehicle coordinate system and the world coordinate system:
0 Comments
More Answers (0)
See Also
Community Treasure Hunt
Find the treasures in MATLAB Central and discover how the community can help you!
Start Hunting!