CN110580005B - 一种适用于极端应用条件的运动控制系统 - Google Patents

一种适用于极端应用条件的运动控制系统 Download PDF

Info

Publication number
CN110580005B
CN110580005B CN201910917655.8A CN201910917655A CN110580005B CN 110580005 B CN110580005 B CN 110580005B CN 201910917655 A CN201910917655 A CN 201910917655A CN 110580005 B CN110580005 B CN 110580005B
Authority
CN
China
Prior art keywords
motion
slave station
time
current
control
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910917655.8A
Other languages
English (en)
Other versions
CN110580005A (zh
Inventor
刘雷
赵伟
陈海峰
李岩
冯俊威
刘毅珍
张文叶
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Research Institute of Mechanical and Electrical Technology
Original Assignee
Beijing Research Institute of Mechanical and Electrical Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Research Institute of Mechanical and Electrical Technology filed Critical Beijing Research Institute of Mechanical and Electrical Technology
Priority to CN201910917655.8A priority Critical patent/CN110580005B/zh
Publication of CN110580005A publication Critical patent/CN110580005A/zh
Application granted granted Critical
Publication of CN110580005B publication Critical patent/CN110580005B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/414Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller
    • G05B19/4141Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller characterised by a controller or microprocessor per axis
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/31From computer integrated manufacturing till monitoring
    • G05B2219/31137Sercos serial real time communications system between servo and cpu

Abstract

本发明涉及一种适用于极端应用条件的运动控制系统,属于运动控制器技术领域,解决了现有技术难以适应极端环境条件、控制精度差的问题。该运动控制系统包括主站和从站。主站,用于接收用户输入的运动控制设定信息,根据设定信息和从站反馈的实时运动数据获得从站相应伺服驱动器当前时刻的控制调整信息,将控制调整信息和设定信息转换成控制信号后以广播数据帧的形式发送至相应从站;从站,用于接收主站的广播数据帧,并对其进行解析,提取相应控制调整信息、设定信息中的从站设定参数,根据从站设定参数和控制调整信息执行相应操作,并实时采集从站相应伺服电机的运动数据作为反馈信号发送至总站。本发明实现了高可靠性结构设计,控制精度较高。

Description

一种适用于极端应用条件的运动控制系统
技术领域
本发明涉及运动控制器技术领域,尤其涉及一种适用于极端应用条件的运动控制系统。
背景技术
运动控制通常是指,在复杂条件下将预定的控制方案、规划指令转变成期望的机械运动,实现机械运动精确的位置控制、速度控制、加速度控制、转矩或力的控制。
运动控制器是控制电动机运行方式的专用控制器,比如,通过行程开关控制交流接触器,实现电动机拖动物体向上运行达到指定位置后又向下运行,或者通过时间继电器控制电动机正反转或转一会停一会再转一会后停。运动控制器在机器人和数控机床的领域内的应用要比在专用机器中的应用更复杂,因为后者运动形式更简单,被称为通用运动控制。但当前运动控制器难以适应极端环境条件,导致其引用范围不广。
运动控制系统作为运动控制器的核心组件,用于产生控制信号发送至相应从站(各伺服驱动器)控制执行相应操作。现有技术中,运动控制系统的控制精度受环境因素影响很大。目前,缺少一种可应用于高温、高湿热、霉菌、烟雾等极端条件的运动控制系统。
发明内容
鉴于上述的分析,本发明实施例旨在提供一种适用于极端应用条件的运动控制系统,用以解决现有技术难以适应极端环境条件、控制精度差的问题。
一方面,本发明实施例提供了一种适用于极端应用条件的运动控制系统,包括:
主站,用于接收用户输入的运动控制设定信息,根据所述设定信息和从站反馈的实时运动数据获得从站相应伺服驱动器当前时刻的控制调整信息,将所述控制调整信息和设定信息转换成控制信号后以广播数据帧的形式发送至相应从站;
从站,用于接收主站的广播数据帧,并对其进行解析,提取相应控制调整信息、设定信息中的从站设定参数,根据所述从站设定参数和控制调整信息执行相应操作,并实时采集从站相应伺服电机的运动数据作为反馈信号发送至总站。
上述技术方案的有益效果如下:可通过一个主站同时对多个从站进行运动控制,运动控制方式多样,可同时实现不同的操作过程。通过主站发出的控制信号中包含的控制调整信息,从站能够精准地及时调整相应不规范动作,控制灵敏度高。由于通过控制调整信息可以及时修正动作异常,在一定程度上,适合应用于极端应用条件,例如高温、高湿热、霉菌、烟雾等环境。
基于上述方法的进一步改进,所述主站进一步包括:
人机交互模块,用于在伺服电机运动开始前,接受用户输入的运动控制设定信息,将其转换成各从站的设定参数后发送至运动控制模块,并且,在伺服电机运动过程中,向用户实时展示各从站的运动数据;
运动控制模块,用于根据上述各从站的设定参数和从站反馈的实时运动数据获得从站相应伺服驱动器当前时刻的控制调整信息,将上述控制调整信息和设定信息转换成控制信号发送至通信模块;
通信模块,用于接收从站反馈的实时运动数据传输至运动控制模块,并将上述控制信号以广播数据帧的形式发送至从站。
上述进一步改进方案的有益效果是:将运动控制系统的主站通过软件方式进行分层,根据其功能的不同,分为了对外的人机交互、对内的运动控制以及对下的通信三个模块。这三个模块通过数据交互进行关联,界限清晰明了,便于用户在系统异常时快速查找异常出处,也便于开发者对其进行再次二次开发优化。
进一步,所述从站进一步包括:各轴依次连接的伺服驱动器和伺服电机,以及布设于伺服电机上的数据采集模块;
所述数据采集模块,用于采集从站相应伺服电机的运动数据,包括:从轴运动时间、从轴偏移角度、当前电压和电流、反馈周期、电机运动状态。
上述进一步改进方案的有益效果是:从站在各轴上均设置了伺服驱动器和伺服电机,用于分别控制各轴的运动,各轴运动保持独立,减少运动过程中耦合带来的影响。并且,将数据采集部分模块化,将伺服电机上的各种采集信息整合后再发送至主站,便于开发者和使用者识别,并根据实际情况对数据采集模块进行修改、优化。
进一步,所述运动控制模块执行如下程序获得从站相应伺服驱动器当前时刻的控制调整信息:
获取从站相应电机运动轴的半径、当前时刻从轴偏移角度αt、与当前时刻间隔一周期的上一时刻从轴偏移角度αt-T、当前时刻系统时间t、与当前时刻间隔一周期的上一时刻系统时间t-T、当前电压u和电流i;
通过下面公式获得当前时刻伺服电机的瞬时转速vt和瞬时加速度at
Figure BDA0002216579420000031
Figure BDA0002216579420000041
其中
Figure BDA0002216579420000042
式中,vt-T是上一时刻电机的瞬时转速,m是自然系数,T是采样周期;
将上述计算获得的当前时刻伺服电机的瞬时转速vt、瞬时加速度at与设定信息中的理论值vt'、at'比较,判断前后项是否一致;如果一致,判定从站相应伺服驱动器当前时刻的控制调整信息为维持运动状态不变;如果至少有一项不一致,根据二者差值vt-vt'或at-at'获得从站相应伺服驱动器下一时刻的从轴偏移角度αt+T、电压u和电流i调整信息。
上述进一步改进方案的有益效果是:通过上述公式可以精准地计算当前时刻从轴上伺服电机的瞬时转速和瞬时加速度,再与预期理论值(可以是上一次计算获得的瞬时转速和瞬时加速度)进行比较,若两者中的任一数值不一致,则说明实际运动发生了改变,需要在下一时刻(采集周期)对其运动进行控制调整,具体地,通过计算转速和加速度的偏差值做出相应调整。
进一步,所述从站相应伺服驱动器下一时刻的从轴偏移角度αt+T通过下面公式获得
Figure BDA0002216579420000043
所述从站相应伺服驱动器下一时刻的电压u和电流i调整信息通过下面公式获得
Figure BDA0002216579420000044
上述进一步改进方案的有益效果是:根据上述公式可以精准地计算下一周期各从轴的偏移角度和电压、电流的调整信息,根据这些信息可以对从轴做出有效的运动控制,使其运动符合设计需求。
进一步,所述从站还包括控制器;所述控制器通过电缆与各轴的伺服驱动器连接;
所述控制器,用于接收广播数据帧形式的控制信号,对其进行识别,根据主站发出的伺服驱动器当前时刻的控制调整信息以匀加速度执行相应操作,并实时检测极端条件是否发生,及时进行调控,当极端条件发生时,控制伺服电机以预设规则到达预设速度。
上述进一步改进方案的有益效果是:通过从站的控制器可以对主站发送的控制调整信息进行有效识别,判断是否为本从站的控制调整信息,并对是否发生极端条件进行监测以及及时进行调控。在复杂系统中,从站的控制器是从站运动控制系统的重要组成部分,独立于主站的控制作用,即根据实际情况进一步修正控制过程。
进一步,所述控制器执行如下程序检测极端条件是否发生并进行调控:
获取伺服电机在运动过程中当前时刻的瞬时加速度at和上一时刻的瞬时加速度at-T
根据所述at和at-T判断瞬时加速度是否发生骤然变化,如果at-at-T不为0,判定发生骤然变化,执行下一步,否则,不发生骤然变化,无需调控;
根据下面方程组获取加速度调控量am以及调控时间tm
Figure BDA0002216579420000051
式中,t0为极端条件发生的时刻,a0为极端条件发生前的加速度,ax是极端条件发生时的加速度,tx是在极端条件发生后加速度回到a0的时刻,am是调控结束后的加速度;
根据上述am、tm,控制极端条件发生时伺服电机的瞬时加速度ax在tm-t0时间段内均匀变化到am,完成调控。
上述进一步改进方案的有益效果是:通过瞬时加速度计算公式可计算出当前时刻的瞬时加速度,进而可以进行是否发生极端条件的实时判断。根据上述公式计算得出的加速度调控量以及调控时间,经大量试验证明调控精确有效,对控制过程造成的影响能够降到最低,符合工业设计要求。
进一步,所述广播数据帧形式的控制信号采用如下格式:
数据帧类型+地址+第1轴数据×N+第2轴数据×N+第3轴数据×N+第4轴数据×N+CRC16H+CRC16L
其中,×N表示占有N字节,CRC16为16CRC校验字节,CRC16H为高字节,CRC16L为低字节。
上述进一步改进方案的有益效果是:将所有从轴的设定数据或者控制信息按照类型+地址+各轴数据+循环冗余校验(CRC32)的格式进行广播发送,有利于将多个轴的信息整合在一条指令中,简化了主站对从站的数据传输。循环冗余校验,有利于数据的正确性检查。
进一步,所述数据采集模块包括:
红外传感器,设置于从轴的侧面,用于采集所述从轴的偏移角度,每个采集周期采集一次,将其发送至主站;
电压表和电流表,设置于从轴伺服驱动器电路中,用于采集控制从轴运动的电压和电流,实时显示,并将其发送至主站;
模式识别模块,用于识别伺服电机当前时刻处于运动开始、运动中、运动停止以及异常状态。
上述进一步改进方案的有益效果是:数据采集模块包括红外传感器、电压表和电流表、模式识别模块三部分,根据使用环境等因素,用户可以增加别的设备,并可以对其进行优化和升级。
进一步,所述主站和从站通过串行总线连接;所述串行总线采用RS485型、CAN型、LVDS型电气总线中的一种;
每个从站发出的所述反馈信号采用如下格式:
数据帧类型+地址+应答数据×M+CRC16H+CRC16L
其中,×M表示占有M字节,CRC16为16CRC校验字节,CRC16H为高字节,CRC16L为低字节。
上述进一步改进方案的有益效果是:主站和从站间支持多种串行总线(RS485型、CAN型、LVDS型等)进行数据传输,用户可以根据现场的需求采用不同的串行总线传输,有助于运动控制系统的移植。反馈信号末尾采用循环冗余校验(CRC32),方便于对反馈数据的正确性检查。
本发明中,上述各技术方案之间还可以相互组合,以实现更多的优选组合方案。本发明的其他特征和优点将在随后的说明书中阐述,并且,部分优点可从说明书中变得显而易见,或者通过实施本发明而了解。本发明的目的和其他优点可通过说明书以及附图中所特别指出的内容中来实现和获得。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。
图1为本发明实施例1适用于极端应用条件的运动控制系统组成示意图;
图2为本发明实施例2主站组成示意图;
图3为本发明实施例2从站组成示意图;
图4为本发明实施例2发生极端条件时,应给予伺服电机的瞬时加速度变化;
图5为本发明实施例2运动控制系统工作流程示意图。
具体实施方式
下面结合附图来具体描述本发明的优选实施例,其中,附图构成本申请一部分,并与本发明的实施例一起用于阐释本发明的原理,并非用于限定本发明的范围。
实施例1
本发明的一个具体实施例,公开了一种适用于极端应用条件的运动控制系统,如图1所示,包括主站和1个以上数量的从站。
主站,用于接收用户输入的运动控制设定信息,根据所述设定信息和从站反馈的实时运动数据获得从站相应伺服驱动器当前时刻的控制调整信息,将所述控制调整信息和设定信息转换成控制信号后以广播数据帧的形式发送至相应从站。
从站,用于接收主站的广播数据帧,并对其进行解析,提取相应控制调整信息、设定信息中的从站设定参数,根据所述从站设定参数和控制调整信息执行相应操作,并实时采集从站相应伺服电机的运动数据作为反馈信号发送至总站。
可选地,每个从站包括一个以上数量的运动控制系统,每个运动控制系统控制一个从轴的运动。
上述运动控制设定信息可以是具体动作指令,比如伺服电机拖动物体向上运行达到指定位置后又向下运行,或者伺服电机正反转或转一会停一会再转一会后停。
实施时,由于采样间隔很短,前后两次采样获得的反馈信号可认为是不变的,但在极端条件(高温、高湿热等环境)下,从站采集的前后两次反馈信号会发生突然改变,此时,主站对反馈信号进行分析获得控制调整信息可在一定程度上初步修正该改变量,即消除了极端条件对运动控制过程的影响。
与现有技术相比,本实施例提供的运动控制系统可通过一个主站同时对多个从站进行运动控制,运动控制方式多样,可同时实现不同地点不同的操作过程。通过主站发出的控制信号中包含的控制调整信息,从站能够精准地及时调整相应不规范动作,控制灵敏度即高。由于通过控制调整信息可以及时修正动作异常,在一定程度上,适合应用于大多数极端应用条件。
实施例2
在实施例1的基础上进行优化,所述主站进一步包括人机交互模块、运动控制模块、通信模块。其中,人机交互模块、通信模块的输出端依次与运动控制模块输入端连接,如图2所示。
人机交互模块,用于在伺服电机运动开始前,接受用户输入的运动控制设定信息,将其转换成各从站的设定参数后发送至运动控制模块,并且,在伺服电机运动过程中,向用户实时展示各从站的运动数据。
运动控制模块,用于根据上述各从站的设定参数和从站反馈的实时运动数据获得从站相应伺服驱动器当前时刻的控制调整信息,将上述控制调整信息和设定信息转换成控制信号发送至通信模块。
通信模块,用于接收从站反馈的实时运动数据传输至运动控制模块,并将上述控制信号以广播数据帧的形式发送至从站。
人机交互模块的显示内容包含各从站的反馈信息、运动控制更新、运动曲线输出。其中,运动曲线输出采用NURBS曲线插补算法,能够有效减少运动曲线计算产生的误差。
优选地,从站进一步包括各轴依次连接的伺服驱动器和伺服电机,以及布设于伺服电机上的数据采集模块,如图3所示(图中省略了数据采集模块)。
伺服驱动器,用于驱动伺服电机运转。
数据采集模块,用于采集从站相应伺服电机的运动数据,包括:从轴运动时间、从轴偏移角度、当前电压和电流、反馈周期、电机运动状态。
具体地,上述电机运动状态指的是,伺服电机当前时刻处于运动开始、运动中、运动停止还是异常状态。
优选地,主站中,运动控制模块执行如下程序获得从站相应伺服驱动器当前时刻的控制调整信息:
S11.获取从站相应电机运动轴的半径、当前时刻从轴偏移角度αt、与当前时刻间隔一周期的上一时刻从轴偏移角度αt-T、当前时刻系统时间t、与当前时刻间隔一周期的上一时刻系统时间t-T、当前电压u和电流i。
S12.通过下面公式获得当前时刻伺服电机的瞬时转速vt和瞬时加速度at
Figure BDA0002216579420000101
Figure BDA0002216579420000111
其中
Figure BDA0002216579420000112
式中,vt-T是上一时刻电机的瞬时转速,m是自然系数,T是采样周期。
S13.将上述计算获得的当前时刻伺服电机的瞬时转速vt、瞬时加速度at与设定信息中的理论值vt'、at'比较,判断前后项是否一致;如果一致,判定从站相应伺服驱动器当前时刻的控制调整信息为维持运动状态不变;如果至少有一项不一致,根据二者差值vt-vt'或at-at'获得从站相应伺服驱动器下一时刻的从轴偏移角度αt+T、电压u和电流i调整信息。
优选地,步骤S13中,从站相应伺服驱动器下一时刻的从轴偏移角度αt+T通过下面公式获得
Figure BDA0002216579420000113
从站相应伺服驱动器下一时刻的电压u和电流i调整信息通过下面公式获得
Figure BDA0002216579420000114
优选地,从站还包括控制器,如图2所示。所述控制器通过电缆与各轴的伺服驱动器连接,控制器内包含通信模块。
控制器,用于接收广播数据帧形式的控制信号,对其进行识别,根据主站发出的伺服驱动器当前时刻的控制调整信息以匀加速度执行相应操作,并实时检测极端条件是否发生,及时进行调控,当极端条件发生时,控制伺服电机以预设规则到达预设速度。
优选地,控制器执行如下程序检测极端条件是否发生并进行调控:
S21.获取伺服电机在运动过程中当前时刻的瞬时加速度at和上一时刻的瞬时加速度at-T
S22.根据所述at和at-T判断瞬时加速度是否发生骤然变化,如果at-at-T不为0,判定发生骤然变化,执行下一步,否则,不发生骤然变化,无需调控;
S23.根据下面方程组获取加速度调控量am以及调控时间tm
Figure BDA0002216579420000121
式中,t0为极端条件发生的时刻,a0为极端条件发生前的加速度,ax是极端条件发生时的加速度,tx是在极端条件发生后加速度回到a0的时刻,am是调控结束后的加速度;
S24.根据上述am、tm,控制极端条件发生时伺服电机的瞬时加速度ax在tm-t0时间段内均匀变化到am,完成调控,如图4所示。
主站发送的控制调整信息带来的修正是延时的,只能在下一时刻进行修正,对于控制过程而言,需要先实时修正加速度,再调整偏移角度、电压和电流,才是有效的调控。步骤S21~S23给出了从站的上述加速度实时调控过程,先将加速度调整,再在下一时刻修正从轴偏移角度αt+T、电压u和电流i。
可选地,也可采用多圈绝对值编码器采集伺服电机在运动过程中当前时刻的瞬时速度和瞬时加速度,每个采集周期采集一次。
优选地,所述主站发出的广播数据帧形式的控制信号采用如下格式:
数据帧类型+地址+第1轴数据×N+第2轴数据×N+第3轴数据×N+第4轴数据×N+CRC16H+CRC16L (7)
其中,×N表示占有N字节,CRC16为16CRC校验字节,CRC16H为高字节,CRC16L为低字节,控制信号的数据帧为3+4M字节。
每个从站发出的所述反馈信号采用如下格式:
数据帧类型+地址+应答数据×M+CRC16H+CRC16L (8)
其中,×M表示占有M字节,CRC16为16CRC校验字节,CRC16H为高字节,CRC16L为低字节,反馈信号的数据帧为3+M字节。
优选地,所述数据采集模块包括红外传感器、电压表和电流表、模式识别模块。
红外传感器,设置于从轴的侧面(便于数据采集与实时传递),用于采集所述从轴的偏移角度,每个采集周期采集一次,将其发送至主站。
电压表和电流表,设置于从轴伺服驱动器电路(便于数据统计整合)中,用于采集控制从轴运动的电压和电流,实时显示,并将其发送至主站。
模式识别模块,用于识别伺服电机当前时刻处于运动开始、运动中、运动停止以及异常状态。具体地,模式识别模块采用识别方法可采用现有方法,不再赘述。
优选地,主站和从站通过串行总线连接。所述串行总线采用RS485型、CAN型、LVDS型电气总线中的一种。本实施例的控制过程如图5所示,用户可以根据现场的需求,采用不同的串行总线传输数据,有助于运动控制系统的移植。
与实施例1相比,本实施例提供的运动控制系统对主站和从站的结构进行了进一步细化,主站用于分析从站反馈的运动信息和用户输入的指令信息(设定参数),产生控制信号(控制数据),从站用于响应所述控制信号,并实时对极端条件进行监测,当发生极端条件时,及时调控至影响最小的状态,保证整个运动过程不受极端条件影响。与现有技术相比,本实施例的控制方法能够更有效地控制从站各轴运动稳定。
本领域技术人员可以理解,实现上述实施例方法的全部或部分流程,可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于计算机可读存储介质中。其中,所述计算机可读存储介质为磁盘、光盘、只读存储记忆体或随机存储记忆体等。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。

Claims (7)

1.一种适用于极端应用条件的运动控制系统,其特征在于,包括:
主站,用于接收用户输入的运动控制设定信息,根据所述设定信息和从站反馈的实时运动数据获得从站相应伺服驱动器当前时刻的控制调整信息,将所述控制调整信息和设定信息转换成控制信号后以广播数据帧的形式发送至相应从站;
多个从站,用于接收主站的广播数据帧,并对其进行解析,提取相应控制调整信息、设定信息中的从站设定参数,根据所述从站设定参数和控制调整信息执行相应操作,并实时采集从站相应伺服电机的运动数据作为反馈信号发送至总站;
所述主站包括运动控制模块,用于根据上述各从站的设定参数和从站反馈的实时运动数据获得从站相应伺服驱动器当前时刻的控制调整信息,将上述控制调整信息和设定信息转换成控制信号;所述运动控制模块执行如下程序获得从站相应伺服驱动器当前时刻的控制调整信息:
获取从站相应电机运动轴的半径、当前时刻从轴偏移角度αt、与当前时刻间隔一周期的上一时刻从轴偏移角度αt-T、当前时刻系统时间t、与当前时刻间隔一周期的上一时刻系统时间t-T、当前电压u和电流i;
根据上述从站相应电机运动轴的半径、当前时刻从轴偏移角度αt、与当前时刻间隔一周期的上一时刻从轴偏移角度αt-T、当前时刻系统时间t、与当前时刻间隔一周期的上一时刻系统时间t-T、当前电压u和电流i,获得当前时刻伺服电机的瞬时转速vt和瞬时加速度at
将上述当前时刻伺服电机的瞬时转速vt、瞬时加速度at与设定信息中的理论值vt'、at'比较,判断前后项是否一致;如果一致,判定从站相应伺服驱动器当前时刻的控制调整信息为维持运动状态不变;如果至少有一项不一致,根据二者差值vt-vt'或at-at'获得从站相应伺服驱动器下一时刻的从轴偏移角度αt+T、电压u和电流i调整信息;
所述从站还包括控制器;所述控制器,用于实时检测极端条件是否发生,及时进行调控,当极端条件发生时,控制伺服电机以预设规则到达预设速度;
所述控制器执行如下程序检测极端条件是否发生并进行调控:
获取伺服电机在运动过程中当前时刻的瞬时加速度at和上一时刻的瞬时加速度at-T
根据所述at和at-T判断瞬时加速度是否发生骤然变化,如果at-at-T不为0,判定发生骤然变化,执行下一步,否则,不发生骤然变化,无需调控;
根据下面方程组获取加速度调控量am以及调控时间tm
Figure FDA0002774860130000021
式中,t0为极端条件发生的时刻,a0为极端条件发生前的加速度,ax是极端条件发生时的加速度,tx是在极端条件发生后加速度回到a0的时刻,am是调控结束后的加速度;
根据上述am、tm,控制极端条件发生时伺服电机的瞬时加速度ax在tm-t0时间段内均匀变化到am,完成调控。
2.根据权利要求1所述的适用于极端应用条件的运动控制系统,其特征在于,所述主站还包括:
人机交互模块,用于在伺服电机运动开始前,接受用户输入的运动控制设定信息,将其转换成各从站的设定参数后发送至运动控制模块,并且,在伺服电机运动过程中,向用户实时展示各从站的运动数据;
通信模块,用于接收从站反馈的实时运动数据传输至运动控制模块,并将运动控制模块发送的控制信号以广播数据帧的形式发送至从站。
3.根据权利要求1或2所述的适用于极端应用条件的运动控制系统,其特征在于,所述从站进一步包括:各轴依次连接的伺服驱动器和伺服电机,以及布设于伺服电机上的数据采集模块;
所述数据采集模块,用于采集从站相应伺服电机的运动数据,包括:从轴运动时间、从轴偏移角度、当前电压和电流、反馈周期、电机运动状态。
4.根据权利要求1或2所述的适用于极端应用条件的运动控制系统,其特征在于,所述控制器通过电缆与各轴的伺服驱动器连接;
所述控制器,还用于接收广播数据帧形式的控制信号,对其进行识别,根据主站发出的伺服驱动器当前时刻的控制调整信息以匀加速度执行相应操作。
5.根据权利要求4所述的适用于极端应用条件的运动控制系统,其特征在于,所述广播数据帧形式的控制信号采用如下格式:
数据帧类型+地址+第1轴数据×N+第2轴数据×N+第3轴数据×N+第4轴数据×N+CRC16H+CRC16L
其中,×N表示占有N字节,CRC16为16CRC校验字节,CRC16H为高字节,CRC16L为低字节。
6.根据权利要求3所述的适用于极端应用条件的运动控制系统,其特征在于,所述数据采集模块包括:
红外传感器,设置于从轴的侧面,用于采集所述从轴的偏移角度,每个采集周期采集一次,将其发送至主站;
电压表和电流表,设置于从轴伺服驱动器电路中,用于采集控制从轴运动的电压和电流,实时显示,并将其发送至主站;
模式识别模块,用于识别伺服电机当前时刻处于运动开始、运动中、运动停止以及异常状态。
7.根据权利要求1或2所述的适用于极端应用条件的运动控制系统,其特征在于,所述主站和从站通过串行总线连接;所述串行总线采用RS485型、CAN型、LVDS型电气总线中的一种;
每个从站发出的所述反馈信号采用如下格式:
数据帧类型+地址+应答数据×M+CRC16H+CRC16L
其中,×M表示占有M字节,CRC16为16CRC校验字节,CRC16H为高字节,CRC16L为低字节。
CN201910917655.8A 2019-09-26 2019-09-26 一种适用于极端应用条件的运动控制系统 Active CN110580005B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910917655.8A CN110580005B (zh) 2019-09-26 2019-09-26 一种适用于极端应用条件的运动控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910917655.8A CN110580005B (zh) 2019-09-26 2019-09-26 一种适用于极端应用条件的运动控制系统

Publications (2)

Publication Number Publication Date
CN110580005A CN110580005A (zh) 2019-12-17
CN110580005B true CN110580005B (zh) 2020-12-25

Family

ID=68813736

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910917655.8A Active CN110580005B (zh) 2019-09-26 2019-09-26 一种适用于极端应用条件的运动控制系统

Country Status (1)

Country Link
CN (1) CN110580005B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115781691B (zh) * 2023-01-05 2023-05-05 季华实验室 基于伺服驱动器和上位机的机器人轴数据采集系统

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR19990006338A (ko) * 1997-06-25 1999-01-25 기타오카 다카시 통신제어장치
CN103775269A (zh) * 2012-10-19 2014-05-07 福特环球技术公司 发动机控制系统和方法

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05127753A (ja) * 1991-11-06 1993-05-25 Sekonitsuku:Kk サーボモータの加減速運転制御方法
CN201397467Y (zh) * 2009-02-25 2010-02-03 南京工业大学 一种基于Profibus的游乐设施安全监控装置
CN201966855U (zh) * 2010-12-22 2011-09-07 施大发 一种基于EtherCAT网络的交流伺服控制系统
CN102393762A (zh) * 2011-08-30 2012-03-28 上海三一精机有限公司 一种用于数控系统电机主轴转速的控制系统及方法
CN102393702A (zh) * 2011-10-14 2012-03-28 南京航空航天大学 运动控制终端的扩展方法及系统
CN202285094U (zh) * 2011-10-19 2012-06-27 河南华东工控技术有限公司 连续纺丝机控制系统
CN103425106B (zh) * 2013-08-08 2015-12-23 华南理工大学 一种基于Linux的EtherCAT主/从站控制系统及方法
CN105269577B (zh) * 2015-06-26 2017-06-13 浙江大学 仿人双足机器人步态切换控制系统及控制方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR19990006338A (ko) * 1997-06-25 1999-01-25 기타오카 다카시 통신제어장치
CN103775269A (zh) * 2012-10-19 2014-05-07 福特环球技术公司 发动机控制系统和方法

Also Published As

Publication number Publication date
CN110580005A (zh) 2019-12-17

Similar Documents

Publication Publication Date Title
CN105353726B (zh) 一种电子压装机专用控制器及控制方法
US7174284B2 (en) Apparatus and method for simulation of the control and machine behavior of machine tools and production-line machines
CN109639187B (zh) 驱控一体伺服实现方法和系统
CN102435948B (zh) 一种动负荷模拟测试仪及模拟测试方法
CN105033996B (zh) 基于手推示教式五轴水平关节机器人的控制系统
CN104122089B (zh) 一种涡轴发动机转速扭矩信号模拟装置及模拟方法
CN104698974A (zh) 一种数控机床及其调试方法
CN110647120B (zh) 一种适用于极端应用条件的运动控制方法
CN107972036B (zh) 基于TensorFlow的工业机器人动力学控制系统及方法
CN110580005B (zh) 一种适用于极端应用条件的运动控制系统
JP7294085B2 (ja) 制御システム、制御装置および制御方法
CN105204441A (zh) 手推示教式五轴抛光打磨机器人
CN112338903A (zh) 一种基于模型设计的机械臂控制方法
CN106873524A (zh) 一种基于pc的数控机床全闭环控制系统
US20210018903A1 (en) Information processing system, information processing method, and recording medium
CN103817695B (zh) 一种机器人柔性关节的控制方法及驱动装置
CN201374136Y (zh) 多功能教学设备
CN113492414B (zh) 一种基于Web的机器人跨平台人机交互系统及实现方法
CN103244137A (zh) 一种土压平衡盾构刀盘驱动电机同步伺服控制模拟装置
CN203484980U (zh) 基于工业以太网总线的圆度误差测量装置
CN115026820A (zh) 人机协作装配机器人控制系统及控制方法
CN2906795Y (zh) 基于多轴运动控制卡的教学用多轴混合控制系统
CN113258849B (zh) 一种永磁同步电机控制参数智能辨识方法
CN214586522U (zh) 一种集成plc、视觉或力反馈的智能伺服系统
CN215006354U (zh) 一种集成plc、视觉或力反馈的一体化执行机构

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant