CN116594342A - 多mcu模块伺服从站控制器实现方法 - Google Patents
多mcu模块伺服从站控制器实现方法 Download PDFInfo
- Publication number
- CN116594342A CN116594342A CN202310714892.0A CN202310714892A CN116594342A CN 116594342 A CN116594342 A CN 116594342A CN 202310714892 A CN202310714892 A CN 202310714892A CN 116594342 A CN116594342 A CN 116594342A
- Authority
- CN
- China
- Prior art keywords
- microprocessor chip
- slave station
- sensor data
- chip
- clock
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 63
- 230000007246 mechanism Effects 0.000 claims abstract description 12
- 238000004364 calculation method Methods 0.000 claims abstract description 11
- 238000004891 communication Methods 0.000 claims description 43
- 230000008569 process Effects 0.000 claims description 22
- 230000001360 synchronised effect Effects 0.000 claims description 11
- 230000033001 locomotion Effects 0.000 claims description 9
- 238000005070 sampling Methods 0.000 claims description 8
- 230000005540 biological transmission Effects 0.000 claims description 5
- 230000003750 conditioning effect Effects 0.000 claims description 4
- 238000013500 data storage Methods 0.000 claims description 3
- 238000001914 filtration Methods 0.000 claims description 3
- ACGUYXCXAPNIKK-UHFFFAOYSA-N hexachlorophene Chemical compound OC1=C(Cl)C=C(Cl)C(Cl)=C1CC1=C(O)C(Cl)=CC(Cl)=C1Cl ACGUYXCXAPNIKK-UHFFFAOYSA-N 0.000 claims description 3
- 238000013507 mapping Methods 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 claims description 2
- 239000003990 capacitor Substances 0.000 claims description 2
- 238000006073 displacement reaction Methods 0.000 claims description 2
- 230000003993 interaction Effects 0.000 claims description 2
- 230000000694 effects Effects 0.000 abstract description 3
- 230000006870 function Effects 0.000 description 22
- 238000012545 processing Methods 0.000 description 10
- 230000000737 periodic effect Effects 0.000 description 7
- 230000007704 transition Effects 0.000 description 6
- 238000013461 design Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000009471 action Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000001143 conditioned effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
- 230000011664 signaling Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0421—Multiprocessor system
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/24—Pc safety
- G05B2219/24182—Redundancy
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Small-Scale Networks (AREA)
Abstract
本发明公开了一种多MCU模块伺服从站控制器实现方法,其特征在于:主站通过Ethercat总线下达DC时钟机制给工业以太网芯片,工业以太网芯片执行DC时钟机制控制各个微处理器芯片同步性初始化及从站进行同步性操作;主站下达目标传感器数据给STM32微处理器芯片,STM32微处理器芯片将目标传感器数据与DSP微处理器芯片处理后的实际传感器数据进行PID计算,并输出控制指令给DAC微处理器芯片;DAC微处理器芯片输出相应量程电压控制从站运动。其显著效果是:实现了对伺服从站的精确控制,提高了对从站控制的稳定性、同步性、准确性及可靠性。
Description
技术领域
本发明涉及伺服从站控制器技术领域,特别涉及一种多MCU模块伺服从站控制器实现方法。
技术背景
伺服从站控制器是工业自动化应用中,用于控制伺服从站的设备。伺服从站是一个被动的设备,不能主动发起请求,只能在控制器(主站)的请求下工作。伺服从站控制器负责向伺服从站下达命令,将指令进行解析处理,并将其转化为电信号或机械动作控制,实现对伺服从站的控制。
伺服从站控制器会运行一个软件程序,该程序包含了与伺服从站进行通信所需要的协议,和控制伺服从站的逻辑代码。这些控制器可以使用不同的通信协议对伺服从站控制器实现与各种通信协议的兼容,从而对不同类型的伺服从站进行控制。伺服从站控制器可以通过计算要发送给伺服从站的电信号或指令,精确地控制响应速度和位置等参数。同时,它们还具有各种输入和输出接口,用于接收来自传感器和开关的信号,并控制执行器和输出设备。伺服从站控制器是在工业自动化应用中实现对伺服从站的控制的一个关键部件。它能够使用各种通信协议,接收来自传感器的数据,并将处理后的信号发送给伺服从站,以实现对其运动、位置、速度等控制实现。
现有技术缺点:现如今市场上大多存在的伺服从站控制器是基于单MCU处理器内核,只能在主站的请求下工作,其对伺服从站控制的稳定性、同步性和准确性都较低。
发明内容
本发明的主要目的是,提供一种多MCU模块伺服从站控制器实现方法,对伺服从站进行精确控制,提高对从站控制的稳定性、同步性和准确性。
为实现上述目的,本发明的技术方案如下:提供的一种多MCU模块伺服从站控制器实现方法,其关键是:包括以下步骤:
步骤1:搭建多MCU模块伺服从站网络***,包括上位机、主站和n个从站,n个从站串联,每个从站都设置有一个从站控制器,该从站控制器由AD微处理器芯片、DSP微处理器芯片、STM32微处理器芯片、DAC微处理器芯片、以太网芯片和工业以太网芯片共同组成;
上位机通过以太网芯片与主站连接,上位机和主站分别通过Ethercat总线与工业以太网芯片连接,STM32微处理器芯片一端连接工业以太网芯片,另一端通过SPI全双工通信方式与DSP微处理器芯片连接,STM32微处理器芯片还通过以太网芯片与上位机连接,DSP微处理器芯片还与AD微处理器芯片连接。
步骤2:用于AD微处理器芯片、DSP微处理器芯片、STM32微处理器芯片、DAC微处理器芯片、以太网芯片、工业以太网芯片进行上电完成初始化,上位机上电完成初始化显示控制界面的步骤;
步骤3:用于主站通过Ethercat总线实时下达DC时钟机制给工业以太网芯片,工业以太网芯片执行DC时钟机制并控制各个微处理器芯片同步性初始化及从站进行同步性操作的步骤;
步骤4:用于主站通过工业以太网芯片传送目标传感器数据给STM32微处理器芯片的步骤;
步骤5:用于上位机控制AD微处理器芯片通过多路复用器通道采集实际传感器数据,并将采集的实际传感器数据转化为数字信号的步骤;
步骤6:用于DSP微处理器芯片读取AD微处理器芯片采集的实际传感器数据,并对其进行滤波处理,然后通过SPI全双工通信方式传递给STM32微处理器芯片的步骤;
步骤7:用于STM32微处理器芯片通过PID算法计算实际传感器数据与目标传感器数据之间的差值,并对实际传感器数据进行差值补偿,STM32微处理器芯片输出相应控制指令给DAC微处理器芯片,并通过以太网芯片连接上位机控制界面进行数据显示的步骤;
步骤8:用于DAC微处理器芯片接收控制指令,输出相应量程电压控制从站运动,致使实际传感器数据与目标传感器数据一致,达到稳态运动的步骤。
通过上述设计,工业以太网芯片使用DC时钟机制实时控制各个微处理器芯片及从站进行同步性操作,STM32微处理器芯片将实际传感器数据与目标传感器数据进行PID算法计算,得出控制量数据,并输出控制指令给DAC微处理器芯片实时控制从站运动,提高了对从站控制的准确性、稳定性和同步性。
作为优选:步骤3中,DC时钟机制控制从站进行同步性操作的步骤包括:
步骤31:主站配置全局***时钟Tsys_ref,并通过Ethercat总线周期性的向第1个从站的工业以太网芯片广播Ethercat数据帧进行时钟同步,第1个从站的工业以太网芯片再将Ethercat数据帧依次传递给第2个从站、第3个从站…第n个从站,然后再从第n个从站依次返回至第1个从站;
步骤32:工业以太网芯片实时读取从站***本地时钟Tsys_local数据,并将其与***时钟Tsys_ref进行对比,根据对比差值对从站***本地时钟Tsys_local进行时钟补偿,确保从站***本地时钟Tsys_local与***时钟Tsys_ref一致。
作为优选:在步骤32中,工业以太网对从站***本地时钟Tsys_local进行同步性控制的时钟同步计算过程如下:
Ti=Tlocal(i)+(i-1)Tdelay
Tdelay(i)=[(T2n-T1)-(T2n-i+1-Ti)]÷2
Toffset(i)=Ti-Tsys_ref-Tdelay(i)
Tsys_local(i)=Tlocal(i)-Toffset(i)
其中,Ti表示Ethercat数据帧的第一个位到达从站i的时间;n表示共有n个从站;T2n-i+1表示Ethercat数据帧的第一个位到达从站n后返回,再次到达从站i的时间;T2n表示Ethercat数据帧的第一个位到达从站n后返回,再次到达从站1的时间;Tlocal(i)表示从站i的本地时钟;Tdelay表示延迟时间;Tdelay(i)表示从站i和从站1之间的传输延迟时间;Toffset(i)表示Ethercat数据帧第一个位到达第i个从站的本地时钟与***时钟Tsys_ref的误差偏移量;Tsys_local(i)表示从站i的***本地时钟;
将计算得到的从站i的***本地时钟与***时钟进行比较,当从站i的***本地时钟与***时钟相等时,表示从站i与***同步;当从站i的***本地时钟与***时钟不相等时,表示从站i与***不同步,需对从站i的***本地时钟进行补偿,使从站i的***本地时钟始终与***时钟同步;
对从站i的***本地时钟进行补偿,计算从站i的***本地时钟与***时钟的偏移时间Δt的计算公式为:
Δt=Tsys_local(i)-Tdelay(i)-Tsys_ref
当Δt>0时,表示从站i的***本地时钟走快了,工业以太网芯片控制从站i的***本地时钟每10ns减少Δt个单位时间;当Δt<0时,表示从站i的***本地时钟走慢了了,工业以太网芯片控制从站i的***本地时钟每10ns增加Δt个单位时间。
通过上述设计,主站通过Ethercat总线周期性地下达DC时钟机制给工业以太网芯片,由工业以太网芯片来控制各个微处理芯片进行同步性初始化操作,并控制从站同步性运动;工业以太网芯片周期性地读取从站***本地时钟,并将其与***时钟进行比较,根据比较结果对从站***本地时钟进行时钟补偿,使得从站***本地时钟与***时钟保持一致,进而实现主站与各个从站之间进行同步性操作的目的。
作为优选:在步骤5中,上位机控制AD微处理器芯片采集实际传感器数据包括以下步骤:
步骤51:操作上位机控制界面进行多路复用器通道的选择,上位机通过Ethercat总线下达多路复用器通道选择命令和AD微处理器芯片采样命令给STM32微处理器芯片;
步骤52:STM32微处理器芯片通过SPI全双工通信方式与DSP微处理器芯片进行数据交互,DSP微处理器芯片控制多路复用器开关进行初始化,并控制打开上位机选择的多路复用器通道开关;
步骤53:DSP微处理器芯片通过SPI接口向AD微处理器芯片发送采样命令,AD微处理器芯片使用内部采样保持电容和采样保持放大器通过打开的多路复用器通道采集实际传感器数据,并将其转化成数字信号。
通过上述设计,上位机对多路复用器的通道进行选择,控制AD微处理器芯片通过需要采样的多路复用器通道采集实际传感器数据,完成了对实际传感器数据的筛选,使得AD微处理器采集到的实际传感器数据属性与目标传感器数据属性相匹配,提高了对伺服从站运动控制的准确性。
作为优选:在步骤7中,STM32微处理器芯片通过PID算法计算实际传感器数据与目标传感器数据之间的差值并输出控制量u(t)的计算公式如下:
其中,Kp表示比例增益;Ki表示积分增益;Kd表示微分增益;e(t)表示t时刻的实际传感器数据与目标传感器数据之间的差值,u(t)表示控制量。
作为优选:在步骤8中,DAC微处理器芯片输出相应量程电压的电压计算公式如下:
其中,VOUT表示输出电压;DIN表示配置DAC数据输出寄存器的数值,范围为0到65535;VREF表示参考电压;Gain表示增益。
如果VREF使用内部参考电压,那么VREF的值为2.5V;如果VREF使用外部参考电压,那么VREF的值由VREFIN引脚的输入决定。
如果禁止内部电压基准,Gain的值为1;如果使能内部电压基准,Gain的值为2。
作为优选:所述工业以太网芯片在进行通信的过程中包括以下状态:
Init状态,从站上电时,工业以太网芯片处于Init状态,用于读取从站的设备信息和做一些准备进入pre-op初始化的配置;
Pre-OP状态,用于映射pdo数据,并配置好FMMU的映射;
Safe-OP状态;用于判断从站DC时钟同步是否达到一个稳定值,DC同步稳定,从站也没有报错即可申请进入OP状态;
OP状态,正常运行状态,用于对伺服进行运动控制。
进一步解释说明,在工业以太网芯片进行状态转换的过程中需要经过以下阶段:
检查SM设置,在进入“Per-OP”状态之前,需要读取并检查邮箱通信相关SM0和SM1通道的配置;在进入“Safe-OP”状态之前,需要检查周期性过程数据通信使用的SM2和SM3通道的配置,需要检查的SM通道的设置内容如下:
①SM通道大小;
②SM通道的设置是否重叠,特别注意三个缓存区应该预留3倍配置长度大小的空间;
③SM通道起始地址应该为偶数;
④SM通道应该被使能;
SM通道配置的检查工作在函数CheckSmSettings()中完成,具体如下:
⑴启动邮箱数据通信,进入Per-OP状态;
在从站进入Per-OP状态之前,先检查邮箱通信SM配置,如果配置成功则调用函数MBX_StartMailboxHandler()进入Per-OP状态;
⑵启动周期性输入数据通信,进入Safe-OP状态;
在进入Safe-OP状态之前,先检查过程数据SM通道设置是否正确,如正确则使能输入数据通道SM3,调用函数StartInputHandler()进入Safe-OP状态;
⑶启动周期性输出数据通信,进入OP状态;
在进入OP状态之前,先检查过程数据SM通道设置是否正确,如正确则使能输出数据通道SM2,调用函数StartOutputHandler()进入OP状态;
⑷停止工业以太网芯片数据通信。
在工业以太网芯片通信状态回退时停止相应的数据通信SM通道,其回退方式有以下三种:
Ⅰ.从高状态退回Safe-OP状态时,调用函数StopOutputHandler()停止周期性过程数据输出处理;
Ⅱ.从高状态退回Pre-OP状态时,调用函数StopInputHandler()停止周期性过程数据输入处理;
Ⅲ.从高状态退回Init状态时,调用函数BackToInitTransition()停止所有应用层数据处理。
工业以太网芯片通过通信状态的切换,实现了不同通信设备之间可靠而高效的数据传输,提高了网络通信和控制***的稳定性及其性能,其具体作用如下:
1.状态管理:多MCU模块伺服从站控制器根据工业以太网芯片的状态要求对从站设备状态进行管理,实现从Init状态到Pre-OP、Safe-OP、OP状态的转换;
2.网络配置:多MCU模块伺服从站控制器通过工业以太网芯片的状态实现从站设备的网络配置,包括设备网络地址、数据类型及通讯速率等参数的配置;
3.数据接收和发送:在Safe-OP和OP状态下,多MCU模块伺服从站控制器接收和处理主站发送的数据命令,实现在从站设备和主站设备之间高效的数据通讯;
4.错误处理:多MCU模块伺服从站控制器能够根据工业以太网芯片的状态进行错误处理,当网络出现故障或状态切换失败时,多MCU模块伺服从站控制器会进行相应的处理,避免网络出现问题。
作为优选:所述目标传感器数据或是位移目标传感器数据;或是加速度目标传感器数据;或是力目标传感器数据;或是速度目标传感器数据;或是电压目标传感器数据;或是电流目标传感器数据;或是压强目标传感器数据;
所述AD微处理器芯片采集的实际传感器数据是与目标传感器数据属性相对应的传感器数据。
作为优选:所述实际传感器信号通过信号调理卡进入多路复用器通道供AD微处理器芯片采集,该信号调理卡的应用可提高对实际传感器数据采集的精度,进而提高对从站运动控制的准确性;所述DSP微处理器芯片使用IIC总线的EEROPM数据存储方式进行数据的存储,可保证在出现紧急情况时,DSP微处理器芯片掉电后数据不丢失;所述STM32微处理器芯片将数据保存到SDRAM存储器中。
作为优选:所述DSP微处理器芯片与STM32微处理器芯片具有相同的通信模式、时钟极性、时钟相位,确保DSP微处理器芯片与STM32微处理器芯片正确通信,并能够同步完成数据的处理、接收与发送。
本发明的显著效果是:提供一种多MCU模块伺服从站控制器实现方法,对伺服从站进行精确控制,提高对从站控制的稳定性、同步性、准确性及可靠性。
附图说明
图1为本发明的结构示意图;
图2为主站与各从站的连接示意图;
图3为工业以太网芯片状态切换示意图;
图4为工业以太网芯片状态函数处理流程图。
具体实施方式
下面结合附图和具体实例对本发明进一步详细说明。以下实施例或者附图用于说明本发明,但不用来限制本发明的范围。
本实施例中,采用的AD微处理器芯片的型号是AD7608,DSP微处理器芯片的型号是DSP28335,STM32微处理器芯片的型号是STM32F429,DAC微处理器芯片的型号是DAC8563,工业以太网芯片的型号是AX58100。
如图1所示:一种多MCU模块伺服从站控制器实现方法,其关键是:包括以下步骤:
步骤1:搭建多MCU模块伺服从站网络***,包括上位机、主站和n个从站,n个从站串联,每个从站都设置有一个从站控制器,该从站控制器由AD微处理器芯片、DSP微处理器芯片、STM32微处理器芯片、DAC微处理器芯片、以太网芯片和工业以太网芯片共同组成;
上位机通过以太网芯片与主站连接,上位机和主站分别通过Ethercat总线与工业以太网芯片连接,STM32微处理器芯片一端连接工业以太网芯片,另一端通过SPI全双工通信方式与DSP微处理器芯片连接,STM32微处理器芯片还通过以太网芯片与上位机连接,DSP微处理器芯片还与AD微处理器芯片连接;
步骤2:用于AD微处理器芯片、DSP微处理器芯片、STM32微处理器芯片、DAC微处理器芯片、以太网芯片、工业以太网芯片进行上电完成初始化,上位机上电完成初始化显示控制界面的步骤;
步骤3:用于主站通过Ethercat总线实时下达DC时钟机制给工业以太网芯片,工业以太网芯片执行DC时钟机制并控制各个微处理器芯片同步性初始化及从站进行同步性操作的步骤;
步骤4:用于主站通过工业以太网芯片传送目标传感器数据给STM32微处理器芯片的步骤;
步骤5:用于上位机控制AD微处理器芯片通过多路复用器通道采集实际传感器数据,并将采集的实际传感器数据转化为数字信号的步骤;
步骤6:用于DSP微处理器芯片读取AD微处理器芯片采集的实际传感器数据,并对其进行滤波处理,然后通过SPI全双工通信方式传递给STM32微处理器芯片的步骤;
步骤7:用于STM32微处理器芯片通过PID算法计算实际传感器数据与目标传感器数据之间的差值,并对实际传感器数据进行差值补偿,STM32微处理器芯片输出相应控制指令给DAC微处理器芯片,并通过以太网芯片连接上位机控制界面进行数据显示的步骤;
步骤8:用于DAC微处理器芯片接收控制指令,输出相应量程电压控制从站运动,致使实际传感器数据与目标传感器数据一致,达到稳态运动的步骤。
多MCU模块伺服从站控制器的传感器进行上电初始化后,采集从站实际传感器数据,通过信号调理卡对采集到的实际传感器数据进行调理并输送至多路复用器,多路复用器对实际传感器数据进行选择和分离,然后供AD微处理器芯片采集和转换。
DSP微处理器芯片通过引脚实时控制多路复用器通道开关状态的切换,同时控制AD微处理器芯片对实际传感器数据的采集与停止;为保证在出现紧急情况时,DSP微处理器芯片掉电后数据不丢失,DSP微处理器芯片使用IIC总线的EEROPM数据存储方式对数据进行储存。
具体地,在步骤7中,STM32微处理器芯片通过PID算法计算实际传感器数据与目标传感器数据之间的差值并输出控制量u(t)的计算公式如下:
其中,Kp表示比例增益;Ki表示积分增益;Kd表示微分增益;e(t)表示t时刻的实际传感器数据与目标传感器数据之间的差值,u(t)表示控制量。
在步骤8中,DAC微处理器芯片输出相应量程电压的电压计算公式如下:
其中,VOUT表示输出电压;DIN表示配置DAC数据输出寄存器的数值,范围为0到65535;VREF表示参考电压;Gain表示增益。
如果VREF使用内部参考电压,那么VREF的值为2.5V;如果VREF使用外部参考电压,那么VREF的值由VREFIN引脚的输入决定。
如果禁止内部电压基准,Gain的值为1;如果使能内部电压基准,Gain的值为2。
如图2所示:主站通过Ethercat总线周期性的向工业以太网芯片广播Ethercat数据帧进行时钟同步;工业以太网芯片实时读取从站***本地时钟Tsys_local数据,并将其与***时钟Tsys_ref进行对比,根据对比差值对从站***本地时钟Tsys_local进行时钟补偿,确保从站***本地时钟Tsys_local与***时钟Tsys_ref一致。
工业以太网对从站***本地时钟Tsys_local进行同步性控制的时钟同步计算过程如下:
Ti=Tlocal(i)+(i-1)Tdelay
Tdelay(i)=[(T2n-T1)-(T2n-i+1-Ti)]÷2
Toffset(i)=Ti-Tsys_ref-Tdelay(i)
Tsys_local(i)=Tlocal(i)-Toffset(i)
其中,Ti表示Ethercat数据帧的第一个位到达从站i的时间;n表示共有n个从站;T2n-i+1表示Ethercat数据帧的第一个位到达从站n后返回,再次到达从站i的时间;T2n表示Ethercat数据帧的第一个位到达从站n后返回,再次到达从站1的时间;Tlocal(i)表示从站i的本地时钟;Tdelay表示延迟时间;Tdelay(i)表示从站i和从站1之间的传输延迟时间;Toffset(i)表示Ethercat数据帧第一个位到达第i个从站的本地时钟与***时钟Tsys_ref的误差偏移量;Tsys_local(i)表示从站i的***本地时钟;
将计算得到的从站i的***本地时钟与***时钟进行比较,当从站i的***本地时钟与***时钟相等时,表示从站i与***同步;当从站i的***本地时钟与***时钟不相等时,表示从站i与***不同步,需对从站i的***本地时钟进行补偿,使从站i的***本地时钟始终与***时钟同步;
对从站i的***本地时钟进行补偿,计算从站i的***本地时钟与***时钟的偏移时间Δt的计算公式为:
Δt=Tsys_local(i)-Tdelay(i)-Tsys_ref
当Δt>0时,表示从站i的***本地时钟走快了,工业以太网芯片控制从站i的***本地时钟每10ns减少Δt个单位时间;当Δt<0时,表示从站i的***本地时钟走慢了了,工业以太网芯片控制从站i的***本地时钟每10ns增加Δt个单位时间。
如图3所示:工业以太网芯片在进行通信的过程中包括以下状态:
Init状态,从站上电时,工业以太网芯片处于Init状态,用于读取从站的设备信息和做一些准备进入pre-op初始化的配置;
Pre-OP状态,用于映射pdo数据,并配置好FMMU的映射;
Safe-OP状态;用于判断从站DC时钟同步是否达到一个稳定值,DC同步稳定,从站也没有报错即可申请进入OP状态;
OP状态,正常运行状态,用于对伺服进行运动控制。
如图4所示:在进入函数AL_ControlInd()后,将状态机当前状态和请求状态的状态码分别存放于变量stateTrans的高四位和低四位中。然后根据状态机当前状态和请求状态(即根据变量stateTrans)检查相应的SM通道配置情况(若stateTrans的值不同,则所检查的SM通道也不同),并将检查结果存放于变量result中,上述SM通道的检查工作是在switch语句体中完成的。
S4-A:如果SM通道配置检查正确(即result结果为0),则根据变量stateTrans进行状态转换。若从引导状态转换为Init状态,则调用函数BackTolnitTransition()。若从Init状态转换为Pre-OP状态,则调用函数MBX_StartMailboxHandler()。若从Pre-OP状态转换为Safe-OP状态,则调用函数StartInputHandler()。若从Safe-OP状态转换为OP状态,则调用函数StartOutputHandler()。
S4-B:如果SM通道检查不正确(即result的值不为0),则根据状态机当前状态进行相关操作。若当前处于OP状态,则执行函数APPL_StopOutputHandler()和StopOutputHandler()停止周期性输出过程数据通信。若当前处于Safe-OP状态,则执行函数APPL StopInputHandler()和StopInputHandler()停止周期性输人过程数据通信。当前处于Pre-OP状态,则执行MBX_StopMailboxHandler()和APPL_StopMailboxHandler()停止邮箱数据通信。
进一步解释说明,在工业以太网芯片进行状态转换的过程中需要经过以下阶段:
检查SM设置,在进入“Per-OP”状态之前,需要读取并检查邮箱通信相关SM0和SM1通道的配置;在进入“Safe-OP”状态之前,需要检查周期性过程数据通信使用的SM2和SM3通道的配置,需要检查的SM通道的设置内容如下:
①SM通道大小;
②SM通道的设置是否重叠,特别注意三个缓存区应该预留3倍配置长度大小的空间;
③SM通道起始地址应该为偶数;
④SM通道应该被使能;
SM通道配置的检查工作在函数CheckSmSettings()中完成,具体如下:
⑴启动邮箱数据通信,进入Per-OP状态;
在从站进入Per-OP状态之前,先检查邮箱通信SM配置,如果配置成功则调用函数MBX_StartMailboxHandler()进入Per-OP状态;
⑵启动周期性输入数据通信,进入Safe-OP状态;
在进入Safe-OP状态之前,先检查过程数据SM通道设置是否正确,如正确则使能输入数据通道SM3,调用函数StartInputHandler()进入Safe-OP状态;
⑶启动周期性输出数据通信,进入OP状态;
在进入OP状态之前,先检查过程数据SM通道设置是否正确,如正确则使能输出数据通道SM2,调用函数StartOutputHandler()进入OP状态;
⑷停止工业以太网芯片数据通信。
在工业以太网芯片通信状态回退时停止相应的数据通信SM通道,其回退方式有以下三种:
Ⅰ.从高状态退回Safe-OP状态时,调用函数StopOutputHandler()停止周期性过程数据输出处理;
Ⅱ.从高状态退回Pre-OP状态时,调用函数StopInputHandler()停止周期性过程数据输入处理;
Ⅲ.从高状态退回Init状态时,调用函数BackToInitTransition()停止所有应用层数据处理。
Claims (10)
1.一种多MCU模块伺服从站控制器实现方法,其特征在于:包括以下步骤:
步骤1:搭建多MCU模块伺服从站网络***,包括上位机、主站和n个从站,n个从站串联,每个从站都设置有一个从站控制器,该从站控制器由AD微处理器芯片、DSP微处理器芯片、STM32微处理器芯片、DAC微处理器芯片、以太网芯片和工业以太网芯片共同组成;
上位机通过以太网芯片与主站连接,上位机和主站分别通过Ethercat总线与工业以太网芯片连接,STM32微处理器芯片一端连接工业以太网芯片,另一端通过SPI全双工通信方式与DSP微处理器芯片连接,STM32微处理器芯片还通过以太网芯片与上位机连接,DSP微处理器芯片还与AD微处理器芯片连接;
步骤2:用于AD微处理器芯片、DSP微处理器芯片、STM32微处理器芯片、DAC微处理器芯片、以太网芯片、工业以太网芯片进行上电完成初始化,上位机上电初始化显示控制界面的步骤;
步骤3:用于主站通过Ethercat总线实时下达DC时钟机制给工业以太网芯片,工业以太网芯片执行DC时钟机制并控制各个微处理器芯片同步性初始化及从站进行同步性操作的步骤;
步骤4:用于主站通过工业以太网芯片传送目标传感器数据给STM32微处理器芯片的步骤;
步骤5:用于上位机控制AD微处理器芯片通过多路复用器通道采集实际传感器数据,并将采集的实际传感器数据转化为数字信号的步骤;
步骤6:用于DSP微处理器芯片读取AD微处理器芯片采集的实际传感器数据,并对其进行滤波处理,然后通过SPI全双工通信方式传递给STM32微处理器芯片的步骤;
步骤7:用于STM32微处理器芯片通过PID算法计算实际传感器数据与目标传感器数据之间的差值,并对实际传感器数据进行差值补偿,STM32微处理器芯片输出相应控制指令给DAC微处理器芯片,并通过以太网芯片连接上位机控制界面进行数据显示的步骤;
步骤8:用于DAC微处理器芯片接收控制指令,输出相应量程电压控制从站运动,致使实际传感器数据与目标传感器数据一致,达到稳态运动的步骤。
2.根据权利要求1所述的多MCU模块伺服从站控制器实现方法,其特征在于:步骤3中,DC时钟机制控制从站进行同步性操作的步骤包括:
步骤31:主站配置全局***时钟Tsys_ref,并通过Ethercat总线周期性的向第1个从站的工业以太网芯片广播Ethercat数据帧进行时钟同步,第1个从站的工业以太网芯片再将Ethercat数据帧依次传递给第2个从站、第3个从站…第n个从站,然后再从第n个从站依次返回至第1个从站;
步骤32:工业以太网芯片实时读取从站***本地时钟Tsys_local数据,并将其与***时钟Tsys_ref进行对比,根据对比差值对从站***本地时钟Tsys_local进行时钟补偿,确保从站***本地时钟Tsys_local与***时钟Tsys_ref一致。
3.根据权利要求2所述的多MCU模块伺服从站控制器实现方法,其特征在于:在步骤32中,工业以太网对从站***本地时钟Tsys_local进行同步性控制的时钟同步计算过程如下:
Ti=Tlocal(i)+(i-1)Tdelay
Tdelay(i)=[(T2n-T1)-(T2n-i+1-Ti)]÷2
Toffset(i)=Ti-Tsys_ref-Tdelay(i)
Tsys_local(i)=Tlocal(i)-Toffset(i)
其中,Ti表示Ethercat数据帧的第一个位到达从站i的时间;n表示共有n个从站;T2n-i+1表示Ethercat数据帧的第一个位到达从站n后返回,再次到达从站i的时间;T2n表示Ethercat数据帧的第一个位到达从站n后返回,再次到达从站1的时间;Tlocal(i)表示从站i的本地时钟;Tdelay表示延迟时间;Tdelay(i)表示从站i和从站1之间的传输延迟时间;Toffset(i)表示Ethercat数据帧第一个位到达第i个从站的本地时钟与***时钟Tsys_ref的误差偏移量;Tsys_local(i)表示从站i的***本地时钟;
将计算得到的从站i的***本地时钟与***时钟进行比较,当从站i的***本地时钟与***时钟相等时,表示从站i与***同步;当从站i的***本地时钟与***时钟不相等时,表示从站i与***不同步,需对从站i的***本地时钟进行补偿,使从站i的***本地时钟始终与***时钟同步;
对从站i的***本地时钟进行补偿,计算从站i的***本地时钟与***时钟的偏移时间Δt的计算公式为:
Δt=Tsys_local(i)-Tdelay(i)-Tsys_ref
当Δt>0时,表示从站i的***本地时钟走快了,工业以太网芯片控制从站i的***本地时钟每10ns减少Δt个单位时间;当Δt<0时,表示从站i的***本地时钟走慢了了,工业以太网芯片控制从站i的***本地时钟每10ns增加Δt个单位时间。
4.根据权利要求1所述的多MCU模块伺服从站控制器实现方法,其特征在于:在步骤5中,上位机控制AD微处理器芯片采集实际传感器数据包括以下步骤:
步骤51:操作上位机控制界面进行多路复用器通道的选择,上位机通过Ethercat总线下达多路复用器通道选择命令和AD微处理器芯片采样命令给STM32微处理器芯片;
步骤52:STM32微处理器芯片通过SPI全双工通信方式与DSP微处理器芯片进行数据交互,DSP微处理器芯片控制多路复用器开关进行初始化,并控制打开上位机选择的多路复用器通道开关;
步骤53:DSP微处理器芯片通过SPI接口向AD微处理器芯片发送采样命令,AD微处理器芯片使用内部采样保持电容和采样保持放大器通过打开的多路复用器通道采集实际传感器数据,并将其转化成数字信号。
5.根据权利要求1所述的多MCU模块伺服从站控制器实现方法,其特征在于:在步骤7中,STM32微处理器芯片通过PID算法计算实际传感器数据与目标传感器数据之间的差值并输出控制量u(t)的计算公式如下:
其中,Kp表示比例增益;Ki表示积分增益;Kd表示微分增益;e(t)表示t时刻的实际传感器数据与目标传感器数据之间的差值,u(t)表示控制量。
6.根据权利要求1所述的多MCU模块伺服从站控制器实现方法,其特征在于:在步骤8中,DAC微处理器芯片输出相应量程电压的电压计算公式如下:
其中,VOUT表示输出电压,其电压范围为-10V到+10V;DIN表示配置DAC数据输出寄存器的数值,范围为0到65535;VREF表示参考电压;Gain表示增益。
7.根据权利要求1所述的多MCU模块伺服从站控制器实现方法,其特征在于:所述工业以太网芯片在进行通信的过程中包括以下状态:
Init状态,从站上电时,工业以太网芯片处于Init状态,用于读取从站的设备信息和做一些准备进入pre-op初始化的配置;
Pre-OP状态,用于映射pdo数据,并配置好FMMU的映射;
Safe-OP状态;用于判断从站DC时钟同步是否达到一个稳定值,DC同步稳定,从站也没有报错即可申请进入OP状态;
OP状态,正常运行状态,用于对伺服进行运动控制。
8.根据权利要求1所述的多MCU模块伺服从站控制器实现方法,其特征在于:所述目标传感器数据或是位移目标传感器数据;或是加速度目标传感器数据;或是力目标传感器数据;或是速度目标传感器数据;或是电压目标传感器数据;或是电流目标传感器数据;或是压强目标传感器数据;
所述AD微处理器芯片采集的实际传感器数据是与目标传感器数据属性相对应的传感器数据。
9.根据权利要求1所述的多MCU模块伺服从站控制器实现方法,其特征在于:所述实际传感器信号通过信号调理卡进入多路复用器通道供AD微处理器芯片采集;所述DSP微处理器芯片使用IIC总线的EEROPM数据存储方式进行数据的存储;所述STM32微处理器芯片将数据保存到SDRAM存储器中。
10.根据权利要求1所述的多MCU模块伺服从站控制器实现方法,其特征在于:所述DSP微处理器芯片与STM32微处理器芯片具有相同的通信模式、时钟极性、时钟相位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310714892.0A CN116594342A (zh) | 2023-06-16 | 2023-06-16 | 多mcu模块伺服从站控制器实现方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310714892.0A CN116594342A (zh) | 2023-06-16 | 2023-06-16 | 多mcu模块伺服从站控制器实现方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116594342A true CN116594342A (zh) | 2023-08-15 |
Family
ID=87593802
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310714892.0A Pending CN116594342A (zh) | 2023-06-16 | 2023-06-16 | 多mcu模块伺服从站控制器实现方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116594342A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117784699A (zh) * | 2024-02-28 | 2024-03-29 | 深圳市瑞天激光有限公司 | 一种通讯方法、装置及*** |
-
2023
- 2023-06-16 CN CN202310714892.0A patent/CN116594342A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117784699A (zh) * | 2024-02-28 | 2024-03-29 | 深圳市瑞天激光有限公司 | 一种通讯方法、装置及*** |
CN117784699B (zh) * | 2024-02-28 | 2024-05-28 | 深圳市瑞天激光有限公司 | 一种通讯方法、装置及*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105024777B (zh) | 基于EtherCAT实时以太网的伺服驱动器同步方法 | |
EP2317411B1 (en) | Network device interface for digitally interfacing data channels to a controller via a network | |
JP6140459B2 (ja) | センサーデータ伝送装置 | |
CN116594342A (zh) | 多mcu模块伺服从站控制器实现方法 | |
EP2458468A2 (en) | Test system and method for testing | |
WO2000062455A9 (en) | Single wire bus interface for multidrop applications | |
JPH04293338A (ja) | 通信システム | |
CN101480347B (zh) | 一种四维超声探头电机控制*** | |
Liu et al. | EtherCAT based robot modular joint controller | |
CN201355804Y (zh) | 一种四维超声探头电机控制*** | |
US9877042B1 (en) | Position encoder sample timing system | |
CN109450763B (zh) | 一种总线扩展方法、网关和总线扩展*** | |
CN112327707B (zh) | 伺服驱动器的时序控制方法、装置和*** | |
CN115826505A (zh) | 一种基于同步实时以太网的多轴电液伺服从站控制*** | |
CN112631196A (zh) | 一种基于plc的高速数据采集与控制*** | |
EP3767413B1 (en) | Control device, control system, control method, and control program | |
EP3764175A1 (en) | Control device and control system | |
CN114342311B (zh) | 用于同步串行数据传输的装置和方法 | |
US20060274598A1 (en) | Method for controlling the access times to a system bus and communication module | |
CN114594695A (zh) | 一种基于fpga和dsp的惯性器件仿真控制*** | |
CN211531028U (zh) | 基于stm32控制l640h驱动器的多轴步进电机控制*** | |
EP3696626B1 (en) | Communication system, communication method, and program | |
CN114238197A (zh) | 一种基于车规级芯片搭建qnx***的飞机仪表的方法 | |
CN111208784A (zh) | 运动控制***及其同步方法 | |
CN112630795A (zh) | 一种基于2d激光雷达的三维点云数据合成*** |
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 |