CN105242533B - 一种融合多信息的变导纳遥操作控制方法 - Google Patents

一种融合多信息的变导纳遥操作控制方法 Download PDF

Info

Publication number
CN105242533B
CN105242533B CN201510555862.5A CN201510555862A CN105242533B CN 105242533 B CN105242533 B CN 105242533B CN 201510555862 A CN201510555862 A CN 201510555862A CN 105242533 B CN105242533 B CN 105242533B
Authority
CN
China
Prior art keywords
msub
mrow
mover
centerdot
arm
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
CN201510555862.5A
Other languages
English (en)
Other versions
CN105242533A (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.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
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 Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN201510555862.5A priority Critical patent/CN105242533B/zh
Publication of CN105242533A publication Critical patent/CN105242533A/zh
Priority to EP16842867.0A priority patent/EP3345087B1/en
Application granted granted Critical
Publication of CN105242533B publication Critical patent/CN105242533B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L63/00—Network architectures or network communication protocols for network security
    • H04L63/08—Network architectures or network communication protocols for network security for authentication of entities
    • H04L63/083—Network architectures or network communication protocols for network security for authentication of entities using passwords
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L63/00—Network architectures or network communication protocols for network security
    • H04L63/08—Network architectures or network communication protocols for network security for authentication of entities
    • H04L63/0884—Network architectures or network communication protocols for network security for authentication of entities by delegation of authentication, e.g. a proxy authenticates an entity to be authenticated on behalf of this entity vis-à-vis an authentication entity
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L63/00—Network architectures or network communication protocols for network security
    • H04L63/08—Network architectures or network communication protocols for network security for authentication of entities
    • H04L63/0807—Network architectures or network communication protocols for network security for authentication of entities using tickets, e.g. Kerberos
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L67/00—Network arrangements or protocols for supporting network services or applications
    • H04L67/01—Protocols
    • H04L67/02—Protocols based on web technology, e.g. hypertext transfer protocol [HTTP]
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L67/00—Network arrangements or protocols for supporting network services or applications
    • H04L67/01—Protocols
    • H04L67/02—Protocols based on web technology, e.g. hypertext transfer protocol [HTTP]
    • H04L67/025—Protocols based on web technology, e.g. hypertext transfer protocol [HTTP] for remote control or remote monitoring of applications
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L67/00—Network arrangements or protocols for supporting network services or applications
    • H04L67/01—Protocols
    • H04L67/10—Protocols in which an application is distributed across nodes in the network
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L67/00—Network arrangements or protocols for supporting network services or applications
    • H04L67/50—Network services
    • H04L67/52—Network services specially adapted for the location of the user terminal
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L67/00—Network arrangements or protocols for supporting network services or applications
    • H04L67/50—Network services
    • H04L67/535—Tracking the activity of the user
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/33—Director till display
    • G05B2219/33004—Manual control of manipulator, machine
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
    • G06Q30/00—Commerce
    • G06Q30/06—Buying, selling or leasing transactions
    • G06Q30/0601—Electronic shopping [e-shopping]
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L63/00—Network architectures or network communication protocols for network security
    • H04L63/08—Network architectures or network communication protocols for network security for authentication of entities
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L63/00—Network architectures or network communication protocols for network security
    • H04L63/08—Network architectures or network communication protocols for network security for authentication of entities
    • H04L63/0892—Network architectures or network communication protocols for network security for authentication of entities by using authentication-authorization-accounting [AAA] servers or protocols
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L63/00—Network architectures or network communication protocols for network security
    • H04L63/10—Network architectures or network communication protocols for network security for controlling access to devices or network resources

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Computer Hardware Design (AREA)
  • General Engineering & Computer Science (AREA)
  • Computer Security & Cryptography (AREA)
  • Computing Systems (AREA)
  • Artificial Intelligence (AREA)
  • Health & Medical Sciences (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer And Data Communications (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种融合多信息的变导纳遥操作控制方法，属于空间机器人领域和远程操作领域。本发明设计了包含阻尼的自适应控制器，将操作者的行为意识融合到控制器设计中，并产生控制信号Uh，能够通过自适应调整阻尼比减轻操作者压力；其次，对从端环境建模并实时反馈控制信号Ue，环境信息的实时采集和修正使系统保持稳定；最后，通过使用隐式马尔可夫模型(HMW)进行任务辨识，并根据实际操作需求适应性的变更任务指令，从而保证操作连续性和提高操作效率。

Description

一种融合多信息的变导纳遥操作控制方法
【技术领域】
本发明属于空间机器人领域和远程操作领域，涉及一种融合多信息的变导纳遥操作控制方法。
【背景技术】
从上世纪60年代空间机器人开始应用到今天,空间机器人的应用领域在不断地扩大,同时空间机器人所承担任务的复杂性也在不断增加:从结构化已知环境中的重复性操作到非结构化未知环境中的非重复性操作，而且其精度要求也越来越高,需要完成一些诸如运动目标捕获,卫星装配,卫星维修之类的精密任务，同时要求操作者具备灵活且稳定的操作。考虑操作环境的未知性、操作者行为的不确定性和操作任务的复杂性等因素，空间机器人需要具备较强的环境适应能力、操作者需要具备操作行为适应性变更能力，并且操作任务指令可以实时生成和传送。从长远看,能够对环境进行感知、高度自主、能代替人类从事各种空间作业而不需要人类干涉的智能机器人是空间机器人的最终发展方向，但受现有技术(传感器技术,人工智能技术,控制技术等)水平的限制,能够在复杂的非结构环境中全自主工作的智能空间机器人在相当长一段时间内是难以实现的,一个现实的选择就是从全自主方式转向局部自主方式,即有人参与的机器人局部自主方式，机器人在完成底层控制方面有优势,能够精确地完成诸如位置控制、力控制这类任务,而人类在智能决策,异常情况处理等方面有优势。有人参与的机器人局部自主控制方式综合了两者的长处,可以大大提高系统的控制精度和对外界的适应能力。另外，提高任务指令的精确度以及适应性变更能力也是空间遥操作需要解决的问题。
一个双向力反馈遥操作系统允许操作者通过接受力反馈在遥远环境中进行复杂的操作。操作者通过力反馈设备来控制从端的机械手，并通过信息交互通道完成控制信号、反馈信号及任务指令的接收及发送。遥操作系统中控制器设计的主要目标是提高鲁棒性、临场感、任务执行度及透明性。理论上，这些目标能够在不失去闭环系统稳定性的前提下同时得到优化，为此，系统的特征参数比如主从设备的类型、传感器和时延、信道上的数据包丢失都应在控制器设计上得到考虑。为了实现更高性能的遥操作系统，本发明考虑将环境因素、操作者行为及任务指令等影响因素进行整合，使系统得到更大的改进。传统空间遥操作系统中控制器的设计只针对影响遥操作性能的主要因素进行设计，但在实际操作过程中，环境因素的不可控、操作者行为的不稳定及任务指令的模糊与时延等都是造成操作系统不稳定的因素，另外，对控制器适应性的设计也是提高系统稳定性的一种方法。
【发明内容】
本发明的目的在于解决上述现有技术中的问题，提供一种融合多信息的变导纳遥操作控制方法，该方法是将环境因素、操作者行为及任务信息整合在一起设计控制器。
为达到上述目的，本发明所采用的技术方案包括以下步骤：
1)从端环境动力学特性分析及生成反馈信号Ue：
操作者控制手控器对机械臂末端进行操作，首先对从端环境进行动力学特性分析，使用弹簧阻尼模型表示：
其中，ke表示位置参数，de表示速度参数，xs表示从端机械臂末端的实时位置，xo表示从端操作对象的起始位置；确定其中的模型参数信息或者在操作者控制机械臂末端进行操作过程中进行评估；
在上述弹簧阻尼模型中加入质量模块构成导纳控制，导纳控制输入力fd生成期望的位置xd和位置修正量δxd，其物理学模型如下：
其中，x0表示操作对象的起始位置，输入力fd和位置控制器用来驱动从端机械臂到期望的位置；采用使用位置/力控制模式，其中位置信息由主端发送到从端，从端机械臂执行相应的动作，并反馈力控制信号Ue，控制系统二阶质量-弹簧-阻尼模型为：
其中，ke,d表示由自由空间操作到接触操作过程中所需的最小阻尼，位置参数ke能够修改环境与从端机械臂的交互频率ωc和阻尼率ξc，则：
为了达到期望的阻尼率调整主端阻尼dd的大小，dd的适应性表达式为
其中，是位置参数的评估值，需要通过递推最小二乘方法进行评估；
2)主端操作者行为建模及生成控制信号Uh：
在得到从端环境的反馈信号Ue后，需要对主端操作者行为进行建模和辨识，通过求解手臂位置变化的极小值来建立模型，假设起始、终点处速度为零、加速度为零，从而得到关于手臂位置的五次多项式：
x(t)＝xi+(xf-xi)(6τ5-15τ4+10τ3) (7)
其中，xi、ti、Tt、xf分别表示初始位置、初始时间、手臂运动时间及终点位置；
将得到的手臂位置参数加入到控制器设计中，即考虑手臂阻抗，同样的由质量-弹簧-阻尼模型表述：
其中，kh、dh分别表示位置参数及速度参数，mh为手臂质量；为了获取控制力fh需要对mh、kh、dh进行辨识，其中，手臂质量通过离线辨识，并将其设定为常值；通过改变手臂的位置参数来进一步改变速度参数：
其中，表示导纳控制器的阻尼，α是比例项，表示人手臂刚度系数；
通过改变控制力的大小及速度方向，区分操作者是加速运动还是减速运动，从而使控制器阻尼系数在加速/减速过程中相应地减少/增加，使系统保持稳定：
其中，Uh表示主端经过适应控制后发出的控制信号，参数d0的作用是当无适应性发生时保证系统稳定，是对适应性的加权值；
3)获取任务指令T：
在获取到反馈信号Ue及控制信号Uh后，控制器阻尼由操作者控制力及环境力决定，下一步针对操作任务，开始获取任务指令T：如果任务种类未知，通过在遥操作系统中添加任务辨识功能；另外，遥操作系统中添加有效的辅助作用能够提高操作性能，选取虚拟夹具作为辅助手段，针对不同操作任务，选取不同的虚拟夹具进行辅助作用；
4)由反馈信号Ue、控制信号Uh及任务指令T设计控制器：
控制器设计中由主端向从端发送控制信号Uh及任务指令T：
其中，δx表示机械臂末端位置变化率，作为统计值，δx的变化反映任务不同，其中加权值α的变化反映主端操作者控制从端机械臂的适应性，方便操作者执行复杂任务；
从端机械臂与未知环境发生作用时会产生相应的反馈信号Ue，同时结合主端的控制信号Uh及任务指令T进行综合控制：
其中，ke,d表示自由操作到接触操作所需最小阻尼，θk表示从端机械臂的位置参数，同时决定交互频率及阻尼率的大小。
本发明进一步的改进在于：
所述步骤1)中，确定模型参数信息或者在操作者控制机械臂末端进行操作过程中进行评估的具体方法为：
从端操作对象起始位置xo：通过摄像机、激光探测器、视觉追踪测量等测量工具获取操作对象的位置信息，同时传感器带来的未知因素要根据被评估系统的可靠性在控制器设计中进行考虑；机械臂末端与操作对象接触过程中，使用辨识技术实时对环境模型参数进行评估。
所述步骤3)中的任务辨识使用隐式马尔可夫模型进行任务辨识。
所述步骤3)中的虚拟夹具为引导型或禁止型虚拟夹具。
与现有技术相比，本发明具有以下有益效果：
本发明融合了操作者行为、环境变化因素以及任务指令等多种信息，与传统控制器设计中只考虑单一的控制因素相比具有更好的控制效果。首先，设计了包含阻尼的自适应控制器，将操作者的行为意识融合到控制器设计中，并产生控制信号Uh，能够通过自适应调整阻尼比减轻操作者压力；其次，对从端环境建模并实时反馈控制信号Ue，环境信息的实时采集和修正使系统保持稳定；最后，通过使用隐式马尔可夫模型(HMW)进行任务辨识，并根据实际操作需求适应性的变更任务指令，从而保证操作连续性和提高操作效率。
【附图说明】
图1为本发明导纳控制原理图；
图2为本发明融合环境因素的变导纳控制原理图；
图3为本发明融合操作者感知的变导纳控制图；
图4为本发明多信息融合控制器设计图；
图5为本发明避障实验示意图。
【具体实施方式】
下面结合附图对本发明做进一步详细描述：
参见图1至图5，本发明包括以下步骤：
步骤一：从端环境动力学特性分析及生成反馈信号Ue：
操作者控制手控器等设备对机械臂末端进行操作，首先对从端环境进行动力学特性分析，使用弹簧阻尼模型表示：
其中，ke表示位置参数，de表示速度参数，xs表示从端机械臂末端的实时位置，xo表示从端操作对象的起始位置。由分析可知，应该首先确定其中的模型参数信息或者在操作者控制机械臂末端进行操作过程中进行评估，具体的评估方法为：
从端操作对象起始位置xo：通过摄像机、激光探测器、视觉追踪测量等测量工具获取操作对象的位置信息，同时传感器带来的未知因素要根据被评估系统的可靠性在控制器设计中进行考虑。
位置参数ke及速度参数de：机械臂末端与操作对象接触过程中，使用合适的辨识技术能实时对环境模型参数进行评估，例如递归最小二乘法，环境模型参数评估的重要作用是提高参数收敛到真值的速度且保证模型假设的准确性。
在上述弹簧阻尼模型中加入质量模块构成导纳控制，如图1所示，导纳控制输入力fd生成期望的位置xd和位置修正量δxd。相关的物理学模型如下：
其中，x0表示操作对象的起始位置，输入力fd和位置控制器用来驱动从端机械臂到期望的位置。此外，将环境信息整合到控制器设计中，把控制参数由固定改为自适应，便是融合环境因素的自适应导纳控制方法。如图2所示，从端机械臂和环境作用过程中，产生位置信息xs和环境作用力fe，其中对xs进行反复采集达到校正从端机械臂的效果，fe作为从端的反馈值将其整合到控制器设计中，并产生相应的反馈信号。该方法采用位置/力控制模式，其中位置信息由主端发送到从端，从端机械臂执行相应的动作，并反馈力控制信号Ue，控制系统二阶质量-弹簧-阻尼模型为：
其中，ke,d表示由自由空间操作到接触操作过程中所需的最小阻尼，位置参数ke可以修改环境与从端机械臂的交互频率ωc和阻尼率ξc，
为了达到期望的阻尼率需要相应的调整主端阻尼dd的大小，dd的适应性表达式为
其中，是位置参数的评估值，需要通过递推最小二乘方法进行评估。
步骤二：主端操作者行为建模及生成控制信号Uh：
在得到从端环境的反馈信号Ue后，需要对主端操作者行为进行建模和辨识，提出一种手臂最小化颤动模型，通过求解手臂位置变化的极小值来建立模型，假设起始、终点处速度为零、加速度为零，从而得到关于手臂位置的五次多项式：
x(t)＝xi+(xf-xi)(6τ5-15τ4+10τ3) (7)
其中，xi、ti、Tt、xf分别表示初始位置、初始时间、手臂运动时间及终点位置，这些参数经过辨识后可以得出手臂运动轨迹大致呈直线而速度呈抛物线型。
将得到的手臂位置参数加入到控制器设计中，即考虑手臂阻抗，同样的可由经典的质量-弹簧-阻尼模型表述：
其中，kh、dh分别表示位置参数及速度参数，mh为手臂质量。为了获取控制力fh需要对mh、kh、dh进行辨识，其中，手臂质量可以通过离线辨识，并且由于质量参数变化很小，可以将其设定为常值，位置及速度参数的有效改变可以改善人机协同操作性能。这里通过改变手臂的位置参数(刚度)来进一步改变速度参数(阻尼)：
其中，表示导纳控制器的阻尼，α是比例项，表示人手臂刚度系数。对于给定的手臂刚度系数，取合适的比例值使控制器阻尼尽可能小，可以提高控制精度。
由于操作者的感知意识对控制的影响，提出融合操作者感知的变导纳控制方法，如图3所示，操作者自身的操作速度可以得到，将其作为反馈值与控制力fh进行整合，通过改变控制力的大小及速度方向，可以区分操作者是加速运动还是减速运动，从而使控制器阻尼系数在加速/减速过程中相应地减少/增加，使系统保持稳定：
其中，Uh表示主端经过适应控制后发出的控制信号，参数d0的作用是当无适应性发生时保证系统稳定，是对适应性的加权值。通过这个方法，当减小阻尼时，操作者控制机械臂加速运动只需更少的力气，当增加阻尼时，可以简化定位和位置保持等运动。
步骤三：获取任务指令T：
在获取到反馈信号Ue及控制信号Uh后，控制器阻尼可以由操作者控制力及环境力决定，下一步针对操作任务，开始获取任务指令T：如果任务种类未知，比如轴孔装配、避障、跟踪等，可以通过在遥操作系统中添加任务辨识功能，通常使用隐式马尔可夫模型(HMW)进行任务辨识，它是一种隐式的统计学模型，可以对多个简单任务进行辨识，并根据实际操作需求适应性的变更任务指令。另外，遥操作系统中添加有效的辅助作用可以提高操作性能，通常选取虚拟夹具作为辅助手段，针对不同操作任务，选取不同的虚拟夹具(引导型或禁止型)进行辅助作用。
步骤四：由反馈信号Ue、控制信号Uh及任务指令T设计控制器：
综合环境因素、操作者控制及具体任务指令后，一个带有阻尼的包含控制信号、反馈信号及任务指令的自适应控制器设计如图4所示：
控制器设计中由主端向从端发送控制信号Uh及任务指令T
其中，δx表示机械臂末端位置变化率，作为统计值，δx的变化反映任务不同，其中加权值α的变化反映主端操作者控制从端机械臂的适应性，方便操作者执行复杂任务。
另一方面，从端机械臂与未知环境发生作用时会产生相应的反馈信号Ue，由于环境的未知因素较多，需要通过传感器获取较准确的位置速度等信息，同时结合主端的控制信号Uh及任务指令T进行综合控制
其中，ke,d表示自由操作到接触操作所需最小阻尼，θk表示从端机械臂的位置参数，同时决定交互频率及阻尼率的大小。
实施例：
本发明的一个具体实施例是使用多信息融合的自适应控制器控制机械臂末端在虚拟环境中进行避障实验，具体过程如下：
1.构造实验场景：
实验中主端选用3自由度的Force Dimension Omega3.0手控器，从端是一个6自由度的虚拟机械臂，手控器控制机械臂末端，操作平台是基于CHAI3D仿真平台搭建，由OpenGL底层图形库创建三维视景窗口，操作者通过仿真平台控制从端机械臂完成实验任务。
2.信息交互通道设置：
实验中手控器宿主机作为信息交互的核心，设计任务指令接收模块、控制信号发送模块及反馈信号接收模块，其中，任务指令由其他计算机设备生成并通过网络进行传输，控制信号由手控器所在的人机交互平台生成并发送，从端机械臂与环境之间的交互信息反馈回主端。
3.实验场景参数设置：
实验中，操作者控制机械臂末端在虚拟环境中进行避障实验，首先需要进行任务规划：
设定机械臂末端起始点位置为S(0，0，0)，目标点位置为D(0，6.28，0)，单位为mm。
设定两个静态球形障碍物，球心坐标分别为O1(0,1.6,0.8),O2(0,2.2,-1.2)，其中O1为半径为0.5mm，O2的半径为0.8mm。
4.控制器参数设置：
实验中，要求操作者控制机械臂末端避开障碍物，故需要在机械臂末端接近障碍物时，操作者行为及任务指令做出适应性改变
其中，中令d0＝0.5(无适应性需求时保证操作稳定)，0.1＜α＜1，最小阻尼ke,d＝0.3，0.1＜θk＜1，δx由任务进行过程中HMW模型实时计算得到。
5.避障实验：
操作者控制Force Dimension Omega3.0手控器对虚拟场景中的机械臂末端进行操作，如图5所示，机械臂末端从起始位置S出发向目标位置D移动，中间需要对障碍物O1、O2进行适应性躲避，实验中，通过记录操作时间及碰撞次数验证控制器设计是否有效。
实验结果表明，适当的调整适应性权值α及阻尼比θk的值可以较高效的完成实验任务，控制器设计对操作者、环境及任务具备适应性调整能力。
以上内容仅为说明本发明的技术思想，不能以此限定本发明的保护范围，凡是按照本发明提出的技术思想，在技术方案基础上所做的任何改动，均落入本发明权利要求书的保护范围之内。

Claims (4)

1.一种融合多信息的变导纳遥操作控制方法，其特征在于，包括以下步骤：
1)从端环境动力学特性分析及生成反馈信号Ue：
操作者控制手控器对机械臂末端进行操作，首先对从端环境进行动力学特性分析，使用弹簧阻尼模型表示：
<mrow> <msub> <mi>f</mi> <mi>e</mi> </msub> <mo>=</mo> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>k</mi> <mi>e</mi> </msub> <mo>(</mo> <mrow> <msub> <mi>x</mi> <mi>s</mi> </msub> <mo>-</mo> <msub> <mi>x</mi> <mi>o</mi> </msub> </mrow> <mo>)</mo> <mo>+</mo> <msub> <mi>d</mi> <mi>e</mi> </msub> <mo>(</mo> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>s</mi> </msub> <mo>)</mo> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>
其中，ke表示位置参数，de表示速度参数，xs表示从端机械臂末端的实时位置，xo表示从端操作对象的起始位置；确定其中的模型参数信息或者在操作者控制机械臂末端进行操作过程中进行评估；
在上述弹簧阻尼模型中加入质量模块构成导纳控制，导纳控制输入力fd生成期望的位置xd和位置修正量δxd，其物理学模型如下：
<mrow> <mi>f</mi> <mo>=</mo> <mi>m</mi> <mover> <mi>x</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mo>+</mo> <mi>d</mi> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mi>k</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>
其中，x0表示操作对象的起始位置，输入力fd和位置控制器用来驱动从端机械臂到期望的位置；采用使用位置/力控制模式，其中位置信息由主端发送到从端，从端机械臂执行相应的动作，并反馈力控制信号Ue，控制系统二阶质量-弹簧-阻尼模型为：
<mrow> <msub> <mi>m</mi> <mi>d</mi> </msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mo>+</mo> <msub> <mi>d</mi> <mi>d</mi> </msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>k</mi> <mrow> <mi>e</mi> <mo>,</mo> <mi>d</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>k</mi> <mi>e</mi> </msub> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mi>x</mi> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mi>f</mi> <mo>+</mo> <msub> <mi>U</mi> <mi>e</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
其中，ke,d表示由自由空间操作到接触操作过程中所需的最小阻尼，位置参数ke能够修改环境与从端机械臂的交互频率ωc和阻尼率ξc，则：
<mrow> <msup> <mi>&amp;omega;</mi> <mi>c</mi> </msup> <mo>=</mo> <msqrt> <mfrac> <mrow> <msub> <mi>k</mi> <mrow> <mi>e</mi> <mo>,</mo> <mi>d</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>k</mi> <mi>e</mi> </msub> </mrow> <msub> <mi>m</mi> <mi>d</mi> </msub> </mfrac> </msqrt> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msup> <mi>&amp;xi;</mi> <mi>c</mi> </msup> <mo>=</mo> <mfrac> <msub> <mi>d</mi> <mi>d</mi> </msub> <mrow> <mn>2</mn> <msub> <mi>m</mi> <mi>d</mi> </msub> <msup> <mi>&amp;omega;</mi> <mi>c</mi> </msup> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>
为了达到期望的阻尼率调整主端阻尼dd的大小，dd的适应性表达式为
<mrow> <msub> <mover> <mi>d</mi> <mo>^</mo> </mover> <mi>d</mi> </msub> <mo>=</mo> <mn>2</mn> <msubsup> <mi>&amp;xi;</mi> <mi>d</mi> <mi>c</mi> </msubsup> <msqrt> <mrow> <msub> <mi>m</mi> <mi>d</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>k</mi> <mrow> <mi>e</mi> <mo>,</mo> <mi>d</mi> </mrow> </msub> <mo>+</mo> <msub> <mover> <mi>k</mi> <mo>^</mo> </mover> <mi>e</mi> </msub> <mo>)</mo> </mrow> </mrow> </msqrt> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
其中，是位置参数的评估值，需要通过递推最小二乘方法进行评估；
2)主端操作者行为建模及生成控制信号Uh：
在得到从端环境的反馈信号Ue后，需要对主端操作者行为进行建模和辨识，通过求解手臂位置变化的极小值来建立模型，假设起始、终点处速度为零、加速度为零，从而得到关于手臂位置的五次多项式：
x(t)＝xi+(xf-xi)(6τ5-15τ4+10τ3) (7)
其中，xi、ti、Tt、xf分别表示初始位置、初始时间、手臂运动时间及终点位置；
将得到的手臂位置参数加入到控制器设计中，即考虑手臂阻抗，同样的由质量-弹簧-阻尼模型表述：
<mrow> <msub> <mi>f</mi> <mi>h</mi> </msub> <mo>=</mo> <msub> <mi>m</mi> <mi>h</mi> </msub> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>h</mi> </msub> <mo>+</mo> <msub> <mi>d</mi> <mi>h</mi> </msub> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>h</mi> </msub> <mo>+</mo> <msub> <mi>k</mi> <mi>h</mi> </msub> <msub> <mi>x</mi> <mi>h</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>
其中，kh、dh分别表示位置参数及速度参数，mh为手臂质量；为了获取控制力fh需要对mh、kh、dh进行辨识，其中，手臂质量通过离线辨识，并将其设定为常值；通过改变手臂的位置参数来进一步改变速度参数：
<mrow> <msub> <mover> <mi>d</mi> <mo>^</mo> </mover> <mi>h</mi> </msub> <mo>=</mo> <mi>&amp;alpha;</mi> <msub> <mover> <mi>k</mi> <mo>^</mo> </mover> <mi>h</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>
其中，表示导纳控制器的阻尼，α是比例项，表示人手臂刚度系数；
通过改变控制力的大小及速度方向，区分操作者是加速运动还是减速运动，从而使控制器阻尼系数在加速/减速过程中相应地减少/增加，使系统保持稳定：
<mrow> <mi>m</mi> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>h</mi> </msub> <mo>+</mo> <mi>d</mi> <mrow> <mo>(</mo> <msub> <mover> <mi>f</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>h</mi> </msub> <mo>,</mo> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>h</mi> </msub> <mo>)</mo> </mrow> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>h</mi> </msub> <mo>=</mo> <msub> <mi>f</mi> <mi>h</mi> </msub> <mo>+</mo> <msub> <mi>U</mi> <mi>h</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>
其中，Uh表示主端经过适应控制后发出的控制信号，参数d0的作用是当无适应性发生时保证系统稳定，是对适应性的加权值；
3)获取任务指令T：
在获取到反馈信号Ue及控制信号Uh后，控制器阻尼由操作者控制力及环境力决定，下一步针对操作任务，开始获取任务指令T：如果任务种类未知，通过在遥操作系统中添加任务辨识功能；另外，遥操作系统中添加有效的辅助作用能够提高操作性能，选取虚拟夹具作为辅助手段，针对不同操作任务，选取不同的虚拟夹具进行辅助作用；
4)由反馈信号Ue、控制信号Uh及任务指令T设计控制器：
控制器设计中由主端向从端发送控制信号Uh及任务指令T：
<mrow> <mi>m</mi> <mover> <mi>x</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mo>+</mo> <mi>d</mi> <mrow> <mo>(</mo> <msub> <mover> <mi>f</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>h</mi> </msub> <mo>,</mo> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>h</mi> </msub> <mo>)</mo> </mrow> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mi>&amp;delta;</mi> <mi>x</mi> <mo>=</mo> <mi>f</mi> <mo>+</mo> <msub> <mi>U</mi> <mi>h</mi> </msub> <mo>+</mo> <mi>T</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> </mrow> </mrow>
其中，δx表示机械臂末端位置变化率，作为统计值，δx的变化反映任务不同，其中加权值α的变化反映主端操作者控制从端机械臂的适应性，方便操作者执行复杂任务；
从端机械臂与未知环境发生作用时会产生相应的反馈信号Ue，同时结合主端的控制信号Uh及任务指令T进行综合控制：
<mrow> <mi>m</mi> <mover> <mi>x</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mo>+</mo> <mi>d</mi> <mrow> <mo>(</mo> <mover> <mi>f</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>,</mo> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>)</mo> </mrow> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>k</mi> <mrow> <mi>e</mi> <mo>,</mo> <mi>d</mi> </mrow> </msub> <mo>+</mo> <mi>&amp;theta;</mi> <mi>k</mi> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mi>x</mi> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mi>&amp;delta;</mi> <mi>x</mi> <mo>=</mo> <mi>f</mi> <mo>+</mo> <msub> <mi>U</mi> <mi>e</mi> </msub> <mo>+</mo> <msub> <mi>U</mi> <mi>h</mi> </msub> <mo>+</mo> <mi>T</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>12</mn> <mo>)</mo> </mrow> </mrow>
其中，ke,d表示自由操作到接触操作所需最小阻尼，θk表示从端机械臂的位置参数，同时决定交互频率及阻尼率的大小。
2.根据权利要求1所述的融合多信息的变导纳遥操作控制方法，其特征在于，所述步骤1)中，确定模型参数信息或者在操作者控制机械臂末端进行操作过程中进行评估的具体方法为：
从端操作对象起始位置xo：通过摄像机、激光探测器、视觉追踪测量工具获取操作对象的位置信息，同时传感器带来的未知因素要根据被评估系统的可靠性在控制器设计中进行考虑；机械臂末端与操作对象接触过程中，使用辨识技术实时对环境模型参数进行评估。
3.根据权利要求1所述的融合多信息的变导纳遥操作控制方法，其特征在于，所述步骤3)中的任务辨识使用隐式马尔可夫模型进行任务辨识。
4.根据权利要求1或3所述的融合多信息的变导纳遥操作控制方法，其特征在于，所述步骤3)中的虚拟夹具为引导型或禁止型虚拟夹具。
CN201510555862.5A 2015-09-01 2015-09-01 一种融合多信息的变导纳遥操作控制方法 Active CN105242533B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201510555862.5A CN105242533B (zh) 2015-09-01 2015-09-01 一种融合多信息的变导纳遥操作控制方法
EP16842867.0A EP3345087B1 (en) 2015-09-01 2016-08-31 Method, device, and system for access control of a cloud hosting service

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510555862.5A CN105242533B (zh) 2015-09-01 2015-09-01 一种融合多信息的变导纳遥操作控制方法

Publications (2)

Publication Number Publication Date
CN105242533A CN105242533A (zh) 2016-01-13
CN105242533B true CN105242533B (zh) 2017-11-28

Family

ID=55040214

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510555862.5A Active CN105242533B (zh) 2015-09-01 2015-09-01 一种融合多信息的变导纳遥操作控制方法

Country Status (2)

Country Link
EP (1) EP3345087B1 (zh)
CN (1) CN105242533B (zh)

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105955486A (zh) * 2016-05-16 2016-09-21 西北工业大学 一种基于视觉激发脑电波辅助遥操作的方法
CN106406098B (zh) * 2016-11-22 2019-04-19 西北工业大学 一种机器人系统在未知环境下的人机交互控制方法
CN106625661B (zh) * 2016-12-09 2019-08-09 北京邮电大学 一种基于osg的自适应虚拟夹具的构造方法
CN107053179B (zh) * 2017-04-21 2019-07-23 苏州康多机器人有限公司 一种基于模糊强化学习的机械臂柔顺力控制方法
CN107553485B (zh) * 2017-07-13 2020-05-12 西北工业大学 一种人机交互过程中动态虚拟夹具的生成方法
CN108333924B (zh) * 2018-01-18 2020-05-12 西北工业大学 一种操作交互过程中的虚拟夹具优化生成方法
CN108227506A (zh) * 2018-02-08 2018-06-29 常州普旺科技有限公司 一种基于自适应最优化方法的机器人导纳控制系统
CN109249394B (zh) * 2018-09-27 2022-04-15 上海电气集团股份有限公司 基于导纳控制算法的机器人控制方法及系统
CN110181517B (zh) * 2019-06-21 2022-05-10 西北工业大学 一种基于虚拟夹具的双人遥操作训练方法
CN111413984B (zh) * 2020-04-08 2022-07-26 合肥学院 一种针对时延遥操作机器人系统的控制方法及装置
CN112192614A (zh) * 2020-10-09 2021-01-08 西南科技大学 一种基于人机合作的核运维机器人轴孔装配方法
CN112783046B (zh) * 2020-12-31 2022-03-15 西北工业大学 基于模糊策略的双边遥操作末端平滑行为规划控制方法
CN112558486B (zh) * 2021-02-23 2021-06-01 佛山隆深机器人有限公司 一种温度控制的机器人打磨方法及计算机可读存储介质
CN113171177B (zh) * 2021-04-07 2023-02-17 上海交通大学 可捕捉腰椎穿刺组织层突破感的人机交互控制方法及系统
CN113568313B (zh) * 2021-09-24 2021-12-17 南京航空航天大学 基于操作意图识别的变导纳辅助大部件装配方法及系统
CN114932557B (zh) * 2022-06-24 2023-07-28 合肥工业大学 一种运动学约束下基于能量消耗的自适应导纳控制方法
CN116572249B (zh) * 2023-06-07 2024-01-02 哈尔滨理工大学 一种基于三模态切换机制的柔性机械臂遥操作控制方法
CN116619393B (zh) * 2023-07-24 2023-11-14 杭州键嘉医疗科技股份有限公司 基于svm的机械臂变导纳控制方法、装置及设备

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5086400A (en) * 1990-05-11 1992-02-04 The United States Of America As Represented The The Administrator Of The National Aeronautics And Space Administration Bilevel shared control for teleoperators
US5581666A (en) * 1993-08-04 1996-12-03 Anderson; Robert J. Modular architecture for robotics and teleoperation
US8966594B2 (en) * 2008-02-04 2015-02-24 Red Hat, Inc. Proxy authentication
RO123527B1 (ro) * 2008-03-27 2013-04-30 Institutul De Mecanica Solidelor Al Academiei Române Metodă şi dispozitiv de control în timp real al roboţilor prin proiecţie virtuală
CN101526801A (zh) * 2009-04-17 2009-09-09 天津理工大学 履带式移动机械手的广义系统统一动力学建模方法
US8850554B2 (en) * 2010-02-17 2014-09-30 Nokia Corporation Method and apparatus for providing an authentication context-based session
CN102880063B (zh) * 2012-09-13 2016-01-20 中国人民解放军63921部队 同步控制遥操作系统及方法
CN102848391A (zh) * 2012-09-20 2013-01-02 北京邮电大学 基于真实力反馈的四通道双边遥操作控制系统
CN103056872B (zh) * 2013-01-15 2014-10-29 西北工业大学 空间机械手遥操作指令安全检测与修正方法
RU2679549C2 (ru) * 2013-11-11 2019-02-11 Адаллом, Инк. Брокер и прокси обеспечения безопастности облачных услуг
CN103722554B (zh) * 2014-01-15 2015-12-09 西北工业大学 一种空间遥操作方法
CN103991077B (zh) * 2014-02-19 2015-12-09 吉林大学 一种基于力融合的机器人手控器共享控制方法
CN103955207B (zh) * 2014-04-24 2016-06-22 哈尔滨工业大学 一种三爪式空间末端执行器在微重力环境下的捕获容差能力测试系统及方法
CN104723341A (zh) * 2015-03-07 2015-06-24 哈尔滨工业大学 基于连接和阻尼配置的柔性关节机械臂的位置控制方法
CN104723340B (zh) * 2015-03-07 2016-06-22 哈尔滨工业大学 基于连接和阻尼配置的柔性关节机械臂的阻抗控制方法

Also Published As

Publication number Publication date
EP3345087B1 (en) 2020-07-01
CN105242533A (zh) 2016-01-13
EP3345087A4 (en) 2019-03-13
EP3345087A1 (en) 2018-07-11

Similar Documents

Publication Publication Date Title
CN105242533B (zh) 一种融合多信息的变导纳遥操作控制方法
US20190036337A1 (en) System for robotic 3d printing
Burdea Invited review: the synergy between virtual reality and robotics
CN108241339B (zh) 仿人机械臂的运动求解和构型控制方法
CN108286949B (zh) 一种可移动式三维检测机器人系统
EP3578322A1 (en) Robot path-generating device and robot system
CN111015649B (zh) 一种驱控一体化控制系统
Farkhatdinov et al. A user study of command strategies for mobile robot teleoperation
Wang et al. Real-time process-level digital twin for collaborative human-robot construction work
Slawiñski et al. Teleoperation of a mobile robot with time-varying delay and force feedback
Ahmad et al. New computer vision based Snakes and Ladders algorithm for the safe trajectory of two axis CNC machines
Ahmad et al. Generation of safe and intelligent tool-paths for multi-axis machine-tools in a dynamic 2D virtual environment
CN109062227A (zh) 一种基于动态窗口的多曲线局部路径规划方法
Slawiñski et al. PD-like controller with impedance for delayed bilateral teleoperation of mobile robots
Panzirsch et al. Haptic intention augmentation for cooperative teleoperation
CN114347033A (zh) 机器人物品抓取方法、装置、机器人及存储介质
Brecher et al. Towards anthropomorphic movements for industrial robots
Hou et al. Representation of vehicle dynamics in haptic teleoperation of aerial robots
EP3670108A1 (en) Robot teaching programming method, apparatus and system, and computer-readable medium
Chopra et al. Passivity-based control of robots: Theory and examples from the literature
Gonzalez et al. Smooth transition-based control of encounter-type haptic devices
CN109483541B (zh) 一种基于分解速度规划算法的移动物体抓取方法
Pol et al. Autonomous Differential Drive Mobile Robot Navigation with SLAM, AMCL using ROS
Salinas et al. Complete Bilateral Teleoperation System for a Rotorcraft UAV with Time‐Varying Delay
Krejsa et al. Mobile robot motion planner via neural network

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