一种基于角度传感器的串并联机器人末端姿态闭环控制方法技术

本发明专利技术涉及一种基于角度传感器的串并联机器人末端姿态闭环控制方法。本方法是：将角度传感器安装在串并联机器人末端法兰盘的安装槽中，并用螺钉固定，测量得到机器人在大地坐标系下绕x轴和绕z轴的姿态角。通过坐标转化，大地坐标系下的姿态角转化为机器人基坐标系下的位姿矩阵。然后根据串并联机器人的运动学模型，通过逆运动学求解得到当前位姿下机器人的实际关节变量，从而得到各关节的关节误差。对关节误差进行补偿，实现串并联机器人末端位姿的闭环控制。该方法基于角度传感器实现闭环控制，集成方便，不影响末端执行器的安装，能够提高机器人的末端姿态精度，适用于一些对末端姿态精度要求较高的场合。

A Closed-loop Control Method for Terminal Attitude of Series-Parallel Robot Based on Angle Sensor

The present invention relates to a closed-loop control method for the terminal attitude of a series-parallel robot based on an angle sensor. This method is to install the angle sensor in the installation groove of the end flange of the serial-parallel Robot and fix it with screw. The attitude angles of the robot around the x-axis and Z-axis in the geodetic coordinate system are measured. Through coordinate transformation, the attitude angle in the geodetic coordinate system is transformed into the pose matrix in the basic coordinate system of the robot. Then, according to the kinematics model of the serial-parallel robot, the actual joint variables of the robot in the current position and posture are obtained by inverse kinematics solution, and the joint errors of each joint are obtained. The joint error is compensated to realize the closed-loop control of the position and posture of the end of the serial-parallel robot. The method realizes closed-loop control based on angle sensor, which is easy to integrate and does not affect the installation of end-effector. It can improve the attitude accuracy of the end-effector of the robot. It is suitable for some occasions where the attitude accuracy of the end-effector is high.

【技术实现步骤摘要】
一种基于角度传感器的串并联机器人末端姿态闭环控制方法
本专利技术涉及一种基于角度传感器的串并联机器人末端姿态闭环控制方法。
技术介绍
在现代的自动化生产中机器人占据着及其重要的地位。相比于传统的机床加工，机器人有着更好的灵活性和更大的运动空间。但是机器人的精度相对较低，在一些精密件的加工领域机器人还不能取代机床得到很好的应用。一些精度要求较高，运动空间要求较大的场合就需要在应用机器人的情况下尽可能提高其加工精度。串并联机器人结合了并联机器人和串联机器人的优点，加工精度较高，运动空间较大。在此基础上运用闭环控制方法，对机器人位姿进行误差补偿，可有效提高机器人精度，满足更多的应用需求。目前机器人的控制方法主要有两种：半闭环控制和闭环控制。半闭环控制方法通过电机编码器进行误差补偿，只能补偿电机的转动误差，不能有效的提高末端位姿精度。在此基础上，在关节传动件的末端添加光电编码器进行误差补偿，可消除传动件的传动误差，提高末端位姿精度。但此方法需要多个光电编码器，而且只能补偿传动误差，对于一些结构参数的误差无法消除。本专利技术在末端法兰盘安装角度传感器，通过测量得到实际末端位姿并基于运动学进行误差补偿，从全局进行误差补偿可有效提高机器人加工精度。
技术实现思路
本专利技术的目的在于针对已有技术存在的缺陷，提供一种基于角度传感器的串并联机器人末端姿态闭环控制方法，为达到上述目的，本专利技术采用全局进行误差补偿而有效提高机器人的加工精度。本专利技术的构思是：本专利技术将角度传感器安装在串并联机器人末端法兰盘的安装槽中，并用螺钉固定，测量得到机器人在大地坐标系下绕x轴和绕z轴的姿态角。通过坐标转化，大地坐标系下的姿态角转化为机器人基坐标系下的的位姿矩阵。然后根据串并联机器人的运动学模型，通过逆运动学求解得到当前位姿下机器人的实际关节变量，从而得到各关节的关节误差。对关节误差进行补偿，实现串并联机器人末端位姿的闭环控制。该方法基于角度传感器实现闭环控制，集成方便，不影响末端执行器的安装，能够提高机器人的末端姿态精度，适用于一些对末端姿态精度要求较高的场合。如图1所示。给定机器人某一点位姿，通过逆运动学求解得到关节变量J。关节变量J传递给控制器，然后带动伺服系统和传动系统执行运动命令。其中，系统传函包括伺服系统和传动系统的传递函数。在机器人运动的过程中，角度传感器测得当前末端姿态A1,B1。然后通过坐标转化得到基于串并联机器人基坐标系的末端位姿，逆运动学求解得到当前关节变量，从而得到关节误差ΔJ。数据处理单元包括坐标转化，逆运动学求解，各关节误差求解。求得的关节误差补偿到关节变量中，便可提高机器人的精度。(J＝[q1,q2,q3,β1,β2]T,ΔJ＝[Δq1,Δq2,Δq3,Δβ1,Δβ2]T)根据上述专利技术构思，本专利技术采用下述技术方案：一种基于角度传感器的串并联机器人末端姿态闭环控制方法，其特征在于采用如下闭环控制系统，包括逆运动学模型(4)、控制器(1)、系统传函(5)、角度传感器(2)和数据处理单元(7)；给定位姿XYZAB(3)通过逆运动学模型(4)求解得到串并联机器人的关节变量J,然后传递到控制器(1)，控制器(1)的控制信号传递到传动机构的系统传函(3)得到串并联机器人实际位姿X1Y1Z1A1B1(6)；角度传感器(2)检测到串并联机器人末端姿态角A1B1，并传递到数据处理单元(7)得到关节变量误差ΔJ，ΔJ与J的差值作为输入值传递给控制器(1)，实现串并联机器人末端姿态的闭环控制；具体操作步骤如下：1)将角度传感器(2)安装在串并联机器人末端法兰盘的安装槽(A)中，并用螺钉固定，在机器人运动过程中测得末端坐标系与大地坐标系x轴的夹角σ、与y轴的夹角θ；2)角度传感器(2)测得的基于大地坐标系的两个角度参数，以矩阵形式描述当前末端执行器在大地坐标系下的位姿Tw，通过坐标转换得到末端执行器在串并联机器人基坐标系下的位姿矩阵To；3)建立运动学模型，通过逆运动学求解得到当前位姿下串并联机器人的实际关节变量q′1,q′2,q′3,β′1,β′2，其中q′1代表支链1(3′)的实际关节长度，q′2代表支链2(5′)的实际关节长度，q′3代表支链3(4′)的实际关节长度，β′1代表旋转关节1(7′)的实际关节角度，β′2代表旋转关节2(8′)的实际关节角度；4)已知当前串并联机器人的关节控制变量q1,q2,q3,β1,β2，求出当前位姿下的关节变量误差Δq1,Δq2,Δq3,Δβ1,Δβ2，对各关节变量进行误差补偿，从而提高机器人的末端姿态精度,其中q1代表支链1(3′)的理论关节长度，q2代表支链2(5′)的理论关节长度，q3代表支链3(4′)的理论关节长度，β1代表旋转关节1(7′)的理论关节角度，β2代表旋转关节2(8′)的理论关节角度，Δqi＝qi-q′i,i＝1,2,3；Δβi＝βi-β′i,i＝1,2。根据以上步骤所述，测量末端姿态需要用到角度传感器。该串并联机器人有五个自由度(两转三移)，为了测量末端执行器的姿态可选用高精度双轴倾角仪。通过该倾角仪可测得末端坐标系相对于大地坐标系x轴，y轴的夹角。该倾角仪分辨率为0.0005°，精度0.002°，输入电压可选11-35V的直流电，输出频率可选5-100Hz，产品输出可选RS232，RS485，和CAN总线。为了保证倾角仪测得的角度为末端坐标系相对于大地坐标系x轴，y轴的夹角，在该串并联机器人上把倾角仪安装在五轴与末端执行器连接的法兰盘上，并保证倾角仪在零度角的情况下与大地水平。倾角仪尺寸为103.8*55.4*26mm，安装孔直径4mm*3。在连接法兰上开一个110*60*30mm的槽，并用螺钉固定安装在槽中。如图3所示，A为角度传感器的安装槽，B为角度传感器的安装孔，C为角度传感器工作原理示意。根据步骤2)所述，角度传感器测得的基于大地坐标系的两个角度参数(σ、θ)需要通过坐标转化转换为末端执行器在串并联机器人基坐标系下的位姿矩阵。如图4所示，A1A2A3为定平台，B1B2B3为动平台，q1,q2,q3为三根直动链关节变量，beta1，beta2为两个转动关节变量。混联机器人的基坐标系为O-x1y1z1,大地坐标系为O-x2y2z2,角度传感器本身的坐标系为O-x3y3z3,其坐标系方向与大地坐标系方向相同。末端执行器在大地坐标系下的位置坐标为(xw,yw,zw)，转换方法如下：①大地坐标系下的位姿矩阵Tw:②转换矩阵该转换矩阵在不同情况下有不同的使用情况。当机器人基坐标系与大地坐标系方向一致时为单位矩阵；当机器人基坐标系与大地坐标系不一致时，根据基坐标系的改变而改变，表示大地坐标系转化为基坐标系的变化矩阵。③基坐标系下的位姿矩阵To：根据步骤3)所述，串并联机器人基坐标系下的当前位姿需要通过逆运动学求解得到当前位姿下的关节变量。本专利技术中运动学求解采用模块化方法，并联部分作为一个模块，可用一个变换矩阵T0表示其末端位姿。然后就可按照串联机器人运动学建模方法对串并联机器人进行运动学建模。通过建立DH模型，串并联机器人串联1关节的变化矩阵T1，串联2关节变化矩阵T2，末端位姿矩阵Th：Th＝T0*T1*T2公式两段各右乘以T2的逆矩阵，可求得两个串联关节得关节变量β′1，β本文档来自技高网...

【技术保护点】
1.一种基于角度传感器的串并联机器人末端姿态闭环控制方法，其特征在于采用如下闭环控制系统，包括逆运动学模型(4)、控制器(1)、系统传函(5)、角度传感器(2)和数据处理单元(7)；给定位姿XYZAB(3)通过逆运动学模型(4)求解得到串并联机器人的关节变量J,然后传递到控制器(1)，控制器(1)的控制信号传递到传动机构的系统传函(3)得到串并联机器人实际位姿X1Y1Z1A1B1(6)；角度传感器(2)检测到串并联机器人末端姿态角A1B1，并传递到数据处理单元(7)得到关节变量误差ΔJ，ΔJ与J的差值作为输入值传递给控制器(1)，实现串并联机器人末端姿态的闭环控制；具体操作步骤如下：1)将角度传感器(2)安装在串并联机器人末端法兰盘的安装槽(A)中，并用螺钉固定，在机器人运动过程中测得末端坐标系与大地坐标系x轴的夹角σ、与y轴的夹角θ；2)角度传感器(2)测得的基于大地坐标系的两个角度参数，以矩阵形式描述当前末端执行器在大地坐标系下的位姿Tw，通过坐标转换得到末端执行器在串并联机器人基坐标系下的位姿矩阵To；3)建立运动学模型，通过逆运动学求解得到当前位姿下串并联机器人的实际关节变量q′1,q′2,q′3,β′1,β′2，其中q′1代表支链1(3′)的实际关节长度，q′2代表支链2(5′)的实际关节长度，q′3代表支链3(4′)的实际关节长度，β′1代表旋转关节1(7′)的实际关节角度，β′2代表旋转关节2(8′)的实际关节角度；4)已知当前串并联机器人的关节控制变量q1,q2,q3,β1,β2，求出当前位姿下的关节变量误差Δq1,Δq2,Δq3,Δβ1,Δβ2，对各关节变量进行误差补偿，从而提高机器人的末端姿态精度,其中q1代表支链1(3′)的理论关节长度，q2代表支链2(5′)的理论关节长度，q3代表支链3(4′)的理论关节长度，β1代表旋转关节1(7′)的理论关节角度，β2代表旋转关节2(8′)的理论关节角度，Δqi＝qi‑q′i,i＝1,2,3；Δβi＝βi‑β′i,i＝1,2。...

【技术特征摘要】
2018.03.30 CN 20181029443641.一种基于角度传感器的串并联机器人末端姿态闭环控制方法，其特征在于采用如下闭环控制系统，包括逆运动学模型(4)、控制器(1)、系统传函(5)、角度传感器(2)和数据处理单元(7)；给定位姿XYZAB(3)通过逆运动学模型(4)求解得到串并联机器人的关节变量J,然后传递到控制器(1)，控制器(1)的控制信号传递到传动机构的系统传函(3)得到串并联机器人实际位姿X1Y1Z1A1B1(6)；角度传感器(2)检测到串并联机器人末端姿态角A1B1，并传递到数据处理单元(7)得到关节变量误差ΔJ，ΔJ与J的差值作为输入值传递给控制器(1)，实现串并联机器人末端姿态的闭环控制；具体操作步骤如下：1)将角度传感器(2)安装在串并联机器人末端法兰盘的安装槽(A)中，并用螺钉固定，在机器人运动过程中测得末端坐标系与大地坐标系x轴的夹角σ、与y轴的夹角θ；2)角度传感器(2)测得的基于大地坐标系的两个角度参数，以矩阵形式描述当前末端执行器在大地坐标系下的位姿Tw，通过坐标转换得到末端执行器在串并联机器人基坐标系下的位姿矩阵To；3)建立运动学模型，通过逆运动学求解得到当前位姿下串并联机器人的实际关节变量q′1,q′2,q′3,β′1,β′2，其中q′1代表支链1(3′)的实际关节长度，q′2代表支链2(5′)的实际关节长度，q′3代表支链3(4′)的实际关节长度，β′1代表旋转关节1(7′)的实际关节角度，β′2代表旋转关节2(8′)的实际关节角度；4)已知当前串并联机器人...

【专利技术属性】
技术研发人员：沈南燕，禹壮，耿亮，叶飞，李静，张俊，
申请(专利权)人：上海大学，
类型：发明
国别省市：上海,31