一种基于串联机器人的倒立摆教学系统及控制方法技术方案

本发明专利技术涉及一种基于串联机器人的倒立摆教学系统及控制方法，包括以下步骤：初始化倒立摆参考输入；将参考输入与采集数据比较，分别计算控制误差，包括：水平运动位置误差、速度误差、旋转角度误差及角速度的误差；根据控制误差，利用倒立摆控制算法计算机器人期望控制量；根据期望控制量，利用机器人控制算法得到驱动机器人运动所需的控制量，将该控制量发送至机器人；采集倒立摆运动状态并反馈至采集数据中，倒立摆运动状态包括水平运动位置与速度、旋转角度与角速度，实现倒立摆的闭环控制。本发明专利技术能够满足高校在机器人、自动控制等相关学科方向的教学实验需求，能够帮助学生将所学到的专业知识应用到具体的工程项目中。

【技术实现步骤摘要】
一种基于串联机器人的倒立摆教学系统及控制方法
本专利技术涉及机器人、自动控制及相关教学等领域。具体的说是一种基于串联机器人的倒立摆教学系统及控制方法。
技术介绍
倒立摆系统广泛应用于军工、航天、行走机器人等领域。而串联机器人又在工业生产、科学研究甚至人民生活中起着重要作用。急需高校培养大量专业技术人员，对高校在相关领域的教学提出了更高的要求。因此，高校对相关领域的教学设备需求巨大。目前将机器人与倒立摆结合的教学设备较为缺乏。机器人与倒立摆结合的教学系统能够更加全面的培养学生的能力，同时也能促进多个
的融合。
技术实现思路
本专利技术目的是提供一种基于串联机器人的倒立摆教学系统及控制方法，用于满足高校对机器人及自动控制等相关学科的教学需求。如：机器人运动学、机器人轨迹规划、倒立摆控制等算法的教学与实验。本专利技术解决其技术问题所采用的技术方案是：一种基于串联机器人的倒立摆教学系统控制方法，包括以下步骤：初始化倒立摆参考输入：水平运动位置与速度、旋转角度与角速度；将参考输入与采集数据比较，分别计算控制误差，包括：水平运动位置误差、速度误差、旋转角度误差及角速度的误差；根据控制误差，利用倒立摆控制算法得到机器人末端期望控制量；根据期望控制量，利用机器人控制算法得到驱动机器人运动所需的控制量，将该控制量发送至机器人；采集倒立摆运动状态并反馈至采集数据中，倒立摆运动状态包括水平运动位置与速度、旋转角度与角速度，实现倒立摆的闭环控制。所述机器人控制算法包括以下步骤：对期望控制量即机器人末端加速度进行插补和积分，从而获取机器人末端期望位置偏移量，再利用逆运动学，求解每个关节的控制量，进而驱动机器人实现期望的运动。所述机器人控制算法的控制周期与倒立摆控制算法的控制周期不同。所述机器人控制算法的控制周期与倒立摆控制算法的控制周期满足如下关系：Ti＝c·Tr其中：Ti为倒立摆控制周期；Tr为机器人控制周期；c为大于0的整数。一种基于串联机器人的倒立摆教学系统，包括旋转角采集设备、摆杆、机器人与旋转角采集设备连接装置、旋转角采集设备与摆杆连接装置；所述机器人与旋转角采集设备连接装置将旋转角采集设备固定于机器人末端法兰上，用于调节旋转角采集设备与法兰的距离及倾角；所述旋转角采集设备与摆杆连接装置将旋转角采集设备与摆杆末端连接，用于保证旋转采集设备与摆杆同轴旋转，且在非旋转方向上具有弹性。所述机器人与旋转角采集设备连接装置采用金属连接件将旋转角采集设备连接到机器人法兰；该金属连接件两端具有固定机器人法兰和旋转角采集设备的卡槽，中间具有调整两端卡槽的距离和倾角的旋钮。所述旋转角采集设备与摆杆连接装置为圆柱体形状，两端分别具有固定旋转角采集设备和摆杆的孔位，中间为非旋转方向的弹性结构。所述旋转角采集设备的旋转轴与摆杆同轴，且非旋转方向具有弹性。所述旋转角采集设备为编码器。本专利技术具有以下有益效果及优点：1.本专利技术提供了一种安装简单、操作方便、价格低廉的教学系统。能够满足高校在机器人、自动控制等相关学科方向的教学实验需求，能够帮助学生将所学到的专业知识应用到具体的工程项目中。通过理论与实践结合的实验课程提升学生的专业素质能力。2.本专利技术将机器人倒立摆控制算法拆分成机器人控制算法和倒立摆控制算法，且二者之间不存在耦合关系，可以分别进行设计。3.本专利技术通过引人周期控制参数，允许机器人控制算法和倒立摆控制算法采用不同的控制周期，能够显著增强控制系统的稳定性。附图说明图1为本专利技术一种基于串联机器人的倒立摆装置教学系统示意图。其中1-串联机器人；2-机器人法兰盘；3-旋转角采集设备；4-摆杆；5-机器人与旋转角采集设备连接装置；6-旋转角采集设备与摆杆连接装置；7-机器人及倒立摆控制处理器；8-机器人控制数据传输线；9-数据采集传输线；10-算法开发平台；11-网线(或无线)。图2为本专利技术基于串联机器人的倒立摆教学系统控制流程。图3为本专利技术基于串联机器人的倒立摆教学系统的机器人控制算法流程图。图4为倒立摆控制周期与机器人控制周期的关系示意图。其中μ倒立摆的期望控制量。具体实施方式下面结合实施例对本专利技术做进一步的详细说明。一种基于串联机器人的倒立摆装置教学系统包括一个串联机器人、旋转角采集设备、摆杆、机器人与旋转角采集设备连接装置、旋转角采集设备与摆杆连接装置、机器人及倒立摆控制处理器、算法开发平台。其中串联机器人和机器人及倒立摆控制处理器组成机器人系统，旋转角采集设备、摆杆、机器人与旋转角采集设备连接装置、旋转角采集设备与摆杆连接装置组成倒立摆系统。串联机器人用于带动倒立摆系统在工作空间中进行线性运动，以维持倒立摆系统的平衡。旋转角采集设备用于采集摆杆的偏转角度，并将偏转角度数据传输至机器人及倒立摆控制处理器。机器人及倒立摆控制处理器用于根据摆杆的偏角状态计算期望的机器人控制量。负责控制算法的运行。机器人与旋转角采集设备连接装置将旋转角采集设备固定在机器人末端法兰上，并用于调节二者距离及倾角。旋转角采集设备与摆杆连接装置用于连接旋转角采集设备与摆杆，并在非旋转方向上具有一定弹性。算法开发平台用于机器人运动控制算法开发和倒立摆控制算法开发，并通过有线或无线远程部署的机器人及倒立摆控制处理器中，同时在系统运行过程中进行运行状态的监控与显示。一种基于串联机器人的倒立摆教学系统控制方法包括机器人控制部分和倒立摆控制部分。机器人控制部分用于实现机器人运动控制；倒立摆控制部分用于维持倒立摆的平衡状态。为了保证机器人运动的平滑化，需要对倒立摆的期望输入进行插补。倒立摆控制周期与机器人控制周期的关系示意图，如图4所示。图1为本专利技术所采用的基于串联机器人的倒立摆装置教学系统示意图，包括机器人；一个串联机器人、旋转角采集设备、摆杆、机器人与旋转角采集设备连接装置、旋转角采集设备与摆杆连接装置、机器人及倒立摆控制处理器、算法开发平台。其中串联机器人和机器人及倒立摆控制处理器组成机器人系统，旋转角采集设备、摆杆、机器人与旋转角采集设备连接装置、旋转角采集设备与摆杆连接装置组成倒立摆系统。其中串联机器人用于带动倒立摆系统在工作空间中进行线性运动，以维持倒立摆系统的平衡。旋转角采集设备用于采集摆杆的偏转角度，并将偏转角度数据传输至机器人及倒立摆控制处理器。机器人及倒立摆控制处理器用于根据摆杆的偏角状态计算期望的机器人控制量。负责控制算法的运行。机器人与旋转角采集设备连接装置将旋转角采集设备固定在机器人末端法兰上，并用于调节二者距离及倾角。旋转角采集设备与摆杆连接装置用于连接旋转角采集设备与摆杆，并在非旋转方向上具有一定弹性。算法开发平台由于机器人运动控制算法开发和倒立摆控制算法开发，并通过有线或无限远程部署的机器人及倒立摆控制处理器中，同时在系统运行过程中进行运行状态的监控与显示。如图2所示本文档来自技高网...

【技术保护点】
1.一种基于串联机器人的倒立摆教学系统控制方法，其特征在于包括以下步骤：/n初始化倒立摆参考输入：水平运动位置与速度、旋转角度与角速度；/n将参考输入与采集数据比较，分别计算控制误差，包括：水平运动位置误差、速度误差、旋转角度误差及角速度的误差；/n根据控制误差，利用倒立摆控制算法得到机器人末端期望控制量；/n根据期望控制量，利用机器人控制算法得到驱动机器人运动所需的控制量，将该控制量发送至机器人；采集倒立摆运动状态并反馈至采集数据中，倒立摆运动状态包括水平运动位置与速度、旋转角度与角速度，实现倒立摆的闭环控制。/n

【技术特征摘要】
1.一种基于串联机器人的倒立摆教学系统控制方法，其特征在于包括以下步骤：
初始化倒立摆参考输入：水平运动位置与速度、旋转角度与角速度；
将参考输入与采集数据比较，分别计算控制误差，包括：水平运动位置误差、速度误差、旋转角度误差及角速度的误差；
根据控制误差，利用倒立摆控制算法得到机器人末端期望控制量；
根据期望控制量，利用机器人控制算法得到驱动机器人运动所需的控制量，将该控制量发送至机器人；采集倒立摆运动状态并反馈至采集数据中，倒立摆运动状态包括水平运动位置与速度、旋转角度与角速度，实现倒立摆的闭环控制。


2.根据权利要求1所述的一种基于串联机器人的倒立摆教学系统控制方法，其特征在于，所述机器人控制算法包括以下步骤：
对期望控制量即机器人末端加速度进行插补和积分，从而获取机器人末端期望位置偏移量，再利用逆运动学，求解每个关节的控制量，进而驱动机器人实现期望的运动。


3.根据权利要求1所述的一种基于串联机器人的倒立摆教学系统控制方法，其特征在于，所述机器人控制算法的控制周期与倒立摆控制算法的控制周期不同。


4.根据权利要求1或3所述的一种基于串联机器人的倒立摆教学系统控制方法，其特征在于，所述机器人控制算法的控制周期与倒立摆控制算法的控制周期满足如下关系：
Ti＝c·Tr
其中：Ti为倒立摆控制周期；Tr为机...

【专利技术属性】
技术研发人员：韩冰，刘广辉，张华良，王福东，杨帆，
申请(专利权)人：中国科学院沈阳自动化研究所，
类型：发明
国别省市：辽宁;21