CN106003049A - 人-机协作系统的控制方法 - Google Patents
人-机协作系统的控制方法 Download PDFInfo
- Publication number
- CN106003049A CN106003049A CN201610523283.7A CN201610523283A CN106003049A CN 106003049 A CN106003049 A CN 106003049A CN 201610523283 A CN201610523283 A CN 201610523283A CN 106003049 A CN106003049 A CN 106003049A
- Authority
- CN
- China
- Prior art keywords
- robotic arm
- limbs
- power
- centerdot
- feedback signal
- 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.)
- Granted
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
Abstract
本发明公开一种人‑机协作系统的控制方法,包括肢体、机器臂以及控制系统,机器臂包括端部受动器以及力传感手柄,所述力传感手柄设置在所述受动器并用于测量肢体向所述臂施加的力,控制系统根据力传感手柄所获得的力的大小对机器臂产生控制输入,并驱动端部受动器达到预定的目的地;控制方法包括:S1,通过力传感手柄测量肢体向机器臂施加力的大小及方向,并将其定义为肢体模型中预定轨迹和真实轨迹之间的误差;S2,将步骤S1所测量的力进行积分作为控制系统中所需的反馈信号,以区分外界干扰和肢体主动施加的力;S3,将步骤S2中得到的反馈信号反馈给控制系统,控制系统根据阻抗模型控制对反馈信号进行最小化处理实现机器臂自主跟随肢体运动。
Description
技术领域
本发明涉及一种人-机协作系统的控制方法。
背景技术
随着科技的发展,人-机协作的需求越来越广泛。人-机协作不仅可以降低人类的工作负荷、成本以及疲劳风险,还可以提高生产效率。在工业化生产中,很多新兴的生产作业工作一方面由于复杂程度高而难以自动化生产,另一方面由于太繁重而难以进行人工操作,这就需要器械和人工共同完成。
然而在人-机协作中,难以使机器了解人类的运动意图,从而无法使机器实现自主工作。
发明内容
本发明解决的技术问题在于克服上述现有技术中存在不足而提供一种人-机协作系统的控制方法。
一种人-机协作系统的控制方法,所述人-机协作系统包括肢体、机器臂以及控制系统,所述机器臂包括端部受动器以及力传感手柄,所述力传感手柄设置在所述端部受动器并用于测量肢体向所述机器臂施加的力,所述控制系统根据所述力传感手柄所获得的力的大小对所述机器臂产生控制输入,并驱动所述端部受动器达到预定的目的地;所述控制方法包括以下步骤:
S1,通过力传感手柄测量肢体向所述机器臂施加力的大小及方向,并将其定义为肢体模型中预定轨迹和真实轨迹之间的误差;
S2,将步骤S1所测量的力进行积分作为控制系统中所需的反馈信号,以区分外界干扰和肢体主动施加的力;
S3,将步骤S2中得到的反馈信号反馈给所述控制系统,所述控制系统根据阻抗控制对该反馈信号进行最小化处理从而实现所述机器臂自主跟随肢体运动。
进一步的,所述肢体模型表示为:
f(t)=K(x-xd)
其中,f(t)为力传感手柄测量的力,K为肢体的阻抗系数,x为机器臂端部的实际位置,xd为肢体的预定轨迹。
进一步的,所述阻抗模型为:
其中,xr为机器臂的目标位置;F为反馈信号,且通过将f(t)对时间积分获得;Md,Cd,Gd分别为理想的质量、阻尼以及弹性矩阵。
进一步的,在步骤S3中,所述控制系统根据阻抗模型控制对该反馈信号进行最小化处理从而实现所述机器臂自主跟随肢体运动的步骤包括:
通过公式(7)对反馈信号F最小化获得机器臂的目标位置xr;
将所述目标位置xr转换为所述机器臂的输入控制信号u;
其中,输入控制信号u满足:且,M(q)∈Rn×n为对称有界的正定惯性矩阵,表示科里奥利以及离心力,为重力,为控制输入向量,J(q)∈Rn×n为Jacobian矩阵,q为所述机器臂关节的角度。
所述基于力反馈的自适应控制系统可以和阻抗控制结合,从而实现机器臂主动跟随肢体运动。
附图说明
图1是本发明提供的人-机协作系统的结构示意图。
图2是本发明提供的人-机协作系统的控制方法的流程图。
具体实施方式
以下结合附图对本发明做进一步详细的阐述。
请参照图1-2,一种人-机协作系统的控制方法,所述人-机协作系统包括肢体20、机器臂10以及控制系统,所述机器臂10包括端部受动器12以及力传感手柄11,所述力传感手柄11设置在所述端部受动器12并用于测量肢体20向所述机器臂10施加的力,所述控制系统根据所述力传感手柄11所获得的力的大小,对所述机器臂10产生控制输入,并驱动所述端部受动器12达到预定的目的地。所述端部受动器12可以根据物体的尺寸和形状灵活地挑选并放置。在整套系统中,人通过施加力给所述力传感手柄11,从而使机器臂10将物体传输到目标位置。
所述控制方法以下步骤:
S1,通过力传感手柄11测量肢体20向所述机器臂10施加力的大小及方向,并将其定义为肢体模型中预定轨迹和真实轨迹之间的误差;
S2,将步骤S1所测量的力进行积分作为控制系统中所需的反馈信号,以区分外界干扰和肢体主动施加的力;
S3,将步骤S2中得到的反馈信号反馈给所述控制系统,所述控制系统根据阻抗控制对该反馈信号进行最小化处理从而实现所述机器臂10自主跟随肢体20运动。
在步骤S1中,所述肢体模型表示为:
f(t)=K(x-xd)
其中,f(t)为力传感手柄测量的力,K为肢体的阻抗系数,x为机器臂端部的实际位置,xd为肢体的预定轨迹。该肢体模型表明,当测量的力f(t)被最小化时,实际位置x和预定轨迹xd之间的误差也可以被最小化,这样意味着机器臂运动到了人的目标位置。
通过对所测量的力进行积分,可以区分由于测量误差或者外界扰动带来的干扰力和人的肢体主动施加在机器臂上的力。假设干扰力具有类似于白噪声的特点,则它在一段时间内的数学期望为0,意味着它的积分对机器臂的运动不造成影响。对应于干扰力来说,人的肢体所施加的力具有连续性,所以它的积分可以反映人的运动意图。
测量力的积分最小化甚至为0,驱动机器臂运动到人想要到达的位置。在此过程中,人的肢体运动起到导向的作用但实际驱动机器臂运动的力来自于控制系统的输出,因此人所做的功被减少并且工作效率可以提高。
所述物体30被看做是所述机器臂10的一部分。
所述机器臂10的运动可以通过方程(1)定义:
x(t)=ψ(q) (1)
其中,x(t)∈Rn以及q∈Rn分别为操作空间的方位以及关节空间的坐标。
方程(1)关于时间的微分为:
其中,J(q)∈Rn×n为Jacobian矩阵。进一步的,公式(2)关于时间的微分:
假定所述Jacobian矩阵J(q)在有限的工作空间中为已知的非奇异矩阵。
所述机器臂10在关节空间可以描述为:
其中,M(q)∈Rn×n为对称有界的正定惯性矩阵,表示科里奥利以及离心力,为重力,为控制输入向量,代表肢体20的力。
将公式(1)-(3)带入(4)中,得到公式(5):
其中,
且u为所述机器臂10的控制输入信号。
所述机器臂10运动符合目标阻抗模型的描述:
其中,xr为机器臂10的目标位置;F为反馈信号,且通过f(t)积分获得;Md,Cd,Gd分别为理想的质量、阻尼以及弹性矩阵。基于阻抗模型(7)对反馈信号F最小化可以获得所述机器臂10的目标位置xr。将所述目标位置xr转换为所述机器臂10的输入控制信号u,从而实现所述机器臂10自主跟随肢体20运动。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明保护的范围之内。
Claims (4)
1.一种人-机协作系统的控制方法,所述人-机协作系统包括肢体、机器臂以及控制系统,所述机器臂包括端部受动器以及力传感手柄,所述力传感手柄设置在所述端部受动器并用于测量肢体向所述机器臂施加的力,所述控制系统根据所述力传感手柄所获得的力的大小对所述机器臂产生控制输入,并驱动所述端部受动器达到预定的目的地;所述控制方法包括以下步骤:
S1,通过力传感手柄测量肢体向所述机器臂施加力的大小及方向,并将其定义为肢体模型中预定轨迹和真实轨迹之间的误差;
S2,将步骤S1所测量的力进行积分作为控制系统中所需的反馈信号,以区分外界干扰和肢体主动施加的力;
S3,将步骤S2中得到的反馈信号反馈给所述控制系统,所述控制系统根据阻抗模型控制对该反馈信号进行最小化处理从而实现所述机器臂自主跟随肢体运动。
2.根据权利要求1所述的人-机协作系统的控制方法,其特征在于,所述肢体模型表示为:
f(t)=K(x-xd)
其中,f(t)为力传感手柄测量的力,K为肢体的阻抗系数,x为机器臂端部的实际位置,xd为肢体的预定轨迹。
3.根据权利要求2所述的人-机协作系统的控制方法,其特征在于,所述阻抗模型为:
其中,xr为机器臂的目标位置;F为反馈信号,且通过将f(t)对时间积分获得;Md,Cd,Gd分别为理想的质量、阻尼以及弹性矩阵。
4.根据权利要求3所述的人-机协作系统的控制方法,其特征在于,在步骤S3中,所述控制系统根据阻抗模型控制对该反馈信号进行最小化处理从而实现所述机器臂自主跟随肢体运动的步骤包括:
通过公式(7)对反馈信号F进行最小化处理获得机器臂的目标位置xr;
将所述目标位置xr转换为所述机器臂的输入控制信号u;
其中,输入控制信号u满足:且,M(q)∈Rn×n为对称有界的正定惯性矩阵,表示科里奥利以及离心力,为重力,为控制输入向量,J(q)∈Rn×n为Jacobian矩阵,q为所述机器臂关节的角度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610523283.7A CN106003049B (zh) | 2016-07-05 | 2016-07-05 | 人-机协作系统的控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610523283.7A CN106003049B (zh) | 2016-07-05 | 2016-07-05 | 人-机协作系统的控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106003049A true CN106003049A (zh) | 2016-10-12 |
CN106003049B CN106003049B (zh) | 2018-06-12 |
Family
ID=57107949
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610523283.7A Active CN106003049B (zh) | 2016-07-05 | 2016-07-05 | 人-机协作系统的控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106003049B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111216130A (zh) * | 2020-01-10 | 2020-06-02 | 电子科技大学 | 一种基于变化阻抗控制的不确定机器人自适应控制方法 |
CN112276944A (zh) * | 2020-10-19 | 2021-01-29 | 哈尔滨理工大学 | 一种基于意图识别的人机协作系统控制方法 |
Citations (8)
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 |
JP2002018752A (ja) * | 2000-07-10 | 2002-01-22 | Japan Science & Technology Corp | ロボットの協調制御方法 |
CN101687321A (zh) * | 2007-07-05 | 2010-03-31 | 松下电器产业株式会社 | 机器人手臂的控制装置及控制方法、机器人及控制程序 |
CN102039594A (zh) * | 2009-10-20 | 2011-05-04 | 株式会社安川电机 | 阻抗控制参数调节装置和调节方法 |
CN103249368A (zh) * | 2010-11-11 | 2013-08-14 | 约翰霍普金斯大学 | 人机协作机器人系统 |
CN103648733A (zh) * | 2011-07-01 | 2014-03-19 | 库卡实验仪器有限公司 | 用于控制机器人的方法和控制装置 |
CN105619425A (zh) * | 2014-11-20 | 2016-06-01 | 西门子股份公司 | 用于机器人设备的可指定移动性 |
CN105705305A (zh) * | 2013-11-08 | 2016-06-22 | 库卡系统有限责任公司 | 检测装置和检测方法 |
-
2016
- 2016-07-05 CN CN201610523283.7A patent/CN106003049B/zh active Active
Patent Citations (8)
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 |
JP2002018752A (ja) * | 2000-07-10 | 2002-01-22 | Japan Science & Technology Corp | ロボットの協調制御方法 |
CN101687321A (zh) * | 2007-07-05 | 2010-03-31 | 松下电器产业株式会社 | 机器人手臂的控制装置及控制方法、机器人及控制程序 |
CN102039594A (zh) * | 2009-10-20 | 2011-05-04 | 株式会社安川电机 | 阻抗控制参数调节装置和调节方法 |
CN103249368A (zh) * | 2010-11-11 | 2013-08-14 | 约翰霍普金斯大学 | 人机协作机器人系统 |
CN103648733A (zh) * | 2011-07-01 | 2014-03-19 | 库卡实验仪器有限公司 | 用于控制机器人的方法和控制装置 |
CN105705305A (zh) * | 2013-11-08 | 2016-06-22 | 库卡系统有限责任公司 | 检测装置和检测方法 |
CN105619425A (zh) * | 2014-11-20 | 2016-06-01 | 西门子股份公司 | 用于机器人设备的可指定移动性 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111216130A (zh) * | 2020-01-10 | 2020-06-02 | 电子科技大学 | 一种基于变化阻抗控制的不确定机器人自适应控制方法 |
CN111216130B (zh) * | 2020-01-10 | 2021-04-20 | 电子科技大学 | 一种基于变化阻抗控制的不确定机器人自适应控制方法 |
CN112276944A (zh) * | 2020-10-19 | 2021-01-29 | 哈尔滨理工大学 | 一种基于意图识别的人机协作系统控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106003049B (zh) | 2018-06-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Sun et al. | Energy coupling output feedback control of 4-DOF underactuated cranes with saturated inputs | |
Wang et al. | Adaptive inverse dynamics control of robots with uncertain kinematics and dynamics | |
CN104723340A (zh) | 基于连接和阻尼配置的柔性关节机械臂的阻抗控制方法 | |
CN104589304A (zh) | 机器人控制装置以及机器人 | |
Karayiannidis et al. | Online contact point estimation for uncalibrated tool use | |
JP2010188471A (ja) | ロボット装置及びその制御方法、並びにコンピューター・プログラム | |
CN109746913B (zh) | 一种机器人姿势保持拖动示教的方法及系统 | |
CN106945040A (zh) | 一种用于单自由度柔性末端的机械臂控制算法 | |
CN110394802B (zh) | 一种打磨机器人及位置补偿方法 | |
Oftadeh et al. | Bounded-velocity motion control of four wheel steered mobile robots | |
Liang et al. | An augmented discrete-time approach for human-robot collaboration | |
Zhang et al. | A hybrid passive/active force control scheme for robotic belt grinding system | |
Mandava et al. | Design of PID controllers for 4-DOF planar and spatial manipulators | |
KR20150142796A (ko) | 로봇의 팔꿈치 제어시스템 및 그 제어방법 | |
CN106003049A (zh) | 人-机协作系统的控制方法 | |
CN106003032A (zh) | 一种可在空间站舱内稳定攀爬的机器人宇航员 | |
CN105643627A (zh) | 机器人运动控制的增益调整装置及方法 | |
CN112847366B (zh) | 一种力位混合示教机器人系统及示教方法 | |
CN105965485B (zh) | 非正交六轴示教杆 | |
You et al. | Dynamic control of a 3-DOF cable-driven robot based on backstepping technique | |
Karayiannidis et al. | Online kinematics estimation for active human-robot manipulation of jointly held objects | |
Xu et al. | Biomechtronic design of a supernumerary robotic limbs for industrial assembly | |
Yin et al. | Position control of a series elastic actuator based on global sliding mode controller design | |
CN106772243A (zh) | 一种爬行焊接机器人和焊缝间夹角估计方法 | |
CN107253180B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right |
Effective date of registration: 20200225 Address after: 361000 3f-a258, Zone C, innovation building, software park, Xiamen Torch High tech Zone, Fujian Province Patentee after: Xiamen Wayne Technology Co., Ltd Address before: 361000 No. 13, Lane 302, Gong Gong, Xiangan District, Fujian, Xiamen Co-patentee before: Li Qi Patentee before: Li Yanan |