en
×

分享给微信好友或者朋友圈

使用微信“扫一扫”功能。
通讯作者:

史东华,E-mail:dshi@bit.edu.cn

中图分类号:TP241

文献标识码:A

文章编号:1672-6553-2022-20(3)-008-07

DOI:10.6052/1672-6553-2021-047

参考文献 1
Kuffner J J,LaValle S.RRT-connect:An efficient approv-each to single-query path planning.In:IEEE International Coinferences on Robotics and Automation,San Francisco,CA,24-28 April,2000.Piscataway:IEEE,2000:995~1001
参考文献 2
Junge O,Marsden J E,Ober-Blbaum S.Discrete mechanics and optimal control.ESAIM Control Optimisation and Calculus of Variations,2005,16(2):538~543
参考文献 3
Karaman S,Frazzoli E.Sampling-based algorithms for optimal motion planning.The International Journal of Robotics Research,2011,30(7):846~894
参考文献 4
Gammell J D,Srinivasa S S,Barfoot T D.Batch informed trees(BIT*):Sampling-based optimal planning via the heuristically guided search of implicit random geometric graphs.In:2015 IEEE International Conference on Robotics and Automation(ICRA),Seattle,2015.Piscataway:IEEE,2015:3067~3074
参考文献 5
Khatib O.Real-time obstacle avoidance for manipulators and mobile robots.The International Journal of Robotics Research,1986,5(1):90~98
参考文献 6
Chang D E,Marsden J E.Gyroscopic forces and collision avoidance with convex obstacles.In:Lecture Notes in Control and Information Sciences,2003,295:145~160
参考文献 7
Wang W,Zhu M,Wang X,et al.An improved artificial po-tential field method of trajectory planning and obstacle avoid-ance for redundant manipulators.International Journal of Advanced Robotic Systems,2018,15(5):1~13
参考文献 8
Lynch K M,Park F C.Park.Modern robotics:mechanics,planning,and control.Cambridge:Cambridge University Press,2017:269~298
参考文献 9
Kane C,Marsden J E,Ortiz M,et al.Variational integrators and the newmark algorithm for conservative and dissipative mechanical systems.International Journal for Numerical Methods in Engineering,2000,49(10):1295~1325
参考文献 10
Marsden J,West M.Discrete mechanics and variational integrators.Acta Numerica,2001,10(1):357~514
参考文献 11
白龙,戈新生.基于球摆模型的离散变分积分子算法研究.动力学与控制学报,2013,11(4):295~300;(Bai L,Ge X S.The discrete variational integrators method of the spherical pendulum.Journal of Dynamics and Control,2013,11(4):295~300(in Chinese))
参考文献 12
刘铖,胡海岩.基于李群局部标架的多柔体系统动力学建模与计算.力学学报,2021,53(1):213~233;(Liu C,Hu H Y.Dynamic modeling and calculation of flexible multibody system based on Lie group local frame.Chinese Journal of Theoretical and Applied Mechanics,2021,53(1):213~233(in Chinese))
参考文献 13
王亮,安志朋,史东华.几何精确梁的Hamel场变分积分子.北京大学学报(自然科学版),2016,52(4):692~698;(Wang L,An Z P,Shi D H.Hamel’s field variational integra-tor of geometrically exact beam.Acta Scientiarum Naturalium Universitatis Pekinensis,2016,52(4):692~698(in Chinese))
参考文献 14
An Z P,Wu H,Shi D H.Minimum-time optimal control of robotic manipulators based on Hamel’s integrators.Meccanica,2019,54(15):2521~2537
参考文献 15
Lee J,Liu C K,Park F C,et al.A linear-time variational integrator for multibody systems.In:Algorithmic Foundations of Robotics XII.Berlin:Springer,2020:352~367
参考文献 16
Brockett R W.Robotic manipulators and the product of exponentials formula.In:Fuhrmann P A ed.Mathematical Theory of Networks and Systems.Berlin:Springer,1984:120 ~129
参考文献 17
Murray R,Li Z,Sastry S.A mathematical introduction to robotic manipulation.Boca Raton:CRC Press,1994:19~ 95
参考文献 18
Michor P W.Topics in differential geometry.Washington:American Mathematical Socity,2008:54~55
参考文献 19
Chang D E,Jiménez F,Perlmutter M.Feedback integrat-ors.Journal of Nonlinear Science,2016,26(6):1693~1721
参考文献 20
Garimella G,Sheckells M,Kobilarov M.A stabilizing gyroscopic obstacle avoidance controller for underactuated systems.In:2016 IEEE International Conferenceon Decision and Control,Las Vegas,2016.Piscataway:IEEE,2016:5010 ~5016
目录contents

    摘要

    在几何力学框架下,首先,推导了开链机械臂的反馈Hamel变分积分子,其中用反馈控制算法实现了Hamel积分子的寻根; 其次,将上述算法用于计算反应规划的正向动力学,在此基础上将回转力引入传统人工势场法来设计斥力,可以克服传统人工势场法中易陷入势场局部极小的缺点,实现机械臂整臂的实时避障轨迹规划;最后,通过两个数值仿真验证了上述所提算法的有效性.

    Abstract

    In this paper, we first derive Hamel’s variational integrators for open-chain manipulators in the framework of geometric mechanics, where the roots of Hamel’s variational integrators are found by feedback control.Next, we use the above algorithm to solve a forward dynamics problem in reaction planning. As a result, the gyroscopic force is introduced to replace the repulsive force, thus avoiding the local minima dilemma of the artificial potential method, and realizing real-time obstacle avoidance for the whole manipulator. Finally, the effectiveness of the proposed algorithm is illustrated via two numerical examples.

  • 引言

  • 机械臂传统运动规划算法大致可分为路径规划和反应规划两种方式.路径规划通常由随机采样生成树、最优控制等方法得到可行或最优的避障路径,如Kuffner和LaValle等[1]提出的快速随机生成树法(Rapid Exploring Random Trees, RRT),Junge和Marsden等[2]提出的离散力学与最优控制方法 (Discrete Mechanics and Optimal Control,DMOC),以及其他学者对上述方法一系列的改进,如RRT-connect,RRT,Batch Informed Trees等[3,4].这些算法用于机械臂路径规划时存在难以实时实现,计算复杂度高等缺陷.反应规划则通常由操作空间中引入的虚拟势场产生的力实现避障,如Khatib[5]提出的人工势场法,Chang和Marsden提出的回转力方法[6],以及改进的人工势场法[7]等.这些算法主要应用于移动机器人领域.

  • 机械臂精确高效的反应规划往往要求解正向动力学问题.即在给定机械臂状态变量以及关节力或力矩的前提下确定其加速度[8].解此问题的多数方法使用Lagrange形式,并通过变分原理推导Euler-Lagrange方程,由给定初值的微分方程积分得到任意时刻的系统状态.在需长时间进行高精度控制机械臂场景中,其控制算法如何长时间保持系统守恒量,进而能定性准确地反应连续系统行为仍然是关键挑战.对于离散时间仿真,一些先进的微分方程数值算法也会因误差积累使系统产生耗散.为了解决这一问题,Kane等[9]说明了Newmark算法在某种意义上是离散力学的变分版本,可以保辛结构和动量,拥有较为出色的全局能量行为.Marsden和West[10]提出了变分积分子(VI),通过对Lagrange函数离散变分得到的离散Euler-Lagrange(DEL)方程进行求解,构造了一种应用广泛的保辛算法.在此基础上出现的李群/李代数变分积分子已应用于诸多动力学建模与控制研究中[11-14].虽然基于DEL方程的变分积分子保辛,但仍然存在一定的计算复杂性.变分积分子将动力学方程的积分转化为代数方程组寻根,计算复杂性主要体现在计算DEL方程和雅可比逆矩阵两方面.在递归动力学的启发下,Lee等[15]提出了多体系统的一种李群变分积分子,将DEL的计算转化为求解离散逆动力学问题,并借助铰接体惯性算法(Articulated Body Inertial Algorithm,ABI)近似计算雅可比逆矩阵,得到了一种计算复杂度只有O(n)的算法.

  • 通常情况下,机器人最显著的物理特征由几何来自然描述.Brockett[16]基于刚体运动的李群结构展示了如何用几何方式来描述运动链.关于用微分几何和李群语言研究机器人系统的表述参见文献[8,17].本文使用几何力学框架建立开链机械臂动力学模型并处理运动规划问题,建立了适用于开链机械臂多体系统的Hamel变分积分子,并引入反馈控制实现Hamel积分子寻根计算,使算法计算复杂度为O(n);此外将上述算法应用于反应规划的正向动力学计算,提出回转力与人工势场法的实时避障轨迹规划算法,可以克服传统人工势场法中易陷入势场局部极小的缺点.

  • 本文其余部分安排如下:首先,利用旋量理论及指数积(Product of Exponentials,POE)公式,对开链机械臂正运动学建模,并在Lagrange力学框架下推导了其递归动力学及带反馈的Hamel变分积分子;其次,将回转力引入人工势场法中,通过回转力改进势场法中的斥力,实现机械臂整臂的实时避障轨迹规划;最后,通过两个数值仿真验证了上述所提算法的有效性.

  • 1 基于POE公式的正运动学建模

  • 本节给出机械臂正运动学建模方法.

  • 若机械臂末端刚体的体坐标系{T }相对于惯性坐标系{S }的初始位形为T st(0),刚体绕螺旋轴S=(w,v)se(3)R6 (其中‖ω‖或‖v‖为1)做螺旋运动后,{T }的最终位形T st可表示为θ的指数形式:

  • Tst(θ)=eS^θTst(0)
    (1)
  • 此处,若‖ω‖=1,θ为绕螺旋轴转动的角度;‖ω‖=0,θ为沿螺旋轴移动的距离,“·^”为帽子映射,指数映射

  • eS^θeω^θI-eω^θω×v+θωωTv01,ω=1Iθv01,ω=0

  • eω^θ=I+ω^sin(θ)+ω^2(1-cos(θ))
    (2)
  • 对于ω=(ω1,ω2,ω3)T

  • ω^=0-ω3ω2ω30-ω1-ω2ω10

  • n连杆开链机械臂关节空间Q是各独立关节变量θi(1≤I n)所在空间S1n重笛卡尔积Tn.各关节螺旋运动加以组合得到机械臂末端正运动学映射Tst:QSE(3)如下[17]:

  • Tst(θ)=eS1θ1eS2θ2eSnθnTst(0)
    (3)
  • 2 开链机械臂的Hamel变分积分子

  • 为模拟开链机械臂多体系统,本节给出开链机械臂的Hamel变分积分子,通过建立在每个杆上的活动标架描述运动,并采用变分原理推导开链机械臂Hamel方程,由此得出逆动力学方程.最后将上述过程离散化,将正向动力方程的积分问题转化为DEL方程的寻根问题,并将文献[14]中得到的开链机械臂Hamel变分积分子进一步简化更新,应用于冗余机械臂路径规划与反应规划中.

  • 首先,我们通过Lagrange力学框架推导开链机械臂的递归动力学方程.考虑n连杆,关节位形θ=θ1,,θnTn.在第i个杆的质心处建立随体标架{i },记gi-1,i∈SE(3)为标架{i }相对于标架{i-1}的位姿表示,g 0,i简记为gi,则有

  • gi=gi-1gi-1,i, 且 gi-1,iθi=gi-1,i(0)eAiθi
    (4)
  • 其中Ai为标架{i }旋量轴在标架{i }中的表示,它与旋量轴Si关系满足:

  • Ai=Adgi-1(0)Si

  • ξi∈se(3)为第i杆在体坐标系下运动旋量(body twist),则有向前动力学方程:

  • ξi=TgiLgi-1g˙i=gi-1g˙i=gi-1gi-1,i-1g˙i-1gi-1,i+gi-1g˙i-1,i=Adgi-1,i-1ξi-1+Aiθ˙i
    (5)
  • ηi=TgiLgi-1δgi=gi-1δgi,则与上式推导类似有

  • ηi=Adgi-1,i-1ηi-1+Aiδθi.

  • fi为作用在标架{i }的力,驱动器只需在关节的旋量轴方向上提供标量力或力矩,则加在第i关节处的力矩

  • τi=fiTAi=AiTfi
    (6)
  • 开链机械臂的Lagrange函数为

  • l(g,ξ)=i=1n 12Iiξi,ξi-i=1n Ugi
    (7)
  • 其中,Ii为第i杆的惯性矩阵,Ugi为机械臂的势能函数.令e 3=[0,0,-9.81,0]T为惯性系下的重力矢量,则

  • Ugi=mie3,gir

  • 其中r=[0,0,0,1]T.

  • 根据Lagrange-d’Alembert原理:

  • δab l(g,ξ)dt+i=1n ab τi,δθidt=0

  • 以及变分公式[13]

  • δξ=η˙+[ξ,η]

  • 0=i=1n δab 12Iiξi,ξi-Ugidt+i=1n δab τi,θidt=i=1n ab -Iiξ˙i+ξi,Iiξi*-T*LgidUgi+fi,ηidt+i=0n-1 ab -Adgi,i+1-1*fi+1,ηidt,

  • 由于ηi的任意性,可得开链机械臂的向后动力学方程:

  • fi=ADgi,i+1-1*fi+1+Iiξ˙i-ξi,Iiξi*+T*LgidUgi
    (8)
  • 离散情形下面给出开链机械臂的Hamel变分积分子.记gik为第k时刻的第i个杆的位形,Δt为时间步长.离散时间网格如图1所示.

  • 图1 离散积分子网格

  • Fig.1 Discrete-time integrator grids

  • 引理1对于α∈[0,1],由gik+1=gikexpΔtξik+α定义对流速度ξik+α满足

  • ξik+α=Adgi-1,i-kξi-1k+α+Aiθik+1-θikΔt+O(Δt)
    (9)
  • 证明gik+1=gi-1k+1gi-1,ik+1结合ξik+α定义有

  • gikexpΔtξik+α=gi-1kexpΔtξi-1k+αgi-1,ik+1

  • expΔtξik+α=gi-1,i-kexpΔtξi-1k+αgi-1,ikgi-1,i-kgi-1,ik+1=ADgi-1,i-kexpΔtξi-1k+αe-Aiθtkgi-1,i-1(0)gi-1,i(0)eAiθlki+1=

  • expAdgi-1,i-kΔtξi-1k+αexpAiθik+1-θik

  • 由BCH公式[18]可得式(9).证毕.

  • ηik+α=αηik+1+(1-α)ηik,我们不加证明给出引理[14]:

  • 引理2 如下离散变分公式成立:

  • δξik+α=ξik+α,ηik+α+1Δtηik+1-ηik
    (10)
  • Aiδθik=ηik-Adgi-1,i-kηi-1k
    (11)
  • 记离散Lagrange函数

  • ld=Δti=1n 12Iiξik+α,ξik+α-Ugik
    (12)
  • 则有如下定理:

  • 定理1 下面陈述是等价的:

  • 1.开链机械臂的离散运动方程

  • fik=Adgi+1,ik*fi+1k-(1-α)ξik+α,Iiξik+α*-αξik-1+α,Iiξik-1+α*+1ΔtIiξik+α-1ΔtIiξik-1+α+T*LgikdUgik
    (13)
  • 成立,其中i=1,,n,k=1,,N-1.

  • 2.对于任意i,离散Lagrange-d’Alembert原理

  • δk=0N-1 ldgik+α,gik+α+k=0N-1 i=1n τik,δθik=0
    (14)
  • 成立,其中δξik+α满足式(10), ηi0=ηiN=0.

  • 证明 由引理2及离散变分原理,用边界条件ηi0=ηiN=0,及ηik,i=1,,n,k=1,,N-1的任意性可得式(13).证毕.

  • 文献[14]已有上述定理类似的陈述和证明,本文利用引理1对其进行了更新和简化.

  • 由此,我们给出开链机械臂的离散递归逆动力学算法.逆动力学方程一般用于最优控制问题中力矩约束的计算.

  • 3 Hamel方程寻根过程

  • 本节我们通过反馈控制实现Hamel积分子的寻根计算.

  • DEL方程定义了系统的离散演化过程,若已知开链机械臂广义坐标为θk,为计算下一时刻满足约束流形(13)的解θk+1,从控制观点看[15,19],可由DEL方程所得的τe=hqk,vk+1 (由算法 定义)作为反馈控制引入机械臂运动方程,若‖τe‖小于某收敛阈值ε,则将θk+1视为下一时刻满足DEL方程的解,否则可利用τe构造迭代策略更新计算θk+1直到满足DEL方程.

  • 机械臂封闭形式的动力学为

  • θ¨k=M-1θk-τe-Cθk,θ˙k-Pθk
    (15)
  • 其中, θ˙k为关节角速度,Mθk为关节空间质量矩阵,Cθk,θ˙k为科氏力、离心力等,Pθk为关节空间重力.

  • 使用二阶中心差分近似θk+1:

  • θk+1=Δt2θ¨k+2θk-θk-1,

  • k +1时刻位形的第l次迭代为θ(l)k+1,则

  • θ(l+1)k+1=Δt2M-1θk-j=0l τe(j)-Cθk,θ˙k-pθk+2θk-θk-1

  • 从而迭代更新策略为:

  • θ(l+1)k+1=θ(l)k+1-Δt2M-1θkτe(l)
    (16)
  • 此迭代过程如图2所示.

  • 图2 由反馈τe(l)进行迭代

  • Fig.2 Iteration with feedback-τe(l)

  • 4 回转力改进人工势场法

  • 直接在关节空间中设计控制律并不直观.操作空间控制的思想是在需要执行任务的操作空间中设计控制律f,由雅可比矩阵将其转化为关节空间力矩τ.

  • 由Khatib[5]提出的人工势场法常用于机器人操作空间中设计反应控制律,其关键在于将机器人放入一个虚拟的势场中,根据目标点产生的引力fatt和障碍物产生的斥力frep综合作用在机器人上实现避障目的.对机械臂而言,考虑机械臂末端位置为xe,目标点位置为xd,kp,kv为控制系数,则施加在机械臂末端的引力取为

  • fatt=-kpxe-xd-kvx˙e
    (17)
  • 为简单起见,考虑球形障碍物O,当机械臂进入避障范围(|ρ|≤ρ0),假设机械臂连杆i距离障碍物最近一点为xiR3,则施加在连杆i上的斥力

  • frep ,xi=η1|ρ|-1ρ01|ρ|2|ρ|xi
    (18)
  • 其中,η为增益项,ρxi指向障碍物最近点向量,ρ0为安全距离.

  • 若目标点对机械臂的引力与障碍物对机械臂的斥力合力为0,那么机械臂将陷入人工势场法的局部极小点.我们提出一种改进策略如下: 当机械臂进入避障范围(|ρ|≤ρ0)且ρx˙i>0,通过引入回转力取代式(18):

  • frep ,xi*=Γρ,xix˙i
    (19)
  • 其中Γ(s)为待定斜对称矩阵,有

  • Γρ,xi=kobsexparccosρx˙i|ρ|x˙i-11|ρ|11+e|ρ|-ρ0e^
    (20)
  • 这里kobs为避障系数,e=ρ^x˙i/ρ^x˙i为速度的旋转轴[20].利用

  • τ=JxTMxf
    (21)
  • 可将操作空间中的控制律转化为关节空间等效力矩,其中操作空间惯性矩阵Mx=Jx-TM(θ)Jx-1,这里Jx为与f在同一个标架下描述的雅可比矩阵.下面给出改进人工势场法算法Ⅱ:

  • 5 数值计算与分析

  • 本节我们通过平面三连杆正向动力学和四连杆反应规划两个例子验证所提算法.

  • 5.1 正向动力学

  • 考虑除重力作用外不施加额外力矩的平面三连杆,其各关节为旋转关节,每根杆杆长为0.1m,质心取在各杆的几何中心,惯性矩阵Ii =diag(1,1,1,1,1,1),i=1,2,3.初始位形θ=(0,0,0)T,重力矢量e 3=[0,0,-9.81,0]T,时间步长Δt=0.01s.将标架取在关节质心处描述动力学,采用Hamel变分积分子,式(16)中初值θ(0)k+1取为θk,ε取10-8,三连杆运动100s中各时间步寻根迭代次数及反馈误差力矩τe分别如图5(a)和图5(b)所示,由其可见:Hamel积分子寻根计算迭代数小于等于4,且τe一直保持在10-8数量级范围内.三连杆质心轨迹见图3,末端y轴轨迹如图4所示,结果表明反馈Hamel变分积分子与作为基准算法的半隐式欧拉法[8]所得轨迹轨迹基本一致.

  • 图3 三连杆各杆质心轨迹

  • Fig.3 The trajectory of the center of mass of each link of the three-link manipulator

  • 图4 三连杆末端 y 轴轨迹对比

  • Fig.4 Comparison of y position at end-effector of the three-link manipulator

  • 5.2 改进人工势场法

  • 考虑基本参数如表1所示的平面四连杆,第i杆的旋量轴Si:

  • Si=ωi-ωi×qi,i=1,,4
    (22)
  • 其中,ωi为旋转轴,qici分别为关节i及质心i的位置向量.

  • 图5 Hamel积分子寻根计算迭代次数及反馈误差力矩τe

  • Fig.5 The number of iterations of the root-finding of Hamel’s integrators and feedback errorτe

  • 表1 平面四连杆旋量参数

  • Table1 The screw axes and inertia matrix of the planar four-link manipulator

  • 平面四连杆初始位姿为

  • Tst(0)=I 4000 1
    (23)
  • 将标架取在关节质心ci处描述机械臂动力学,考虑平面四连杆整臂反应规划,用算法Ⅱ 所得仿真结果如图6所示.其中位置为(2.4, 2.2, 0)、半径为0.25的内侧圆圈表示障碍物,半径为0.75的外侧虚线圆圈外表示避障的安全区域,位置(2,3,0)的小圆圈表示目标吸引点,曲线为四连杆末端轨迹.当平面四连杆靠近障碍物时,由于传统人工势场法中目标点产生的吸引力和障碍物产生的斥力平衡而使平面四连杆陷入静止.经回转力改进,可使四连杆运动方向偏离障碍物而顺利避障,其轨迹如图6所示.结果表明相比于式(18)中的斥力形式,式(19)在一定程度上可以克服机械臂陷于势场局部极小的缺点.

  • 图6 四连杆避障

  • Fig.6 Avoidance of planar four-link manipulator

  • 6 总结与展望

  • 本文在Lagrange力学框架下推导了机械臂的递归动力学及带反馈的Hamel变分积分子,并将回转力引入传统人工势场法中改进斥力设计方式,实现机械臂整臂的实时避障轨迹规划.下一步将探究Hamel变分积分子保动量、保能量等保结构性质,并进一步构造多体系统的Hamel场变分积分子,利用场积分子分布式计算特征得到可用于实时并行计算的反应规划算法.

  • 参考文献

    • [1] Kuffner J J,LaValle S.RRT-connect:An efficient approv-each to single-query path planning.In:IEEE International Coinferences on Robotics and Automation,San Francisco,CA,24-28 April,2000.Piscataway:IEEE,2000:995~1001

    • [2] Junge O,Marsden J E,Ober-Blbaum S.Discrete mechanics and optimal control.ESAIM Control Optimisation and Calculus of Variations,2005,16(2):538~543

    • [3] Karaman S,Frazzoli E.Sampling-based algorithms for optimal motion planning.The International Journal of Robotics Research,2011,30(7):846~894

    • [4] Gammell J D,Srinivasa S S,Barfoot T D.Batch informed trees(BIT*):Sampling-based optimal planning via the heuristically guided search of implicit random geometric graphs.In:2015 IEEE International Conference on Robotics and Automation(ICRA),Seattle,2015.Piscataway:IEEE,2015:3067~3074

    • [5] Khatib O.Real-time obstacle avoidance for manipulators and mobile robots.The International Journal of Robotics Research,1986,5(1):90~98

    • [6] Chang D E,Marsden J E.Gyroscopic forces and collision avoidance with convex obstacles.In:Lecture Notes in Control and Information Sciences,2003,295:145~160

    • [7] Wang W,Zhu M,Wang X,et al.An improved artificial po-tential field method of trajectory planning and obstacle avoid-ance for redundant manipulators.International Journal of Advanced Robotic Systems,2018,15(5):1~13

    • [8] Lynch K M,Park F C.Park.Modern robotics:mechanics,planning,and control.Cambridge:Cambridge University Press,2017:269~298

    • [9] Kane C,Marsden J E,Ortiz M,et al.Variational integrators and the newmark algorithm for conservative and dissipative mechanical systems.International Journal for Numerical Methods in Engineering,2000,49(10):1295~1325

    • [10] Marsden J,West M.Discrete mechanics and variational integrators.Acta Numerica,2001,10(1):357~514

    • [11] 白龙,戈新生.基于球摆模型的离散变分积分子算法研究.动力学与控制学报,2013,11(4):295~300;(Bai L,Ge X S.The discrete variational integrators method of the spherical pendulum.Journal of Dynamics and Control,2013,11(4):295~300(in Chinese))

    • [12] 刘铖,胡海岩.基于李群局部标架的多柔体系统动力学建模与计算.力学学报,2021,53(1):213~233;(Liu C,Hu H Y.Dynamic modeling and calculation of flexible multibody system based on Lie group local frame.Chinese Journal of Theoretical and Applied Mechanics,2021,53(1):213~233(in Chinese))

    • [13] 王亮,安志朋,史东华.几何精确梁的Hamel场变分积分子.北京大学学报(自然科学版),2016,52(4):692~698;(Wang L,An Z P,Shi D H.Hamel’s field variational integra-tor of geometrically exact beam.Acta Scientiarum Naturalium Universitatis Pekinensis,2016,52(4):692~698(in Chinese))

    • [14] An Z P,Wu H,Shi D H.Minimum-time optimal control of robotic manipulators based on Hamel’s integrators.Meccanica,2019,54(15):2521~2537

    • [15] Lee J,Liu C K,Park F C,et al.A linear-time variational integrator for multibody systems.In:Algorithmic Foundations of Robotics XII.Berlin:Springer,2020:352~367

    • [16] Brockett R W.Robotic manipulators and the product of exponentials formula.In:Fuhrmann P A ed.Mathematical Theory of Networks and Systems.Berlin:Springer,1984:120 ~129

    • [17] Murray R,Li Z,Sastry S.A mathematical introduction to robotic manipulation.Boca Raton:CRC Press,1994:19~ 95

    • [18] Michor P W.Topics in differential geometry.Washington:American Mathematical Socity,2008:54~55

    • [19] Chang D E,Jiménez F,Perlmutter M.Feedback integrat-ors.Journal of Nonlinear Science,2016,26(6):1693~1721

    • [20] Garimella G,Sheckells M,Kobilarov M.A stabilizing gyroscopic obstacle avoidance controller for underactuated systems.In:2016 IEEE International Conferenceon Decision and Control,Las Vegas,2016.Piscataway:IEEE,2016:5010 ~5016

  • 参考文献

    • [1] Kuffner J J,LaValle S.RRT-connect:An efficient approv-each to single-query path planning.In:IEEE International Coinferences on Robotics and Automation,San Francisco,CA,24-28 April,2000.Piscataway:IEEE,2000:995~1001

    • [2] Junge O,Marsden J E,Ober-Blbaum S.Discrete mechanics and optimal control.ESAIM Control Optimisation and Calculus of Variations,2005,16(2):538~543

    • [3] Karaman S,Frazzoli E.Sampling-based algorithms for optimal motion planning.The International Journal of Robotics Research,2011,30(7):846~894

    • [4] Gammell J D,Srinivasa S S,Barfoot T D.Batch informed trees(BIT*):Sampling-based optimal planning via the heuristically guided search of implicit random geometric graphs.In:2015 IEEE International Conference on Robotics and Automation(ICRA),Seattle,2015.Piscataway:IEEE,2015:3067~3074

    • [5] Khatib O.Real-time obstacle avoidance for manipulators and mobile robots.The International Journal of Robotics Research,1986,5(1):90~98

    • [6] Chang D E,Marsden J E.Gyroscopic forces and collision avoidance with convex obstacles.In:Lecture Notes in Control and Information Sciences,2003,295:145~160

    • [7] Wang W,Zhu M,Wang X,et al.An improved artificial po-tential field method of trajectory planning and obstacle avoid-ance for redundant manipulators.International Journal of Advanced Robotic Systems,2018,15(5):1~13

    • [8] Lynch K M,Park F C.Park.Modern robotics:mechanics,planning,and control.Cambridge:Cambridge University Press,2017:269~298

    • [9] Kane C,Marsden J E,Ortiz M,et al.Variational integrators and the newmark algorithm for conservative and dissipative mechanical systems.International Journal for Numerical Methods in Engineering,2000,49(10):1295~1325

    • [10] Marsden J,West M.Discrete mechanics and variational integrators.Acta Numerica,2001,10(1):357~514

    • [11] 白龙,戈新生.基于球摆模型的离散变分积分子算法研究.动力学与控制学报,2013,11(4):295~300;(Bai L,Ge X S.The discrete variational integrators method of the spherical pendulum.Journal of Dynamics and Control,2013,11(4):295~300(in Chinese))

    • [12] 刘铖,胡海岩.基于李群局部标架的多柔体系统动力学建模与计算.力学学报,2021,53(1):213~233;(Liu C,Hu H Y.Dynamic modeling and calculation of flexible multibody system based on Lie group local frame.Chinese Journal of Theoretical and Applied Mechanics,2021,53(1):213~233(in Chinese))

    • [13] 王亮,安志朋,史东华.几何精确梁的Hamel场变分积分子.北京大学学报(自然科学版),2016,52(4):692~698;(Wang L,An Z P,Shi D H.Hamel’s field variational integra-tor of geometrically exact beam.Acta Scientiarum Naturalium Universitatis Pekinensis,2016,52(4):692~698(in Chinese))

    • [14] An Z P,Wu H,Shi D H.Minimum-time optimal control of robotic manipulators based on Hamel’s integrators.Meccanica,2019,54(15):2521~2537

    • [15] Lee J,Liu C K,Park F C,et al.A linear-time variational integrator for multibody systems.In:Algorithmic Foundations of Robotics XII.Berlin:Springer,2020:352~367

    • [16] Brockett R W.Robotic manipulators and the product of exponentials formula.In:Fuhrmann P A ed.Mathematical Theory of Networks and Systems.Berlin:Springer,1984:120 ~129

    • [17] Murray R,Li Z,Sastry S.A mathematical introduction to robotic manipulation.Boca Raton:CRC Press,1994:19~ 95

    • [18] Michor P W.Topics in differential geometry.Washington:American Mathematical Socity,2008:54~55

    • [19] Chang D E,Jiménez F,Perlmutter M.Feedback integrat-ors.Journal of Nonlinear Science,2016,26(6):1693~1721

    • [20] Garimella G,Sheckells M,Kobilarov M.A stabilizing gyroscopic obstacle avoidance controller for underactuated systems.In:2016 IEEE International Conferenceon Decision and Control,Las Vegas,2016.Piscataway:IEEE,2016:5010 ~5016

  • 微信公众号二维码

    手机版网站二维码