% x = current vehicle position in ENU
% theta = current vehicle heading angle in rad (angle from E-axis in CCW)
% vx = vehicle forward velocity
% k_ld = look ahead gain
% wp = way point vetor table
% v_profile = velocity profile for each way point
% wp_idx = current way point index
% delta_d = steering angle
% v_d = velocity command
m_idx=length(wp);
d_th=5; % radius in meter
L=2.55; % Soul Length between front and rear wheel (m)
% ld = look ahead distance 3~25m
ld_min=3; % min look ahead distance = 3m
ld_max=25; % max look ahead distance = 3m
ld=k_ld*vx;
if ld>=ld_max
ld=ld_max;
elseif ld<=ld_min
ld=ld_min;
end
if wp_idx==0
wp_idx=1; % start way point index
end
wp_idx_1=wp_idx-1;
· 해피레포트는 다운로드 받은 파일에 문제가 있을 경우(손상된 파일/설명과 다른자료/중복자료 등) 1주일이내 환불요청 시 환불(재충전) 해드립니다.
(단, 단순 변심 및 실수로 인한 환불은 되지 않습니다.)
· 파일이 열리지 않거나 브라우저 오류로 인해 다운이 되지 않으면 고객센터로 문의바랍니다.
· 다운로드 받은 파일은 참고자료로 이용하셔야 하며,자료의 활용에 대한 모든 책임은 다운로드 받은 회원님에게 있습니다.
저작권안내
보고서 내용중의 의견 및 입장은 당사와 무관하며, 그 내용의 진위여부도 당사는 보증하지 않습니다.
보고서의 저작권 및 모든 법적 책임은 등록인에게 있으며, 무단전재 및 재배포를 금합니다.
저작권 문제 발생시 원저작권자의 입장에서 해결해드리고 있습니다. 저작권침해신고 바로가기