欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2023105780649
申请人: 湖南大学
专利类型:发明专利
专利状态:已下证
专利领域: 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种机器人关节伺服复合容错冗余位置反馈及其电控方法,包括机器人关节伺服机械执行单元、机器人关节伺服冗余型位置反馈电控单元,其特征在于:机器人关节伺服机械执行单元包括伺服力矩电机(4)、谐波减速器(2)、减速轴(18)、关节过渡弯头(19)、输出法兰力传感器(1)、机器人关节壳体(23);

伺服力矩电机(4)、谐波减速器(2)、伺服力矩电机输出盘套(6)、减速轴(18)、关节抱闸(8)、抱闸刹车盘(15)和抱闸固定件(16)均具有中心孔,且与机器人关节壳体(23)的中心轴共轴线;

减速轴(18)位于机器人关节壳体(23)的内部,减速轴(18)具有两级阶梯轴,第一阶梯轴的直径大于第二阶梯轴的直径;第一阶梯轴的轴端具有输出法兰力传感器(1),且输出法兰力传感器(1)通过安装孔和连接件与关节过渡弯头(19)连接;

由减速轴(18)的第一阶梯轴的输出法兰力传感器(1)处向第二阶梯轴方向依次套入安装谐波减速器(2)、伺服力矩电机(4)、伺服力矩电机输出盘套(6)、关节抱闸(8)、抱闸刹车盘(15)和抱闸固定件(16);

伺服力矩电机输出盘套(6)通过安装孔和连接件与伺服力矩电机(4)连接,减速轴(18)上的第二阶梯轴贯穿于伺服力矩电机输出盘套(6),保证伺服力矩电机输出盘套(6)与减速轴(18)之间存在空隙,从而使减速轴(18)和伺服力矩电机输出盘套(6)之间的动力传输彼此独立,不发生干涉;

关节抱闸(8)、抱闸刹车盘(15)和抱闸固定件(16)通过过盈装配到伺服力矩电机输出盘套(6)上,保证伺服力矩电机(4)的转速扭矩和增量位置信号直接传递至伺服力矩电机输出盘套(6)和关节抱闸(8);

机器人关节伺服冗余型位置反馈电控单元包括冗余型增量位置反馈、冗余型绝对位置反馈、低压电源板(11)、伺服驱动板(12)、MCU控制板(13)和传感器感知板(14);

机器人关节伺服冗余型位置反馈电控单元中冗余型增量位置反馈包括第一旋变(7)和增量位置编码器(17);

为向MCU控制板(13)反馈机器人关节伺服的增量位置,第一旋变(7)和增量位置编码器(17)必须安装在减速轴(18)的第二阶梯轴处,并且第一旋变(7)和增量位置编码器(17)必须与伺服力矩电机输出盘套(6)过盈装配,保证伺服力矩电机转子(5)的转矩输出通过伺服力矩电机输出盘套(6)传输到第一旋变(7)和增量位置编码器(17),确保第一旋变(7)和增量位置编码器(17)共同检测伺服力矩电机转子(5)输出端的增量位置信号,并将增量位置信号反馈至MCU控制板(13),该增量位置信号参与机器人关节伺服跟随的速度环和电流环的闭环运算。

2.根据权利要求1所述的机器人关节伺服复合容错冗余位置反馈及其电控方法,其特征在于:

机器人伺服关节掉电停机,关节抱闸(8)会收到来自MCU控制板(13)的命令而自动通电启动,关节抱闸(8)通过电磁力紧紧吸住抱闸刹车盘(15),从而实现伺服力矩电机(4)的紧急制动,此时,冗余型增量位置反馈中的第一旋变(7)和增量位置编码器(17)停止向MCU控制板(13)反馈增量位置信号。

3.根据权利要求1所述的机器人关节伺服复合容错冗余位置反馈及其电控方法,其特征在于:

低压电源板(11)为机器人关节伺服冗余型位置反馈电控单元中冗余型增量位置反馈的第一旋变(7)和增量位置编码器(17)提供正常工作电压,伺服驱动板(12)为整个机器人关节伺服提供驱动,进而带动第一旋变(7)和增量位置编码器(17)旋转,MCU控制板(13)用于接收第一旋变(7)和增量位置编码器(17)反馈的机器人增量位置信号,传感器感知板(14)内部集成了第一旋变(7)和增量位置编码器(17)的信号调理电路,保证第一旋变(7)和增量位置编码器(17)工作时信号不失真。

4.根据权利要求1所述的机器人关节伺服复合容错冗余位置反馈及其电控方法,其特征在于:

机器人关节伺服冗余型位置反馈电控单元中冗余型绝对位置反馈包括输出法兰力传感器(1)、第二旋变(9)和绝对位置编码器(10);

为向MCU控制板(13)反馈机器人关节伺服的绝对位置,第二旋变(9)和绝对位置编码器(10)必须过盈装配在减速轴(18)的第二阶梯轴处,且输出法兰力传感器(1)过盈装配在减速轴(18)的第一阶梯轴处,输出法兰力传感器(1)通过安装孔和连接件与关节过渡弯头(19)连接,关节过渡弯头(19)与机器人连杆(24)连接,保证输出法兰力传感器(1)检测关节过渡弯头(19)和机器人连杆(24)的绝对位置,关节过渡弯头(19)和机器人连杆(24)的绝对位置也是机器人关节伺服输出的绝对位置;

谐波减速器输入盘(3)通过安装孔和连接件与伺服力矩电机转子(5)连接,并接收伺服力矩电机转子(5)的转矩,谐波减速器(2)通过安装孔和连接件与谐波减速器输入盘(3)连接,减速轴(18)的第一阶梯轴与谐波减速器(2)过盈装配连接,上述装配关系保证了伺服力矩电机转子(5)的转矩经过谐波减速器(2)减速增扭后传输至减速轴(18);

减速轴(18)的第二阶梯轴处过盈装配着第二旋变(9)和绝对位置编码器(10),谐波减速器(2)的转矩输出带动第二旋变(9)和绝对位置编码器(10)一起旋转运动,两者共同检测机器人关节伺服输出的绝对位置;

第二旋变(9)、绝对位置编码器(10)和输出法兰力传感器(1)与减速轴(18)的第一阶梯轴处和第二阶梯轴处的过盈装配位置不能更换;

冗余型绝对位置反馈的机电装配关系,保证第二旋变(9)、绝对位置编码器(10)和输出法兰力传感器(1)三者均检测机器人关节伺服的绝对位置,并向MCU控制板(13)反馈机器人关节伺服的绝对位置。

5.根据权利要求1或权利要求4所述的机器人关节伺服复合容错冗余位置反馈及其电控方法,其特征在于:

低压电源板(11)为机器人关节伺服冗余型位置反馈电控单元中冗余型绝对位置反馈的第二旋变(9)、绝对位置编码器(10)和输出法兰力传感器(1)提供正常工作电压,伺服驱动板(12)为整个机器人关节伺服提供驱动,进而带动第二旋变(9)、绝对位置编码器(10)和输出法兰力传感器(1)旋转,MCU控制板(13)用于接收第二旋变(9)、绝对位置编码器(10)和输出法兰力传感器(1)反馈的机器人绝对位置信号,传感器感知板(14)内部集成了第二旋变(9)、绝对位置编码器(10)和输出法兰力传感器(1)的信号调理电路,保证第二旋变(9)、绝对位置编码器(10)和输出法兰力传感器(1)工作时信号不失真。

6.根据权利要求4所述的机器人关节伺服复合容错冗余位置反馈及其电控方法,其特征在于:

冗余型绝对位置反馈中的输出法兰力传感器(1)包括输出法兰力传感器(1)本体、输出法兰力传感器(1)变送器和输出法兰力传感器(1)后端;

输出法兰力传感器(1)本体包括轮辐(20)、弹性体(21)和应变片(22),应变片(22)分多组黏贴安装在弹性体(21)的轮辐(20)内壁上,多组应变片组成一个应变矩阵电桥,应变矩阵电桥可实时感受到机器人关节伺服转动时受到的力/力矩;

输出法兰力传感器(1)变送器包括信号调理电路和AD转换器组成,用于对输出法兰力传感器(1)本体的应变矩阵电桥输出信号放大调理和有源滤波调理,并转换成数字信号传输至MCU控制板(13);

输出法兰力传感器(1)后端包括MCU控制板,MCU下层控制器和MCU上层控制器分别通过集成电路工艺集成在MCU控制板(13)内部;

MCU下层控制器对输出法兰力传感器(1)变送器调理和变送的绝对位置信号进一步数字滤波和状态评估过程,以及MCU上层控制器基于绝对位置信号参与机器人关节伺服的位置闭环运算过程,均在MCU控制板(13)内部完成;

输出法兰力传感器(1)在单独供电电路控制下,输出法兰力传感器(1)长期处于冷后备状态,不进行绝对位置反馈输出;

冗余型绝对位置反馈中第二旋变(9)的硬解码电路和软解码电路,以及绝对位置编码器(10)全部出现故障失效后,输出法兰力传感器(1)从冷后备状态开始启动工作,向MCU控制板(13)反馈机器人伺服关节的绝对位置。

7.根据权利要求6所述的机器人关节伺服复合容错冗余位置反馈及其电控方法,其特征在于:

输出法兰力传感器(1)单独供电电路包括第一N型MOS管N1、第一P型MOS管P1和运放跟随电路OP1;

输出法兰力传感器(1)单独供电电路在连接方式上,第一N型MOS管N1栅极与MCU控制板(13)上的MCU下层控制器连接,第一N型MOS管N1漏极连接第一P型MOS管P1的栅极,第一P型MOS管P1源极连接低压电源板(11),第一P型MOS管P1漏极输出经过分压电阻和与运放跟随电路OP1的正向输入端连接,而运放跟随电路OP1的输出端直接与输出法兰力传感器(1)变送器连接;

第一N型MOS管N1栅极接收到MCU下层控制器下发的仲裁信号,说明第二旋变(9)的硬解码电路和软解码电路,以及绝对位置编码器(10)全部出现故障失效,处于非正常工作状态,第一N型MOS管N1导通,第一P型MOS管P1导通,运放跟随电路OP1的输出端直接跟随输入端,运放跟随电路OP1的输出端直接为输出法兰力传感器(1)变送器单独供电,输出法兰力传感器(1)变送器开始工作;

MCU下层控制器无下发仲裁信号,说明第二旋变(9)的硬解码电路和软解码电路,以及绝对位置编码器(10)正常工作,第一N型MOS管N1截止,第一P型MOS管P1截止,输出法兰力传感器(1)处于无供电后备冗余冷备状态。

8.根据权利要求4所述的机器人关节伺服复合容错冗余位置反馈及其电控方法,其特征在于:

冗余型绝对位置反馈中的第二旋变(9)包括第二旋变(9)硬解码电路和第二旋变(9)软解码电路,其中,第二旋变(9)硬解码电路包括硬解码芯片电路、电流缓冲器和MCU控制板(13),第二旋变(9)软解码电路包括信号调理电路和第二旋变(9)冷冗余供电电路;

冗余型绝对位置反馈中的第二旋变(9),其容错过程可描述为:

第一步骤:第二旋变(9)和绝对位置编码器(10)正常工作时,用于检测和向MCU控制板(13)反馈机器人关节伺服的绝对位置信号,第二旋变(9)硬解码电路和绝对位置编码器(10)直接从低压电源板(11)取电;

第二步骤:MCU控制板(13)上的MCU下层控制器不向第二旋变(9)冷冗余供电电路下发仲裁信号,第二旋变(9)的软解码电路不启动,此时,第一N型MOS管N1截止,第一P型MOS管P1截止,第一P型MOS管P1的漏极输出端不对外供电,第二旋变(9)的软解码电路一直处于无供电冷备状态;

第三步骤:冗余型绝对位置反馈中的第二旋变(9)硬解码芯片电路出现故障效应时,MCU控制板(13)上的MCU下层控制器向第二旋变(9)冷冗余供电电路下发仲裁信号,第二旋变(9)的软解码电路开始启动;

第四步骤:第二旋变(9)冷冗余供电电路接收到MCU控制板(13)的仲裁信号后,第二旋变(9)冷冗余供电电路中的第一N型MOS管N1导通,第一P型MOS管P1导通,第一P型MOS管P1的漏极输出端直接为第二旋变(9)软解码电路中的信号调理电路进行独立供电;

第五步骤:第二旋变(9)软解码电路启动和独立供电均完成,完成后备冷冗余工作的切换,开始对机器人关节伺服绝对位置进行检测,并向MCU控制板(13)反馈机器人关节伺服绝对位置,进而实现第二旋变(9)的容错。

9.根据权利要求4所述的机器人关节伺服复合容错冗余位置反馈及其电控方法,其特征在于:

冗余型绝对位置反馈中的输出法兰力传感器(1)、第二旋变(9)和绝对位置编码器(10)采用梯度复合容错策略,该容错策略可以有效的管理冗余型绝对位置反馈中的输出法兰力传感器(1)、第二旋变(9)和绝对位置编码器(10);

梯度复合容错策略考虑了机器人关节伺服在全工况服役过程,包含了从高精度作业、非高精度作业,再到应急返回,全工况下任何一种或者多种绝对位置反馈同时出现故障效应时,输出法兰力传感器(1)、第二旋变(9)和绝对位置编码器(10)之间的相互容错策略,其容错过程可描述为:第一步骤:机器人关节伺服非高精度作业时,MCU控制板(13)会自动切换至第二旋变(9)的硬解码,依靠第二旋变(9)硬解码满足非精度作业,在此过程中,第二旋变(9)的软解码电路不启动,第二旋变(9)的软解码一直处于后备冷冗余状态;

第二步骤:机器人关节伺服高精度作业时,MCU控制板(13)会自动启动绝对位置编码器(10)和第二旋变(9)以及第二旋变(9)硬解码电路,MCU控制板(13)的下层控制器同时读取绝对位置编码器(10)的绝对位置数据和第二旋变(9)硬解码绝对位置数据,MCU控制板(13)的下层控制器将绝对位置编码器(10)的绝对位置数据和第二旋变(9)硬解码电路的绝对位置数据通过数据融合算法进行融合,得到精度更高的机器人关节伺服绝对位置信号,MCU控制板(13)的上层控制器用融合后的绝对位置数据信号作为机器人关节伺服的最终位置闭环信号,参与机器人关节伺服位置环的闭环运算,在此过程中,第二旋变(9)的软解码电路不启动,第二旋变(9)的软解码一直处于后备冷冗余状态;

第三步骤:机器人关节伺服高精度正常工作时,第二旋变(9)的硬解码芯片电路和绝对位置编码器(10)同时工作,且为主解码电路,当绝对位置编码器(10)出现故障效应时,第二旋变(9)的软解码电路开始启动,此时依靠第二旋变(9)的软解码和硬解码电路,继续为机器人关节伺服提供绝对位置反馈;

第四步骤:随着工作时长增加,第二旋变(9)硬解码芯片电路出现故障效应时,MCU控制板(13)启动输出法兰力传感器(1),输出法兰力传感器(1)继续为机器人关节伺服提供绝对位置反馈,此时,机器人被动的处于应急返回非高精度作业状态;

第五步骤:机器人关节伺服冗余型绝对位置反馈硬件电路全部同时失效,MCU控制板(13)采用变频调速运算,采用绝对位置开环,此时,机器人被动的处于应急返回非高精度作业状态。

10.根据权利要求1所述的机器人关节伺服复合容错冗余位置反馈及其电控方法,其特征在于:

机器人关节伺服冗余型位置反馈电控单元中冗余型增量位置反馈由第一旋变(7)和增量位置编码器(17)组成;

冗余型增量位置反馈第一旋变(7)和增量位置编码器(17)全部出现故障效应时,MCU控制板(13)会自动切换无感高频注入启动算法,MCU控制板(13)构建状态观测器虚拟传感器进行状态输出,状态估计出伺服力矩电机(4)的增量位置信号,同时,向MCU控制板(13)反馈增量位置信号,该增量位置信号参与到MCU控制板(13)的速度闭环控制。

我要求购
我不想找了,帮我找吧
您有专利需要变现?
我要出售
智能匹配需求,快速出售