How to Transform of coordinate of actors from vehicle coordinate to world coordinate or refference coordinate system (ADAS toolbox) ...?

Question

sidharth sidharth 2019년 11월 28일

0
링크

이 질문에 대한 바로 가기 링크

https://kr.mathworks.com/matlabcentral/answers/493709-how-to-transform-of-coordinate-of-actors-from-vehicle-coordinate-to-world-coordinate-or-refference-c

답변: Qu Cao 2020년 1월 16일

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;