主要内容

単纯追迹コントローラー

単纯はアルゴリズムです。ロボット现在位置からロボットの前方ある前方前方注视注视点点点にに达するまでまで动かす角速度速度コマンドコマンドをを计算しします。。线形线形线形速度一定一定一定一定速度変更。次に,はロボットの现在位置にて,,パスパス上上上のの前方注视注视点ををパスパスのの最终点点まで动かし动かしますますます。ははははlookaheaddistanceはことができ。はは前方が配置される距离を决定。。。。。

控制器Pursuitオブジェクト従来のではなく,追従用の追迹アルゴリズムとしてますます。。コントローラーコントローラーははは指定指定されたたウェイウェイポイントポイントののリストリストでで一意一意ですです。。。。目的と线形速度速度速度速度车両仕様て决定されます姿势姿势(位置と向き姿势姿势姿势姿势姿势をををを入力としてとして指定する,,オブジェクトをを使用使用してロボットロボットの线形线形速度角と速度速度使用方法使用しているシステムによってためこれらこれらを指定指定するするとととロボットロボットがどのどのように运动をを実行できるできるかかを考虑lookaheaddistanceですこれに対し,パスに沿っ前方のどのの距离をを追迹追迹するするするかかを指定指定ます。このこのプロパティプロパティはは,,以下

参照座标系

単纯追迹入力出力に使用しいる座标系理解することがが重要重要ですです。以下の図にに,,参照参照参照座标系座标系[x y]座标でのコマンドの计算にます。の姿势姿势は,,点のの(theta)のののののの[x y theta]X X xのとととと方向方向,それぞれそれぞれ右上方向ですですですですですですですですですですですですですですですですですですですですですですですですですですですですののののののののの(测定し(ロボットロボット现在はは0ラジアンです)。

前方注视距离

lookaheaddistanceプロパティ,のな调整です。前方注视距离と角角速度速度コマンドコマンドををを计算计算するためにに,,ロボットロボットがが现在现在のの位置位置からからパスパスパスパスに沿っ読み取る距离距离距离距离示して。図に示すようのパスはウェイポイント同士をを直接结ぶ线线に一致ししないないないこと

こののによってロボットがを追迹する方法を変える変える。これこれににははは,,,パスのの再再再取得取得とととパスパスパスのの维持2再取得には,小さいlookaheaddistanceをする,がパス向かって速く动きます。以下以下のの図図ににに示す示すように,,ロボットロボットははパスパスををオーバーオーバーシュートシュートしし,,,,目的のに沿っ沿っ沿っ沿っには前方距离を选択ことができ。ただし,付近付近の曲率が大きく大きくなるなるますますます

lookaheaddistanceは,ロボットに合わせ合わせ调整しなければませ。またまた,线形线形线形线形速度速度と角角がが异なる异なるとと応答応答も変わるためため,コントローラーコントローラーに

制限

この単纯には注意すべきがかかますます。

  • のようコントローラーウェイポイントの间の直接パスに追従追従できるできるわけわけではありではありではありませませんパフォーマンスパフォーマンスをを最适最适化化し,,时间のの経过経过経过経过伴っててててををを收束收束收束收束收束

  • 1かロボットををををか所安定させアプリケーションアプリケーションでで目标位置位置位置の距离しきい値をを适用して,目的ののの目标

参照

[1] Coulter,R。纯追踪路径跟踪算法的实现。宾夕法尼亚州匹兹堡卡内基·梅隆大学,1990年1月。

参考

|(导航工具箱)