9
.A0!
%
!*
%?
":#
(! "8# "8#
%%
@?
";#
1
! !
!
!
% !
! !
)!
%
3. Control system design
! !
) !
!
BC) D!
% 6 $ %
!
)
$
% =$> !
&
%
Fig.3.$
)
3.1 Trajectory re-planning control algorithm
based on MPC
!
!
$
!3
$ % %
(1) Selection of reference trajectory point
!
%
) )
!
$.E0
!
!
!
!!
%
$!.E0!
)!%
8
Fig.4.9
%8!%%
! % %
!
'8
%3
6
C/
(2) Design of obstacle avoidance function
9 !
1