CN110394801B - 一种机器人的关节控制*** - Google Patents
一种机器人的关节控制*** Download PDFInfo
- Publication number
- CN110394801B CN110394801B CN201910720299.0A CN201910720299A CN110394801B CN 110394801 B CN110394801 B CN 110394801B CN 201910720299 A CN201910720299 A CN 201910720299A CN 110394801 B CN110394801 B CN 110394801B
- Authority
- CN
- China
- Prior art keywords
- joint
- module
- control
- control unit
- robot
- 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
Links
Images
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
-
- 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/1628—Programme controls characterised by the control loop
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种机器人的关节控制***。具体地,该机器人具有机械臂,机械臂包含若干个关节模组和机械臂末端,每一关节模组设置有对应的编码器和驱动电机,机械臂末端设置有末端执行器和多维力传感器,该关节控制***包括:状态反馈模块、目标输入模块以及位控制模块。从而,本申请所述的机器人的关节控制***采用PID控制和虚拟分解控制组合的控制手段,并基于运动学模型进行动态力补偿,能在极大降低运算量的同时提高***的带宽,进而提高机器人的控制精度。
Description
技术领域
本发明涉及机器人控制领域,特别涉及一种机器人的关节控制***。
背景技术
现有机器人控制技术通常在关节进行PID(比例(proportion)、积分(integral)、微分(differential))控制,同时基于模型对重力、关节摩擦力进行补偿,这样的传统控制方法的控制带宽较低,动态性能因此受限。
同时现有的大部分机器人不进行力控制。少数机器人基于关节力矩传感器进行力控制,力控制精度较差。
发明内容
有鉴于此,本发明提供了一种机器人的关节控制***,具有更精准的关节控制和更高的控制带宽,从而实现高精度的机器人控制,满足更精细化的工业加工需求。
本申请的一个实施例提供了一种机器人的关节控制***,该机器人具有机械臂,机械臂包含若干个关节模组和机械臂末端,每一关节模组设置有对应的编码器和驱动电机,机械臂末端设置有末端执行器和多维力传感器,该关节控制***包括:
状态反馈模块,用于获取各关节模组的编码器反馈的关节位置数据;
目标输入模块,用于获取外部输入的机械臂末端的末端目标位置;
位控制模块,包括并联设置的PID控制单元和虚拟分解控制单元,其中:
PID控制单元用于根据机械臂末端的末端目标位置分别计算各关节模组的关节目标位置、并根据各关节模组的关节目标位置以及各关节模组的关节位置数据分别计算各关节模组的第一驱动电流;
虚拟分解控制单元用于根据机械臂末端的末端目标位置分别计算各关节模组的关节目标位置、并根据各关节模组的关节目标位置以及各关节模组的关节位置数据分别计算各关节模组的第二驱动电流;
并且,PID控制单元和虚拟分解控制单元计算得到的每个关节模组的第一驱动电流和第二驱动电流叠加后输出至该关节模组的驱动电机。
可选地,位控制模块包括分别对应于每个关节的一对并联设置的PID控制单元和虚拟分解控制单元。
可选地,每个关节模组包括关节和连杆,并且虚拟分解控制单元包括:
模型创建子单元,用于为每个关节模组创建运动学模型;
参数设定子单元,用于设定每个关节模组的运动学模型的模型参数;
力矩计算子单元,用于调用各关节模组的运动学模型、并以各关节模组的关节位置数据为输入计算各关节模组对应的力矩;
电流计算子单元,用于将各关节模组对应的力矩转换为各关节模组对应的第二驱动电流。
可选地,运动学模型以运动学方程和动力学方程为约束条件;
其中,所述运动学方程为:
所述动力学方程为:
可选地,参数设定子单元进一步利用确定各关节模组之间的自适应律,并利用确定的自适应律方程补偿各关节模组的动态力,其中,所述自适应律方程为:
其中,Γ为正定矩阵。
可选地,所述关节控制***进一步包括导纳控制模块,用于以末端执行器与外界的接触力对末端目标位置进行偏差补偿。
可选地,所述导纳控制模块进一步用于获取多维力传感器的末端受力数据、并根据末端受力数据对输入至PID控制单元和虚拟分解控制单元的末端目标位置进行补偿。
由上可知,本申请所述的机器人的关节控制***采用PID控制和虚拟分解控制组合的控制手段,并基于运动学模型进行动态力补偿,能在极大降低运算量的同时提高***的带宽,进而提高机器人的控制精度。
附图说明
以下附图仅对本发明做示意性说明和解释,并不限定本发明的范围。
图1为本申请一个实施例的关节控制***的控制原理图;
图2为本申请一个实施例的关节控制***的结构示意图;
图3为本申请一个实施例的导纳控制模块的控制原理图;
图4为本申请一个实施例的导纳控制配合关节控制的控制原理图;
图5为本申请一个实施例的导纳控制配合关节控制的结构示意图。
标号说明
100 机器人
101 编码器
102 多维力传感器
110 状态反馈模块
120 目标输入模块
130 位控制模块
131 模型创建子单元
132 参数设定子单元
133 力矩计算子单元
134 电流计算子单元
140 导纳控制模块
具体实施方式
为了对发明的技术特征、目的和效果有更加清楚的理解,现对照附图说明本发明的具体实施方式,在各图中相同的标号表示相同的部分。
在本文中,“示意性”表示“充当实例、例子或说明”,不应将在本文中被描述为“示意性”的任何图示、实施方式解释为一种更优选的或更具优点的技术方案。
为使图面简洁,各图中的只示意性地表示出了与本发明相关部分,而并不代表其作为产品的实际结构。另外,以使图面简洁便于理解,在有些图中具有相同结构或功能的部件,仅示意性地绘示了其中的一个,或仅标出了其中的一个。
在本文中,“第一”、“第二”等仅用于彼此的区分,而非表示重要程度及顺序、以及互为存在的前提等。
为使本发明的目的、技术方案及优点更加清楚明白,以下参照附图并举实施例,对本发明进一步详细说明。
图1为本申请一个实施例的关节控制***的控制原理图;图2为本申请一个实施例的关节控制***的结构示意图。
请参见图1,本申请的一个实施例提供了一种机器人的关节控制***,该机器人100具有机械臂,机械臂包含若干个关节模组和机械臂末端,每一关节模组设置有对应的编码器101和驱动电机,机械臂末端设置有末端执行器和多维力传感器102,该关节控制***包括:状态反馈模块110、目标输入模块120以及位控制模块130。
其中,状态反馈模块110用于获取各关节模组的编码器101反馈的关节位置数据;目标输入模块120用于获取外部输入的机械臂末端的末端目标位置,目标输入模块120的输入数据来源可以为操作者的指令和多维力传感器102的信号;位控制模块130包括并联设置的PID控制单元和虚拟分解控制单元,
PID控制单元用于根据机械臂末端的末端目标位置分别计算各关节模组的关节目标位置、并根据各关节模组的关节目标位置以及各关节模组的关节位置数据分别计算各关节模组的第一驱动电流;
虚拟分解控制单元用于根据机械臂末端的末端目标位置分别计算各关节模组的关节目标位置、并根据各关节模组的关节目标位置以及各关节模组的关节位置数据分别计算各关节模组的第二驱动电流;
并且,PID控制单元和虚拟分解控制单元计算得到的每个关节模组的第一驱动电流和第二驱动电流叠加后输出至该关节模组的驱动电机。
VDC(虚拟分解控制)是较新颖的复杂控制方法且难以调试;PID是传统的控制方法,调试方法成熟简单。本申请通过将VDC中与PID在数学上等价的部分单独提取并进行调试,通过这一方法实现了和原有VDC的相同的效果,同时极大的降低了调试的难度。其中,所谓在数学上等价的部分指的是VDC中包含的等同于PID中积分环节的项,因此在进行PID设计的时候可以不设计I环节(积分环节)。
PID的参数具有实际的物理意义,这样的物理意义在原本的VDC中是无法体现的,经过这一简化之后,就将参数与机器人的物理表现对应起来,详细来说就是将关节视为一个质量-弹簧-阻尼***,速度控制的P对应的是阻尼效果,D对应的是质量(惯性)的效果,I对应的是弹簧(刚度)的效果。
从而,使用VDC可以节省运算量,同时可以补偿所有的动态力(包括惯性力、旋转引起的陀螺效应、负载重力以及机器人本体重力),因而机器人的响应会更快。
为了分别计算每个关节模组的驱动电机的驱动电流,位控制模块130包括分别对应于每个关节的一对并联设置的PID控制单元和虚拟分解控制单元。
请参见图2,每个关节模组包括关节和连杆,并且虚拟分解控制单元包括:
模型创建子单元131,用于为每个关节模组创建运动学模型;
参数设定子单元132,用于设定每个关节模组的运动学模型的模型参数;
力矩计算子单元133,用于调用各关节模组的运动学模型、并以各关节模组的关节位置数据为输入计算各关节模组对应的力矩;
电流计算子单元134,用于将各关节模组对应的力矩转换为各关节模组对应的第二驱动电流。
进一步地,运动学模型以运动学方程和动力学方程为约束条件;
其中,运动学方程为:
动力学方程为:
为了增强关节控制***的控制效果,参数设定子单元132进一步利用确定各关节模组之间的自适应律,并利用确定的自适应律方程补偿各关节模组的动态力,其中,自适应律方程为:
其中,Γ为正定矩阵。
进一步地,关节模组的输出力矩方程为:
自适应律可以实时的辨识出模型参数,并可利用这些参数使得控制效果达到最优化,进而控制相应速度更快。
图3为本申请一个实施例的导纳控制模块的控制原理图;图4为本申请一个实施例的导纳控制配合关节控制的控制原理图;图5为本申请一个实施例的导纳控制配合关节控制的结构示意图。
请参见图3,关节控制***进一步包括导纳控制模块140,用于以末端执行器与外界的接触力对末端目标位置进行偏差补偿。
请参见图4和图5,导纳控制模块进一步用于获取多维力传感器102的末端受力数据、并根据末端受力数据对输入至PID控制单元和虚拟分解控制单元的末端目标位置进行补偿。
导纳控制的控制目标是执行器末端,通过这样的方法可以将导纳控制模块和关节控制***相互独立。在需要的情况下,具备直接迁移至其他机器人控制程序的优势。
本实施例同时对导纳控制进行了简化,将导纳控制模块中位置和加速度的部分去掉,简化了调试的难度。
可以理解的是,由于机器人的关节机构位置与速度、加速度之间存在换算关系,所以,本申请并不排斥其他针对速度、加速度进行补偿的情况。
机器人在本实施例提供的关节控制***控制下,可以实现的模式包括:
位置保持模式,即,使机器人保持现有的位置且速度保持为零;
单关节位置命令模式,即,给机械臂关节角度指令,使得其运动到指定构型;
单关节速度命令模式,即,给定关节的速度指令,经过正弦加速至指令速度并保持;
任务空间(笛卡尔空间)末端位置命令模式,即,为了实现任务空间(笛卡尔空间)的轨迹运动;
任务空间(笛卡尔空间)末端速度命令模式,即,给机械臂末端6维速度指令,规划出按正弦加速至指令速度并保持的过程,然后使用逆运动学进行解算,将对末端速度的规划转换为对关节速度的指令,实现运动;
拖动示教模式,即,基于力传感器的反馈实现末端拖动,即使用力传感器读取操作人员施加在机器人末端的力/力矩,并根据读数赋予机器人相应的速度指令,使其产生近似于直接***作人员拖动的运动效果;
零力模式,即,在对机械臂的重力、关节间摩擦力、动态力进行补偿后,实现机械臂近似于处于无重力的状态;
任务空间(笛卡尔空间)末端位置模式&力控模式,即,在固定的维度实现OCPM运动的同时,通过力传感器的反馈和力控制的算法使得机器人末端与环境接触的力/力矩快速向期望的指令值变化并保持稳定;
任务空间(笛卡尔空间)末端速度模式&力控模式,即,在固定的维度实现MAM运动的同时,通过力传感器的反馈和力控制的算法使得机器人末端与环境接触的力/力矩快速向期望的指令值变化并保持稳定。
其中,在拖动示教模式下,导纳控制模块对末端执行器的末端目标位置进行位置补偿以响应于末端执行器的外界拖拽力。其中,末端拖动模式为末端执行器120收到外界拖拽力的情况。基于多维力传感器感测到外界拖拽力,并通过导纳控制模块为控制装置提供关节模组的关节目标位置,以使关节模组产生位移分量并带动末端执行器移动。
进一步地,关节模组的位置使用上述的PID控制单元和虚拟分解控制单元进行补偿计算。
上文所列出的一系列的详细说明仅仅是针对本发明的可行性实施方式的具体说明,而并非用以限制本发明的保护范围,凡未脱离本发明技艺精神所作的等效实施方案或变更,如特征的组合、分割或重复,均应包含在本发明的保护范围之内。
Claims (5)
1.一种机器人的关节控制***,其特征在于,该机器人具有机械臂,机械臂包含若干个关节模组和机械臂末端,每一关节模组设置有对应的编码器和驱动电机,机械臂末端设置有末端执行器和多维力传感器,该关节控制***包括:
状态反馈模块,用于获取各关节模组的编码器反馈的关节位置数据;
目标输入模块,用于获取外部输入的机械臂末端的末端目标位置;
位控制模块,包括并联设置的PID控制单元和虚拟分解控制单元,其中:
PID控制单元用于根据机械臂末端的末端目标位置分别计算各关节模组的关节目标位置、并根据各关节模组的关节目标位置以及各关节模组的关节位置数据分别计算各关节模组的第一驱动电流;
虚拟分解控制单元用于根据机械臂末端的末端目标位置分别计算各关节模组的关节目标位置、并根据各关节模组的关节目标位置以及各关节模组的关节位置数据分别计算各关节模组的第二驱动电流;
并且,PID控制单元和虚拟分解控制单元计算得到的每个关节模组的第一驱动电流和第二驱动电流叠加后输出至该关节模组的驱动电机。
2.根据权利要求1所述的关节控制***,其特征在于,位控制模块包括分别对应于每个关节的一对并联设置的PID控制单元和虚拟分解控制单元。
3.根据权利要求1所述的关节控制***,其特征在于,每个关节模组包括关节和连杆,并且虚拟分解控制单元包括:
模型创建子单元,用于为每个关节模组创建运动学模型;
参数设定子单元,用于设定每个关节模组的运动学模型的模型参数;
力矩计算子单元,用于调用各关节模组的运动学模型、并以各关节模组的关节位置数据为输入计算各关节模组对应的力矩;
电流计算子单元,用于将各关节模组对应的力矩转换为各关节模组对应的第二驱动电流。
4.根据权利要求1所述的关节控制***,其特征在于,所述关节控制***进一步包括导纳控制模块,用于以末端执行器与外界的接触力对末端目标位置进行偏差补偿。
5.根据权利要求4所述的关节控制***,其特征在于,所述导纳控制模块进一步用于获取多维力传感器的末端受力数据、并根据末端受力数据对输入至PID控制单元和虚拟分解控制单元的末端目标位置进行补偿。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910720299.0A CN110394801B (zh) | 2019-08-06 | 2019-08-06 | 一种机器人的关节控制*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910720299.0A CN110394801B (zh) | 2019-08-06 | 2019-08-06 | 一种机器人的关节控制*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110394801A CN110394801A (zh) | 2019-11-01 |
CN110394801B true CN110394801B (zh) | 2021-04-16 |
Family
ID=68327495
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910720299.0A Active CN110394801B (zh) | 2019-08-06 | 2019-08-06 | 一种机器人的关节控制*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110394801B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111098303A (zh) * | 2019-12-25 | 2020-05-05 | 深圳前海达闼云端智能科技有限公司 | 机器人及其柔性控制方法与装置 |
CN111035454B (zh) | 2019-12-26 | 2021-09-10 | 苏州微创畅行机器人有限公司 | 可读存储介质以及手术机器人 |
CN113319844A (zh) * | 2020-02-28 | 2021-08-31 | 东莞市李群自动化技术有限公司 | 机械臂控制方法、控制设备和机器人 |
CN111300423B (zh) * | 2020-03-17 | 2021-05-18 | 北京理工大学 | 一种机器人关节力矩控制***及其负载补偿方法 |
CN114407022B (zh) * | 2022-03-07 | 2022-09-09 | 哈尔滨工业大学 | 一种基于模型参数误差观测器的机械臂碰撞检测方法 |
CN115026845B (zh) * | 2022-08-12 | 2022-11-08 | 珞石(北京)科技有限公司 | 一种机器人单关节混合控制方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1531766B1 (en) * | 2002-08-22 | 2012-08-01 | Victhom Human Bionics Inc. | Actuated leg prosthesis for above-knee amputees |
JP4581892B2 (ja) * | 2005-07-27 | 2010-11-17 | 株式会社デンソーウェーブ | ロボット制御装置 |
US9221177B2 (en) * | 2012-04-18 | 2015-12-29 | Massachusetts Institute Of Technology | Neuromuscular model-based sensing and control paradigm for a robotic leg |
CN106112985B (zh) * | 2016-08-11 | 2020-05-22 | 上海交通大学 | 下肢助行机器的外骨骼混合控制***及方法 |
CN106985139B (zh) * | 2017-04-12 | 2020-04-14 | 西北工业大学 | 基于扩展状态观测与补偿的空间机器人自抗扰协调控制方法 |
CN108748147A (zh) * | 2018-06-01 | 2018-11-06 | 清华大学深圳研究生院 | 一种外骨骼机械臂的控制***及方法 |
CN108748157B (zh) * | 2018-06-12 | 2020-08-21 | 北京机械设备研究所 | 一种用于空间机械臂关节驱动的控制装置及方法 |
-
2019
- 2019-08-06 CN CN201910720299.0A patent/CN110394801B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110394801A (zh) | 2019-11-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110394801B (zh) | 一种机器人的关节控制*** | |
CN108656112B (zh) | 一种面向直接示教的机械臂零力控制实验*** | |
CN103495977B (zh) | 一种6r型工业机器人负载识别方法 | |
Wang et al. | Uncalibrated visual tracking control without visual velocity | |
CN111546315B (zh) | 一种基于人机协作的机器人柔顺示教及再现方法 | |
JP7058929B2 (ja) | 駆動装置、ロボット装置、制御方法、物品の製造方法、制御プログラム、および記録媒体 | |
CN110053044B (zh) | 一种并联机器人串类水果夹取无模型自适应光滑滑模阻抗控制方法 | |
CN111230882B (zh) | 水果分拣并联机器人夹持机构的自适应变阻抗控制方法 | |
CN109940613B (zh) | 一种计算含压电材料机械臂动力学响应及控制的仿真方法 | |
US9844872B1 (en) | Determining sensor parameters and model parameters of a robot | |
CN114750148A (zh) | 一种重力自适应测量的力闭环零力控制方法及*** | |
CN115122325A (zh) | 一种具有视场约束的拟人化机械手鲁棒视觉伺服控制方法 | |
Fukusho et al. | Control of a straight line motion for a two-link robot arm using coordinate transform of bi-articular simultaneous drive | |
Zhang et al. | Dynamic analysis of flexible-link and flexible-joint robots | |
CN112847373B (zh) | 一种机器人轨迹同步控制方法、计算机可读存储介质 | |
Ma et al. | A novel aerial manipulator system compensation control based on ADRC and backstepping | |
Ansarieshlaghi et al. | Hybrid Force/Position Control of a Very Flexible Parallel Robot Manipulator in Contact with an Environment. | |
CN114211502B (zh) | 机器人负载识别方法及识别装置 | |
Nuritdinovich et al. | The concept of the mathematical description of the multi-coordinate mechatronic module of the robot | |
Poitrimol et al. | Haptic interface for virtual reality based on hybrid Cable-Driven parallel robot | |
Hao et al. | Development and evaluation of a 7-DOF haptic interface | |
Moldoveanu et al. | Trajectory tracking control of a two-link robot manipulator using variable structure system theory | |
WO2019216416A1 (ja) | 撓み量推定装置、ロボット制御装置、及び撓み量推定方法 | |
CN114454161B (zh) | 一种基于球形电机驱动的机械手刚柔耦合*** | |
Jazar | Robot Dynamics |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |