兼顾精密和高效的力控运动控制方法及系统技术方案

本发明专利技术公开一种兼顾精密和高效的力控运动控制方法及系统，方法应用于具有PC端和总线伺服驱动器的执行机构；实现在不同精度要求下，分别使用软件运动控制器或者总线伺服驱动器来实现对力控运动的控制；方法包括以下步骤：对力控参数进行配置；根据力控精度要求选定执行机构的主要控制方式；当选定为总线伺服驱动器进行控制时，根据力控参数进行控制，能够以高精密水平完成对执行机构的力控过程，并且由软件运动控制器协同监控；当选定由PC端的软件运动控制器进行控制时，由PC端的软件运动控制器根据力控参数进行力控运动的控制，实现高效率完成对执行机构的力控过程，大大提升了动作的实时性和效率。动作的实时性和效率。动作的实时性和效率。

【技术实现步骤摘要】
兼顾精密和高效的力控运动控制方法及系统


[0001]本专利技术涉及精密自动化控制
，尤其涉及一种兼顾精密和高效的力控运动控制方法及系统。

技术介绍

[0002]在精密自动化控制领域，除了要对位置和速度进行控制之外，越来越多的半导体和3C电子组装场合要求对元件和芯片进行力的精密控制以实现良好的接触、安装精度和保护元件的作用。在现在的机器换人的自动化时代，机器已经可以在位置精度和速度上媲美人工，但是要想实现越来越多的精密装配应用场景，必须要找到非常好的力控解决方案。目前常用的方案一般有两种，一是在总线控制器上编程控制对电机的电流进行限制从而实现力控；二是伺服驱动器自行控制力控的整个动作流程，在其内部程序通过对电流反馈或者外部力传感器信号进行闭环处理来实现力控。
[0003]这两个方案都有各自的应用场景和不足。一、在总线控制器上编程控制电机的电流，虽然控制流程很灵活，效率也很高，但是因为受制于总线控制周期不能太小，因此一般应用于对力控精度要求不是太高的场合，而且无法对力控在执行机构上的结果进行实时监控。此外，在总线控制器上一般在Windows系统上编程和运行，对精密力控的整个动作流程的实时性无法进行很好的保证，也就进一步影响到了力控的效果。
[0004]二、由伺服驱动器自行控制力控的整个动作流程，在伺服驱动器内部程序通过对电流反馈或者外部力传感器信号进行闭环处理来实现力控的方案中，因为驱动器的电流环等算法周期短运行频率高，因此可以实现很高精度的力控，但是由于其整个控制流程对于外部控制器来说是黑盒子，难以灵活调整和修改，在流程中出了问题也很难同控制器端的程序进行即时的协同处理，在力控过程完成后又将控制权交回给控制器，因此增加了很多控制流程的复杂性和降低了控制效率。所以精密制备时如何适应多种不同工况要求进行控制是亟需解决的。

技术实现思路

[0005]针对上述技术中存在的现有技术中，对于不同工况要求如何达到最适合的控制方式的问题；本申请提供一种技术方案进行解决。
[0006]为实现上述目的，本专利技术提供一种兼顾精密和高效的力控运动控制方法，应用于具有PC端和总线伺服驱动器的执行机构；包括以下步骤：对力控参数进行配置；获取配置中的力控精度要求，根据力控精度要求选定执行机构的主要控制方式；当选定为总线伺服驱动器进行控制时，根据所述力控参数进行控制；当选定为PC端进行控制时，由所述PC端的软件运动控制器根据所述力控参数进行力控运动控制。
[0007]作为优选，设定力控精度的第一阈值为n牛；当所述力控精度属于[
‑
n，+n]区间时，
选定所述总线伺服驱动器进行控制；当所述力控精度不属于[
‑
n，+n]区间时，选定所述软件运动控制器进行力控运动控制。
[0008]作为优选，当选定为总线伺服驱动器进行力控运动控制时，所述PC端对所述力控运动以外的运动阶段进行监测。
[0009]作为优选，在所述总线伺服驱动器进行力控运动控制时，循环读取执行机构上的力传感器的力反馈，并根据力反馈在电流控制器中进行精密控制。
[0010]作为优选，在所述总线伺服驱动器进行力控运动控制时发生错误后，所述PC端的软件运动控制器对错误进行处理。
[0011]作为优选，当所述软件运动控制器进行力控运动控制时，在实时API缓存区中录制力控程序，同时将电流限制值输入所述总线伺服驱动器；所述总线伺服驱动器循环读取电流反馈，并与所述电流限制值进行比较，以在电流控制器中进行力控限制。
[0012]作为优选，在所述软件运行控制器进行力控运动控制时发生错误后，所述软件运行控制器对错误进行修正，并执行力控运动控制。
[0013]作为优选，在获取电流限制值时，通过以下方法获得：在实时API缓存区中录制用户应用程序，执行机构根据第一位置指令从起始点运行到减速点，开始速度为0，命令速度为V0，结束速度为V1；执行机构再根据第二位置指令从起始点运行到减速点，开始速度为V1，命令速度为V1，结束速度为0；再将预设电流限制值写入所述总线伺服驱动器中，等待所述执行机构执行完成所述第二位置指令，则将所述预设电流限制值作为目标电流限制值写入所述总线伺服驱动器，并将所述执行结构返回起始点。
[0014]还公开一种兼顾精密和高效的力控运动控制系统，采用上述的方法；PC端的软件运动控制器包括共享内存的非实时操作系统和实时操作系统，所述非实时操作系统设置有控制接口模块、通讯接口模块，且力控参数的位置在所述非实时操作系统完成；所述实时操作系统包括电连接的实时控制内核、实时API缓存区和力控处理单元，所述实时API缓存区用于写入力控程序，所述力控处理单元用于执行力控控制；所述实时控制内核通过实时通讯内核连接总线伺服驱动器的实时总线接口；当选定为总线伺服驱动器进行控制时，所述总线伺服驱动器自主接收所述力控参数进行控制；当选定为软件运动控制器进行控制时，由所述API缓存区的力控程序进行力控运动控制。
[0015]作为优选，所述总线伺服驱动器包括依次电连接的MCU微处理器、FPGA可编程逻辑处理单元，驱动逆变单元、电机动力接口；所述电机动力接口用于与伺服电机连接以驱动所述执行机构；所述总线伺服驱动器还包括力反馈单元和编码器反馈接口；所述力反馈单元用于接收所述执行机构上的力传感器的力反馈，所述编码器反馈接口用于接收伺服电机的位置编码器模块的返回信息。
[0016]本专利技术的有益效果是：本专利技术公开一种兼顾精密和高效的力控运动控制方法及系统，方法应用于具有PC端和总线伺服驱动器的执行机构；通过对力控精度要求高低不同的应用场景，分别使用PC端的软件运动控制器或者总线伺服驱动器来实现对力控运动运动的控制，以兼顾精密和高效；方法包括以下步骤：对力控参数进行配置；获取配置中的力控精度要求，根据力控精度要求选定执行机构的主要控制方式；当选定为总线伺服驱动器进行控制时，根据力控参数进行控制；该状态中，PC端的软件运动控制器虽然不参与控制过程，但是仍然实时监控所有流程，并可对外部力传感器的反馈信号进行监控和结果确认；当选
定为PC端进行控制时，由PC端的软件运动控制器根据力控参数进行力控运动的控制，包含力控处理的用户应用程序在实时API缓存区中进行录制，且运行在实时操作系统中；由PC端的软件运动控制器根据力控参数进行力控运动的控制，实现高效率完成对执行机构的力控过程，大大提升了动作的实时性和效率。
附图说明
[0017]图1为本专利技术的方法流程图；图2为本专利技术的力控方法流程示意图；图3为本专利技术的总线伺服器内部原理架构图；图4为本专利技术的力控速度时间图；图5为本专利技术的力控控制过程示意图；图6为本专利技术系统架构图。
具体实施方式
[0018]为了更清楚地表述本专利技术，下面结合附图对本专利技术作进一步地描述。
[0019]在下文描述中，给出了普选实例细节以便提供对本专利技术更为深入的理解。显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部实施例。应当理解所述具体实施例仅用以解释本本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种兼顾精密和高效的力控运动控制方法，其特征在于，应用于具有PC端和总线伺服驱动器的执行机构；包括以下步骤：对力控参数进行配置；获取配置中的力控精度要求，根据力控精度要求选定执行机构的主要控制方式；当选定为总线伺服驱动器进行控制时，根据所述力控参数进行控制；当选定为PC端进行控制时，由所述PC端的软件运动控制器根据所述力控参数进行力控运动控制。2.根据权利要求1所述的兼顾精密和高效的力控运动控制方法，其特征在于，设定力控精度的第一阈值为n牛；当所述力控精度属于[
‑
n，+n]区间时，选定所述总线伺服驱动器进行控制；当所述力控精度不属于[
‑
n，+n]区间时，选定所述软件运动控制器进行力控运动控制。3.根据权利要求2所述的兼顾精密和高效的力控运动控制方法，其特征在于，当选定为总线伺服驱动器进行力控运动控制时，所述软件运动控制器对所述力控运动以外的运动阶段进行监测。4.根据权利要求3所述的兼顾精密和高效的力控运动控制方法，其特征在于，在所述总线伺服驱动器进行力控运动控制时，循环读取执行机构上的力传感器的力反馈，并根据力反馈在电流控制器中进行精密控制。5.根据权利要求4所述的兼顾精密和高效的力控运动控制方法，其特征在于，在所述总线伺服驱动器进行力控运动控制时发生错误后，所述PC端的软件运动控制器对错误进行处理。6.根据权利要求1所述的兼顾精密和高效的力控运动控制方法，其特征在于，当所述软件运动控制器进行力控运动控制时，在实时API缓存区中录制力控程序，同时将电流限制值输入所述总线伺服驱动器；所述总线伺服驱动器循环读取电流反馈，并与所述电流限制值进行比较，以在电流控制器中进行力控限制。7.根据权利要求6所述的兼顾精密和高效的力控运动控制方法，其特征在于，在所述软件运行控制器进行力控运动控制时发生错误后，所述软件运行控制器对错误进行修正，...

【专利技术属性】
技术研发人员：李寅，陈华，吴方泳，郭帅，
申请(专利权)人：深圳技术大学，
类型：发明
国别省市：