【技术实现步骤摘要】
本专利技术涉及机械臂控制，尤其涉及一种基于能量罐的机械臂分层变阻抗控制方法。
技术介绍
1、机械臂包括协作机械臂，作为与人类并肩工作的创新工具，其新一代设计亮点在于采用了轻量级结构并集成了7个自由度。这一革新不仅极大地提升了机械臂的灵活度与操作精度，更为其同时胜任多任务处理构筑了坚实的硬件基石，预示着协作机械臂应用领域与能力的广泛拓展与深化。
2、在控制方法层面，变阻抗控制作为一种先进的机器人控制方法，其核心在于模拟质量-弹簧-阻尼二阶系统的动态特性，使机器人能够智能调整其对外界力或力矩的响应参数。此方法赋予了机器人高度的环境适应性，尤其是在协作场景下执行精细作业时，展现出无与伦比的灵活性。医疗手术协作便是其应用的典范，通过力位混合控制方法，机械臂能根据预设的阻抗控制律及实时感知到的外力，精准执行如切割、穿刺等精细手术操作，而这一切均在操作员的远程精细控制下完成，实现了人机协作的新高度。
3、但是，在机械臂运用阻抗控制器执行精细操作或应对复杂多变的环境时，若其无法实时根据外部环境动态调整各关节的阻抗参数，控制器将不可避免地产生难以预测和控制的控制力矩。这一状况将严重削弱机械臂的操作可靠性和安全性，增加作业风险。
4、尽管通过离线调整阻抗参数能在一定程度上提升机械臂的环境适应性，但在面对复杂、非结构化的工作环境时，频繁进行离线参数调整显然不够灵活和高效，甚至可能因延误调整时机而导致操作失败或事故。
5、因此，为了提升机械臂在复杂环境中的适应性和操作稳定性，亟需一种能够实时感知环境变化
技术实现思路
1、本专利技术的目的在于提出一种基于能量罐的机械臂分层变阻抗控制方法，确保机械臂在执行细腻操作或面对突发情况时，能够迅速而准确地调整其动力学特性，从而保持操作过程的安全性和可靠性。
2、为达此目的，本专利技术采用以下技术方案：
3、一种基于能量罐的机械臂分层变阻抗控制方法，包括以下步骤：
4、s1、通过关节传感器获得机器人机械臂的关节信息，其中关节信息包括关节角度位置信息、关节角速度信息和机械臂末端姿态信息；
5、s2、根据获取的关节信息建立机械臂的动力学模型；
6、s3、定义任务空间速度坐标，并计算出动力学模型中雅可比矩阵的零空间基矩阵，再根据定义的任务空间速度坐标以及零空间基矩阵将机械臂的动力学模型扩展为机械臂的分层控制模型；
7、s4、在分层控制模型的各个工作空间中设置作为储能元件的能量罐，同时通过能量罐的状态更新率引入机械臂在分层控制模型的各个工作空间的变阻抗特性；
8、s5、利用能量罐得到的变阻抗特性将机械臂的分层控制模型扩展为机械臂的分层变阻抗控制模型；
9、s6、通过关节传感器获得的机械臂末端姿态信息和预设的期望机械臂末端姿态信息计算出姿态误差，将姿态误差代入分层变阻抗控制模型计算出各个任务所需的控制力矩，输入到机器人机械臂实现对机械臂的控制。
10、优选的，在s2中，所述根据获取的关节信息建立机械臂的动力学模型，具体包括以下步骤：
11、s21、基于笛卡尔空间方程，建立具有n个自由度的机械臂的动力学模型：
12、
13、λ(ξ)＝j(q)-tm(q)j(q)-1 (2)
14、
15、其中，q和分别表示为关节传感器获得机械臂关节空间坐标位置和坐标速度，ξ、和分别表示为关节传感器获得的机械臂末端笛卡尔空间坐标位置、速度和加速度；λ(ξ)和是相对于坐标位置ξ与坐标速度的惯性矩阵和离心力矩阵，由式(2)和式(3)表示；fg(ξ)＝j(q)-tg(q)表示为机械臂笛卡尔空间重力，j(q)∈rm×n与分别表示为机械臂雅可比矩阵和雅可比矩阵的一阶导，g(q)∈rn×1表示为机械臂关节空间的重力项；fτ表示为模型的输入向量，fext表示为作用到机械臂末端执行器的外力，m(q)∈rn×n表示为机械臂关节空间中的惯量矩阵，表示为机械臂关节空间的科氏力矩阵；s22、令笛卡尔空间坐标速度与机械臂关节空间坐标速度满足以下关系：
16、
17、其中，j(q)∈rm×n为机械臂雅可比矩阵，m表示为末端执行器任务空间的维度，m表示为6，n为机械臂关节数；对于冗余机械臂，n大于6；
18、s23、令关节输入力矩τ与输入向量fτ满足以下关系：
19、τ＝j(q)tfτ (5)
20、s24、令作用到机械臂末端执行器的外力fext映射到机械臂关节空间坐标q：
21、τext＝jt(q)fext (6)
22、其中τext为机械臂关节上受到的外力；
23、s25、通过机器人正运动学方程，引入子任务的坐标向量：
24、
25、其中，r代表子任务的个数，每个子任务的维度为i＝1是最高优先级任务，i＝r是最低优先级任务，对于任意两个任务ia和ib，如果ia<ib，则表示ia比ib的任务优先级高。
26、优选的，在s3中，所述定义任务空间速度坐标，并计算出动力学模型中雅可比矩阵的零空间基矩阵，再根据定义的任务空间速度坐标以及零空间基矩阵将机械臂的动力学模型扩展为机械臂的分层控制模型，具体包括以下步骤：
27、s31、利用每个子任务的雅克比矩阵完成从关节空间速度到任务空间速度的映射：
28、
29、s32、由于式(8)描述的各个子任务的关节空间速度相互耦合，因此定义一种任务空间速度坐标vi表示为：
30、
31、其中，是待确定的扩展雅可比矩阵；
32、s33、通过选择使其是非奇异的以及保证零空间投影的动态一致性，被选择为：
33、
34、其中，最高优先级任务保持与原雅克比矩阵一致，为使符号的统一，令而剩余的低优先级任务和增广矩阵的一个行满秩的零空间基矩阵zi和机器人的惯性矩阵相关；
35、增广矩阵表示为：
36、
37、s34、为了确保低优先级任务不对高优先级任务造成影响，令零空间基矩阵zi表示为：
38、
39、其中，m+表示为机械臂惯性矩阵加权的伪逆，表示为的标准正交基，通过对进行奇异值分解获得；表示为最高优先级任务雅克比矩阵j1的惯性加权伪逆，表示为最低优先级任务利用机械臂所有剩余的自由度；
40、s35、由式(8)和式(11)得到扩展雅克比矩阵的逆矩阵：
41、
42、s36、将式(14)代入式(9)得到：
43、
44、s36、将式(15)代入式(8)得到各个子任务空间的任务空间速度：
45、
46、s37、将式(13)至式(16)代入式(1)至式(3)得到机械臂的分层控制模型：
47、...
【技术保护点】
1.一种基于能量罐的机械臂分层变阻抗控制方法，其特征在于，包括以下步骤：
2.根据权利要求1所述的一种基于能量罐的机械臂分层变阻抗控制方法，其特征在于，在S2中，所述根据获取的关节信息建立机械臂的动力学模型，具体包括以下步骤：
3.根据权利要求2所述的一种基于能量罐的机械臂分层变阻抗控制方法，其特征在于，在S3中，所述定义任务空间速度坐标，并计算出动力学模型中雅可比矩阵的零空间基矩阵，再根据定义的任务空间速度坐标以及零空间基矩阵将机械臂的动力学模型扩展为机械臂的分层控制模型，具体包括以下步骤：
4.根据权利要求3所述的一种基于能量罐的机械臂分层变阻抗控制方法，其特征在于，在S4中，所述在分层控制模型的各个工作空间中设置作为储能元件的能量罐，同时通过能量罐的状态更新率引入机械臂在分层控制模型的各个工作空间的变阻抗特性，具体包括以下步骤：
5.根据权利要求4所述的一种基于能量罐的机械臂分层变阻抗控制方法，其特征在于，在S5中，所述利用能量罐得到的变阻抗特性将机械臂的分层控制模型扩展为机械臂的分层变阻抗控制模型，具体包括以下步骤：
【技术特征摘要】
1.一种基于能量罐的机械臂分层变阻抗控制方法，其特征在于，包括以下步骤：
2.根据权利要求1所述的一种基于能量罐的机械臂分层变阻抗控制方法，其特征在于，在s2中，所述根据获取的关节信息建立机械臂的动力学模型，具体包括以下步骤：
3.根据权利要求2所述的一种基于能量罐的机械臂分层变阻抗控制方法，其特征在于，在s3中，所述定义任务空间速度坐标，并计算出动力学模型中雅可比矩阵的零空间基矩阵，再根据定义的任务空间速度坐标以及零空间基矩阵将机械臂的动力学模型扩展为机械臂的分层...
【专利技术属性】
技术研发人员：刘勇华，邢邓鸿，徐旺，熊义添，张戈猛，苏春翌，
申请(专利权)人：广东工业大学，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。