CN103213129B - 一种空间机械臂位置力混合控制方法 - Google Patents

一种空间机械臂位置力混合控制方法 Download PDF

Info

Publication number
CN103213129B
CN103213129B CN201310134201.6A CN201310134201A CN103213129B CN 103213129 B CN103213129 B CN 103213129B CN 201310134201 A CN201310134201 A CN 201310134201A CN 103213129 B CN103213129 B CN 103213129B
Authority
CN
China
Prior art keywords
des
space
joint angle
force
planning
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201310134201.6A
Other languages
English (en)
Other versions
CN103213129A (zh
Inventor
葛东明
邹元杰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Spacecraft System Engineering
Original Assignee
Beijing Institute of Spacecraft System Engineering
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Spacecraft System Engineering filed Critical Beijing Institute of Spacecraft System Engineering
Priority to CN201310134201.6A priority Critical patent/CN103213129B/zh
Publication of CN103213129A publication Critical patent/CN103213129A/zh
Application granted granted Critical
Publication of CN103213129B publication Critical patent/CN103213129B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Feedback Control In General (AREA)
  • Manipulator (AREA)

Abstract

一种空间机械臂位置力混合控制方法,是一种笛卡尔空间和关节空间相结合的双回路控制方法。相比于基于整体模型的传统控制方法存在的过渡过程振荡和算法复杂性问题,本发明将位置/力混合控制问题分解为笛卡尔空间的规划问题和关节空间的控制问题,给出笛卡尔空间到关节空间的位置/力运动学规划和关节空间的动力学控制,组成内外回路控制系统,实现对机械臂末端自由空间的位置控制和受环境约束空间的接触力控制。对7自由度冗余机械臂的仿真结果证实了方法简单、有效、易于工程实现。

Description

一种空间机械臂位置力混合控制方法
技术领域
本发明涉及一种空间机械臂位置力混合控制方法,可为我国载人三期机械臂工程提供技术支持。
背景技术
空间机械臂研制是我国未来空间站项目成败的核心技术之一,其工程设计要求十分苛刻,涉及众多亟需攻关解决的关键技术。机械臂在空间站系统中发挥着重要作用,承担着舱段捕获与转移、仪器设备转移与安装、辅助航天员作业等多种功能。由于空间机械臂是一个复杂的动力学系统,呈现变质量、变结构、大柔性、强非线性、强耦合的复杂动力学特性,无论从动力学建模还是控制系统设计都给设计师带来很大的挑战。机械臂完成任务操作有两种基本模式:在自由空间的位置控制和被环境约束时的力控制。在实际工程中往往需要同时执行自然约束和人工约束控制这两种基本模式,此时,位置控制与力控制组成一个有机整体,这类位置控制和力控制融合在一起的控制问题即为位置/力混合控制问题。这类混合工作模式的控制相对于基本模式控制要困难得多,国内外的研究也不成熟。
机械臂单独的力控制方法包括刚度控制、阻抗控制和直接力控制等方法。Raibert和Craig首先提出位置/力混合反馈控制,代表性的有,Khabib提出了基于任务空间模型的控制方法,Yoshikawa提出了基于动力学模型和末端约束超平面描述的动态控制方法,McClamroch给出了机械臂受限动力学模型的镇定条件和闭环特性,关于混合控制的稳定性问题,Doulgeri讨论了运动学坐标变换引出的运动学失稳问题,An讨论了机械臂动力学与环境接触力动力学耦合引出的动力学失稳问题。邱志成和谈大龙提出利用加速度反馈,处理位置控制到力控制过渡时存在的冲击、震荡、不稳定等问题。机械臂力控制的主要难点在于笛卡尔空间的接触力模型与关节空间的动力学模型是非线性对应关系,特对是对于冗余自由度机械臂,是复射关系,造成难以将模型处理为从关节空间控制力矩输入到笛卡尔空间力输出的统一模型。然而,目前的控制方法大都是将运动学模型和动力学模型作为整体处理,给出基于物理概念的控制律,但没有补偿动力学特性,存在过渡过程振荡和稳定性问题;给出基于模型推导的控制律,但存在如雅克比矩阵导数项难以求解的算法问题,且计算量过大而难以应用。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提供一种空间机械臂位置力混合控制方法,将位置/力混合控制问题分解为笛卡尔空间的规划问题和关节空间的控制问题,给出笛卡尔空间到关节空间的位置/力运动学规划和关节空间的动力学控制,组成内外回路控制系统,实现对机械臂末端自由空间的位置控制和受环境约束空间的接触力控制。针对7自由度冗余机械臂的仿真结果,验证了方法的有效性和实用性。
本发明的技术解决方案是:
一种空间机械臂位置力混合控制方法,步骤如下:
(1)建立机械臂动力学模型为其中,q∈Rn为关节角,分别为q的二阶导数和一阶导数,M(q)∈Rn×n为关节空间的惯性矩阵,为离心力和科氏力耦合效应,τ∈Rn为关节驱动力矩,F∈R6为机械臂末端在笛卡儿空间的广义力,环境自由度n>6,冗余自由度为n-6,J(q)∈R6×n为雅克比矩阵;
(2)通过位置和力运动规划算法得到机械臂末端从笛卡尔空间到关节空间的逆向运动学结果,该逆向运动学结果即为关节角指令;
(3)通过关节角运动控制算法进行机械臂动力学特性的补偿,实现对所述关节角指令的跟踪控制;
(4)由机械臂动力学模型、位置和力运动规划算法以及关节角运动控制算法组成内外回路位置/力混合控制系统,实现对所述空间机械臂位置力混合控制。
所述位置和力运动规划算法具体为:
(2.1)令设置为被控对象;
(2.2)假设雅克比矩阵J(q)是行满秩的,即机械臂处于非奇异位形,令ux=J+(q)Kx(xdes-x),其中Kx∈R6×6是正定对角增益矩阵,J+(q)为雅克比矩阵的广义逆,J+(q)=JT(q)(J(q)JT(q))-1,xdes∈R6为期望末端位姿,x为机械臂末端在笛卡尔空间的位姿,有x=[x,y,z,φ,θ,ψ]T,其中[x,y,z]T为位置,[φ,θ,ψ]T为姿态;
(2.3)由公式可以得到位置规划方程
(2.4)根据机械臂运动的低动态特性,忽略公式中的小量动态项,简化为F=KtEx;其中,Mt,Bt,Kt∈R6×6为正定对角矩阵,分别代表环境惯性、阻尼和刚度,Ex=x-xr其中xr为接触点标称轨迹,包括机械臂末端位置和姿态;
(2.5)对式F=KtEx两边取导,得将雅克比矩阵关系式 x · = J ( q ) q · 代入得 F · = K t E · x = K t J ( q ) q · , 重新定义控制量 q · = J + ( q ) u f , 得到 F · = K t J ( q ) q · = K t u f ;
(2.6)针对线性系统令uf=Kf(Fdes-F),将其代入得到力规划方程其中Kf∈R6×6是正定对角增益矩阵,Fdes∈R6是期望接触力;
(2.7)位置规划方程 q · = J + ( q ) K x ( x des - x ) 和力规划方程 q · = J + ( q ) K f ( F des - F ) 即为机械臂末端从笛卡尔空间到关节空间的逆向运动学结果。
所述关节角运动控制算法具体为:
(3.1)针对机械臂关节空间的动力学模型定义新的控制输入uq∈Rn,对其非线性状态反馈补偿得到控制方程
(3.2)针对式 q · · = u q , 设计PD控制律 u q = q · · des + K d ( q · des - q · ) + K p ( q des - q ) , 其中qdes∈Rn为运动规划关节角,为运动规划关节角速度,为运动规划关节角加速度,Kp∈Rn×n为比例增益矩阵,Kd∈Rn×n为微分增益矩阵;
(3.3)将 u q = q · · des + K d ( q · des - q · ) + K p ( q des - q ) 代入式 τ = M ( q ) u q + C ( q , q · ) q · + J T ( q ) F , 即得到控制律为 τ = M ( q ) ( q · · des + K d ( q · des - q · ) + K p ( q des - q ) ) + C ( q , q · ) q · + J T ( q ) F .
位置/力混合控制系统具体为:
(4.1)将位置规划方程 q · = J + ( q ) K x ( x des - x ) 和力规划方程 q · = J + ( q ) K f ( F des - F ) 组成位置/力规划外回路,利用所述位置规划方程和力规划方程将自由空间的期望末端位姿xdes和期望接触力Fdes统一规划为关节角命令,利用位姿x和接触力F,计算得到关节角qdes、关节角速度和关节角加速度作为关节角控制内回路指令;
(4.2)将关节角控制律 τ = M ( q ) ( q · · des + K d ( q · des - q · ) + K p ( q des - q ) ) + C ( q , q · ) q · + J T ( q ) F 组成关节角内回路,将外回路计算得到的关节角信息qdes作为输入指令,利用机械臂模型得到的关节角q和角速度作为反馈量,实现对外回路指令的跟踪控制。
本发明与现有技术相比的优点在于:
1)将位置/力混合控制问题分解为笛卡尔空间的规划问题和关节空间的控制问题,给出笛卡尔空间到关节空间的位置/力运动学规划和关节空间的动力学控制,组成内外回路位置力混合控制系统。
2)相比于基于整体模型的传统控制方法存在的过渡过程振荡和方法复杂性问题,此位置力混合控制方法物理意义清晰,能够实现从位置约束到力约束平缓稳定的过渡,且位置/力混合控制跟踪精确,计算简单,便于工程实现。
附图说明
图1为本发明方法流程图;
图2为本发明位置/力混合控制原理图;
图3为本发明机械臂Matlab模型图;
图4为机械臂末端位置x曲线图;
图5为机械臂末端位置y曲线图;
图6为机械臂末端位置Z曲线图;
图7为机械臂末端接触力Fx曲线图;
图8为机械臂末端接触力Fy曲线图;
图9为机械臂末端接触力Fz曲线图;
图10为机械臂末端姿态滚动角曲线图;
图11为机械臂末端姿态俯仰角曲线图;
图12为机械臂末端姿态偏航角曲线图;
图13为机械臂末端接触力矩Mx曲线图;
图14为机械臂末端接触力矩My曲线图;
图15为机械臂末端接触力矩Mz曲线图。
具体实施方式
整个发明的实施流程见图1。具体实施方式详述如下:
(1)建立机械臂动力学模型
考虑一个n自由度冗余空间机械臂,其多刚体动力学方程在关节空间描述为
M ( q ) q · · + C ( q , q · ) q · = τ - - - ( 1 )
其中M(q)∈Rn×n为关节空间的惯性矩阵,为离心力和科氏力耦合效应,τ∈Rn为关节驱动力矩,自由度n>6,冗余自由度为n-6。当机械臂末端与环境接触时,其受限动力学方程描述为
M ( q ) q · · + C ( q , q · ) q · = τ - τ e - - - ( 2 )
其中τe为机械臂在笛卡尔空间的末端接触力作用在关节处的等效力矩。
定义机械臂末端在笛卡尔空间的位姿x=[x,y,z,φ,θ,ψ]T其中[x,y,z]T为位置,[φ,θ,ψ]T为姿态。由运动学关系,末端位姿与关节角之间满足以下代数方程
x=x(q)    (3)
对式(3)两边取导,得机械臂末端笛卡儿空间运动速度与关节空间运动速度的关系
x · = Σ i = 1 6 Σ j = 1 n ∂ x i ∂ q j q · j = J ( q ) q · - - - ( 4 )
其中J(q)∈R6×n为雅克比矩阵,代表关节空间速度向笛卡儿空间速度的传动比。
建立笛卡儿空间的环境力与关节空间的驱动力矩之间的静力变换,根据虚功等价原理,得
FTδx=τTδq    (5)
其中F∈R6为机械臂末端在笛卡儿空间的广义力,包括力和力矩,由式(4)得
τ=JT(q)F    (6)
那么,式(2)中的等效力矩τe=JTF。机械臂末端与环境之间的接触力具有如下动态特性
M t E · · x + B t E · x + K t E x = F - - - ( 7 )
其中Mt,Bt,Kt∈R6×6为正定对角矩阵,分别代表环境惯性、阻尼和刚度,Ex定义如下
Ex=x-xr    (8)
其中xr为接触点标称轨迹,包括机械臂末端位置和姿态。Ex描述了机械臂末端与环境物体之间的嵌入深度,式(7)描述了机械臂末端位姿与环境作用力之间的动态关系。
(2)设计位置和力运动规划方法
运动规划解决机械臂末端从笛卡尔空间到关节空间的逆向运动学求解问题,即给定末端位置和力控制要求,求解一组关节角和角速度,用于驱动关节空间控制系统。文本选择在速度水平上,利用雅克比矩阵,将运动规划问题转换为控制问题,给出闭环运动规划方法。
考虑位置规划,令考虑方程(4)为被控对象
x · = J ( q ) u x - - - ( 9 )
假设雅克比矩阵J(q)是行满秩的,即机械臂处于非奇异位形,令
ux=J+(q)Kx(xdes-x)    (10)
其中Kx∈R6×6是正定对角增益矩阵,J+(q)为雅克比矩阵的广义逆,当J(q)行满秩时,J+(q)=JT(q)(J(q)JT(q))-1是线性方程组(4)的最小范数解,xdes∈R6为期望末端位姿。代入式(9),得一阶闭环动态特性
x · = K x ( x des - x ) - - - ( 11 )
最终,得到位置规划方程
q · = J + ( q ) K x ( x des - x ) - - - ( 12 )
考虑力规划,由于机械臂运动的低动态特性,忽略式(7)中的小量动态项,简化为
F=KtEx    (13)
对式(13)两边取导,得
F · = K t E · x = K t x · - - - ( 14 )
利用雅克比矩阵关系式(4),代入式(14)得
F · = K t E · x = K t J ( q ) q · - - - ( 15 )
重新定义控制量
F · = K t E · x = K t u f - - - ( 16 )
针对线性系统(16),令
uf=Kf(Fdes-F)    (17)
其中Kf∈R6×6是正定对角增益矩阵,Fdes∈R6是期望接触力。代入式(16),得一阶闭环动态特性
F · + K t K f F = K t K f F des - - - ( 18 )
最终,得到力规划方程
q · = J + ( q ) K f ( F des - F ) - - - ( 19 )
(3)设计关节角运动控制方法
运动控制解决机械臂动力学特性的补偿问题,提供良好的动态特性和稳定性,实现对位置和力规划给出的关节角指令的快速、精确跟踪控制。本文选择在关节空间,将机械臂耦合项和非线性项考虑在控制律中,采用非线性控制加以补偿和解耦,给出运动控制方法。
考虑机械臂关节空间的动力学模型(2),定义新的控制输入uq∈Rn,对其非线性状态反馈补偿
τ = M ( q ) u q + C ( q , q · ) q · + J T ( q ) F - - - ( 20 )
将式(2)中的惯性矩阵、离心力和科氏力项、接触力等效力矩补偿掉,得到如下控制方程
q · · = u q - - - ( 21 )
方程(21)为非线性补偿后的线性解耦系统。针对式(21),设计如下PD控制律
u q = q · · des + K d ( q · des - q · ) + K p ( q des - q ) - - - ( 22 )
其中qdes∈Rn为运动规划关节角,为运动规划关节角速度、为运动规划关节角加速度,Kp∈Rn×n为比例增益矩阵,Kd∈Rn×n为微分增益矩阵。通常按照典型二阶环节选择Kp和Kd为如下形式
K p = diag ( ω 1 2 , ω 2 2 , . . . , ω n 2 ) - - - ( 23 )
Kd=diag(2ξ1ω1,2ξ2ω2,…,2ξnωn)    (24)
其中ωi为第i个通道的带宽,ξi为第i个通道的阻尼比。定义跟踪误差
e=qdes-q    (25)
则由式(2),式(20)和式(22)二阶闭环动态特性
e · · + K d e · + K p e = 0 - - - ( 26 )
最终获得的控制律为
τ = M ( q ) ( q · · des + K d ( q · des - q · ) + K p ( q des - q ) ) + C ( q , q · ) q · + J T ( q ) F - - - ( 27 )
(4)组成位置力混合控制方法
由(1)给出的机械臂动力学模型,(2)所给出的运动规划方法、和(3)给出的运动控制方法,组成内外回路位置/力混合控制系统,如图2所示。具体为:位置/力混合控制系统具体为:
(4.1)将位置规划方程和力规划方程组成位置/力规划外回路,利用所述位置规划方程和力规划方程将自由空间的期望末端位姿xdes和期望接触力Fdes统一规划为关节角命令,利用位姿x和接触力F,计算得到关节角qdes、关节角速度和关节角加速度,作为关节角控制内回路指令;
(4.2)将关节角控制律 τ = M ( q ) ( q · · des + K d ( q · des - q · ) + K p ( q des - q ) ) + C ( q , q · ) q · + J T ( q ) F 组成关节角内回路,将外回路计算得到的关节角信息qdes作为输入指令,利用机械臂模型得到的关节角q和角速度作为反馈量,实现对外回路指令的跟踪控制。
工作过程描述:机械臂开始工作时常为位置控制,即机械臂末端按照指令要求沿目标轨迹和给定速度运动。当末端与环境接触时,安装在机械臂末端上的力传感器探测到接触的发生,图2中的规划回路将受环境约束自由度由位置规划切换为力规划,即在环境约束方向进行接触力柔顺控制,在自由方向进行人为的位姿控制,实现位置/力混合控制。应用中,图2规划回路中的切换器后可以串联滤波器,保证切换信号的连续性和光滑性。
(5)仿真算例
为了验证所给出的位置/力混合控制方法的合理性和有效性,首先利用Matlab的Robotics Toolbox建立7自由度冗余机械臂的多刚体动力学模型,如图3所示。机械臂初始关节角和关节角速度均为零,所对应的机械臂末端初始位姿为x0=[8.14m,1.42m,1.605m,0°,0°,0°]T
仿真时间为100s,机械臂处于自由运动状态,首先控制机械臂末端从初始位姿运动到期望位姿xdes=[5m,2m,3m,10°,-10°,10°]T,假设在末端坐标系x,y轴平动自由度和z轴转动自由度存在环境约束,即在x<7.64m,y>1.92m,ψ>5°时产生接触力和力矩,期望接触力和力矩为Fx=-5N,Fy=5N,Mz=5N·m,当产生接触力时,在环境约束方向位置规划转换为力规划,在自由方向仍为位置规划,如图1所示。仿真结果如图4-15所示,可以看出,在受环境约束自由度方向的接触力产生时,位置控制平缓稳定过渡到力控制,且稳定在期望值附近,在自由方向继续进行位置控制,实现对参考轨迹的精确跟踪。

Claims (2)

1.一种空间机械臂位置力混合控制方法,其特征在于步骤如下:
(1)建立机械臂动力学模型为其中,q∈Rn为关节角,分别为q的二阶导数和一阶导数,M(q)∈Rn×n为关节空间的惯性矩阵,为离心力和科氏力耦合效应,τ∈Rn为关节驱动力矩,F∈R6为机械臂末端在笛卡儿空间的广义力,环境自由度n>6,冗余自由度为n-6,J(q)∈R6×n为雅克比矩阵;
(2)通过位置和力运动规划算法得到机械臂末端从笛卡尔空间到关节空间的逆向运动学结果,该逆向运动学结果即为关节角指令;
(3)通过关节角运动控制算法进行机械臂动力学特性的补偿,实现对所述关节角指令的跟踪控制;
(4)由机械臂动力学模型、位置和力运动规划算法以及关节角运动控制算法组成内外回路位置/力混合控制系统,实现对所述空间机械臂位置力混合控制;
所述位置和力运动规划算法具体为:
(2.1)令设置为被控对象;
(2.2)假设雅克比矩阵J(q)是行满秩的,即机械臂处于非奇异位形,令ux=J+(q)Kx(xdes-x),其中Kx∈R6×6是正定对角增益矩阵,J+(q)为雅克比矩阵的广义逆,J+(q)=JT(q)(J(q)JT(q))-1,xdes∈R6为期望末端位姿,x为机械臂末端在笛卡尔空间的位姿,有其中[x,y,z]T为位置,为姿态;
(2.3)由公式得到位置规划方程
(2.4)根据机械臂运动的低动态特性,忽略公式中的小量动态项,简化为F=KtEx;其中,Mt,Bt,Kt∈R6×6为正定对角矩阵,分别代表环境惯性、阻尼和刚度,Ex=x-xr,其中xr为接触点标称轨迹,包括机械臂末端位置和姿态;
(2.5)对式F=KtEx两边取导,得将雅克比矩阵关系式代入得 F . = K t E . x = K t J ( q ) q . , 重新定义控制量 q . = J + ( q ) u f , 得到 F . = K t J ( q ) q . = K t u f ;
(2.6)针对线性系统令uf=Kf(Fdes-F),将其代入得到力规划方程其中Kf∈R6×6是正定对角增益矩阵,Fdes∈R6是期望接触力;
(2.7)位置规划方程和力规划方程即为机械臂末端从笛卡尔空间到关节空间的逆向运动学结果;
所述关节角运动控制算法具体为:
(3.1)针对机械臂关节空间的动力学模型定义新的控制输入uq∈Rn,对其非线性状态反馈补偿得到控制方程
(3.2)针对式设计PD控制律其中qdes∈Rn为运动规划关节角,为运动规划关节角速度,为运动规划关节角加速度,Kp∈Rn×n为比例增益矩阵,Kd∈Rn×n为微分增益矩阵;
(3.3)将 u q = q . . des + K d ( q . des - q . ) + K p ( q des - q ) 代入式 &tau; = M ( q ) u q + C ( q , q . ) q . + J T ( q ) F , 即得到控制律为 &tau; = M ( q ) ( q . . des + K d ( q . des - q . ) + K p ( q des - q ) ) + C ( q , q . ) q . + J T ( q ) F .
2.根据权利要求1所述的一种空间机械臂位置力混合控制方法,其特征在于:位置/力混合控制系统具体为:
(4.1)将位置规划方程和力规划方程组成位置/力规划外回路,利用所述位置规划方程和力规划方程将自由空间的期望末端位姿xdes和期望接触力Fdes统一规划为关节角命令,利用位姿x和接触力F,计算得到关节角qdes、关节角速度和关节角加速度作为关节角控制内回路指令;
(4.2)将关节角控制律 &tau; = M ( q ) ( q . . des + K d ( q . des - q . ) + K p ( q des - q ) ) + C ( q , q . ) q . + J T ( q ) F 组成关节角内回路,将外回路计算得到的关节角信息qdes作为输入指令,利用机械臂模型得到的关节角q和角速度作为反馈量,实现对外回路指令的跟踪控制。
CN201310134201.6A 2013-04-17 2013-04-17 一种空间机械臂位置力混合控制方法 Active CN103213129B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310134201.6A CN103213129B (zh) 2013-04-17 2013-04-17 一种空间机械臂位置力混合控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310134201.6A CN103213129B (zh) 2013-04-17 2013-04-17 一种空间机械臂位置力混合控制方法

Publications (2)

Publication Number Publication Date
CN103213129A CN103213129A (zh) 2013-07-24
CN103213129B true CN103213129B (zh) 2015-04-22

Family

ID=48811451

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310134201.6A Active CN103213129B (zh) 2013-04-17 2013-04-17 一种空间机械臂位置力混合控制方法

Country Status (1)

Country Link
CN (1) CN103213129B (zh)

Families Citing this family (32)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104626152B (zh) * 2013-11-14 2016-08-31 沈阳新松机器人自动化股份有限公司 工业机器人主动柔顺控制方法及装置
CN105313119B (zh) * 2014-07-15 2020-05-19 科德数控股份有限公司 工业机器人的5 轴6 轴混合控制方法及其系统
CN104325460B (zh) * 2014-10-15 2016-05-25 天津航天机电设备研究所 多关节空间机械臂微低重力模拟方法
CN105234930B (zh) * 2015-10-15 2017-05-24 哈尔滨工程大学 基于构形平面的冗余机械臂运动控制方法
CN105320142B (zh) * 2015-11-17 2018-01-16 西北工业大学 一种三自由度遥操作绝对稳定控制方法
CN105404156B (zh) * 2015-12-31 2018-02-06 微创(上海)医疗机器人有限公司 触觉反馈装置及其变阻尼控制方法和应用
WO2017132905A1 (zh) * 2016-02-03 2017-08-10 华为技术有限公司 控制运动系统的方法和装置
CN105563489B (zh) * 2016-03-01 2018-08-17 浙江工业大学 基于非线性自抗扰控制技术的柔性机械臂控制方法
CN106346480B (zh) * 2016-11-17 2018-09-21 贵州大学 一种基于ug和matlab的多自由度注塑机械臂建模方法
CN106777475B (zh) * 2016-11-17 2019-11-26 贵州大学 一种有限空间约束的注塑机械臂动力学协同仿真方法
CN107009363A (zh) * 2017-06-09 2017-08-04 微创(上海)医疗机器人有限公司 医疗机器人及其控制方法
CN107414827B (zh) * 2017-07-25 2021-01-26 电子科技大学 基于线性反馈控制器的六自由度机械臂自适应检测方法
CN107253195B (zh) * 2017-07-31 2018-02-09 中南大学 一种运载机器人手臂操控自适应混合学习映射智能控制方法及系统
CN107414830B (zh) * 2017-07-31 2018-03-23 中南大学 一种运载机器人手臂操控多层映射智能控制方法及系统
CN107932506B (zh) * 2017-11-15 2020-10-16 电子科技大学 一种力反馈双边遥操作稳定控制方法
CN108161940B (zh) * 2018-02-26 2020-11-03 哈尔滨工业大学 利用空间机械手操作系统实现人机协同拧松螺钉操作方法
CN108453732B (zh) * 2018-02-27 2020-07-14 北京控制工程研究所 控制体系封闭机器人自适应动态力/位置混合控制方法
CN109015658B (zh) * 2018-09-20 2021-10-08 北京邮电大学 一种用于捕获翻滚目标的空间双臂机器人控制方法
CN109434829B (zh) * 2018-11-07 2022-07-29 华侨大学 一种立体石雕机器人加工系统的变形预测及补偿方法
CN109483541B (zh) * 2018-11-22 2020-09-04 浙江大学 一种基于分解速度规划算法的移动物体抓取方法
CN110561425B (zh) * 2019-08-21 2021-02-19 哈尔滨工业大学(深圳) 绳索驱动的柔性机器人力位混合控制方法及系统
CN110653801B (zh) * 2019-09-30 2022-06-17 哈尔滨工业大学 机器人操作臂的导引操纵系统及其柔顺操纵控制与示教学习方法
CN111360838B (zh) * 2020-04-24 2022-10-21 腾讯科技(深圳)有限公司 一种机械臂控制方法、装置、机械臂及存储介质
CN112060094B (zh) * 2020-09-11 2022-02-15 浙大宁波理工学院 基于阻抗控制的机械臂控制方法
CN112091991A (zh) * 2020-09-16 2020-12-18 哈尔滨工业大学 一种基于ros的打磨机械臂控制系统
CN112077851B (zh) * 2020-09-17 2021-06-25 南京埃斯顿自动化股份有限公司 一种基于混合空间的工业机器人过渡轨迹规划方法
CN112799303B (zh) * 2021-01-06 2022-06-10 西安电子科技大学 一种机械臂的h∞控制方法
CN113814978B (zh) * 2021-09-30 2022-09-16 深圳市优必选科技股份有限公司 机器人控制方法、装置、机器人及存储介质
CN113954070B (zh) * 2021-10-27 2023-05-02 苏州艾利特机器人有限公司 机械臂运动控制方法、装置、存储介质及电子设备
CN114714348B (zh) * 2022-03-17 2024-01-02 浙江大学 一种工业机器人绝对定位精度提高方法
CN115998446A (zh) * 2022-12-07 2023-04-25 杭州迪视医疗生物科技有限公司 一种具有重力补偿的眼科手术用主控摇杆
CN116985145B (zh) * 2023-09-26 2023-12-29 西北工业大学太仓长三角研究院 基于力位混合控制的冗余偏置机械臂末端柔顺控制方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5414799A (en) * 1987-04-06 1995-05-09 California Institute Of Technology Method and apparatus for adaptive force and position control of manipulators
US5767648A (en) * 1996-04-19 1998-06-16 Massachusetts Institute Of Technology Base force/torque sensor apparatus for the precise control of manipulators with joint friction and a method of use thereof
CN102448683A (zh) * 2009-07-02 2012-05-09 松下电器产业株式会社 机器人、机器人手臂的控制装置及机器人手臂的控制程序

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0245806A (ja) * 1988-08-08 1990-02-15 Hitachi Constr Mach Co Ltd 多自由作業機械の位置と力の制御装置
WO2012124342A1 (ja) * 2011-03-17 2012-09-20 パナソニック株式会社 ロボット、ロボットの制御装置、制御方法、及び制御プログラム

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5414799A (en) * 1987-04-06 1995-05-09 California Institute Of Technology Method and apparatus for adaptive force and position control of manipulators
US5767648A (en) * 1996-04-19 1998-06-16 Massachusetts Institute Of Technology Base force/torque sensor apparatus for the precise control of manipulators with joint friction and a method of use thereof
CN102448683A (zh) * 2009-07-02 2012-05-09 松下电器产业株式会社 机器人、机器人手臂的控制装置及机器人手臂的控制程序

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
"两种具有动力学补偿的机器人位置/力混合控制器";刘美华等;《国防科技大学学报》;19890831;第11卷(第1期);第42-49页 *
"机械臂的位置与力的混合控制方法";程勉;《自动化学报》;19910930;第17卷(第5期);第524-530页 *
"漂浮基柔性空间机械臂关节运动增广变结构控制及柔性振动主动抑制";洪昭斌等;《工程力学》;20110131;第28卷(第1期);第219-225页 *

Also Published As

Publication number Publication date
CN103213129A (zh) 2013-07-24

Similar Documents

Publication Publication Date Title
CN103213129B (zh) 一种空间机械臂位置力混合控制方法
CN102795544B (zh) 基于轨迹在线规划的桥式吊车高效消摆控制方法
Wu et al. Nonlinear energy-based regulation control of three-dimensional overhead cranes
Hu et al. Coordinated adaptive robust contouring controller design for an industrial biaxial precision gantry
CN103399986B (zh) 基于微分几何的空间机械臂建模方法
CN102848391A (zh) 基于真实力反馈的四通道双边遥操作控制系统
CN107065564A (zh) 一种基于自抗扰的中性浮力机器人姿态与轨迹控制方法
CN103869704A (zh) 基于扩展雅克比矩阵的空间机器人星臂协调控制方法
Li et al. Network-based coordinated motion control of large-scale transportation vehicles
Ma et al. Fractional-order adaptive integral hierarchical sliding mode control method for high-speed linear motion of spherical robot
CN106976804A (zh) 双摆吊车能耗最优轨迹规划方法
CN114779799B (zh) 基于扩张干扰观测器的柔性航天器姿轨跟踪控制方法
McCourt et al. Autonomous robotic capture of a satellite using constrained predictive control
Peng et al. Research on hover control of AUV uncertain stochastic nonlinear system based on constructive backstepping control strategy
Zhao et al. Backstepping designed sliding mode control for a two-axis tracking system
CN113859588A (zh) 一种航天器姿态/故障/干扰协同观测与容错抗干扰控制方法
Kilicaslan Tracking control of elastic joint parallel robots via state-dependent Riccati equation
CN106570296A (zh) 一种六自由度并联机构实时正解方法
Antonya et al. Co-simulation environment for the analysis of the driving simulator’s actuation
Filipovic et al. Expansion of source equation of elastic line
Chen et al. Design and dynamics modeling of a novel 2R1T 3-DOF parallel motion simulator
Liu et al. Data-driven motion-force control for acceleration minimization of robots
Yuan et al. Trajectory tracking control of a nonholonomic mobile robot
Lattarulo et al. Towards conformant models of automated electric vehicles
CN116360258A (zh) 基于固定时间收敛的高超声速变形飞行器抗干扰控制方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant