绳驱动并联机器人具有惯性低、容易调整、质量轻、出现损耗容易更换等优点,应用前景广泛。但是绳子的柔性特点造成其运动时所需的控制电机数量要大于其运动自由度的数量且执行机构刚度不够,这样造成控制困难,控制精度低、环境适应性差等问题。为了解决这些问题,需要降低电机数量和提升机器人的刚度,本文基于标准万向节铰链,通过刚柔结合原理,实现了并联机器人的少电机、模块化、多关节绳驱动,并通过求解其运动学和轨迹规划,使其末端能够实现圆形轨迹。 Rope driven parallel robots have the advantages of low inertia, easy adjustment, light weight, and easy replacement in case of wear and tear, and have a wide range of application prospects. However, the flexible nature of the rope results in a greater number of control motors required for its movement than its degrees of freedom, and insufficient stiffness of the actuator, which leads to control difficulties, low control accuracy, and poor environmental adaptability. In order to solve these problems, it is necessary to reduce the number of motors and improve the stiffness of the robot. Based on the standard universal joint hinge and the principle of rigid flexible combination, this paper realizes the small motor, modular, and multi joint rope drive of the parallel robot. By solving its kinematics and trajectory planning, the end can achieve a circular trajectory.
绳驱动并联机器人具有惯性低、容易调整、质量轻、出现损耗容易更换等优点,应用前景广泛。但是绳子的柔性特点造成其运动时所需的控制电机数量要大于其运动自由度的数量且执行机构刚度不够,这样造成控制困难,控制精度低、环境适应性差等问题。为了解决这些问题,需要降低电机数量和提升机器人的刚度,本文基于标准万向节铰链,通过刚柔结合原理,实现了并联机器人的少电机、模块化、多关节绳驱动,并通过求解其运动学和轨迹规划,使其末端能够实现圆形轨迹。
绳驱动机器人,并联机器人,轨迹规划,刚柔结合
Zihan Li, Yuesong Li, Shuai Zheng, Hongwei Li
School of Mechatronics Engineering, Henan University of Science and Technology, Luoyang Henan
Received: Apr. 12th, 2024; accepted: May 24th, 2024; published: May 31st, 2024
Rope driven parallel robots have the advantages of low inertia, easy adjustment, light weight, and easy replacement in case of wear and tear, and have a wide range of application prospects. However, the flexible nature of the rope results in a greater number of control motors required for its movement than its degrees of freedom, and insufficient stiffness of the actuator, which leads to control difficulties, low control accuracy, and poor environmental adaptability. In order to solve these problems, it is necessary to reduce the number of motors and improve the stiffness of the robot. Based on the standard universal joint hinge and the principle of rigid flexible combination, this paper realizes the small motor, modular, and multi joint rope drive of the parallel robot. By solving its kinematics and trajectory planning, the end can achieve a circular trajectory.
Keywords:Rope Driven Robot, Parallel Robot, Trajectory Planning, Combination of Rigidity and Flexibility
Copyright © 2024 by author(s) and beplay安卓登录
This work is licensed under the Creative Commons Attribution International License (CC BY 4.0).
http://creativecommons.org/licenses/by/4.0/
绳驱动并联机构就是通过使用绳索来进行传动的一种并联机构,相比传统的机械结构绳驱动损耗小,结构相对简单,有很好的韧性,运动机构质量小,同时具备并联结构承载能力强的优点 [
虽然绳驱动并联机器人具有惯性低、容易调整、质量轻、出现损耗容易更换等优点,但是绳子的柔性特点造成其运动时所需的控制电机数量要大于其运动自由度的数量且执行机构刚度不够,这样造成控制困难,控制精度低、环境适应性差等问题。为了提升应用范围,降低电机数量和提升机器人的刚度,本文基于标准万向节,设计了一种少电机、模块化、多关节绳驱动并联机器人。本文将对此机器人的结构、工作原理以及运行情况进行论述,为此类绳驱动并联机器人的应用奠定基础。
模块化多关节绳驱动并联机器人的结构示意图,如图1所示,其主要组成部分包括末端执行器、绳索、步进电机、万向节等组成,其三维结构如图2所示,实物如图3所示。
图1. 绳驱动并联机器人的结构示意图
图2. 绳驱动并联机器人的三维视图
图3. 绳驱动并联机器人实物图
由图1~3可知,模块化多关节绳驱动并联机器人的运动由三个步进电机控制,步进电机上有绕线轮,绕线轮上缠着钢丝绳,可以控制钢丝绳的长短。钢丝绳与末端执行器相连,末端执行器部件与万向节铰链相连,万向节铰链固定在支架上,末端执行部件可以带动万向节铰链产生旋转。通过步进电机旋转可以实现三根钢丝绳的长度控制,由于钢丝绳与末端执行部件相连,可以控制末端执行部件的X和Y的位置,通过万向节铰链的旋转可以实现末端执行部件Z方向(即高度方向)的控制。从而实现三个电机控制末端执行部件坐标位置(X, Y, Z)。由于万向节铰链的存在,Z方向的重力不仅仅依靠绳子拉力克服,因此绳子上受力较小,其弹性伸缩带来的误差能够减少。
图4. 控制系统原理图
模块化多关节绳驱动并联机器人的控制系统由图4所示,其由上位机电脑、Arduino控制板、步进电机驱动器和三个步进电机构成,电脑发送指令到Arduino控制板使其产生脉冲,控制步进电机驱动器输出电流驱动各自步进电机运动角度。步进电机带动绕线轮旋转,控制绳索的长短,实现末端执行部件的位置控制。实物的控制系统如图5所示。
图5. 控制系统实物
运动学的位置分析需要确定关节位置、重心位置和绳索与步进电机水平轴的角度。图1中考虑了步进电机端节点B和万向节法兰盘端点A的平面分析。因为绳索在万向节重力的拉扯下始终保持绷紧状态可以近似看作不具有刚性的连杆机构。设(XA, YA)为相对于参考框架xOy的端点A的坐标,(XB, YB)为具有相同参考框架的端点B的坐标。使用方程组可以编写以下关系
( X B − X A ) 2 + ( Y B − Y A ) 2 = A B 2 = L A B 2 (1)
LAB连接AB的长度。设φ是连杆AB与水平轴Ox的角度。然后,将链接AB的斜率m定义为:
m = tan ∂ = Y B − Y A X B − X A (2)
设n为AB与垂直轴Oy的截距。利用斜率m和截距n,平面上直线连杆的方程是:y = mX + n其中x和y是这个链接上任意点的坐标。
LAB的长度取决于步进电机运动的步数,28BYJ-48步进电机的齿轮减速比为64:1,在4细分模式下,步进电机32步旋转一周,步进角11.25˚/步。由于存在齿轮减速,每个步进角对应输出轴的输出角度为11.25˚/64。步进电机上的法兰盘外径为10 mm周长为7.85 mm,即步进电机每逆时针(或顺时针主要取决于程序的编写和电机的安装位置)转动一周LAB长度减少7.85 mm,顺时针(或逆时针主要取决于程序的编写和电机的安装位置)转动一周LAB长度增加7.85 mm。那么利用公式(1)可知因为B点坐标始终不变就可以通过控制LAB的长度来实现A点坐标的变动,从而实现位置控制。
本次设计要实现万向节下端作为平台的法兰盘的运动轨迹为一个直径4 cm圆,首先通过预先模拟的方式,采用描点法,进行预演。因为要画出一个圆可分解为两个圆弧,根据描点法一个圆弧需要选定三个点作为运动规划,因此选取六个点作为机器人的运动规划。
运用描点法时需要进行相关数据的测量,由于在方程的分析中假定绳索的角度不变,但是在实际过程中绳索的角度会有一定的变化因此存在一定的误差。
在机械机构运动到第一个测定点时,图中右侧步进电机的运动应当是收缩绳索的状态,此时绳索的长度为7.8厘米,图中上侧边角的步进电机的运动应当是收缩状态,此时绳索的长度为11.6厘米,图中左侧下方电机运动状态应当是释放状态,此时绳索长度为14.2厘米。
在机械机构运动到第二个测定点时,图中右侧步进电机的运动应当是释放绳索的状态,此时绳索的长度为10.3厘米,图中上侧边角的步进电机的运动应当是收缩状态,此时绳索的长度为9.6厘米,图中左侧下方电机运动状态应当是收缩状态,此时绳索长度为10.5厘米。
在机械机构运动到第三个测定点时,图中右侧步进电机的运动应当是释放绳索的状态,此时绳索的长度为11.2厘米,图中上侧边角的步进电机的运动应当是收缩状态,此时绳索的长度为9.1厘米,图中左侧下方电机运动状态应当是收缩状态,此时绳索长度为8.4厘米。
在机械机构运动到第四个测定点时,图中右侧步进电机的运动应当是收缩绳索的状态,此时绳索的长度为7.6厘米,图中上侧边角的步进电机的运动应当是收缩状态,此时绳索的长度为13.6厘米,图中左侧下方电机运动状态应当是收缩状态,此时绳索长度为8.8厘米。
在机械机构运动到第五个测定点时,图中右侧步进电机的运动应当是收缩绳索的状态,此时绳索的长度为7.9厘米,图中上侧边角的步进电机的运动应当是收缩状态,此时绳索的长度为11.6厘米,图中左侧下方电机运动状态应当是释放状态,此时绳索长度为14.2厘米。
在机械机构运动到第六个测定点时,图中右侧步进电机的运动应当是收缩绳索的状态,此时绳索的长度为7.8厘米,图中上侧边角的步进电机的运动应当是收缩状态,此时绳索的长度为10.8厘米,图中左侧下方电机运动状态应当是释放状态,此时绳索长度为13.8厘米。
规划完成后,导入计算机,通过运行可得绳驱动机器人圆形轨迹运动如图6所示。
图6. 绳驱动机器人圆形轨迹运动
针对绳子的柔性造成绳驱动并联机器人运动时所需的控制电机数量要大于其运动自由度的数量以及其执行机构刚度不够造成控制精度低、环境适应性差等问题,本文提出了一种基于万向节铰链的多关节、模块化绳驱动机器人,每个机器人有三个电机控制,分别实现三自由度运动,通过对三自由度绳驱动机器人的结构分析、轨迹规划和控制系统设计,达到其末端机构能够实现圆形轨迹。
本项目获得河南省大学生创新创业训练计划项目(202310464002)资助。
李子含,李跃松,郑 帅,李泓葳. 模块化多关节绳驱动并联机器人设计Design of Modular Multi Joint Rope Driven Parallel Robot[J]. 人工智能与机器人研究, 2024, 13(02): 419-424. https://doi.org/10.12677/airr.2024.132043