The shared control dynamic window approach for non-holonomic semi-autonomous robots
Abstract
A shared control method, called Shared Control Dynamic Window Approach, is presented. It is inspired in the Dynamic Window Approach (DWA) for autonomous mobile robots. It takes user commands by means of the control interface and provide the most suitable and kinodinamically feasible trajectory that guarantees obstacle avoidance. It provides navigation assistance to drive vehicles in unstructured environments and other scenarios where dynamic constraints play an important role . In order to keep an intuitive control for the user, the intrusiveness of the method varies gradually and proportionally with the danger of collision. Preliminary experiments with users driving vehicles in a simulated world validate the method. Its implementation is public under General Public License.
Full text
'!!! 3#"## 0 ! #! !#" .!! # # 5 5 #!7"$ ##!! !#0# #43" $ ! ! ! 8 #0 3" !#! "93# !!! # # 0" 0 !! !" .! # #" # # ! 3 5!!3 "-!!# !! :;<" 03 3! #43#12" # 0 5##:=<:><! "5 !!# " 0!! 001;2" +#08= #!03#"$ > 0! + '/. 0 ? ## " @ "5! A0B" ! "#$ /3:?<C:A<! #00# 8DE D! E D E"#0 0"30 D#E"D!E # ! ! 18 2!##5 1!"2"& D E 4!0 !"! ##4 #4!" # !" 43 #:B<:G<"H0! 0038# ##### " #4##0 !"#$!%""$ &'(+( !"#$!#+%""$ $,'(+ !"#$!%""$ '-+ !"#$!%""$ . " '/0.1'/.2#"3# #!3#4!" !!!!!0 "3!#!# !0#"50!! 0!"6"
5"! :I<!1 020 !10 #J02 !:;K<:;;< ! 0 " 03 # # ! #".00 ! "9 " 9 :;=< # " !#4 ##0 #DE DE" 9! !L!" !#!# #" D E " -:@<:;><C:;@<# 0 :@< # !#" %&'0#$03"3 " #3#4# 0$'/.4". 03# 3 ! "0 3!0 " :;A< :;B< 3 3 #0 D E" H0! # 0 ! 13 30 !2!" #03 " /3 :;G<:;I< !# 03 ! # ".03:=K< # # # , 1#2" H0!#3 53# ! ! 30 #" ( )& $'/. # 0!##! ! :=;< :==<" # 3 # ! # ! # !" D E # D !E# 03+4 "!# M #" '/.1'/0.2 # # ! " #! 38 !03 0 0!# 0 "# 30 ! ".3 ! ##0 " #0 " ! ! 0 3 0330 "N !0#70 #7" M#
#0#0 # 1 2"&#!0# 4 #" #+ # DE1=2" 1'/.2! ## # D ' /0E1=2" # ! 0 #8 "L 53 0 5"! 00 1 2"H "& 5# 08 " #0!# ". # 0# ". ! ! ## 34 # ! ! 00" 9 '/. # 03 "&# '/.# "# "# +# 0 #8 $ % $ % $ % & >00 # $ $ $ " # ! " #! "'/.# 0#00 ! " # M#00!0 " %& !8- #'/." . 00 # 3 "$ #3#4# /3 " * # !'/.08 & 1&2 L.&1L.&2"& # !0 # ! # 0"' 0! !#!3 '/.$'/." &'/.0 8# 4"$# !"& ##4".5 # & 4#"H 0+# !" # !#L.&" L.&3'/.#" H0! 1# 4 0 !2" # 0! 4 !!"'# '/. 3 "50 +# " M8/ O.0 0##! :=><"H0! !## # 5" # #5# 4"'# ! #8 !0#030#" D,&&E1,&&2 :=?< D,&HE1,H&2 :=@< 03" '/. :=A< ! , - 1,-2 :=B<+ " DNP $E :=G< 4" D4 $E:=I< $ # !" ! 0 3 #! " ! !
%& >8 !## 8 # #!"#0# 03100 2"0 12 & 1320 !" 0#0M8D/ 0 ! OE" ' " 0 8 ! # " !4 #M ##1L.&2" 5 3 12"5 !30! #03#8 =% % =% % " #0 ####1 %#; 2 ! 1 % # ; 2". !! 0 0 ;8 U K( ;( KK # 9## ! + :K;<" !##00;" &>"## 4 ! 3 " & ? 0# > 0#!05 " ;5#0! 130!0 2" + #3# $'/.#0 4#0!# 1 ;2" '/. # #" #5 #00 ; = 0""" ; 5". # " ! ! ! ) 01# 032 #8 ( ! " # 3$'/.3! "!'/. 0" $'/.#0508 !# #3!"' "+ ! # 5:>K<" #! " .#&L.& '/."##! ##"# #! 8 ; #### #'/.# M"#! !#"# #0!5 #"90; 0"8 # ; $ # $ # # ! 3 '/." $'/.# 00 !#!"H ##8 # * ' * ! # # $'/. 0#!"! 0 ! +5! 8 # / # ! # # " 0!;0 DE" . 0 $# ; = > ? ; = > ? &; &> & ?
! #" 0#"# 0!##IKQ" !# 5 0 0" 5! 38 ; # !5"#3 ## 8 /! "/ !" , -. # $'/.#!# #6 "!#M @KH+ B=6H+0 #00# =K;@ " ##+, " 3 "' #M # =K H+ 10 ;=K 2## K"K@"'5##3 0#'!" !## J " !D$E :>;<" 5 12" #0##0 #08 9$ 18JJ000""2 L! 1L2 18JJ""JJ! J2!" $5!$'/. + 0" & !" 5!#00 ##!0!!8!0 !##!00 " 0308# !!40 12R!0 $'/. " 3 " ! 50!" !0##3 0",.! !! 1;2" "$ ( . ?# ; A# = >#= ;"@ #; @K #= G#; A# = A#= > #; @K #= ;K# ; ;@# = B#= > #; @K #= -"./0#( #/ )"0! 0 !0 !01#!0!02" ;K # ! # IKQ " !00 "0!0 ! # ! 0 ?#; ;"@ # ; ".#!#0 !!0 !0"& !" 0 M31#!02 # #04 !" " 0 ! 5M" &!. 1#2# 0 " H0! # 010 2 0 ! 0 0"0 !0 !"0 !##M0 " H0!# 0 ## " 0 ! !!".#@#0# 0!3 0" # 0 # ! 0 !# 3"#03 IKQ01# I#; 2" / %$ .!!# 3!" 3!0!! "-! 0
0!#! !01! 502"0? !0 ### 00 !# " &030 ! 4" 0 3 3 #4 ! # # 0 ! 3" $& 0304, 1N=KKI;KA>IK?K=2 1N=K;=>BGAG K?K=2R # $ - # $ ! 4 6 86--! #$+#..! 1..2 S =K;; # N " :;;<"#"-"D 0!43J43! E*88:2<<<2/(/"/"/"B?>CB?GS" =KKI" :;=<X"YD.!0E=KKG" :;><."" "L",+",+D.! #E </3/=//<3=*8.8/2/(/2<<<!"=K;K" ?B;C?B?=K;K" :;?<6"-"$D.-#$ /E!"KK"=KKB" :;@<S"."Z"-"S""$! D.L8!0 E1#(.83 2<(###"=KKG" =I>C=I?" :;A<N"",N"'N"3S"S" '$D0/L!. PN!H&3E">BKAC>B;= =K;=" :;B<-"$"+0D'!#! #E*8..2<<<2/(/"/ =#">>BC>?='"=K;;" :;G<DH',!!#8E @/A##2#/!"=I"@=K;=" :;I<S"P3"L[-4,D! .'!E"-"??C?I=KK@" :=K<$".D## #!E2//B">G>C>GGS" =K;=" :=;<"$".-"D 8-3'! $#E">CA=KKI" :==<."N ##";;=="=KK?" :=><"&H".D!] 0#OE /"/!";G";K";KK;C;K=?'" =KK?" :=?<S"V"PD!## E2<<<-#/#/3/"/!";I"@" ;;BIC;;GB;IGI" :=@<V"PS"D# #!E1#/.::.2<<<2/ (/"//";>IGC;?K?;II;" :=A<'"&5/"$"D00 !E"//3/2<<<!"?";"=>C>> ;IIB" :=B<"$D!,-#9 .!!,-E$".;IIA" :=G<S"-+"-DN5!! !3 E2<<<-#/"/"&;";C;>=KKG" :=I<S"S"6++S"&+-D4 $1$28.L0$# LH-!L!E*88;2<<<?) 2(2"###=KKA" ;;I@C;=KK" :>K<"'"LD/WO/!OE" BAKCBA@=KK=" :>;<","63D J4E</</"/=KKB" :;<S"H"/D### !"E"N>I1?2AI>CBKA";IIA" :=<$",'+".+&"'+'."! '"-+DL80# 0!!E1#( 2(#=KK=!"=" BBGCBG>" :><."""&"'""S"$!6"ST+D$ $8.0 H#+/E1/(2/ $#3"#14/*6768//9".::;;IIA" :?<"""D#00E2<<<</ 3/=/3/!";?"?"?=>C?>;;II@" :@<" S"-"-"&+"TN"S"T+" $U+S""&"6 "T"." &"$!D.0+ #0!E/"#!" >K"=";BIC;IB9"=K;K" :A<"D.$/L!$E" &=K;=" :B<"V"'DH0 #!E*88>2<<<2/(/ "//">I=AC>I>;-=KKG" :G<"V"'D!# 08!##03"E2<<< -#/#/3/"/=/"/!"?=">"GBACGGS" =K;=" :I<H"D/WO/!OE2<<<2/ (//#//0//*88*"BAKCBA@ =KK=" :;K<"V"'D!H /L#'5 -!E1/3?2<<<@278>$/"/@/"- "@ICAA=KKG"