阅读说明：本技术 一种大行程高精度微纳运动伺服进给系统及控制方法 (large-stroke high-precision micro-nano motion servo feeding system and control method ) 是由 冯显英 *** 李沛刚 杜付鑫 孙德鹏 李慧 于 2019-08-07 设计创作，主要内容包括：本发明公开了一种大行程高精度微纳运动控制伺服进给系统,包括第一伺服电机、第二伺服电机、液体静压丝杠副、液压控制系统、压力检测装置、位移检测装置、位置反馈模块、运动控制器和PC机；液体静压丝杠副包括相互配合的丝杠和液体静压螺母组件；第一伺服电机驱动丝杠做旋转运动,第二伺服电机驱动液体静压螺母做旋转运动；两个伺服电机通过各自伺服驱动系统驱动；液体静压螺母组件带动工作台实现直线运动。位移检测装置一端与工作台相连,另一端和位置反馈模块相连,将测得的工作台位移信息反馈到所述位置反馈模块；位置反馈模块将信号反馈到运动控制器中；通过所述液体静压丝杠和螺母两个旋转运动的合成,实现工作台的精确的闭环进给控制。(The invention discloses a large-stroke high-precision micro-nano motion control servo feeding system which comprises a first servo motor, a second servo motor, a hydrostatic pressure screw pair, a hydraulic control system, a pressure detection device, a displacement detection device, a position feedback module, a motion controller and a PC (personal computer); the hydrostatic pressure screw pair comprises a screw and a hydrostatic pressure nut component which are matched with each other; the first servo motor drives the screw rod to rotate, and the second servo motor drives the hydrostatic nut to rotate; the two servo motors are driven by respective servo driving systems; the hydrostatic nut component drives the workbench to realize linear motion. One end of the displacement detection device is connected with the workbench, the other end of the displacement detection device is connected with the position feedback module, and the measured displacement information of the workbench is fed back to the position feedback module; the position feedback module feeds back the signal to the motion controller; and the precise closed-loop feeding control of the workbench is realized by the synthesis of the two rotary motions of the hydrostatic lead screw and the nut.)

一种大行程高精度微纳运动伺服进给系统及控制方法

技术领域

本发明涉及微纳技术领域,属于超精密数控机床及高端机电装备超精密运动控制领域技术，具体涉及一种适用于大行程、高精度数控机床的高分辨率微纳运动伺服进给系统及其控制方法。

背景技术

精密与超精密加工技术已经成为了国防与高新技术发展的技术支撑，随着产品的更新换代，许多高科技产品对零部件的加工精度要求越来越高，因此对精密和超精密机床的性能指标要求也在逐渐提高。然而,这种高精度运动控制的关键技术瓶颈之一是如何在加工过程中使工具或工件得到准确、稳定可靠地实现微纳级分辨率的微量进给控制。由于低速爬行现象的影响,常规的机电传动系统已经不再适用,当前实现微纳级位移的策略主要是依据智能材料的物理属性,如磁致伸缩、电致伸缩、热致伸缩以及机械力微量变形等原理获得微纳级位移的。

但是发明人发现智能材料的应用存在成本高、行程范围小、刚性低、非线性、控制复杂等缺陷，限制了其应用范围。

发明内容

为了解决现有技术中存在的问题，本发明提供了一种基于新型液体静压丝杠螺母副的大行程、高精度微纳运动控制伺服进给系统及其实现方法，实现超精密、高精度加工中的精确微位移控制。可广泛用于各种高端精密数控装备和高精度运动控制下的精确定位、跟踪及检测等场。

本发明采用的技术方案如下：

一种大行程高精度微纳运动控制伺服进给系统，其特征在于，包括第一伺服电机、第二伺服电机、液体静压丝杠副、液压控制系统、压力检测装置、位移检测装置、位置反馈模块、CNC运动控制器和PC机；

所述的液体静压丝杠副包括相互配合的丝杠和液体静压螺母组件；

所述的第一伺服电机驱动液体静压丝杠做旋转运动，第二伺服电机液体静压螺母组件做旋转运动；两个伺服电机各自通过一套伺服驱动系统驱动；所述的液体静压螺母组件上固定工作台，带动工作台做直线运动；感应工作台位移的位移检测装置一端与工作台相连，另一端和位置反馈模块相连，将测得的工作台位移信息反馈到所述位置反馈模块；

所述的位置反馈模块将信号反馈到CNC运动控制器中；所述CNC运动控制器，根据给定运动要求按照一定的算法分配指令给两个伺服驱动系统，使两个伺服电机运动通过液体静压丝杠螺旋传动副差动合成，获得精准的微纳级高分辨率运动位移；

所述的压力检测装置固定在工作台内部，测量液体静压丝杠副的液压油的工作压力，将油压传给液压控制系统，液压控制系统根据油压调节液压站供油；通过所述液体静压丝杠和螺母两个旋转运动的合成，实现工作台的微纳量级进给控制。

作为进一步的技术方案，所述的螺母组件包括液体静压螺母、液体静压轴承和螺母轴承安装座；

所述的液体静压螺母作为液体静压螺母轴承的内圈，液体静压螺母轴承安装在螺母轴承安装座上；在所述的液体静压螺母轴承上设有第一进油孔，在所述的液体静压螺母上设有第二进油孔，第一进油孔和第二进油孔相连通；

作为进一步的技术方案，所述的第二伺服电机采用空心直驱电机，所述的空心直驱电机的转子与液体静压螺母相连，空心直驱电机的定子与电机安装座相连。

作为进一步的技术方案，所述的液体静压丝杠的两端通过液体静压轴承支撑。

作为进一步的技术方案，第一伺服电机的伺服驱动系统包括第一位置环控制器、第一速度环控制器、第一电流环控制器、第一比较器、第二比较器和第三比较器；所述的第一比较器的正相输入端与CNC运动控制器相连，反相输入端与位移传感器相连，第一比较器输出端与第一位置环控制器相连；所述的第一位置环控制器的输出端与第二比较器的正相输入端相连，反相输入端与速度传感器相连，第二比较器输出端与速度环控制器相连；所述的第一速度环控制器的输出端与第三比较器的正相输入端相连，反相输入端与电流传感器相连，第三比较器输出端与第一电流环控制器相连；第一电流环控制器的输出端控制第一伺服电机相连。

作为进一步的技术方案，第二伺服电机的伺服驱动系统包括第二位置环控制器、第二速度环控制器、第二电流环控制器、第四比较器、第五比较器、第六比较器、第七比较器和第八比较器；所述的第七比较器的两个输入端均与CNC运动控制器的输出端相连，第七比较器的输出端与第八比较器的正相输入端相连，所述的第八比较器的另正相输入端与用于检测工作台位移的位移检测装置相连，所述的第八比较器输出端与第四比较器的正相输入端相连；所述的第四比较器的反相输入端与CNC运动控制器相连；第四比较器输出端与第二位置环控制器相连；

所述的第二位置环控制器的输出端与第五比较器的正相输入端相连，反相输入端与速度传感器相连，第五比较器输出端与第二速度环控制器相连；所述的第二速度环控制器的输出端与第六比较器的正相输入端相连，反相输入端与电流传感器相连，第六比较器输出端与第二电流环控制器相连；第二电流环控制器的输出端控制第二伺服电机相连。

作为进一步的技术方案，所述的液压控制系统包括节流器、液压控制器、液压站、第九比较器和第十比较器；

所述的压力检测装置与第九比较器的反相输入端相连，液压控制器与第九比较器的正相输入端相连，第九比较器的输出端与第十比较器的负相输入端相连，所述的第十比较器的正相输入端与液压控制器相连；所述的第十比较器的输出端与液压站相连，所述的液压站与节流器相连，节流器的输出端与液体静压丝杠副的进油口相连。

基于上面的系统，本发明还提供了一种控制方法，包含如下步骤：

步骤1依据第一伺服电机、第二伺服电机具体结构及固有属性，构建丝杠驱动和螺母驱动系统全闭环控制的数学模型；

步骤2依据构建的数学模型进行伺服驱动仿真，调节并整定获取位置、速度、电流各环节PID参数；

步骤3依据液压系统的结构特点，构建液压系统的全闭环控制的数学模型；

步骤4依据构建的数学模型进行仿真，得到相关参数。

步骤5依据所述运动控制器对丝杠电机和螺母电机的各自控指令插补分配，通过PC机各参数设置，分别向伺服电机的伺服系统发送插补分配指令，运动控制器在线实时调整参数，使整个控制系统速度和加减速度变化曲线连续精确通过丝杠螺旋传动副机械的运动合成，工作台便获得微纳级的高分辨率进给。

进一步的，所述的大行程高精度微纳运动控制伺服进给系统的控制方法，在CNC运动控制器和液压系统控制器联合控制下，具有丝杠单驱动、螺母单驱动等多种工作方式。不同的驱动方式下具有不同的工作性能，满足不同场合的工作要求。

本发明的有益效果如下：

本发明在原有丝杠驱动型液体静压丝杠螺母传动副的基础上，进一步改善了其低速进给精度，满足大行程、高精度微纳级进给的运动需求。本发明可广泛用于超精密、高精度加工、定位、跟踪、检测等各行业高档尖端机电装备和数控机床上，可使其整体动态性能指标得到大幅提升。

本发明使驱动液体静压丝杠和螺母的两个电机都避开因材质固有属性决定的易于产生“蠕动”爬行的低速工作区，工作在转速几近相等、转向相同的两个较高的转速区。本发明和目前常用的丝杠驱动型滚珠丝杠副和液体静压丝杠副相比，进给系统几乎不会产生“蠕动”爬行，可以达到微纳米级高精度。本发明专利可构成单轴、双轴高精度运动控制平台，可广泛用于各行业各类高精度加工、定位、跟踪及检测场合的高端数控机电装备。

附图说明

构成本申请的一部分的说明书附图用来提供对本申请的进一步理解，本申请的示意性实施例及其说明用于解释本申请，并不构成对本申请的不当限定。

图1为本发明提供的一种大行程高精度微纳运动控制伺服进给系统及其实现方法原理图；

图2为本发明提供的双驱动微纳进给伺服系统结构图；

图3为本发明提供的双驱动微纳进给伺服系统结构图的俯视角度的全剖视

图中：1—PC机；2—CNC运动控制器；3—丝杠电机控制电路；31—丝杠电机位置换控制器；32—丝杠电机速度环控制器；33—丝杠电机电流环控制器；4 —螺母电机控制电路；41—螺母电机位置换控制器；42—螺母电机速度环控制器； 43—螺母电机电流环控制器；5—液压控回路；51—液压控制器；52—液压站； 53—节流器；54—压力检测装置；6—液压差速双驱动工作台；601—丝杠电机； 602—联轴器；603—液体静压轴承；604—螺母电机；6041—空心电机转子；6042 —空心电机定子；605—液体静压螺母；；606—液体静压螺母轴承；607—液体静压丝杠；608—液体静压轴承；609—螺母轴承安装座；610—液体静压导轨；611 —位置检测装置；612—工作台；613—电机座；614—底座。

具体实施方式

应该指出，以下详细说明都是示例性的，旨在对本申请提供进一步的说明。除非另有指明，本文使用的所有技术和科学术语具有与本申请所属技术领域的普通技术人员通常理解的相同含义。

需要注意的是，这里所使用的术语仅是为了描述具体实施方式，而非意图限制根据本申请的示例性实施方式。如在这里所使用的，除非上下文另外明确指出，否则单数形式也意图包括复数形式，此外，还应当理解的是，当在本说明书中使用术语“包含”和/或“包括”时，其指明存在特征、步骤、操作、器件、组件和/或它们的组合；

为了方便叙述，本发明中如果出现“上”、“下”、“左”“右”字样，仅表示与附图本身的上、下、左、右方向一致，并不对结构起限定作用,仅仅是为了便于描述本发明和简化描述，而不是指示或暗示所指的设备或元件必须具有特定的方位，以特定的方位构造和操作，因此不能理解为对本发明的限制。

术语解释部分:本发明中的“大行程”是指滚珠丝杠整体行程大于100mm，可以扩展到1.5-2m左右。“高精度”是指位移分辨率在0.01μm-1nm左右。

正如背景技术所介绍的，现有技术中存在的不足，为了解决如上的技术问题，本申请提出了一种大行程高精度微纳运动控制伺服进给系统及控制方法。液体静压丝杠螺母副由于丝杠和螺母之间采用流体润滑，具有高刚度、低摩擦、阻尼特性好等优点，可以弥补液体静压导轨运动方向阻尼不足的缺陷。目前国内外没有实现螺母和丝杠可同时作主驱动的液体静压丝杠螺母副及其应用于超高精密加工机床领域中，本发明恰恰填补这这项技术空白。

为使本发明更加清晰明了，如附图1、2、3所示，以下结合附图对本发明做进一步详细说明和解释，但并不限定本发明。

如图1所示为一种大行程高精度微纳运动控制伺服进给系统及其实现方法原理图，包括PC机1、CNC运动控制器2、伺服驱动系统3、伺服驱动系统4、液压控制系统5、差速双驱动工作台6；

差速双驱动工作台6包括丝杠电机601、联轴器602、液体静压轴承603、螺母电机604(空心轴直驱电机)、液体静压螺母605、液体静压螺母轴承606、丝杠607、液体静压轴承608、螺母轴承安装座609、液体静压导轨610、位置检测装置611、工作台612、电机座613、底座614。

液体静压螺母605、液体静压螺母轴承606、螺母轴承安装座609构成了液体静压螺母组件。液体静压螺母组件和丝杠607构成完整的双驱动型液体静压丝杠螺母副。液体静压螺母605的内圈螺旋面与丝杠607螺旋面配合，螺母螺纹面全长四扣，每个牙扣同侧圆周分布有3个油腔，全部有效牙扣上的同侧同圆周位置上的油腔共用一个节流器控制。

液体静压螺母605作为液体静压螺母轴承606的内环，液体静压螺母轴承606 安装在螺母轴承安装座609上；在所述的液体静压螺母轴承606上设有第一进油孔，在所述的液体静压螺母605上设有第二进油孔。第一进油孔和第二进油孔相连通；

螺母电机604采用空心轴直驱电机，空心轴直驱电机的动子通过各自端部法兰与液体静压螺母605相连，定子与电机座613相连，所述的电机座613与工作台612相连，工作台612沿着导轨610移动。所述电机座613和螺母轴承安装座 609可一体化设计并固联于工作台。

丝杠607的两端通过轴向液体静压轴承603和608支撑。

丝杠电机601通过联轴器602与丝杠607相连。

丝杠电机601驱动丝杠做旋转运动，螺母电机604驱动液体静压螺母做旋转运动；两个伺服电机各自通过一套伺服驱动系统驱动；所述的液体静压螺母组件上固定工作台，感应工作台位移的位移检测装置一端与工作台相连，另一端和位置反馈模块相连，将测得的工作台位移信息反馈到所述位置反馈模块；所述的位置反馈模块将信号反馈到CNC运动控制器中；所述CNC运动控制器，根据PC机给定运动要求，按照一定的算法分配指令给两个伺服驱动系统；

所述的压力检测装置固定在工作台内部，测量液体静压丝杠副的液压油的工作压力，并传给液压控制系统，液压控制系统根据油压调节液压站供油；通过所述液体静压丝杠和螺母两个旋转运动的“差动”合成，实现工作台的精确微纳量级进给运动控制。

第一伺服电机的伺服驱动系统包括第一位置环控制器、第一速度环控制器、第一电流环控制器、第一比较器、第二比较器和第三比较器；所述的第一比较器的正相输入端与CNC控制器相连，反相输入端与位移传感器相连，第一比较器输出端与第一位置环控制器相连；所述的第一位置环控制器的输出端与第二比较器的正相输入端相连，反相输入端与速度传感器相连，第二比较器输出端与速度环控制器相连；所述的第一速度环控制器的输出端与第三比较器的正相输入端相连，反相输入端与电流传感器相连，第三比较器输出端与第一电流环控制器相连；第一电流环控制器的输出端控制第一伺服电机相连。

作为进一步的技术方案，第二伺服电机的伺服驱动系统包括第二位置环控制器、第二速度环控制器、第二电流环控制器、第四比较器、第五比较器、第六比较器、第七比较器和第八比较器；所述的第七比较器的两个输入端均与CNC控制器的输出端相连，第七比较器的输出端与第八比较器的正相输入端相连，所述的第八比较器的另正相输入端与用于检测工作台位移的位移检测装置相连，所述的第八比较器输出端与第四比较器的正相输入端相连；所述的第四比较器的反相输入端与CNC控制器相连；第四比较器输出端与第二位置环控制器相连；

所述的第二位置环控制器的输出端与第五比较器的正相输入端相连，反相输入端与速度传感器相连，第五比较器输出端与第二速度环控制器相连；所述的第二速度环控制器的输出端与第六比较器的正相输入端相连，反相输入端与电流传感器相连，第六比较器输出端与第二电流环控制器相连；第二电流环控制器的输出端控制第二伺服电机相连。

作为进一步的技术方案，所述的液压控制系统包括节流器、液压控制器、液压站、压力检测、第九比较器和第十比较器；

所述的压力检测装置与第九比较器的反相输入端相连，液压控制器与第九比较器的正相输入端相连，第九比较器的输出端与第十比较器的负相输入端相连，所述的第十比较器的正相输入端与液压控制器相连；所述的第十比较器的输出端与液压站相连，所述的液压站与节流器相连，节流器的输出端与液体静压丝杠副的进油口相连。

如图1、2给出了一种大行程高精度微纳运动控制伺服进给系统及其实现方法的具体实施例；

与上述实施例相结合，所述传动系统包括液体静压丝杠传动副和空心轴直驱电机传动。所述的液体静压丝杠副不同于常规的液体静压丝杠副，液体静压螺母还作为液体静压螺母轴承606的内圈。

其中丝杠电机601通过联轴器602与丝杠607连接。另一个螺母电机604的空心轴穿过丝杠607，其电机的转子6041直接与液体静压螺母605相连，带动螺母旋转，电机的定子6042安装在电机座613上，电机座固定在工作台612下方，随工作台一起运动。

与上述实施例相结合，所述的位移检测传感器611的一端与工作台相连接，一端与差动位置比较器相连接。

与上述实施例相结合，所述的伺服驱动系统包括丝杠电机伺服驱动系统和螺母电机伺服驱动系统，用于根据各自接收的控制信号和各自的反馈信号，采用PID 算法产生信号分别驱动伺服电机。由丝杠和螺母旋转产生的运动叠加合成，带动工作台运动。

与上述实施例相结合，所述PC机1分别与CNC运动控制器2与液压控制器 51相连接。根据实际工作要求PC机1分别向CNC运动控制器2和液压控制柜3 发送指令。

与上述实施例向结合，所述的CNC运动控制器2，根据实际工作精度要求，按照一定的算法分配给伺服电机601和空心轴伺服电机604运动指令。

与上述实施例相结合，所述两个伺服电机驱动系统中均包含位置控制电路、速度控制电路、电流控制电路以及其相对应的比较器。

与上述实施例相结合，所述螺母605内表面，通过液压油介质和丝杠607构成丝杠螺母螺旋传动副；螺母的端面设有用于将螺母电机动子(转子)固连在螺母上的均布的螺孔。

与上述实施例相结合，所述螺母轴承座端部设有法兰，法兰端面均布设有用于和工作台支承座相配固联工作台的螺孔，通过所述双驱液体静压杠螺母副螺旋传动，实现所述工作台的直线移动。

与上述实施例相结合，所述丝杠607采用“固定一支承”的安装方式，靠近伺服电机602的一端由丝杠固定座约束定位，丝杠固定座内装有一对角接触球轴承远离伺服电机的一端的支承座内装有用来径向定位，而轴向自由的向心球轴承 608。

与上述实施例相结合，所述超精密微量进给伺服驱动系统结构能构建单轴的微纳米级分辨率的超精密伺服工作台、双轴联动超精密伺服工作台以及多轴联动的超精密伺服工作台。

与上述实施例相结合，所述伺服驱动系统包括丝杠电机伺服驱动系统(3)、螺母电机伺服驱动系统(4)、液压油控制系统(5)。差动位置比较器和位置反馈模块。所述两个电机伺服驱动系统中均包含速度控制(32、42)、位置控制(31、 41)、电流控制(33、43)和其分别对应的比较器。液压控制系统中包含压力反馈模块54和压力比较器。

与上述实施例相结合，所述位置较器的一端与CNC运动控制器1相连接；另一端与速度、位置、电流检测器相连。位置比较器把位置信息和丝杠电机的位置比较后，将信息输出到位置控制电路。

与上述实施例相结合，所述的液体静压螺母605和丝杠607的位置比较器与差动比较器相连。丝杠位置信号与工作台位置检测器检测到的位置信号做差，通过改变丝杠电机或螺母电机的运动来弥补位置误差，即得到理想位置。

与上述实施例相结合，所述的压力传感器54将丝杠螺母之间的压力与PC机设置的压力通过压力比较器进行比较，通过液压控制系统51控制液压站52改变供油量进而通过节流器53调节丝杠螺母之间的液压油压力。

与上述实施例相结合，所述的大行程高精度微纳运动控制伺服进给系统的控制方法，其特征在于，包含如下步骤：

步骤1依据所述双驱动伺服系统具体结构及固有属性，构建丝杠3驱动和螺母4驱动系统全闭环控制的数学模型；

步骤2依据构建的数学模型进行伺服驱动仿真，调节并整定获取位置、速度、电流各环节PID参数；

步骤3依据液压系统的结构特点，构建液压系统的全闭环控制的数学模型；

步骤4依据构建的数学模型进行仿真，得到相关参数。

步骤5依据所述运动控制器2对丝杠电机601和螺母电机604的各自控指令插补分配，通过PC机各参数设置，分别向伺服电机的伺服系统发送插补分配指令，运动控制器在线实时调整参数，使整个控制系统速度和加减速度变化曲线连续精确通过丝杠螺旋传动副机械的运动合成，工作台便获得高分辨率的微量进给。

与上述实施例相结合，所述的大行程高精度微纳运动控制伺服进给系统的控制方法，其特征在于，在PC机控制CNC运动控制器2和液压系统控制器51下，具有多种工作方式，即丝杠单驱动、螺母单驱动、丝杠和螺母双驱动。不同的驱动方式下具有不同的工作性能，满足不同场合的工作要求。