一种三自由度并联机器轨迹跟踪系统技术方案

本发明专利技术公开了一种三自由度并联机器轨迹跟踪系统，属于机器人技术领域，建系模块用于对机器主体建立总坐标系和对三自由度结构建立分坐标系；定位模块用于对机器主体以及三自由度结构分别进行定位；监测模块用于对机器主体以及三自由度结构的运行进行监测统计；跟踪模块用于根据监测统计的结果来对三自由度并联机器的轨迹进行跟踪；本发明专利技术用于解决现有方案中没有从不同方面对三自由度并联机器的移动和运行进行监测分析，并跟踪提示异常的初步情况以及异常程度的技术问题。情况以及异常程度的技术问题。情况以及异常程度的技术问题。

【技术实现步骤摘要】
一种三自由度并联机器轨迹跟踪系统


[0001]本专利技术涉及机器人
，具体涉及一种三自由度并联机器轨迹跟踪系统。

技术介绍

[0002]现有的三自由度并联机器轨迹跟踪系统在跟踪时，基于各项传感器来对三自由度并联机器的运行进行监测分析，只能发现并提示出现的异常，无法更深入的监测分析异常的初步原因以及程度，并不能根据不同的异常进行不同方式的控制，导致三自由度并联机器的运行效果不佳。

技术实现思路

[0003]本专利技术的目的在于提供一种三自由度并联机器轨迹跟踪系统，用于解决现有方案中没有从不同方面对三自由度并联机器的移动和运行进行监测分析，并跟踪提示异常的初步情况以及异常程度的技术问题。
[0004]本专利技术的目的可以通过以下技术方案实现：
[0005]一种三自由度并联机器轨迹跟踪系统，包括建系模块、定位模块、监测模块和跟踪模块；
[0006]建系模块用于对机器主体建立总坐标系和对三自由度结构建立分坐标系；
[0007]定位模块用于对机器主体以及三自由度结构分别进行定位；
[0008]监测模块用于对机器主体以及三自由度结构的运行进行监测统计；
[0009]跟踪模块用于根据监测统计的结果来对三自由度并联机器的轨迹进行跟踪。
[0010]进一步地，还包括处理模块和预警模块，处理模块包含处理器，用于对采集的各项数据进行处理，预警模块用于对监测跟踪的结果进行预警提示。
[0011]进一步地，对机器主体建立总坐标系的具体步骤包括：
[0012]获取移动范围的中点并将其设定为原点，将机器主体上端的中点设定为第一监测点，将机器主体前进的方向设定为x0轴，根据x0轴分别建立y0轴和z0轴，根据预设的第一距离和原点建立总坐标系。
[0013]进一步地，对三自由度结构建立分坐标系的具体步骤包括：
[0014]将三自由度结构分别设定为第一结构、第二结构和第三结构；分别将第一结构、第二结构和第三结构的下端点设定为第二监测点、第三监测点和第四监测点，将机器主体下端的中点设定为第二原点，设定的分坐标轴方向与总坐标系的坐标轴方向相同，根据预设的第二距离和第二原点建立分坐标系。
[0015]进一步地，对机器主体以及三自由度结构分别进行定位的具体步骤包括：
[0016]获取机器主体移动范围的长度和宽度，将机器主体的起始点设定为监测原点，对机器主体的实时位置以及第一结构、第二结构和第三结构的实时位置进行定位，得到机器位置集和机构位置集，将机器位置集中机器主体的实时位置与数据库中机器位置表进行匹配；
[0017]若机器主体的实时位置与机器位置表进行匹配时存在相同的位置，则判定机器主体的位置没有发生偏移；
[0018]若机器主体的实时位置在机器位置表进行匹配时存在不相同的位置，则判定机器主体的位置发生偏移，并生成第一调控信号，根据第一调控信号控制机器主体暂停运行；
[0019]将机构位置集中的不同机构的位置分别与数据库中机构位置表进行匹配；若第一结构、第二结构和第三结构的实时位置与机构位置表进行匹配时存在相同的位置，则判定第一结构、第二结构和第三结构的位置没有发生偏移；若第一结构、第二结构和第三结构的实时位置与机构位置表进行匹配时存在不相同的位置，则判定第一结构、第二结构和第三结构的位置存在偏移的情况，并生成第二调控信号，根据第二调控信号控制第一结构、第二结构和第三结构暂停运行；
[0020]根据机器位置集和机构位置集分析判断机器主体以及三自由度结构的运行位置是否正常。
[0021]进一步地，进行监测统计的具体步骤包括：
[0022]获取机器主体、第一结构、第二结构和第三结构的实时移动速度、实时转动角度和实时移动距离并设定为FSik、FPik和FGik，i＝1，2，3，...，n；k＝0，1，2，3；对机器主体以及第一结构、第二结构和第三结构的运行进行分析。
[0023]进一步地，进行分析的具体步骤包括：
[0024]获取机器主体、第一结构、第二结构和第三结构预设的移动速度、转动角度和移动距离，将预设的移动速度设定为YYSik；将预设的转动角度设定为ZYJik；将预设的移动距离设定为YYGik；对标记的各项数据进行归一化处理并取值，通过公式计算获取偏移度，a1、a2和a3为不同的比例系数且均大于零,μ为补偿因子，取值范围为(0,5)；将偏移度与预设的偏移阈值进行匹配，若偏移度不大于偏移阈值，则判定对应结构的运行正常，并生成第一匹配信号；若偏移度大于偏移阈值，则判定对应结构的运行异常，并生成第二匹配信号，根据第二匹配信号将该结构的运行数据进行标记，运行数据包括运行时间、运行速度和运行位置，根据第二匹配信号计算获取偏移度与偏移阈值之间的比值，根据该比值跟踪对应结构异常的情况。
[0025]进一步地，根据该比值跟踪对应结构异常的情况的具体步骤包括：
[0026]将第一次出现异常的时间点设为时间基点并进行标记，获取比值的整数部分并分析，若属于[0，m],则生成第一异常指令，若整数部分属于(m,+∞)，则生成第二异常指令，m为正整数；在监测时间段内统计第一异常指令和第二异常指令出现的次数，根据第一异常指令和第二异常指令出现的次数进行不同程度的预警提示。
[0027]进一步地，进行不同程度的预警提示的具体步骤包括：
[0028]统计第一异常指令出现的次数并标记为YC；统计第一异常指令出现并持续的累计时长并标记为YS；统计第二异常指令出现的次数并标记为EC；统计第二异常指令出现并持续的累计时长并标记为ES；对各项数据进行归一化处理并取值，通过公式TS＝b1
×
YC
×
YS+b2
×
EC
×
ES计算获取提示值,b1和b2为不同的比例系数且均大于零；根据提示值进行提示。
[0029]进一步地，根据提示值进行提示的具体步骤包括：
[0030]将提示值与预设的预警等级范围进行匹配并获取对应的预警级别，根据预警级别生成不同的预警提示；其中，预警等级范围包括(0，n)、[n，2n)、[2n,3n)和[3n,+∞)，n为大于零的有理数，对应的预警级别为初级风险，低级风险、中级风险和高级风险。
[0031]本专利技术的有益效果：
[0032]1、本专利技术中，通过建立总坐标系和分坐标系，可以分别对机器主体和三自由度对应结构的运行进行监测，通过定位分析判断机器主体以及第一结构、第二结构和第三结构的移动是否正常，避免发生位置偏移时影响三自由度并联机器整体的运行。
[0033]2、本专利技术中，受网络以及控制程序的影响，会使得机器主体和三自由度对应结构的运行速度、转动角度和移动距离出现偏差，对运行速度、转动角度和移动距离进行联立计算，通过获取的实时偏移度从局部进行监测，判断机器主体和三自由度对应结构的运行是否异常，可以提高三自由度并联机器运行监测的准确性。
[0034]3、本专利技术中，通过对出现的异常情况进一步进行本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种三自由度并联机器轨迹跟踪系统，其特征在于，包括建系模块、定位模块、监测模块和跟踪模块；建系模块用于对机器主体建立总坐标系和对三自由度结构建立分坐标系；定位模块用于对机器主体以及三自由度结构分别进行定位；监测模块用于对机器主体以及三自由度结构的运行进行监测统计；跟踪模块用于根据监测统计的结果来对三自由度并联机器的轨迹进行跟踪，在监测时间段内根据异常出现的次数以及出现并持续的累计时长计算获取提示值，并根据提示值对异常的状态进行提示。2.根据权利要求1所述的一种三自由度并联机器轨迹跟踪系统，其特征在于，对机器主体建立总坐标系的具体步骤包括：获取移动范围的中点并将其设定为原点，将机器主体上端的中点设定为第一监测点，将机器主体前进的方向设定为x0轴，根据x0轴分别建立y0轴和z0轴，根据预设的第一距离和原点建立总坐标系。3.根据权利要求1所述的一种三自由度并联机器轨迹跟踪系统，其特征在于，将三自由度结构分别设定为第一结构、第二结构和第三结构；分别将第一结构、第二结构和第三结构的下端点设定为第二监测点、第三监测点和第四监测点，将机器主体下端的中点设定为第二原点，设定的分坐标轴方向与总坐标系的坐标轴方向相同，根据预设的第二距离和第二原点建立分坐标系。4.根据权利要求3所述的一种三自由度并联机器轨迹跟踪系统，其特征在于，对机器主体以及三自由度结构分别进行定位的具体步骤包括：获取机器主体移动范围的长度和宽度，将机器主体的起始点设定为监测原点，对机器主体、第一结构、第二结构和第三结构的实时位置进行定位，得到机器位置集和机构位置集，根据机器位置集和机构位置集分析判断机器主体以及三自由度结构的运行位置是否正常。5.根据权利要求3所述的一种三自由度并联机器轨迹跟踪系统，其特征在于，进行监测统计的具体步骤包括：获取机器主体、第一结构、第二结构和第三结构的实时移动速度FSik、实时转动角度FPik和实时移...

【专利技术属性】
技术研发人员：蒋兵兵，罗丹，黄银秀，李玲，张川成，贺国方，刘晓桂，毛远斌，蒋宏玉，
申请(专利权)人：湖南铁路科技职业技术学院，
类型：发明
国别省市：