[发明专利]一种工业机器人轨迹规划原理展示装置及方法

权利要求书

1.一种工业机器人轨迹规划原理展示装置，其特征在于，包括由计算机一、计算机二和真实工业机器人组成的展示装置，所述计算机一显示基于Unity开发的虚拟工业机器人，所述计算机二安装Ubantu实时系统并运行EtherCAT的IGH主站及基于QT开发的机器人控制软件，所述计算机二通过一路EtherCAT网络接口实时控制真实工业机器人，所述计算机二通过一路以太网接口实现对虚拟工业机器人的数据驱动控制，所述展示装置具有虚拟运行模式和虚实同步运行模式，在虚拟运行模式下，计算机二上的机器人控制软件单独驱动控制计算机一上的虚拟工业机器人，在虚实同步运行模式下，通过计算机二分别驱动计算机一上的虚拟工业机器人和真实工业机器人同步运行。

2.根据权利要求1所述的一种工业机器人轨迹规划原理展示装置，其特征在于，所述计算二具有演示性的控制界面，用户可以通过手动控制，分别在空间坐标系下以及关节坐标系下进行点动运行。

3.一种如权利要求1～2任一项所述的工业机器人轨迹规划原理展示装置的展示方法，其特征在于，包括以下步骤：

S1：搭建虚拟仿真平台；

S2：进行参数配置，创建网络连接；

S3：依据虚拟工业机器人的连杆坐标系、连杆参数和各关节DH参数，进行运动学正解和运行学逆解；

S4：机器人控制软件展示空间点到点关节运动插补原理(MOVJ)，通过输入起点、终点，利用三次样条插值进行关节运动插补；

S5：在机器人控制软件展示空间直线轨迹规划插补原理(MOVL)和空间圆弧轨迹规划插补原理(MOVC)，通过输入起始点、中间点与终止点，设置插补周期、插补速度、加减速方式，进行连续轨迹运动插补。

S6：通过机器人控制软件分别导入用户根据插补原理计算得到的关节插补数据、直线插补数据、圆弧插补数据，机器人控制软件将用户插补轨迹与系统自有算法插补轨迹进行比较，验证用户的插补算法正确性及精确性。

S7：连接真实机器人，在虚实同步控制模式下，进一步观察、验证插补算法正确性及精确性。

4.根据权利要求3所述的一种工业机器人轨迹规划原理展示装置的展示方法，其特征在于，所述S1中，首先在计算机二上安装Linux下的Ubantu实时系统并建立EtherCAT的IGH主站，将机器人模型导入计算机一基于Unity开发的软件中，设置机器人运动约束，和实际控制参数绑定；计算机一和计算机二之间通过以太网实现数据的传输；计算机二通过EtherCAT的IGH主站实时控制真实工业机器人运动。

5.根据权利要求3所述的一种工业机器人轨迹规划原理展示装置的展示方法，其特征在于，所述S3中，运动学正解的计算方法：虚拟工业机器人从关节1到关节6进行坐标变换，结果就是末端的位置坐标；运动学逆解的计算方法：根据末端位姿解算出关节角，这里的算法为首先求解虚拟工业机器人末端旋转变换矩阵，接着利用解析法求解6个关节值，求出8组解；并通过判断筛选各关节角范围内的解，设置末端执行器空间坐标系下的位姿，利用虚拟工业机器人逆解算出关节角。

6.根据权利要求3所述的一种工业机器人轨迹规划原理展示装置的展示方法，其特征在于，所述S4中，点到点关节运动插补模式是首先利用逆运动学得到目标位姿的各个关节角，然后在关节坐标系下，各关节采用三次样条插值方法实时计算得到每个时刻关节角。

7.根据权利要求3所述的一种工业机器人轨迹规划原理展示装置的展示方法，其特征在于，所述S5中，空间直线和空间圆弧连续轨迹插补模式是首先在笛卡尔坐标系下根据插补周期、插补速度、加减速方式计算得到各插补点位姿，然后根据逆运动学实时计算得到各关节角。

8.根据权利要求3所述的一种工业机器人轨迹规划原理展示装置的展示方法，其特征在于，可以通过机器人控制软件导入用户计算的插补数据，与系统自有算法插补轨迹进行比较，验证用户的插补算法正确性及精确性，还可以通过连接真实机器人，通过虚实同步控制，进一步验证用户的插补算法正确性及精确性。