掌桥专利:专业的专利平台
掌桥专利
首页

机器人活齿磁浮柔性关节系统及其控制方法

文献发布时间:2024-04-18 19:52:40


机器人活齿磁浮柔性关节系统及其控制方法

技术领域

本发明涉及磁悬浮和机器人技术领域,具体涉及一种活齿磁浮机器人柔性关节系统,也即机器人全滚动活齿磁浮柔性减速器(Meglev Oscillatory RollerTransmisssion),简称MORT关节或MORT减速器。

背景技术

目前工业机器人减速器行业的现状:

1、工业机器人需求日益增加发展迅猛,而与其配套的精密减速器企业凤毛麟角。

2、精密减速器技术性能指标较低,满足不了大部分机器人装备的功能要求。

精密减速器的技术壁垒在机器人的核心零部件中是最高的,在一个配合精密的系统中,间隙或过盈的配合的微小偏差,就会造成接触刚度或啮合刚度的成倍的差异,进而引发其运动参数的大的变动,RV减速器的技术难点在于该部件既要能传递很大的扭矩,又要承受很大的过载冲击,并保证预期的工作寿命,这就要求零部件的加工精度极高,RV减速器在额定扭矩与传递效率、扭转刚度、传动精度、负载率、疲劳强度、噪音、关节抖动、位置重复性、稳定性和绕点精度等方面还有较大的改进空间。

3、机器人精密减速器标准制定滞后,技术工艺不成熟,大部分制造企业还处于小批量试制与稳定性试验阶段,特别是对材料的抗拉强度、抗弯刚度、韧性值、屈服强度的试验与取值,轴承的动载刚度、耐磨性、疲劳极限、齿形齿廓的加工工艺、零部件的热处理工艺,还处于逐步试验与不断改进阶段。

4、机器人产业规划欠合理、基础关键核心零部件研发投入太少,大多数的制造企业重点都是做工业机器人的集成,而对其核心关键零部件研发投入太少,特别是精密减速器、伺服电机、控制器、传感器等核心部件方面的研发不够,形成了单条腿冲刺的局面,既不能满足市场的需求又在关键技术上受制于人,与市场日益剧增的对机器人装备的需求不相适应。

5、机器人精密减速器创新不够、智能化程度低,大都缺少柔性自动化操作系统,不能满足一些特种机器人装备的要求,同时很难实现信息化的有效远程管理,也给机器人系统实现模块化的智能物联网管理带来了一定的障碍和管理成本的增加。

发明内容

本发明旨在提供一种机器人活齿磁浮柔性关节系统,该柔性关节系统可以实现速比恒定的径向活齿矢量,以及活齿与固齿之间精准的共轭啮合,从而具有其它传统减速器无法比拟的啮合齿数多、传动比大、承载能力强、传动效率高、输出刚度大、转矩波动和回差变量小等优越性能。

为了实现上述目的,本发明所采用的技术方案是:

一种机器人活齿磁浮柔性关节系统,其包括机械与电磁磁浮传动系统,该机械与电磁磁浮传动系统包括位于内侧的内活齿磁浮传动减速结构和位于外侧的外活齿磁浮传动减速结构;

所述内活齿磁浮传动减速结构包括激波轴、通过激波轴承柔性支撑在激波轴上的内激波轮、内固齿轮、内固齿轮左联接法兰、内固齿轮右联接法兰、内活齿轮、内活齿架、内活齿架左传力盘、内活齿架右传力盘;所述内活齿架分别通过紧固件与内活齿架左传力盘和内活齿架右传力盘紧固连接形成内活齿架总成;所述内固齿轮分别通过紧固件与内固齿轮左联接法兰和内固齿轮右联接法兰紧固连接形成内固齿轮总成;所述内活齿架总成支承内固齿轮总成的内腔中;所述激波轴的一端通过轴承安装在内活齿架左传力盘的内腔中,另一端则通过轴承安装在内固齿轮右联接法兰及轴承座相应的内孔中,轴承座通紧固件安装在内固齿轮右联接法兰的端面上;所述导电滑环总成通过紧固件固定在轴承座的端面上;

所述外活齿磁浮传动减速结构包括通过激波轴承柔性支撑在内固齿轮上的外激波轮、外固齿轮、外固齿轮左联接法兰、外固齿轮右联接法兰、外活齿轮、外活齿架、外活齿架左传力盘、外活齿架右传力盘、导电滑环总成;所述外活齿架分别通过紧固件与外活齿架左传力盘和外活齿架右传力盘紧固连接形成外活齿架总成;所述外固齿轮分别通过紧固件与外固齿轮左联接法兰和外固齿轮右联接法兰紧固连接形成外固齿轮总成;所述外活齿架总成支承在外固齿轮总成的内腔中;

所述外活齿架左传力盘通过轴承支撑在所述内固齿轮左联接法兰上,所述外活齿架右传力盘通过轴承支撑在所述内固齿轮右联接法兰上;所述外激波轮安装在内固齿轮的外圆上,所述内活齿架左传力盘与外固齿轮左联接法兰固定在一起;所述内固齿轮的外圆中心轴线与其旋转的中心轴线偏心设置;

所述内活齿轮和外活齿轮为圆形滚轮,内激波轮和外激波轮为偏心圆盘,激波轴承为电磁激波轴承,所述内活齿轮与内激波轮各自运动产生的叠加轨迹作为内固齿轮的齿廓精准包络线,外活齿轮与外激波轮各自运动产生的叠加轨迹作为外固齿轮的齿廓精准包络线;

伺服电机的主轴旋转传递给激波轴,通过电磁激波轴承传递给内激波轮并驱动内活齿轮旋转,进而驱动内固齿轮旋转,转动矢量通过外激波轮驱动外活齿轮旋转并沿着外固齿轮的齿廓曲线作圆周运动,然后通过外活齿架右传力盘输出。

机械传动方面:是用以圆形滚轮为活齿轮,以偏心圆盘为激波轮,以电磁激波轴承为激波轴承,以活齿轮与激波轮各自运动产生的叠加轨迹作为固齿轮的齿廓精准包络线。实现速比恒定的径向活齿矢量,以及活齿轮与固齿轮之间精准的共轭啮合,从而具有其它传统减速器无法比拟的啮合齿数多、传动比大、承载能力强、传动效率高、输出刚度大、转矩波动和回差变量小等优越性能。

系统控制方面:是用智能控制技术,尤其是对减速器激波轴承的位移变化,适时的各种数据采集、储存及显示、远程无线通信、数据传输及控制,以及机器人系统自身的执行机构的可变稳定性控制,具有故障自诊断功能等,从而实现MORT减速器的各项执行任务,例如:激波轴承位移数据的调整,减速器的静止与运转,电磁线圈电流参数与磁通量变化的调整与控制,激波轴承承载扭矩大小的控制,系统的工况参数储存与显示、系统运转环境的温度检测等多种功能,极大地提升了机器人减速器的技术性能,拓展了减速器的多用途功能,以及为各种机器人制造公司及时并适时地提供准确的机器人关节运行状况及第一原始数据,并为机器人制造及应用厂商的生产管理提供可靠的依据,极大地节省管理成本,更重要的是为实现智能制造、环保节能提供不可或缺的、有效可靠的关键核心装备。

根据本发明的实施例,还可以对本发明作进一步的优化,以下为优化后形成的技术方案:

在其中一个优选的实施例中,所述内活齿轮包括通过相应的齿轮轴安装于内活齿架总成上的第一内活齿轮和第二内活齿轮,所述外活齿轮包括通过相应的齿轮轴安装于外活齿架总成上的第一外活齿轮和第二外活齿轮;所述内激波轮包括安装在第四电磁激波轴承的外转子上的第一内激波轮和安装在第二电磁激波轴承的外转子上的第二内激波轮;所述外激波轮包括安装在第一电磁激波轴承的外转子上的第二外激波轮和安装在第三电磁激波轴承的外转子上的第一外激波轮;所述第一内活齿轮、第二内活齿轮和对应的齿轮轴分别安装于内活齿架总成的左、右两侧的滚轮槽和销轴槽中;所述第一外活齿轮、第一外活齿轮轴、第二外活齿轮、第二外活齿轮轴分别安装于外活齿架总成上;第三电磁激波轴承的内转子与第一电磁激波轴承的内转子分别安装在内固齿轮的两个偏心外圆上,且第一外激波轮与第二外激波轮的偏心位置相互交错180°;第四电磁激波轴承的内转子与第二电磁激波轴承的内转子分别安装在激波轴的两个偏心圆柱上,且第一内激波轮与第二内激波轮的偏心位置相互交错180°。

在其中一个优选的实施例中,所述内活齿架左传力盘与激波轴相对应的位置安装有第二密封圈、轴承、第二衬套;所述轴承座、内活齿架右传力盘、激波轴以及内固齿轮右联接法兰相对应的位置安装有第一密封圈、轴承、第一衬套。

在其中一个优选的实施例中,所述电磁激波轴承包括第一轴向定子、第二轴向定子、第一轴向电磁线圈组、第二轴向电磁线圈组、永磁环、径向定子、径向电磁线圈组、位移传感器、转子和紧固件;所述第一轴向电磁线圈组嵌绕在第一轴向定子的内圈圆周上,第二轴向电磁线圈组嵌绕在第二轴向定子的内圈圆周上;所述径向电磁线圈组沿圆周等分,均匀嵌绕在径向定子的轴向槽内组成径向定子总成;所述位移传感器安装在径向定子的径向槽内,永磁环、转子以及径向定子总成分别安装在第一轴向定子之间,并且通过紧固件联接紧固。

在其中一个优选的实施例中,所述内激波轮通过电磁激波轴承柔性地支承在激波轴上,外激波轮通过电磁激波轴承柔性地支承在内固齿轮的偏心外圆上,通过调节电磁激波轴承线圈电流的大小,改变径向控制磁通和轴向控制磁通的大小,控制转子与径向定子、轴向定子之间旋转的同轴度、位置度,以及内激波轮与外激波轮旋转动载时的径向与轴向的跳动和位置误差。

在其中一个优选的实施例中,本发明还包括主要由人机对话系统、远程无线通信系统、数据采集反馈系统、控制系统与机构执行系统构成的智能控制电气系统;

所述人机对话系统包括主DSP控制器、LCD显示模块DM和系统工况参数LCD显示器,且LCD显示器与显示模块DM连接,LCD显示模块DM通过总线与主控制器连接;

所述远程无线通信系统包括减速器系统中的嵌入式ZigBee无线通讯收发模块、LCD显示模块DM、工况参数LCD显示器;其中减速器系统中的嵌入式ZigBee无线通讯发射模块,通过总线与主控制器连接,显示器与LCD显示模块DM连接并通过总线与主控制器连接,嵌入式ZigBee无线通信接收模块与系统上位机连接,实现机器人活齿磁浮柔性关节系统与工业物联网各终端的远程通讯;

所述数据采集与反馈系包括位移传感器、温度传感器、温度变送器、电子式力矩传感器、光电编码器、数据采集及信号调理模块;其中,位移传感器与数据采集及信号调理模块连接,再通过RS485模块与主控制器连接,温度传感器与温度变送器连接,再通过RS485模块与主控制器连接,电子式力矩传感器模块通过总线与主控制器连接,光电编码器模块通过总线与主控制器连接,实现对机器人活齿磁浮柔性关节系统中的各电磁激波轴承的位置偏移量、旋转速度、旋转方向、承载扭矩大小和工作温度的实际数据进行适时地采集与反馈;

所述控制系统包括主控制器、电源管理模块、开关量输入模块、DAC数模转换模块;其中电源管理模块、开关量输入模块分别与主控制器连接,DAC数模转换模块是通过总线与主控制器连接,组成一个计算处理中枢,对从各个传感器分别采集而来的数据信号,通过DAC数模转换模块输入主控制器分别进行运算处理,再对相应的执行驱动模块分别发出相应的执行指令信号,并同时通过嵌入式ZigBee无线通信模块及其传输网络,将这些数据信息及指令信息传输到系统上位机,再通过远程无线网,传送到此工业物联网管理终端,从而实现对机器人活齿磁浮柔性关节系统中的各个电磁线圈的控制电流、控制磁通的大小进行精准的适时调整控制;

所述机构执行系统包括电磁激波轴承执行系统和伺服驱动系统;所述电磁激波轴承执行系统包括功率放大器模块、电磁线圈、电磁激波轴承外转子、以及电磁激波轴承内转子和激波轴;其中各功率放大器模块输入端分别与DAC数模转换模块的交流输出端和直流输出端连接,同时通过总线与主控制器连接,各功率放大器模块输出端分别与之相对应电磁铁线圈连接,而与电磁铁线圈相对应的部分电磁激波轴承转子对应安装在两组内激波轮的偏心圆中,另一部分电磁激波轴承转子分别对应安装在两组外激波轮的偏心圆中,与各激波轴承的外转子相对应安装的位移传感器通过信号收发模块分别与数据采集及信号调理模块连接,温度传感器与温度变送器模块连接,再通过信号收发模块与主控制器连接;

所述伺服驱动系统包括伺服驱动模块、伺服电机和激波轴总成;其中,伺服驱动模块通过总线与主控制器连接,伺服电机线圈输入端与伺服驱动模块的交流输出端连接,同时通过信号线与光电编码器连接,电磁激波轴承外转子总成上的电磁线圈输入端,与DAC数模转换模块的直流输出端连接,实现对各电磁线圈的电流以及磁通量的大小进行调整与控制。

基于同一个发明构思,本发明还提供了一种所述的机器人活齿磁浮柔性关节系统的控制方法,其包括:

(一)、电气控制系统的启动

闭合机器人活齿磁浮柔性关节系统的控制电源开关,确认正常工作指示灯绿灯亮起,此时主控制器以及各控制系统的电源已接通;

(二)、人机对话系统工作过程

机对话系统是将从数据采集反馈系统中的各传感器传输进来的数据信息、参数电信号,通过主控制器的运算处理,通过CAN3总线将图像数据和系统各工况参数传输给DM,再传输给LCD显示器显示并保存,并将机器人活齿柔性关节控制系统中的工况技术参数以及各激波轮的位置状态及位置偏差显示出来,同时通过LCD显示器修改、调整或重新设置电磁激波轴承及激波轮的工况技术参数,并通过CAN3总线传输给主控制器,主控制器再将不同的指令分别传送到执行机构的各执行驱动模块,实现机器人活齿磁浮柔性关节系统中的运行状态及运动位置、磁通量、动载扭矩和运行环境温度的调整;

(三)、远程无线通信系统工作过程

远程无线通信系统是包括嵌入式ZigBee无线通信模块及其传感网络、上位机、GPRS/4G通信模块组成的远程无线网络通信系统,包含4G/5G通信模块、LCD显示模块NH12864M、LCD显示器、主控制器,工作时,机器人活齿磁浮柔性关节系统中的运行状态及运动位置偏差、磁通量、动载扭矩和运行环境温度参数信息,通过CAN5总线从主控制器传输到ZigBee无线通信发射模块及其传感网络,再通过ZigBee无线通信接收模块传送到该活齿磁浮柔性关节控制系统的上位机,由计算机系统基于HTTP通信协议通过4G/5G远程通信网络传送到该机器人工业物联网服务器管理终端,物联网管理终端可以根据各运行数据、参数分别对其进行相应的数据设置修改、存储,并发出相应的指令,物联网服务器管理终端基于MQTT消息队列遥感传输技术协议,通过远程无线通信网络将各相应的指令传送给机器人活齿磁浮柔性关节控制系统的上位机,上位机将相应的指令,通过ZigBee无线收发模块及其传感网络及CAN5总线将修改或设置的指令信息传输给主控制器进行比较和运算处理,再将处理运算后的各信息指令,分别通过CAN1总线传送到DAC数模转换模块,通过CAN2总线传送到功率放大器模块,通过CAN7总线传送到执行机构的伺服驱动系统,进而驱动执行机构系统按指令执行动作,通过CAN3总线将各工况参数数据传输给LCD显示模块NH12864M,并在LCD显示器中显示出来;

(四)、数据采集与反馈系统的工作过程

数据采集与反馈系统是由位移传感器、温度传感器、温度变送器、电子式力矩传感器、光电编码器、数据采集及信号调理模块组成,其中,位移传感器与数据采集及信号调理模块连接,再通过RS485模块与主控制器连接,温度传感器与温度变送器连接,再通过RS485模块与主控制器连接,电子式力矩传感器模块通过CAN6总线与主控制器连接,光电编码器模块通过CAN4总线与主控制器连接,将位移传感器、温度传感器、温度变送器、电子式力矩传感器、光电编码器反馈来的工况信号参数,以及开关量输入模块传来的指令传输给主控制器进行分类、比较、运算处理,然后发出相应的指令,通过CAN1总线传送到DAC数模转换模块,再通过CAN2总线对电磁激波轴承系统中的功率放大器模块组进行控制,通过CAN7总线对机构执行中的伺服驱动系统伺服驱动器进行控制,并通过CAN3总线将相应的数据传输到人机对话系统中的LCD显示模块NH12864M,并在工况参数LCD显示器中显示并保存,从而实现对机器人活齿磁浮柔性关节系统中的各激波轮的位置偏移量、电磁激波轴承外转子的旋转角度、旋转速度、旋转方向、承载扭矩大小和工作温度的实际数据进行适时地采集与反馈,并通过CAN5总线传输到ZigBee无线通信模块及其传感网络,进而传送到该控制系统的上位机;

(五)、主控制器控制系统的工作过程

主控制器将接收的指令信息和传感器反馈的数据参数进行集中分类,运算处理,然后再发出相应的执行指令,以控制其它各系统的动作的开启、关闭和安全稳定。

优选地,所述主控制器控制系统的具体工作过程如下:

主控制器将CAN4总线、CAN6总线、RS485通信模块传输进来的指令或数据进行分类、运算、处理,然后发出相应的指令,分别通过CAN3总线、CAN1总线、CAN2总线、CAN7总线对人机对话系统,机构执行系统进行控制,并通过CAN3总线将相应的数据参数、运动状态反馈到人机对话系统,并在LCD显示器中显示,通过CAN5总线将机构执行系统的运行状态信息和人机对话系统中工况参数和运行状态,传送到嵌入式ZigBee无线通信模块及其传感网络,再传送到上位机,并通过远程无线通信网络传送给该活齿磁浮柔性关节系统的物联网管理终端,以精确地提供该系统的运行频次、运行状态的原始工况参数和可靠的共享数据;

将位移传感器、温度传感器、温度变送器、电子式力矩传感器、光电编码器反馈来的工况信号参数,以及开关量输入模块传来的指令进行分类,比较、运算处理,然后发出相应的指令,分别通过CAN2总线、CAN7总线对机构执行系统进行控制,并通过CAN3总线将相应的数据传输到人机对话系统中,并在工况参数LCD显示器中显示并保存,具体是将从各传感器反馈来的工况信号参数和指令进行分类,比较、运算处理,然后发出相应的脉冲指令,对于机构执行系统中的伺服驱动系统的控制,是通过CAN7总线传输给伺服驱动模块SD,从而驱动伺服电机SM,带动激波轴旋转,并在磁场力作用下带动电磁激波轴承外转子总成旋转,同时,光电编码器EN将伺服电机SM的运转方向、运行速度、旋转角度参数信息反馈给主控制器,对于电磁激波轴承的电磁线圈的电流的调节,是主控制器将指令信息通过CAN1总线将指令信息传送给DAC7724数模转换模块,从而调整电磁激波轴承的电磁线圈电流的大小或电流方向;

对于机构执行系统中的电磁激波轴承系统的控制,主控制器将指令信息通过CAN1总线将脉冲指令传送给DAC7724数模转换模块,再通过CAN2总线将相应的脉冲电流分别传送到功率放大器模块AM1、AM2、AM3、AM4进行放大,放大后的电流分别输入到电磁线圈组EM1、EM2、EM3、EM4、EM5、EM6、EM7、EM8、EM9、EM10、EM11、EM12,其中电磁线圈EM1、EM2、EM3的励磁磁通作用于电磁激波轴承转子BE1,电磁线圈EM4、EM5、EM6的励磁磁通作用于激波轴承转子BE2,电磁线圈EM7、EM8、EM9的励磁磁通作用于激波轴承转子BE3,电磁线圈EM10、EM11、EM12的励磁磁通作用于激波轴承转子BE4,其中电磁激波轴承转子BE1、BE2支承内激波轮,电磁激波轴承转子BE3、BE4支承外激波轮,实现内激波轮、内活齿轮与外激波轮、外活齿轮的旋转方向、旋转速度、位置偏差、相位偏差、动载扭矩、运行温度的各工况参数及运动状态的调节。

与现有技术相比,本发明的有益效果是:

1、电磁激波轴承的内转子与外转子之间,即激波轴与激波轮之间,无机械物理接触、无磨损、无须润滑,外转子处于悬浮状态,相对运动表面之间无接触,不产生机械摩擦和接触疲劳,解决了零部件的损耗和更换问题,同时省掉了润滑系统,节省了空间。

2、低振动、低噪声、低功耗,由于其激波轮处于磁悬浮状态,避免了在运行时的接触碰撞引起的大幅振动以及高分贝噪声,提高了该柔性关节运动的稳定性,降低了维护费用,延长了使用寿命,其功耗是传统机械轴承的10%左右,在转速大于10000r/min时,其功耗只有机械轴承的15%左右;有效节能。

3、高转速、高精度、高可靠性,此活齿磁浮柔性关节,可以在上万转的工况下工作,且转轴的回转精度可以达到微米级或更高,这是普通机器人RV减速器无法达到的速度与精度,而且控制和执行动作的电子元器件的可靠性在很大程度上高于传统的机械零部件。

4、具有主动式混合电磁悬浮激波轴承,结构紧凑体积小,该柔性关节具有更强的抗扭刚度和承受更大的冲击载荷的能力,更大的轴向推力和悬臂动量,其背隙小于1弧分。

5、多齿啮合,无需专门的输出机构,且活齿轮可以径向伸缩、柔性浮动,避免了轮齿间的相互干涉,因此具有极高的承载能力和抗冲击能力,其承载能力是普通齿轮传动的6倍以上,多齿同时啮合,且无需专门的输出机构,转矩由活齿架总成直接输出,所以具有极高的扭转刚度和极小的回差,其回差是传统减速器回差的10%左右。

6、滚动接触,传动效率高,全部轮齿及传力零部件之间,均为滚动接触,减少了摩擦损耗,其传动效率可达96%以上。

7、传动比大、结构紧凑、体积小,由于该活齿磁浮柔性关节的传动比等于活齿轮的齿数,因此,与同功率、同传动比的减速器相比,其体积可缩小2/3。

8、传动平稳、转矩波动小,由于多齿同时啮合,且每个轮齿的啮合是按等速共轭的原理设计和制造的,而制造加工精度误差对多齿啮合的影响,一般仅为单齿啮合的误差10%左右,因此,该活齿磁浮柔性关节具有极高的传动平稳性和极小的转矩波动。

9、智能控制、工况检测及故障自诊断功能,可对其静态与动态性能进行全时在线控制,并可同时进行对工况参数的检测与故障诊断,以及对各工况参数的调整与设置。

10、各转轴位移数据的适时采集与反馈;远程无线通信数据传输及控制;控制系统的可变稳定性及电磁磁通量的调节功能。

11、工况技术参数的显示及报警功能,DSP主控制器CPU通过安装在执行器上的传感器反馈过来的数据信号并通过转换和运算,通过传输至人机对话系统并在显示器上实时显示出各相应的工况技术参数,执行系统超限时,实现危险动作限制及报警,从而保护了各相应的执行系统和机器人系统整体的安全。

12、低阻力系数、轻量化机身及高强度的结构设计,极大地增强减速器的刚度与抗弯、抗拉及抗压强度。

本发明的活齿磁浮机器人柔性关节系统主要应用于各类工业机器人、太空机器人、深海机器人、AGV载运车、航天航空器、医疗设备、焊接变位机、数控机床刀库、精密回转台以及其他精密传动控制,是智能化和自动化工业装备的重要组成部分,同时也是实现工业智能化、信息化物联网管理,智能化工厂生产制造不可或缺的理想装备。

附图说明

图1是本发明一种实施例的横截面示意图;

图2是本发明一种实施例的纵剖面示意图;

图3是激波轴、内外激波轮、电磁激波轴承、活齿架、活齿轮及活齿轮轴与固齿轮之间的传动关系结构图;

图4本发明的电磁激波轴承纵剖面示意图;

图5是本发明的电磁激波轴承横截面示意图;

图6是本发明的电气控制系统电原理框图;

图7是本发明的功率放大器模块电气原理图;

图8是本发明的DAC数模转换模块电气原理图;

图9是本发明的电源管理模块电气原理图;

图10是本发明的数据采集及信号调理模块电气原理图(一);

图11是本发明的温度传感器/变送器模块电气原理图(二);

图12是本发明的LCD显示器模块电气原理图;

图13是本发明的LCD显示器模块电气原理图;

图14是本发明的开关量输入输出模块电气原理图;

图15是本发明的主控制器与各模块信号及数据传输电气原理图(一);

图16是本发明的主控制器与各模块信号及数据传输电气原理图(二);

图17是本发明的电磁线圈及磁通分布控制电气原理图;

图18是本发明的主控制器与各模块信号及数据传输电气原理图(三);

图19是本发明的伺服驱动控制系统模块电气原理图。

附图标注说明:

1、第一内活齿轮;2、第一内活齿轮轴;3、内固齿轮;4、第一外活齿轮;5、第一外活齿轮轴;6、外活齿架;7、第一联接螺栓;8、第二联接螺栓;9、第二外激波轮;10、第一电磁激波轴承;11、外固齿轮右联接法兰;12、第一轴承;13、第三联接螺栓;14、内活齿架右传力盘;15、外活齿架右传力盘;16、第二轴承;17、第四联接螺栓;18、轴承座;19、第五联接螺栓;20、导电滑环总成;21、第一密封圈;22、第三轴承;23、第一衬套;24、第四轴承;25、第二内激波轮;26、第二电磁激波轴承;27、第六联接螺栓;28、内固齿轮右联接法兰;29、第二内活齿轮;30、第二内活齿轮轴;31、第二外活齿轮;32、第二外活齿轮轴;33、外固齿轮;34、第七联接螺栓;35、外固齿轮左联接法兰;36、第八联接螺栓;37、第一外激波轮;38、第三电磁激波轴承;39、第五轴承;40、内活齿架;41、第九联接螺栓;42、第六轴承;43、第七轴承;44、第二密封圈;45、圆柱销;46、激波轴;47、平键销;48、内活齿架左传力盘;49、第八轴承;50、第二衬套;51、外活齿架左传力盘;52、第一内激波轮;53、第四电磁激波轴承;54、第十联接螺栓;55、内固齿轮左联接法兰;B01、第一轴向定子;B02、永磁环;B03、第二轴向电磁线圈组;B04、第二轴向定子;B05、第二紧固螺栓;B06、位移传感器;B07、轴向控制磁通;B08、第一轴向电磁线圈组;B09、轴向偏磁磁通;B10、转子;B11、径向电磁线圈组;B12、径向定子;B13、第一紧固螺栓;B14、径向控制磁通;B15、径向偏磁磁通。

具体实施方式

以下将参考附图并结合实施例来详细说明本发明。需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。为叙述方便,下文中如出现“上”、“下”、“左”、“右”字样,仅表示与附图本身的上、下、左、右方向一致,并不对结构起限定作用。

本实施例的机器人活齿磁浮柔性关节(MORT减速器)系统主要是由精密机械与电磁磁浮传动系统和智能控制电气系统两大部分组成,其技术方案如下:

电磁激波轴承传动是采用无机械接触的电磁力传动。首先,其转动矢量是由伺服电机的主轴旋转,传递给激波轴46(输入轴),再通过电磁激波轴承传递给内激波轮,并驱动内活齿轮与内活齿轮轴旋转,进而驱动内固齿轮旋转,内固齿轮的外圆中心轴线与其旋转的中心轴线是偏心的,由于外激波轮是安装在内固齿轮的外圆上的,而内活齿架左传力盘48与外固齿轮左联接法兰35是通过圆柱销固定在一起的,从而转动矢量通过外激波轮,驱动外活齿轮与外活齿轮轴旋转,且沿着外固齿轮的齿廓曲线作圆周运动,其转动矢量通过外活齿架右传力盘15(输出轴)输出;

参见图4、图5、图17,电磁激波轴承的机械结构包括轴向定子、轴向电磁线圈组、永磁环、径向定子、径向电磁线圈组、位移传感器、转子、紧固螺栓等。

其中,内激波轮是通过电磁激波轴承柔性地支承在激波轴(输入轴)上,外激波轮是通过电磁激波轴承柔性地支承在内固齿轮的偏心外圆上,通过调节电磁激波轴承线圈电流的大小,即改变径向控制磁通和轴向控制磁通的大小,可精确地控制转子与径向定子、轴向定子之间旋转的同轴度、位置度,以及内激波轮与外激波轮旋转动载时的径向与轴向的跳动和位置误差,始终保持内外活齿轮与内固齿轮、内外活齿架、内外活齿架传力盘在动态载荷下,旋转的高稳定性和可靠性。

该活齿磁浮柔性关节(MORT减速器)系统的智能控制电气系统,是由五大系统构成,其包括人机对话系统、远程无线通信系统、数据采集反馈系统、控制系统与机构执行系统。

该活齿磁浮柔性关节(MORT减速器)系统的机械结构是由两级全滚动活齿磁浮传动组成,即由内活齿磁浮传动减速(第一级)与外活齿磁浮传动减速(第二级)组成。其结构主要包括:激波轴(输入轴)、内激波轮、内活齿轮与内活齿轮轴总成、内活齿架总成、内固齿轮总成、外激波轮、外活齿轮与外活齿轮轴总成、外活齿架总成、外固齿轮总成、系列电磁激波轴承、导电滑环总成、其它系列轴承、密封圈以及联接螺栓等。

如图1-3所示,活齿磁浮柔性关节系统的机械结构描述:

其中内活齿架40通过第九联接螺栓41与内活齿架左传力盘48紧固连接,通过第三联接螺栓13与内活齿架右传力盘14紧固连接,并共同组成内活齿架总成。

第二密封圈44、第八轴承49、第二衬套50分别安装于内活齿架左传力盘48与激波轴46(输入轴)相对应的位置,第一密封圈21、第二轴承16、第一衬套23分别安装于轴承座18、内活齿架右传力盘14、激波轴46以及内固齿轮右联接法兰28相对应的位置。

第一内活齿轮1、第一内活齿轮轴2、第二内活齿轮29、第二内活齿轮轴30分别安装于内活齿架总成的左、右两侧的滚轮槽和销轴槽中,第一内激波轮52安装在第四电磁激波轴承53的外转子上、第二内激波轮25安装在第二电磁激波轴承26的外转子上、而第四电磁激波轴承53的内转子与第二电磁激波轴承26的内转子,又分别安装在第一级激波轴46的两个偏心圆柱上,且第一内激波轮52与第二内激波轮25的偏心位置是相互交错180°的角度安装的。

其中内固齿轮3通过第十联接螺栓54与内固齿轮左联接法兰55紧固连接,通过第六联接螺栓27与内固齿轮右联接法兰28紧固连接,并共同组成内固齿轮总成。

平键销47安装在激波轴46的键槽中,且激波轴46的键槽端是通过第八轴承49安装在内活齿架左传力盘48的内腔中,另一端则通过第三轴承22安装在内固齿轮右联接法兰28及轴承座18相应的内孔中,而轴承座18是通过第四联接螺栓17紧固在内固齿轮右联接法兰28的端面上的。

导电滑环总成20是通过第五联接螺栓19固定在轴承座18的端面上的。

内活齿架总成是由安装在内活齿架左传力盘48上的第七轴承43、以及安装在内活齿架右传力盘14上的第二轴承16,分别支承在由内固齿轮3、内固齿轮左联接法兰55和内固齿轮右联接法兰28共同组成的内固齿轮总成的内腔中。

第六轴承42的内圈安装在内固齿轮左联接法兰55的相应外圆上,外圈安装在外活齿架左传力盘51的相应内孔中,第四轴承24的内圈安装在内固齿轮右联接法兰28的相应外圆上,外圈安装在外活齿架右传力盘15的相应内孔中。

其中外活齿架6通过第八联接螺栓36与外活齿架左传力盘51紧固连接,通过第二联接螺栓8与外活齿架右传力盘15紧固连接,并共同组成外活齿架总成。

第一外活齿轮4、第一外活齿轮轴5、第二外活齿轮31、第二外活齿轮轴32分别安装于外活齿架总成的左、右两侧的滚轮槽和销轴槽中,第一外激波轮37安装在第三电磁激波轴承38的外转子上、第二外激波轮9安装在第一电磁激波轴承10的外转子上、而第三电磁激波轴承38的内转子与第一电磁激波轴承10的内转子,又分别安装在内固齿轮3的两个偏心外圆上,且第一外激波轮37与第二外激波轮9的偏心位置是相互交错180°的角度安装的。

其中外固齿轮33通过第七联接螺栓34与外固齿轮左联接法兰35紧固连接,通过第一联接螺栓7与外固齿轮右联接法兰11紧固连接,并共同组成外固齿轮总成。

外活齿架总成是由安装在外活齿架左传力盘51上的第五轴承39、以及安装在外活齿架右传力盘15上的第一轴承12,分别支承在由外固齿轮33、外固齿轮左联接法兰35和外固齿轮右联接法兰11共同组成的外固齿轮总成的内腔中。

其中外固齿轮左联接法兰35与内活齿架左传力盘48是通过圆柱销45定位并固定的。

电磁激波轴承结构描述:

电磁激波轴承的机械结构包括第一轴向定子B01、第二轴向定子B04、第一轴向电磁线圈组B08、第二轴向电磁线圈组B03、永磁环B02、径向定子B12、径向电磁线圈组B11、位移传感器B06、转子B10、第一紧固螺栓B13、第二紧固螺栓B05。

第一轴向电磁线圈组B08嵌绕在第一轴向定子B01的内圈圆周上,第二轴向电磁线圈组B03嵌绕在第二轴向定子B04的内圈圆周上;位移传感器B06安装在径向定子B12的径向槽内,径向电磁线圈组B11沿圆周等分,均匀嵌绕在径向定子B12的轴向槽内,组成径向定子总成;永磁环B02、转子B10、以及径向定子总成,分别安装在第一轴向定子B01与第二轴向定子B04的中间,并且用第一紧固螺栓B13和第二紧固螺栓B05联接紧固。

本实施例的精密机械与电磁磁浮传动系统是用以圆形滚轮为活齿轮,以偏心圆盘为激波轮,以电磁激波轴承为激波轴承,以活齿轮与激波轮各自运动产生的叠加轨迹,作为固齿轮的齿廓精准包络线,从而实现速比恒定的径向活齿矢量,以及活齿轮与固齿轮之间精准的共轭啮合,是机械和电磁力的混合传动。

首先,其转动矢量是由伺服电机的转轴通过激波轴46(输入轴)传递到电磁激波轴承的内转子,而激波轴承的外转子在内、外转子气隙之间的磁场力作用下,悬浮在以激波轴的偏心圆为同心圆的径向半径矢量面域内,并随内转子一起同向旋转,从而驱动激波轮同向旋转,激波轮驱动活齿轮旋转、其中活齿轮与激波轮、活齿轮与固齿轮齿廓之间的传动接触是两个高副接触,活齿轮轴是安装在活齿架上的,且活齿轮轴在活齿槽中慢速滚动,当活齿架与其左、右传力盘固定时,则活齿轮驱动固齿轮旋转,反之,当固齿轮固定时,则活齿架及其左、右传力盘旋转。

通过改变激波轴承的电磁线圈的电流大小和方向,即可改变控制磁通的大小和方向,控制磁通产生的磁场力与偏磁磁通产生的磁场力进行矢量叠加,从而改变电磁激波轴承所承载的刚度和扭矩的大小,以及恒定的径向半径矢量,实现恒功率转动矢量的传递,通过改变伺服电机的转动方向,可实现改变活齿轮和固齿轮的旋转方向。

而智能控制电气系统是由五大系统构成,其包括人机对话系统、远程无线通信系统、数据采集反馈系统、控制系统与机构执行系统。

精密机械与电磁磁浮传动系统是采用两级全滚动活齿磁浮传动减速,即由内活齿磁浮传动减速(第一级)与外活齿磁浮传动减速(第二级)组成。

内活齿磁浮传动减速(第一级)描述:其中内活齿架与内活齿架左传力盘48、内活齿架右传力盘14组成内活齿架总成,第一内活齿轮、第一内活齿轮轴、第二内活齿轮、第二内活齿轮轴分别安装于内活齿架总成的左、右两侧的滚轮槽和销轴槽中,第一内激波轮安装在第四电磁激波轴承的外转子上、第二内激波轮安装在第二电磁激波轴承的外转子上、而第四电磁激波轴承的内转子与第二电磁激波轴承的内转子又分别安装在(第一级)激波轴(激波轴)的两个偏心圆柱上,且第一内激波轮与第二内激波轮是相互交错180°角度安装的。

其中内固齿轮齿廓,是采用左右分布的双排精准包络线形成的圆弧形齿廓,两排圆弧形齿廓是在同心圆周上,且相互交错半个圆弧形齿的齿距进行排列的,而内固齿轮外壳上有两个相互交错180°角度的偏心圆柱,内固齿轮与内固齿轮左联接法兰、内固齿轮右联接法兰组成内固齿轮总成。(第一级)传动是将内活齿架总成固定,转矩矢量由内固齿轮总成输出。

外活齿磁浮传动减速(第二级)描述:其中外活齿架与外活齿架左传力盘、外活齿架右传力盘组成外活齿架总成,第一外活齿轮、第一外活齿轮轴、第二外活齿轮、第二外活齿轮轴分别安装于外活齿架总成的左、右两侧的滚轮槽和销轴槽中,第一外激波轮安装在第三电磁激波轴承的外转子上、第二外激波轮安装在第一电磁激波轴承的外转子上、而第三电磁激波轴承的内转子与第一电磁激波轴承的内转子又分别安装在(第二级)激波轴(内固齿轮)的两个偏心圆柱上,且第一外激波轮与第二外激波轮是相互交错180°角度安装的。

其中外固齿轮齿廓,是采用左右分布的双排精准包络线形成的圆弧形齿廓,两排圆弧形齿廓是在同心圆周上,且相互交错半个圆弧形齿的齿距进行排列的,外固齿轮与外固齿轮左联接法兰、外固齿轮右联接法兰组成外固齿轮总成。(第二级)传动是将外固齿轮总成固定,转矩矢量由外活齿架总成输出。

综上所述,该两级全滚动活齿磁浮传动的能实现很大的减速比,以及极高的转矩传输效率,设第一级减速比为i1,内活齿轮个数为Z1,第二级减速比为i2,外活齿轮个数为Z2,总减速比为i,根据本方案设计特点,i1=Z1,i2=Z2,则i=i1×i2,即i=Z1×Z2,其传动比取决于活齿轮的个数的乘积。

通过调节电磁激波轴承线圈电流的大小,即改变径向控制磁通和轴向控制磁通的大小,可精确地控制电磁激波轴承内转子与外转子旋转的同轴度、位置度,以及内转子与外转子旋转动载时的径向、轴向的跳动与位置误差,始终保持电磁激波轴承内转子与外转子在动态载荷下旋转的高稳定性和可靠性。

上述技术方案中,人机对话系统是由主DSP控制器(CPU)、LCD显示模块DM、系统工况参数LCD显示器组成,且LCD显示器与显示模块DM连接,LCD显示模块DM通过CAN3总线与DSP主控制器(CPU)连接,从而可适时显示或设置调整活齿磁浮柔性关节(MORT)系统运行中的各技术参数和运行状态。

上述技术方案中,远程无线通信系统是由减速器系统中的嵌入式ZigBee无线通讯收发模块、LCD显示模块DM、工况参数LCD显示器组成,其中减速器系统中的嵌入式ZigBee无线通讯发射模块,通过CAN5总线与DSP主控制器(CPU)连接,显示器与LCD显示模块DM连接并通过CAN3总线与DSP主控制器(CPU)连接,嵌入式ZigBee无线通信接收模块与系统上位机(计算机系统)连接,从而实现机器人活齿磁浮柔性关节(MORT)系统与该工业物联网各终端的远程通讯。

上述技术方案中,数据采集与反馈系统,是由位移传感器、温度传感器、温度变送器、电子式力矩传感器、光电编码器、数据采集及信号调理模块组成,其中,位移传感器与数据采集及信号调理模块连接,再通过RS485模块与DSP主控制器(CPU)连接,温度传感器与温度变送器连接,再通过RS485模块与DSP主控制器(CPU)连接,电子式力矩传感器模块通过CAN6总线与DSP主控制器(CPU)连接,光电编码器模块通过CAN4总线与DSP主控制器(CPU)连接,从而实现对机器人活齿磁浮柔性关节(MORT)系统中的各电磁激波轴承的位置偏移量、旋转速度、旋转方向、承载扭矩大小和工作温度的实际数据进行适时地采集与反馈。

上述技术方案中,控制系统是由DSP主控制器(CPU)、电源管理模块、开关量输入模块、DAC数模转换模块组成,其中电源管理模块、开关量输入模块分别与DSP主控制器(CPU)连接,DAC数模转换模块是通过CAN1总线与DSP主控制器(CPU)连接,组成一个计算处理中枢,对从各个传感器分别采集而来的数据信号,通过DAC数模转换模块输入DSP主控制器(CPU)分别进行运算处理,再对相应的执行驱动模块分别发出相应的执行指令信号,并同时通过嵌入式ZigBee无线通信模块及其传输网络,将这些数据信息及指令信息传输到系统上位机(计算机系统),再通过远程无线网,传送到此工业物联网管理终端,从而实现对机器人活齿磁浮柔性关节(MORT)系统中的各个电磁线圈的控制电流、控制磁通的大小进行精准的适时调整控制,可为物联网管理终端提供工况数据与故障分析的原始依据,提高管理效能,节约生产制造及管理运营成本。

上述技术方案中,机构执行系统是由电磁激波轴承执行系统和伺服驱动系统两部分组成的,它包括伺服驱动器、伺服电机、激波轴(输入轴)、内活齿架总成、第二电磁激波轴承和第四电磁激波轴承、第一内激波轮和第二内激波轮、第一内活齿轮和第二内活齿轮、第一内活齿轮轴和第二内活齿轮轴、内固齿轮总成、外活齿架总成、第一电磁激波轴承和第三电磁激波轴承、第一外激波轮和第二外激波轮、第一外活齿轮和第二外活齿轮、第一外活齿轮轴和第二外活齿轮轴、外固齿轮总成。

其中,电磁激波轴承执行系统是由功率放大器模块AM1、AM2、AM3、AM4、电磁线圈EM1、EM2、EM3、EM4、EM5、EM6、EM7、EM8、EM9、EM10、EM11、EM12、电磁激波轴承外转子BE1、BE2、BE3、BE4、以及电磁激波轴承内转子和激波轴(输入轴)组成,其中各功率放大器模块输入端分别与DAC数模转换模块的交流输出端和直流输出端连接,同时通过CAN2总线与DSP主控制器(CPU)连接,各功率放大器模块输出端分别与之相对应电磁铁线圈连接,而与电磁铁线圈相对应的电磁激波轴承外转子BE1、BE2对应安装在第一内激波轮和第二内激波轮的偏心圆中,电磁激波轴承转子BE3、BE4分别对应安装在第一外激波轮和第二外激波轮的偏心圆中,而与各激波轴承的外转子相对应安装的位移传感器,通过RS485信号收发模块分别与数据采集及信号调理模块连接,温度传感器与温度变送器模块连接,再通过RS485信号收发模块与DSP主控制器(CPU)连接;而伺服驱动系统是由伺服驱动模块、伺服电机和激波轴总成组成的,其中,伺服驱动模块通过CAN7总线与DSP主控制器(CPU)连接,伺服电机线圈输入端与伺服驱动模块的交流输出端连接,同时通过信号线与光电编码器连接,电磁激波轴承外转子总成上的电磁线圈输入端,与DAC数模转换模块的直流输出端连接,从而实现对各电磁线圈的电流以及磁通量的大小进行调整与控制,进而对机器人活齿磁浮柔性关节(MORT)系统中各执行机构的运动状态的参数,如速度矢量、扭矩大小、位置偏差、温度变化、动载稳定性等进行调整与控制。

本发明的工作原理及工作过程如下:

(一)、电气控制系统的启动

闭合机器人活齿磁浮柔性关节(MORT)系统的控制电源开关,确认正常工作指示灯绿灯亮起,此时DSP主控制器(CPU)以及各控制系统的电源已接通。

(二)、人机对话系统工作原理及过程

人机对话系统是将从数据采集反馈系统中的各传感器传输进来的数据信息、参数等电信号,通过DSP主控制器(CPU)的运算处理,通过CAN3总线将图像数据和系统各工况参数传输给DM,即LCD显示器驱动模块NH12864M,再传输给LCD显示器显示并保存,并将机器人活齿柔性关节控制系统中的工况技术参数以及各激波轮的位置状态及位置偏差显示出来,同时,通过LCD显示器(触摸屏)可以修改、调整或重新设置电磁激波轴承及激波轮的工况技术参数,并通过CAN3总线传输给DSP主控制器(CPU),DSP主控制器(CPU)再将不同的指令分别传送到执行机构的各执行驱动模块,从而实现机器人活齿磁浮柔性关节系统中的运行状态及运动位置、磁通量、动载扭矩和运行环境温度的调整。

(三)、远程无线通信系统工作原理及过程

此通信系统是包括嵌入式ZigBee无线通信模块及其传感网络、上位机(计算机系统/PC机)、GPRS/4G通信模块组成的远程无线网络通信系统,包含4G/5G通信模块、LCD显示模块NH12864M、LCD显示器、主控制器(CPU),工作时,机器人活齿磁浮柔性关节系统中的运行状态及运动位置偏差、磁通量、动载扭矩和运行环境温度等各参数信息,通过CAN5总线从DSP主控制器(CPU)传输到ZigBee无线通信发射模块及其传感网络,再通过ZigBee无线通信接收模块传送到该活齿磁浮柔性关节控制系统的上位机(计算机系统/PC机),再由计算机系统基于HTTP通信协议,通过4G/5G远程通信网络传送到该机器人工业物联网服务器管理终端,物联网管理终端可以根据各运行数据、参数分别对其进行相应的数据设置修改、存储,并发出相应的指令,物联网服务器管理终端基于MQTT消息队列遥感传输技术协议,通过远程无线通信网络将各相应的指令传送给机器人活齿磁浮柔性关节控制系统的上位机(计算机系统/PC机),上位机将相应的指令,通过ZigBee无线收发模块及其传感网络及CAN5总线,将修改或设置的指令信息传输给DSP主控制器(CPU)进行比较和运算处理,再将处理运算后的各信息指令,分别通过CAN1总线传送到DAC数模转换模块,通过CAN2总线传送到功率放大器模块,通过CAN7总线传送到执行机构的伺服驱动系统,进而驱动执行机构系统按指令执行动作,通过CAN3总线将各工况参数数据传输给LCD显示模块NH12864M,并在LCD显示器中显示出来的。

(四)、数据采集与反馈系统的工作原理及过程

数据采集与反馈系统是由位移传感器(BL/ZM1D2000)、温度传感器(T/PIC16F877)、温度变送器、电子式力矩传感器(TN4000)、光电编码器(E6B2-CW25B2000P/R)、数据采集及信号调理模块组成(DAC7724),其中,位移传感器与数据采集及信号调理模块连接,再通过RS485模块与DSP主控制器(CPU)连接,温度传感器与温度变送器连接,再通过RS485模块与DSP主控制器(CPU)连接,电子式力矩传感器模块通过CAN6总线与DSP主控制器(CPU)连接,光电编码器模块通过CAN4总线与DSP主控制器(CPU)连接,将位移传感器、温度传感器、温度变送器、电子式力矩传感器、光电编码器反馈来的工况信号参数,以及开关量输入模块(HC202-16)传来的指令传输给DSP主控制器(CPU)进行分类、比较、运算处理,然后发出相应的指令,通过CAN1总线传送到DAC数模转换模块,再通过CAN2总线对电磁激波轴承系统中的功率放大器模块组进行控制,通过CAN7总线对机构执行中的伺服驱动系统伺服驱动器进行控制,并通过CAN3总线将相应的数据传输到人机对话系统中的LCD显示模块NH12864M,并在工况参数LCD显示器中显示并保存,从而实现对机器人活齿磁浮柔性关节系统中的各激波轮的位置偏移量、电磁激波轴承外转子的旋转角度、旋转速度、旋转方向、承载扭矩大小和工作温度的实际数据进行适时地采集与反馈,并通过CAN5总线传输到ZigBee无线通信模块及其传感网络,进而传送到该控制系统的上位机(计算机系统/PC机)。

(五)、DSP主控制器(CPU)控制系统的工作原理及过程

DSP主控制器(CPU)是该活齿磁浮柔性关节控制系统的指挥中心,是将接收的指令信息和传感器反馈的数据参数进行集中分类,运算处理,然后再发出相应的执行指令,以控制其它各系统的动作的开启、关闭和安全稳定。

将CAN4总线、CAN6总线、RS485通信模块传输进来的指令或数据进行分类、运算、处理,然后发出相应的指令,分别通过CAN3总线、CAN1总线、CAN2总线、CAN7总线对人机对话系统,机构执行系统进行控制,并通过CAN3总线将相应的数据参数、运动状态反馈到人机对话系统,并在LCD显示器中显示,通过CAN5总线将机构执行系统的运行状态信息和人机对话系统中工况参数和运行状态,传送到嵌入式ZigBee无线通信模块及其传感网络,再传送到上位机(计算机系统/PC机),并通过远程无线通信网络传送给该活齿磁浮柔性关节系统的物联网管理终端,以精确地提供该系统的运行频次、运行状态的原始工况参数和可靠的共享数据。

将位移传感器(BL/ZM1D2000)、温度传感器(T/PIC16F877)、温度变送器、电子式力矩传感器(TN4000)、光电编码器(E6B2-CW25B2000P/R)反馈来的工况信号参数,以及开关量输入模块(HC202-16)传来的指令进行分类,比较、运算处理,然后发出相应的指令,分别通过CAN2总线、CAN7总线对机构执行系统进行控制,并通过CAN3总线将相应的数据传输到人机对话系统中,并在工况参数LCD显示器中显示并保存,具体是将从各传感器反馈来的工况信号参数和指令进行分类,比较、运算处理,然后发出相应的脉冲指令,对于机构执行系统中的伺服驱动系统的控制,是通过CAN7总线传输给伺服驱动模块SD,从而驱动伺服电机SM,带动激波轴旋转,并在磁场力作用下带动电磁激波轴承外转子总成旋转,同时,光电编码器EN将伺服电机SM的运转方向、运行速度、旋转角度等参数信息反馈给DSP主控制器(CPU),对于电磁激波轴承的电磁线圈的电流的调节,是DSP主控制器(CPU)将指令信息通过CAN1总线将指令信息传送给DAC7724数模转换模块,从而调整电磁激波轴承的电磁线圈电流的大小或电流方向。

对于机构执行系统中的电磁激波轴承系统的控制,是DSP主控制器(CPU)将指令信息通过CAN1总线将脉冲指令传送给DAC7724数模转换模块,再通过CAN2总线将相应的脉冲电流分别传送到功率放大器模块AM1、AM2、AM3、AM4进行放大,放大后的电流分别输入到电磁线圈组EM1、EM2、EM3、EM4、EM5、EM6、EM7、EM8、EM9、EM10、EM11、EM12,其中电磁线圈EM1、EM2、EM3的励磁磁通作用于电磁激波轴承转子BE1,电磁线圈EM4、EM5、EM6的励磁磁通作用于激波轴承转子BE2,电磁线圈EM7、EM8、EM9的励磁磁通作用于激波轴承转子BE3,电磁线圈EM10、EM11、EM12的励磁磁通作用于激波轴承转子BE4,其中电磁激波轴承转子BE1、BE2支承内激波轮,电磁激波轴承转子BE3、BE4支承外激波轮,从而实现内激波轮、内活齿总成(内活齿轮和内活齿轮轴)与外激波轮、外活齿总成(外活齿轮和外活齿轮轴)的旋转方向、旋转速度、位置偏差、相位偏差、动载扭矩、运行温度的各工况参数及运动状态的调节。

本发明能适时地将机构执行系统的所有工况数据,以及各传感器反馈的工况参数记录与预先设定的正常安全要求的工况技术参数进行对比运算,并储存在DSP主控制器(CPU)中,分别计算出相应的参数比值,通过CAN3总线传输到人机对话系统,其各个系统的各相应的参数数据比值都显示于显示器中,同时会有语言或报警提示,明确故障发生的系统部位,实现故障自诊断功能,同时可以随时查询每一次机构执行系统执行动作的时间,系统工作时的环境温度、运行工作量、机构执行动作时的运载情况,给技术管理人员掌握该活齿磁浮柔性关节系统的使用工作状况和维修保养工作的分析,提供了重要的原始依据,从而实现控制系统的故障诊断及查询功能。

安装在各控制执行机构上的各类传感器组共同组成的一个整体闭式循环内部控制网络,其主要核心是DSP主控制器(CPU)和各类传感器组,包括位移传感器(BL/ZM1D2000)、温度传感器(T/PIC16F877)、温度变送器、电子式力矩传感器(TN4000)、光电编码器(E6B2-CW25B2000P/R),其工作原理及过程,是当DSP主控制器(CPU)发出某指令信息,相应的控制系统就会按照该信息指令使相应的执行器执行该命令动作,而安装在该执行器上的传感器,会适时的将该执行器动作时产生的角度变化矢量、位移变化矢量、速度变化矢量、力矩变化矢量、温度变化值等参数,反馈到DSP主控制器(CPU),DSP主控制器通过运算处理,与预先设置的各相应执行系统的相对应的工况参数进行比较,且根据其参数变化值的大小,重新发出相应的信息指令,分别通过CAN1总线、CAN2总线、CAN7总线传送到各执行系统的驱动模块,调整各相应执行机构的动作,使各个相应的执行系统趋于安全稳定、动作可靠,从而实现各相应执行机构的可变稳定性限制,确保执行动作和被执行对象以及系统自身的可靠性和安全性。

可变稳定性的控制变化的数学模型为:Y=f(x)函数

设:Xo——系统预先设置的工况参数值

Xn——系统工作时实际的工况参数值

△Y——DSP主控制器运算后的函数值

Ymax——极限最大值

Ymin——极限最小值

则:△Y=f(Xn)-f(Xo)

当Ymin﹤△Y﹤Ymax时,各相应的执行系统处于正常稳定工作状态。当△Y≤Ymin或△Y≥Ymax时,说明各相应的执行系统处于不稳定的危险临界状态,此时,DSP主控制器(CPU)会发出相对应的指令,调节或停止相对应的执行机构的动作。

(六)、电磁激波轴承的工作原理及其依据的运动方程

该活齿磁浮柔性关节系统的电磁激波轴承的设计,是采用交直流、径向与轴向三自由度的混合电磁激波轴承,其轴向磁浮力分析如下,设Fm为永磁体对外提供的磁动势,

设Sz为轴向单个磁极面积,δz为轴向气隙长度,μo为真空磁导率,采用等效磁路法,根据磁路基尔霍夫定律ΣF=0和

现假设该电磁激波轴承的转子向左偏移Z,则轴向左、右气隙处的磁导为:

Gz1=μoSz/(δz-Z)

Gz2=μoSz/(δz+Z)

轴向左、右气隙处的磁通为:

则交直流径向、轴向三自由度混合电磁激波轴承的轴向合成的磁悬浮力为:

在忽略磁浮轴承中定子磁阻的情况下,转子在平衡位置时的磁感应强度、磁浮吸力应分别满足的条件是:B1=B2,F1=F2

根据磁感应强度公式:

B=μoNI/2δ

根据磁通量与磁感应强度及磁极面积的关系:

根据磁场力的基本计算公式:

得出

F=B

F=μoSN

从而转子左、右两侧的磁感应强度、磁浮吸力分别为:

B

B

上面公式中的:

S——永磁体磁极面积(mm

N——电磁线圈匝数

I——线圈中的偏置电流(A)

δ——转子与定子之间的气隙(mm)

B

B

F

F

μo——真空磁导率(μo=4π×10

由上面式子清晰地说明,在电磁浮轴承的转子处于平衡位置时,转子左、右两侧的磁密度大小、两侧线圈的电流大小、两侧线圈的匝数、左、右两侧的气隙的大小、左右两侧的磁吸力必须均等。

实际上,当电磁激波轴承的转子悬浮在平衡位置时,会受到外界干扰力的作用,这样转子将产生一定的位置偏移,转子将偏离其平衡位置,设其偏移量为Δx(mm),假设此干扰力方向向左,则转子左侧的气隙将减小为(δ-Δx)(mm),而转子右侧的气隙将增加为(δ+Δx)(mm),此时,位移传感器检测到的位置偏移量为Δx(mm),并将其产生的电压信号通过数据采集及信号调理模块,转化为相应的电压值,并将此电压值与预先设定的电压值进行比较,从而得出电压值变差Δv(V),经过主控制器(CPU)进行PID调节,将控制信号传递到DAC数模转换模块内,并经过功率放大器,将此控制信号转化为差变控制电流Δi(A),并由此差变控制电流改变和控制其磁场力ΔF(N)的大小,此时右侧的电磁吸力F

1、差变控制电流Δi(A)与磁场力增量ΔF(N)的计算表达式如下:

式中:

△x——转子偏离平衡位置的位移量(mm)

δ

δ

I

I

F

F

△F——磁场力增量(N)(使转子回归到初始平衡位置的力)

根据磁场力的基本计算公式,则

△F=F

2、径向电磁激波轴承作用于永磁环上的张力分析

根据麦克斯韦基本微分方程及气隙介质关系:

D=εE

B=μH

J=σE

式中:

H——磁场强度(A/m)

J——电流密度(A/㎡)

D——电位移矢量(C/㎡)

E——电场强度(V/m)

B——磁感应强度(T)

ρ——电荷体密度(C/m

ε——介电常数(F/m)

μ——介质磁导率(H/m)

当动、静永磁环共轴时,径向永磁轴承处于轴对称磁场中,其相应的计算场域是一个轴对称场域,若将此轴对称场域在roz坐标系中建模,在此场域中选择任一矢量点A(r,z),则矢量点A(r,z)应满足泊松方程:

1、

2、

3、

式中:

Ω——计算场域

μ——磁导率(H/m)

J

S

K——常量

W

由于永磁轴承的支承力取决于介质分界面上电磁力的大小,根据麦克斯韦应力张量法,则作用于永磁环上的张力F为:

F=∮

式中:

F——永磁环上的张力(N)

S——包围该磁体的任意封闭曲面(存在于永磁体周围的气隙中)(mm

σ——该曲面上的表面应力张力(N/mm

μ

n——曲面S的单位法向矢量

根据磁感应强度公式:

则永磁环上的张力为:

由上面分析可知,当W(A)值为最小min时,即当

3、径向电磁激波轴承的径向刚度分析

对于两个共轴磁环组成的永磁轴承,其轴向刚度与径向刚度存在着相互制约的关系,若径向稳定,则轴向不稳定;若轴向稳定,则径向不稳定。通常情况下,径向电磁激波轴承是以其径向刚度作为主要分析指标的。

一般在实际应用中,轴承的径向刚度K

式中函数f(x)为:

其中,x

式中:k=j·n,j为磁体的面磁极密度,n为磁体的表面法线,μ

从以上分析可知,当轴向位移d=0时,轴向的承载力为F

(七)、电磁激波轴承外转子负载气隙的磁场及其电磁转矩的分析

因为负载磁场是随外转子的旋转位置和电磁线圈绕组的电流瞬时值而变化的,它是由永磁体偏磁磁场和通电电磁线圈绕组产生的控制磁场,叠加而成的合成磁场,在假设线圈绕组铁芯的磁导率为无穷大的情况下,设气隙内半径r处的气隙磁密径向分量为B

在忽略铁芯磁饱和情况下,N

线圈绕组设计为双层叠加绕组,设P对极线圈绕组中,有2P个线圈组,每个线圈组有q个线圈,α

用同样的方法可得,b相、c相线圈绕组在有瞬时电流i

由于内、外转子负载气隙磁场是由永磁体偏磁磁场与线圈反应磁场叠加而成,如果以a相线圈绕组的轴线为极坐标轴,且当外转子永磁体的N极轴线与a相线圈绕组轴线重合时,以此为转动起始时刻(即t=0)时,那么当外转子转至位于γ角位置时,气隙中的负载磁场B

式中:γ=ω·t,B

式中:i

在伺服电机恒功率运转的的情况下,进一步分析电磁激波轴承内、外转子负载气隙的电磁转矩与其角速度、各相通电线圈绕组的电流的关系,设伺服电机在t时刻输出的功率为P

P

P

P

由于P

因为R

根据,

所以T

ω

上式说明,在伺服电机恒功率P

各相绕组线圈电流的调节,是通过主控制器(CPU)对位置传感器、扭矩传感器的输入信号进行处理后,发出相应的指令给DAC数模转换模块,再传输给功率放大器调节电流的大小,同时实现对开关电路的控制,正确判断各相绕组线圈的通电或断电情况,进而改变各绕组线圈电流导通的逻辑顺序,实现各线圈的电流换向,这样就可以实现外转子按顺时针或逆时针方向旋转,而内转子的旋转方向或转矩大小的调节,是通过主控制器(CPU)对光电编码器、扭矩传感器的输入信号进行处理后,将相应的指令传输给伺服驱动器,进而改变伺服电机的电流方向及其输出扭矩的大小而实现的。

上述实施例阐明的内容应当理解为这些实施例仅用于更清楚地说明本发明,而不用于限制本发明的范围,在阅读了本发明之后,本领域技术人员对本实施例的各种等价形式的修改均落入本发明所附权利要求所限定的范围。

技术分类

06120116333317