CN115060164B - Position and speed detection system and method for high-speed linear motor - Google Patents

Position and speed detection system and method for high-speed linear motor Download PDF

Info

Publication number
CN115060164B
CN115060164B CN202210655392.XA CN202210655392A CN115060164B CN 115060164 B CN115060164 B CN 115060164B CN 202210655392 A CN202210655392 A CN 202210655392A CN 115060164 B CN115060164 B CN 115060164B
Authority
CN
China
Prior art keywords
speed
receiving sensor
signal
pulses
receiving
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
CN202210655392.XA
Other languages
Chinese (zh)
Other versions
CN115060164A (en
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.)
Institute of Electrical Engineering of CAS
Original Assignee
Institute of Electrical Engineering of CAS
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 Institute of Electrical Engineering of CAS filed Critical Institute of Electrical Engineering of CAS
Priority to CN202210655392.XA priority Critical patent/CN115060164B/en
Publication of CN115060164A publication Critical patent/CN115060164A/en
Application granted granted Critical
Publication of CN115060164B publication Critical patent/CN115060164B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00Measuring arrangements characterised by the use of optical techniques
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P3/00Measuring linear or angular speed; Measuring differences of linear or angular speeds
    • G01P3/36Devices characterised by the use of optical means, e.g. using infrared, visible, or ultraviolet light
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01RMEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
    • G01R31/00Arrangements for testing electric properties; Arrangements for locating electric faults; Arrangements for electrical testing characterised by what is being tested not provided for elsewhere
    • G01R31/34Testing dynamo-electric machines

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Electromagnetism (AREA)
  • Power Engineering (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

本发明公开了一种高速直线电机的位置和速度检测系统及方法,所述系统包括光栅尺、多个激光发生器、多个接收装置和控制器。所述检测方法包括:接收装置根据各传感器输入脉冲信号,计算动子位置。然后根据各传感器输出脉冲对应的跟踪微分器计算速度。对各传感器输入脉冲进行独立运算,当跟踪微分器算法输出速度达到稳定后,选取该速度作为速度检测系统最终计算速度传递到控制器,控制器选择接收装置速度和位移信号输出到电机控制系统。该方法能够有效降低跟踪微分器对速度阶跃信号的跟踪的过渡过程,减小时间延迟,且各传感器输出的脉冲为独立运算,避免了传感器绝对位置的误差导致的速度波动,实现了高速直线电机高实时性高精度测量的要求。

The present invention discloses a position and speed detection system and method for a high-speed linear motor, the system comprising a grating ruler, a plurality of laser generators, a plurality of receiving devices and a controller. The detection method comprises: the receiving device calculates the position of the mover according to the pulse signal input by each sensor. Then the speed is calculated according to the tracking differentiator corresponding to the output pulse of each sensor. The input pulses of each sensor are independently calculated, and when the output speed of the tracking differentiator algorithm reaches stability, the speed is selected as the final calculated speed of the speed detection system and transmitted to the controller, and the controller selects the receiving device speed and displacement signal to output to the motor control system. The method can effectively reduce the transition process of the tracking differentiator tracking the speed step signal, reduce the time delay, and the pulses output by each sensor are independently calculated, avoiding the speed fluctuation caused by the error of the absolute position of the sensor, and realizing the requirements of high real-time and high-precision measurement of the high-speed linear motor.

Description

一种高速直线电机的位置和速度检测系统及方法A high-speed linear motor position and speed detection system and method

技术领域Technical Field

本发明属于定位测速领域,具体涉及一种高速直线电机的位置和速度检测系统及方法。The invention belongs to the field of positioning and speed measurement, and in particular relates to a position and speed detection system and method for a high-speed linear motor.

背景技术Background technique

直线电机由于其简单的传动结构,省去了复杂的中间传动装置,在很多需要进行直线运动的场合得到了广泛应用。在高速直线电磁推进领域中,利用高速直线电机在其产生稳定电磁推力的作用下,推动动子(含负载)产生高速直线运动,在有限距离和有限时间内完成动子加速、匀速和减速的整个过程,因此电机必须进行闭环控制,而速度检测的精度是系统闭环稳定运行的关键因素。Linear motors are widely used in many situations where linear motion is required due to their simple transmission structure and the elimination of complex intermediate transmission devices. In the field of high-speed linear electromagnetic propulsion, high-speed linear motors are used to drive the mover (including the load) to produce high-speed linear motion under the action of the stable electromagnetic thrust generated by the motor, completing the entire process of the mover acceleration, uniform speed and deceleration within a limited distance and time. Therefore, the motor must be closed-loop controlled, and the accuracy of speed detection is a key factor in the stable operation of the closed-loop system.

根据电机的经典矢量控制理论,电机控制系统对电机实现速度外环和电流内环的双闭环控制,来驱动直线电机产生稳定的电磁推力,这就需要定位测速系统的传感器实时准确的测量动子的运行位置和运行速度。尤其是对于直线感应电机,速度测量信号需要作为速度外环的反馈信号,需要叠加滑差信号进入电机控制系统,完成对电磁推力的稳定控制。若速度测量信号不准确,必然会反应在最后输出的电磁推力之中,导致推力不稳定、波动大,这是高速直线电磁推进系统所不期望的,尤其是在高速运行的电机需要安全制动的时候。所以对于整个系统来说,要满足推力的稳定,就需要控制速度误差在一定的范围之内。According to the classic vector control theory of the motor, the motor control system implements dual closed-loop control of the outer speed loop and the inner current loop to drive the linear motor to generate stable electromagnetic thrust. This requires the sensors of the positioning speed measurement system to accurately measure the running position and running speed of the mover in real time. Especially for linear induction motors, the speed measurement signal needs to be used as the feedback signal of the outer speed loop, and the slip signal needs to be superimposed to enter the motor control system to complete the stable control of the electromagnetic thrust. If the speed measurement signal is inaccurate, it will inevitably be reflected in the final output electromagnetic thrust, resulting in unstable thrust and large fluctuations, which is not expected for high-speed linear electromagnetic propulsion systems, especially when the high-speed motor needs to be safely braked. Therefore, for the entire system, in order to meet the stability of the thrust, it is necessary to control the speed error within a certain range.

现有的定位测速方案,中国发明专利CN201910210291.X提供了一种有效的位置测量方法和利用差分法获取速度信息,但是差分法极易放大测量噪声,本系统不予考虑。参考传统旋转电机利用编码器的方式,直线电机主要是利用探测器阵列,收集动子经过一系列探测器时产生的各列脉冲信号,再分别利用适合低速的定角测时T法或者适合高速的定时测角M法,参见中国发明专利CN20180464869.X,各个探测器连接的脉冲处理装置计算出电机运行位置和速度。由于高速直线电机的运行速度很高,很难在全程使用T法进行测速,需要在高速度段切换至M法测速,但是M法原理是在固定时间段内测量脉冲数量,在高速运动过程中,虽然能够保证该段时间内产生的脉冲数足够多而使得计算的速度精度高,但是由于极大的加速度,反而会在该时间段内造成较大的速度滞后,同样使得推力不能满足要求。The existing positioning and speed measurement scheme, China invention patent CN201910210291.X provides an effective position measurement method and obtains speed information using the differential method, but the differential method is very easy to amplify the measurement noise, which is not considered in this system. Referring to the way that the traditional rotating motor uses encoders, the linear motor mainly uses a detector array to collect the pulse signals generated by each column when the mover passes through a series of detectors, and then uses the fixed angle measurement T method suitable for low speed or the timing angle measurement M method suitable for high speed, see China invention patent CN20180464869.X, the pulse processing device connected to each detector calculates the motor running position and speed. Due to the high running speed of the high-speed linear motor, it is difficult to use the T method for speed measurement throughout the whole process, and it is necessary to switch to the M method for speed measurement in the high-speed section. However, the principle of the M method is to measure the number of pulses in a fixed time period. During high-speed motion, although it can ensure that the number of pulses generated in this period is sufficient to make the calculated speed high in accuracy, due to the extremely large acceleration, it will cause a large speed lag in this time period, and the thrust cannot meet the requirements.

因此本领域还缺乏应用于高速直线电机的全程精确且快速的测速方法。Therefore, there is still a lack of a fully accurate and fast speed measurement method for high-speed linear motors in the art.

发明内容Summary of the invention

为解决现有技术中的问题,即现有技术无法实现高速直线电机全程精确且快速的速度测量。本发明提供了一种高速直线电机的位置与速度检测系统及方法。利用跟踪微分器对动子速度进行检测,在保证速度测量精度的前提下,通过给跟踪微分器赋初值的方法,能够有效降低跟踪微分器跟踪阶跃信号的延迟,为高速直线电机定位测速系统提供了一种有效的测速方案。In order to solve the problem in the prior art, that is, the prior art cannot realize the accurate and fast speed measurement of the high-speed linear motor throughout the whole process. The present invention provides a position and speed detection system and method for a high-speed linear motor. The moving part speed is detected by using a tracking differentiator. Under the premise of ensuring the speed measurement accuracy, the delay of the tracking differentiator in tracking the step signal can be effectively reduced by assigning an initial value to the tracking differentiator, thereby providing an effective speed measurement solution for the high-speed linear motor positioning and speed measurement system.

为达到上述目的,本发明所提出的技术方案如下:In order to achieve the above object, the technical solution proposed by the present invention is as follows:

一种高速直线电机的位置和速度检测系统,包括光栅尺、多个激光发生器、接收装置以及控制器;所述多个激光发生器,以固定间隔布置与所述高速直线电机上,用于发出激光并保持常亮状态;所述光栅尺,具有固定等宽和等间距的栅格孔,用于遮挡和透过激光,以产生光脉冲信号;所述接收装置,包括接收传感器和信号处理器,用于接收多个激光发生器的光脉冲信号并进行计算;所述信号处理器包括光电转换、滤波电路、高速数字处理器和通信模块;所述接收传感器与所述激光发生器平行布置,用于接收光脉冲信号;所述高速数字处理器根据电脉冲信号、所述光栅尺的栅格孔间距计算速度和位置,然后通过所述通信模块将速度和位置信号传递给所述控制器;控制器,用于接收接收装置计算得到的速度信号。A position and speed detection system for a high-speed linear motor comprises a grating ruler, a plurality of laser generators, a receiving device and a controller; the plurality of laser generators are arranged at fixed intervals on the high-speed linear motor for emitting lasers and keeping them in a constant light state; the grating ruler has grid holes of fixed equal width and equal spacing for shielding and transmitting lasers to generate optical pulse signals; the receiving device comprises a receiving sensor and a signal processor for receiving and calculating optical pulse signals from the plurality of laser generators; the signal processor comprises a photoelectric conversion, a filtering circuit, a high-speed digital processor and a communication module; the receiving sensor is arranged in parallel with the laser generator for receiving optical pulse signals; the high-speed digital processor calculates the speed and position according to the electrical pulse signal and the grid hole spacing of the grating ruler, and then transmits the speed and position signals to the controller through the communication module; the controller is used to receive the speed signal calculated by the receiving device.

本发明还提供一种高速直线电机的位置和速度检测系统的检测方法,其中所述位置的检测方法为:所述接收装置根据所述脉冲信号脉冲数、所述光栅尺的栅格孔间距和所述接收传感器的绝对位置确定所述高速直线电机的动子的实时位置,包括:The present invention also provides a detection method for a position and speed detection system of a high-speed linear motor, wherein the position detection method is: the receiving device determines the real-time position of the mover of the high-speed linear motor according to the number of pulses of the pulse signal, the grid hole spacing of the grating ruler and the absolute position of the receiving sensor, including:

动子的实时位置=接收传感器绝对位置+信号脉冲数×光栅尺栅格孔间距;The real-time position of the mover = the absolute position of the receiving sensor + the number of signal pulses × the grid hole spacing of the grating ruler;

所述速度的检测方法,包括:The speed detection method comprises:

步骤S1,确定所述光栅尺的栅孔间距为w,相邻两个所述接收传感器间距为l1,所述多个接收传感器按照顺序分别定义为第一个接收传感器、第二个接收传感器,至第m个接收传感器;Step S1, determining that the grating hole spacing of the grating ruler is w, the spacing between two adjacent receiving sensors is l 1 , and the multiple receiving sensors are defined in order as a first receiving sensor, a second receiving sensor, to an mth receiving sensor;

步骤S2,所述接收装置接收各接收传感器输入脉冲信号并进行光电转换;所述接收装置首先根据第一个接收传感器输出脉冲进行速度检测,采用光栅尺栅格间距和相邻两个脉冲上升沿时间求得连续n个脉冲中,每一个脉冲对应的速度v1_1、v1_2…v1_nStep S2, the receiving device receives the input pulse signals of each receiving sensor and performs photoelectric conversion; the receiving device first performs speed detection according to the output pulse of the first receiving sensor, and uses the grating scale grid spacing and the rising edge time of two adjacent pulses to obtain the speed v 1_1 , v 1_2 ...v 1_n corresponding to each pulse in the continuous n pulses;

步骤S3,求得所述第一个接收传感器连续输出的n个脉冲对应的平均速度vT_1,其中,vT_1=(v1_1+v1_2+…+v1_n)/n;Step S3, obtaining an average speed v T — 1 corresponding to n pulses continuously output by the first receiving sensor, wherein v T — 1 =(v 1 — 1 +v 1 — 2 +…+v 1 — n )/n;

步骤S4,将所述第一个接收传感器输出脉冲对应的平均速度vT_1作为跟踪微分器的初值,对所述跟踪微分器进行赋初值的操作;赋初值完成后,结合所述光栅尺栅格间距w以及第一个接收传感器输出脉冲数量N1,根据相对位移公式w×N1,得到所述第一个接收传感器检测到的动子板的相对位移X1作为所述跟踪微分器的输入,并启动所述跟踪微分器计算程序,得到所述第一个接收传感器输出脉冲对应的跟踪微分器计算的速度vG_1Step S4, taking the average speed v T_1 corresponding to the output pulse of the first receiving sensor as the initial value of the tracking differentiator, and performing the initial value assignment operation on the tracking differentiator; after the initial value assignment is completed, combining the grating scale grid spacing w and the number of output pulses N 1 of the first receiving sensor, according to the relative displacement formula w×N 1 , the relative displacement X 1 of the mover plate detected by the first receiving sensor is obtained as the input of the tracking differentiator, and the tracking differentiator calculation program is started to obtain the speed v G_1 calculated by the tracking differentiator corresponding to the output pulse of the first receiving sensor;

步骤S5,当所述第二个接收传感器连续输出n个脉冲后,根据上述步骤S3~S4的方法,求得所述第二个接收传感器连续输出n个脉冲对应的平均速度vT_2;当所述第三个接收传感器输出脉冲后,根据上述步骤S3~S4的方法,求得所述第三个接收传感器输出n个脉冲对应的平均速度vT_3;以此类推,当所述第m个接收传感器输出n个脉冲后,求得所述第m个传感器连续输出n个脉冲对应的平均速度vT_mStep S5, when the second receiving sensor continuously outputs n pulses, according to the method of the above steps S3 to S4, the average speed v T_2 corresponding to the n pulses continuously output by the second receiving sensor is obtained; when the third receiving sensor outputs a pulse, according to the method of the above steps S3 to S4, the average speed v T_3 corresponding to the n pulses output by the third receiving sensor is obtained; and so on, when the m-th receiving sensor outputs n pulses, the average speed v T_m corresponding to the n pulses continuously output by the m-th sensor is obtained;

步骤S6,当所述第二个接收传感器连续输出n个脉冲后,根据上述步骤S4的方法,求得所述第二个传感器输出脉冲采用跟踪微分器计算的速度vG_2;当所述第三个接收传感器输出n个脉冲后,根据上述步骤S4的方法,求得所述第三个接收传感器输出脉冲采用跟踪微分器计算的速度vG_3,以此类推,当所述第m个传感器输出n个脉冲后,根据上述步骤S4的方法,求得所述第m个接收传感器输出脉冲采用跟踪微分器计算的速度vG_mStep S6, when the second receiving sensor continuously outputs n pulses, according to the method of step S4, the speed v G_2 of the second sensor output pulse calculated by the tracking differentiator is obtained; when the third receiving sensor outputs n pulses, according to the method of step S4, the speed v G_3 of the third receiving sensor output pulse calculated by the tracking differentiator is obtained; and so on, when the m-th sensor outputs n pulses, according to the method of step S4, the speed v G_m of the m-th receiving sensor output pulse calculated by the tracking differentiator is obtained;

步骤S7,动子在运动过程中,当vG_1跟踪上实际速度且稳定后,选择vG_1作为检测结果vf;当vG_2稳定后,在vG_1和vG_2重叠的区域内,选择vG_2作为检测结果vf;当vG_3稳定后,在vG_2和vG_3重叠的区域内,选择vG_3作为检测结果vf;以此类推,接收装置将vf传递到控制器;Step S7, during the movement of the mover, when v G_1 tracks the actual speed and becomes stable, v G_1 is selected as the detection result v f ; when v G_2 becomes stable, in the overlapping area of v G_1 and v G_2 , v G_2 is selected as the detection result v f ; when v G_3 becomes stable, in the overlapping area of v G_2 and v G_3 , v G_3 is selected as the detection result v f ; and so on, the receiving device transmits v f to the controller;

步骤S8,控制器选择不同接收装置上传的vf,最终实现全程范围内的速度检测。Step S8: The controller selects v f uploaded by different receiving devices, and finally realizes speed detection in the whole range.

进一步地,所述跟踪微分器的离散形式表示为:Furthermore, the discrete form of the tracking differentiator is expressed as:

其中:fhan(x1,x2,u,r,h)为离散最速控制综合函数,其算法公式如下:in: fhan(x 1 ,x 2 ,u,r,h) is the discrete fastest control comprehensive function, and its algorithm formula is as follows:

为了简明的表示fhan(x1,x2,u,r,h),引入d、d0、y、a0、a作为其中间变量;为符号函数,此处x为y或a;u为位置输入信号,x1为位置跟踪信号,属于中间变量,x2为速度输出信号,r为速度因子,h为滤波因子,两者是速度输出信号x2和参数γ1、γ2的自适应函数,r随x2的增大而快速增大,h随x2的增大快速减小;其中γ1和γ2为可调参数,调整它们的大小可以分别改变r和h的变化速率,同时γ1和γ2控制着跟踪微分器通频带的范围,因此需要根据输入信号u的频谱来调整,使得微分器对输入信号u有着良好的微分作用,以及能够滤除输入信号u的高频噪声;A为r的变化范围,T为离散化步长,k为离散时刻(k=0,1,2,3······);所述跟踪微分器采用参数自适应的形式,能够输出全程精准的速度信号。In order to express fhan(x 1 ,x 2 ,u,r,h) concisely, d, d 0 , y, a 0 , a are introduced as intermediate variables; is a sign function, where x is y or a; u is the position input signal, x1 is the position tracking signal, which is an intermediate variable, x2 is the speed output signal, r is the speed factor, and h is the filter factor. The two are adaptive functions of the speed output signal x2 and parameters γ1 and γ2 . r increases rapidly with the increase of x2 , and h decreases rapidly with the increase of x2 . γ1 and γ2 are adjustable parameters. Adjusting their sizes can change the change rates of r and h respectively. At the same time, γ1 and γ2 control the range of the tracking differentiator passband. Therefore, they need to be adjusted according to the frequency spectrum of the input signal u so that the differentiator has a good differential effect on the input signal u and can filter out the high-frequency noise of the input signal u. A is the range of r, T is the discretization step size, and k is the discrete time (k=0, 1, 2, 3······). The tracking differentiator adopts the form of parameter adaptation and can output a fully accurate speed signal.

进一步地,所述步骤S4中的所述跟踪微分器赋初值的操作包括:Furthermore, the operation of assigning an initial value to the tracking differentiator in step S4 includes:

步骤S40:所述接收装置计算得到的所述第一个接收传感器连续输出n个脉冲对应的平均速度vT_1作为跟踪微分器速度信号初值v0,即所述跟踪微分器速度信号x2(k)的初始值为x2(0)=vT_1Step S40: the receiving device calculates the average speed v T — 1 corresponding to the n pulses continuously output by the first receiving sensor as the initial value v 0 of the tracking differentiator speed signal, that is, the initial value of the tracking differentiator speed signal x 2 (k) is x 2 (0) = v T — 1 ;

步骤S41:所述接收装置对所述跟踪微分器的位置输入初始值赋初值,即u的初始值u(0)为0;Step S41: the receiving device assigns an initial value to the position input initial value of the tracking differentiator, that is, the initial value u(0) of u is 0;

步骤S42:所述接收装置对所述跟踪微分器的位置跟踪信号赋初值,即中间变量位置跟踪信号x1(k)的初始值为:Step S42: The receiving device assigns an initial value to the position tracking signal of the tracking differentiator, that is, the initial value of the intermediate variable position tracking signal x 1 (k) is:

其中,y=x1(0)-u(0)+hx2(0);计算出上述三种情况的x1(0)的值,对应各自的条件约束,选择满足约束的值。Wherein, y=x 1 (0)-u(0)+hx 2 (0); the values of x 1 (0) in the above three cases are calculated, and the corresponding values satisfying the constraints are selected.

进一步地,各接收传感器输出的脉冲信号为独立处理并运算,以避免接收传感器绝对位置的误差造成的速度波动。Furthermore, the pulse signals output by each receiving sensor are processed and calculated independently to avoid speed fluctuations caused by errors in the absolute positions of the receiving sensors.

进一步地,所述光栅尺的长度大于相邻的接收传感器的间距以保证检测结果是连续的。本发明具有以下有益效果:Furthermore, the length of the grating ruler is greater than the spacing between adjacent receiving sensors to ensure that the detection result is continuous. The present invention has the following beneficial effects:

本发明能够保证高速直线电机位置与速度检测系统速度检测结果的品质,使得电机控制系统获得动子运动全程范围内精确且快速的速度测量反馈信息,使得高速直线电机能够产生稳定的电磁推力;避免了传感器绝对位置误差带来的速度波动,降低了跟踪微分器对速度的跟踪延迟。The present invention can ensure the quality of the speed detection results of the high-speed linear motor position and speed detection system, so that the motor control system can obtain accurate and fast speed measurement feedback information within the entire range of the mover movement, so that the high-speed linear motor can generate stable electromagnetic thrust; avoid the speed fluctuation caused by the absolute position error of the sensor, and reduce the tracking delay of the tracking differentiator to the speed.

附图说明BRIEF DESCRIPTION OF THE DRAWINGS

图1为本发明实施例提供的一种高速直线电机的位置和速度检测系统示意图。FIG1 is a schematic diagram of a position and speed detection system for a high-speed linear motor provided in an embodiment of the present invention.

图2为本发明实施例提供的一种高速直线电机的位置和速度检测系统的光栅尺结构示意图。FIG. 2 is a schematic diagram of the structure of a grating scale of a position and speed detection system for a high-speed linear motor provided by an embodiment of the present invention.

图3为本发明实施例提供的一种高速直线电机的速度检测方法的流程图。FIG. 3 is a flow chart of a method for detecting the speed of a high-speed linear motor provided in an embodiment of the present invention.

图4为本发明实施例提供的一种高速直线电机的速度检测方法过程中位置信号以及赋初值前后的中间变量位置跟踪信号x1(k)测量结果对比。FIG. 4 is a comparison of measurement results of a position signal and an intermediate variable position tracking signal x 1 (k) before and after initialization during a speed detection method for a high-speed linear motor provided by an embodiment of the present invention.

图5为本发明实施例提供的一种高速直线电机的位置和速度检测方法过程中参考速度以及赋初值前后的速度信号x2(k)测量速度结果对比。FIG. 5 is a comparison of the reference speed and the speed signal x 2 (k) measured speed results before and after the initialization in a method for detecting the position and speed of a high-speed linear motor provided by an embodiment of the present invention.

图6为本发明实施例提供的一种高速直线电机的位置和速度检测方法实施例过程中多个接收传感器输出脉冲采用本发明的跟踪微分器和传统跟踪微分器方法测量结果对比。FIG6 is a comparison of measurement results of multiple receiving sensor output pulses using the tracking differentiator of the present invention and the traditional tracking differentiator method during an embodiment of a method for detecting the position and speed of a high-speed linear motor provided by an embodiment of the present invention.

具体实施方式Detailed ways

以下将结合附图对本发明的具体实时例进行详细说明,阐述了具体细节,以帮助全面解释本发明。The following will describe in detail specific real-time examples of the present invention in conjunction with the accompanying drawings, and set forth specific details to help fully explain the present invention.

如图1所示,本发明提供了一种高速直线电机的位置与速度检测系统,该系统包括包括光栅尺0、多个激光发生器1、接收装置2、接收传感器21,信号处理器22和控制器3。As shown in FIG1 , the present invention provides a position and speed detection system for a high-speed linear motor, which includes a grating ruler 0, multiple laser generators 1, a receiving device 2, a receiving sensor 21, a signal processor 22 and a controller 3.

光栅尺0,为具有固定等宽和等间距的栅格孔的装置,用于遮挡和透过激光,以产生光脉冲信号;Grating ruler 0 is a device with fixed grid holes of equal width and spacing, used to block and transmit laser light to generate optical pulse signals;

多个激光发生器1,以固定间隔布置于所述高速直线电机上,用于发出激光并保持常亮状态;A plurality of laser generators 1 are arranged at fixed intervals on the high-speed linear motor, and are used to emit lasers and keep them in a constant light state;

接收装置2,包括接收传感器21和信号处理器22,用于接收光脉冲信号并进行计算。接收装置2可以接收多路所述接收传感器21的脉冲信号,本实施例中接收装置2可以接收16路所述接收传感器21的脉冲信号。信号处理器22包括光电转换模块、滤波电路、高速数字处理器和通信模块。接收传感器21与激光发生器1平行布置,用于接收光脉冲信号,高速数字处理器根据电脉冲信号、所述光栅尺0的栅格孔间距计算速度和位置,然后通过通信模块将速度和位置信号传递给控制器3。The receiving device 2 includes a receiving sensor 21 and a signal processor 22, which is used to receive the optical pulse signal and perform calculations. The receiving device 2 can receive multiple pulse signals from the receiving sensor 21. In this embodiment, the receiving device 2 can receive 16 pulse signals from the receiving sensor 21. The signal processor 22 includes a photoelectric conversion module, a filtering circuit, a high-speed digital processor and a communication module. The receiving sensor 21 is arranged in parallel with the laser generator 1 and is used to receive the optical pulse signal. The high-speed digital processor calculates the speed and position based on the electrical pulse signal and the grid hole spacing of the grating ruler 0, and then transmits the speed and position signals to the controller 3 through the communication module.

控制器3,用于接收各接收装置2计算得到的速度信号。The controller 3 is used to receive the speed signals calculated by each receiving device 2 .

本发明提供了一种高速直线电机的位置和速度检测方法,该方法包括:The present invention provides a method for detecting the position and speed of a high-speed linear motor, the method comprising:

所述接收装置2根据所述脉冲信号脉冲数、所述光栅尺0的栅格孔间距和所述接收传感器21的绝对位置确定所述高速直线电机的动子的实时位置包括:The receiving device 2 determines the real-time position of the mover of the high-speed linear motor according to the pulse number of the pulse signal, the grid hole spacing of the grating ruler 0 and the absolute position of the receiving sensor 21, including:

动子的实时位置=接收传感器绝对位置+信号脉冲数×光栅尺栅格孔间距。The real-time position of the mover = the absolute position of the receiving sensor + the number of signal pulses × the grid hole spacing of the grating ruler.

如图2所示,本发明提供了一种高速直线电机的位置与速度检测系统的光栅尺结构示意图,所述光栅尺0的栅孔间距w=10mm,所述光栅尺总长度为L=2.2m,动子运动将带动所述光栅尺0在所述多个激光发生器1的阵列中运动,驱使接收传感器21在运动方向上逐次接收到脉冲信号。As shown in Figure 2, the present invention provides a schematic diagram of the grating scale structure of a high-speed linear motor position and speed detection system, wherein the grating scale 0 has a grating hole spacing w=10 mm, and a total length of the grating scale L=2.2 m. The movement of the mover will drive the grating scale 0 to move in the array of the multiple laser generators 1, driving the receiving sensor 21 to receive pulse signals one by one in the direction of movement.

需要说明的是所述光栅尺长度需要一定长度,本实施例中取所述光栅尺长度为L=2.2m,略长于2倍的激光发生器1的间隔,即任意时刻至少有两对所述接收传感器21产生脉冲信号,系统正常运行时高速数字处理装置采用最新产生脉冲的所述接收传感器21脉冲信号进行处理,当该所述接收传感器21故障时,所述信号处理器22可采用前一个所述接收传感器21信号,关于故障检测和处理的更多细节内容本发明不再展开详细说明。It should be noted that the length of the grating ruler needs to be a certain length. In this embodiment, the length of the grating ruler is L=2.2m, which is slightly longer than 2 times the interval of the laser generator 1, that is, at least two pairs of the receiving sensors 21 generate pulse signals at any time. When the system is operating normally, the high-speed digital processing device uses the latest pulse signal of the receiving sensor 21 for processing. When the receiving sensor 21 fails, the signal processor 22 can use the previous signal of the receiving sensor 21. More details about fault detection and processing will not be elaborated in detail in this invention.

如图3所示,本发明提供了一种高速直线电机的速度检测方法,该方法包括:As shown in FIG3 , the present invention provides a method for detecting the speed of a high-speed linear motor, the method comprising:

步骤S1,确定所述光栅尺栅孔间距为20mm,相邻两个所述接收传感器间距为1000mm,所述多个接收传感器按照顺序分别定义为第一个接收传感器、第二个接收传感器,以此类推,第m个接收传感器;Step S1, determining that the grating scale hole spacing is 20 mm, the spacing between two adjacent receiving sensors is 1000 mm, and the multiple receiving sensors are defined in order as the first receiving sensor, the second receiving sensor, and so on, the mth receiving sensor;

步骤S2,所述接收装置接收各接收传感器输入脉冲信号并进行光电转换;所述接收装置首先根据第一个接收传感器输出脉冲进行速度检测,采用光栅尺栅格间距/相邻两个脉冲上升沿时间的方法求得连续6个脉冲,每一个脉冲对应的速度v1_1、v1_2…v1_6Step S2, the receiving device receives the input pulse signals of each receiving sensor and performs photoelectric conversion; the receiving device first performs speed detection according to the output pulse of the first receiving sensor, and uses the method of grating scale grid spacing/rise edge time of two adjacent pulses to obtain 6 consecutive pulses, and the speed v 1_1 , v 1_2 ...v 1_6 corresponding to each pulse;

步骤S3,求得所述第一个接收传感器连续输出的6个脉冲对应的平均速度vT_1,即vT_1=(v1_1+v1_2+…+v1_6)/6;Step S3, obtaining an average speed v T — 1 corresponding to the six pulses continuously output by the first receiving sensor, that is, v T — 1 =(v 1 — 1 +v 1 — 2 +…+v 1 — 6 )/6;

步骤S4,将所述第一个接收传感器输出脉冲对应的平均速度vT_1作为跟踪微分器的初值,对所述跟踪微分器进行赋初值的操作;赋初值完成后,结合所述光栅尺栅格间距20mm以及第一个接收传感器输出脉冲数量N1,根据相对位移公式X1=20mm×N1,得到所述第一个接收传感器检测到的动子板的相对位移X1作为所述跟踪微分器的输入,并启动所述跟踪微分器计算程序,得到所述第一个接收传感器输出脉冲对应的跟踪微分器计算的速度vG_1Step S4, taking the average speed v T_1 corresponding to the output pulse of the first receiving sensor as the initial value of the tracking differentiator, and performing the initial value assignment operation on the tracking differentiator; after the initial value assignment is completed, combining the grating scale grid spacing of 20mm and the number of output pulses of the first receiving sensor N 1 , according to the relative displacement formula X 1 =20mm×N 1 , the relative displacement X 1 of the mover plate detected by the first receiving sensor is obtained as the input of the tracking differentiator, and the tracking differentiator calculation program is started to obtain the speed v G_1 calculated by the tracking differentiator corresponding to the output pulse of the first receiving sensor;

步骤S5,当所述第二个接收传感器连续输出6个脉冲后,根据上述步骤S3~S4的方法,求得所述第二个接收传感器连续输出6个脉冲对应的平均速度vT_2;当所述第三个接收传感器输出脉冲后,根据上述步骤S3~S4的方法,求得所述第三个接收传感器输出6个脉冲对应的平均速度vT_3;以此类推,当所述第m个接收传感器输出6个脉冲后,求得所述第m个传感器连续输出6个脉冲对应的平均速度vT_mStep S5, when the second receiving sensor continuously outputs 6 pulses, according to the method of the above steps S3 to S4, the average speed v T_2 corresponding to the 6 pulses continuously output by the second receiving sensor is obtained; when the third receiving sensor outputs a pulse, according to the method of the above steps S3 to S4, the average speed v T_3 corresponding to the 6 pulses output by the third receiving sensor is obtained; and so on, when the m-th receiving sensor outputs 6 pulses, the average speed v T_m corresponding to the 6 pulses continuously output by the m-th sensor is obtained;

步骤S6,当所述第二个接收传感器连续输出6个脉冲后,根据上述步骤S4的方法,求得所述第二个传感器输出脉冲采用跟踪微分器计算的速度vG_2;当所述第三个接收传感器输出6个脉冲后,根据上述步骤S4的方法,求得所述第三个接收传感器输出脉冲采用跟踪微分器计算的速度vG_3,以此类推,当所述第m个传感器输出6个脉冲后,根据上述步骤S4的方法,求得所述第m个接收传感器输出脉冲采用跟踪微分器计算的速度vG_mStep S6, when the second receiving sensor continuously outputs 6 pulses, according to the method of step S4, the speed v G_2 of the second sensor output pulse calculated by the tracking differentiator is obtained; when the third receiving sensor outputs 6 pulses, according to the method of step S4, the speed v G_3 of the third receiving sensor output pulse calculated by the tracking differentiator is obtained; and so on, when the m-th sensor outputs 6 pulses, according to the method of step S4, the speed v G_m of the m-th receiving sensor output pulse calculated by the tracking differentiator is obtained;

步骤S7,动子在运动过程中,当vG_1跟踪上实际速度且稳定后,选择vG_1作为检测结果vf,当vG_2稳定后,在vG_1和vG_2重叠的区域内,选择vG_2作为检测结果vf,当vG_3稳定后,在vG_2和vG_3重叠的区域内,选择vG_3作为检测结果vf,以此类推,接收装置将vf传递到控制器,控制器选择不同接收装置上传的vf,最终实现全程范围内的速度检测。Step S7, during the movement of the mover, when v G_1 tracks the actual speed and stabilizes, v G_1 is selected as the detection result v f ; when v G_2 is stable, in the overlapping area of v G_1 and v G_2 , v G_2 is selected as the detection result v f ; when v G_3 is stable, in the overlapping area of v G_2 and v G_3 , v G_3 is selected as the detection result v f ; and so on. The receiving device transmits v f to the controller, and the controller selects v f uploaded by different receiving devices, and finally realizes speed detection within the entire range.

进一步的,所述跟踪微分器的离散形式表示为:Furthermore, the discrete form of the tracking differentiator is expressed as:

其中:fhan(x1,x2,u,r,h)为离散最速控制综合函数,其算法公式如下:in: fhan(x 1 ,x 2 ,u,r,h) is the discrete fastest control comprehensive function, and its algorithm formula is as follows:

为了简明的表示fhan(x1,x2,u,r,h),这里引入了d、d0、y、a0、a作为其中间变量;为符号函数,此处x为y或a;u为位置输入信号,x1为位置跟踪信号,属于中间变量,x2为速度输出信号,r为速度因子,h为滤波因子,两者是速度输出信号x2和参数γ1、γ2的自适应函数,r随x2的增大而快速增大,h随x2的增大快速减小;其中γ1和γ2为可调参数,调整它们的大小可以分别改变r和h的变化速率,同时γ1和γ2控制着跟踪微分器通频带的范围,因此需要根据输入信号u的频谱来调整,使得微分器对输入信号u有着良好的微分作用,以及能够滤除输入信号u的高频噪声;A为r的变化范围,T为离散化步长,k为离散时刻(k=0,1,2,3······);所述跟踪微分器采用参数自适应的形式,能够输出全程精准的速度信号,本实施例中T=0.0001s,根据输入信号u的频谱分析,取γ1=10,γ2=40,A=2500。In order to concisely represent fhan(x 1 ,x 2 ,u,r,h), d, d 0 , y, a 0 , a are introduced as intermediate variables; is a sign function, where x is y or a; u is the position input signal, x1 is the position tracking signal, which is an intermediate variable, x2 is the speed output signal, r is the speed factor, and h is the filter factor. The two are adaptive functions of the speed output signal x2 and the parameters γ1 and γ2 . r increases rapidly with the increase of x2 , and h decreases rapidly with the increase of x2 . γ1 and γ2 are adjustable parameters. Adjusting their sizes can change the change rates of r and h respectively. At the same time, γ1 and γ2 control the range of the tracking differentiator passband. Therefore, it is necessary to adjust according to the spectrum of the input signal u so that the differentiator has a good differential effect on the input signal u and can filter out the high-frequency noise of the input signal u. A is the range of r, T is the discretization step size, and k is the discrete time (k=0, 1, 2, 3...); the tracking differentiator adopts the form of parameter adaptation and can output a fully accurate speed signal. In this embodiment, T=0.0001s. According to the spectrum analysis of the input signal u, γ 1 =10, γ 2 =40, A =2500.

基于所需赋值的速度初值vT_1,接收装置对所述跟踪微分器进行赋初值的操作,具体实施如下:Based on the required initial velocity value v T — 1 , the receiving device performs an operation of assigning an initial value to the tracking differentiator, which is specifically implemented as follows:

步骤S40:所述接收装置对所述跟踪微分器的速度信号赋初值,即速度信号x2(k)的初始值,在本实施例中,当第一个传感器输出脉冲6个脉冲后的速度为平均速度为100m/s,x2(0)=vT_1=100m/s;Step S40: the receiving device assigns an initial value to the speed signal of the tracking differentiator, that is, the initial value of the speed signal x 2 (k). In this embodiment, when the speed after the first sensor outputs 6 pulses is an average speed of 100 m/s, x 2 (0) = v T — 1 = 100 m/s;

步骤S41:所述接收装置对所述跟踪微分器的位置输入初始值赋初值,即u的初始值u(0)=0;Step S41: the receiving device assigns an initial value to the position input initial value of the tracking differentiator, that is, the initial value of u is u(0)=0;

步骤S42:所述接收装置对所述中间变量位置跟踪信号x1(k)的初始值为:Step S42: The initial value of the intermediate variable position tracking signal x 1 (k) of the receiving device is:

其中,y=x1(0)-u(0)+hx2(0),在本实施例中,计算得到满足约束条件的x1(0)=-0.2。Wherein, y=x 1 (0)-u(0)+hx 2 (0). In this embodiment, x 1 (0)=-0.2 is calculated to satisfy the constraint condition.

步骤S43,赋初值后启动所述跟踪微分器计算程序,跟踪实际的动子速度,当跟踪微分器跟踪实际速度后即可选择该跟踪微分器计算结果作为速度检测结果输出。Step S43, after assigning initial values, the tracking differentiator calculation program is started to track the actual mover speed. When the tracking differentiator tracks the actual speed, the calculation result of the tracking differentiator can be selected as the speed detection result output.

如图4所示,根据本发明的速度检测方法的过程,计算得到的所述第1个接收传感器检测的动子相对位置曲线。图4中,阶梯状的线段为相对位移信号X1曲线,以0.0001s的周期递增;x1(k)和x1(k)’分别为赋初值和不赋初值的跟踪微分器中间变量位置跟踪信号的曲线。可见对速度赋初值的同时需要给中间变量位置跟踪信号赋初值,让其提前从x1(0)开始跟踪,而非从零开始。As shown in FIG4 , according to the process of the speed detection method of the present invention, the relative position curve of the mover detected by the first receiving sensor is calculated. In FIG4 , the stepped line segment is the relative displacement signal X1 curve, which increases in a period of 0.0001s; x1 (k) and x1 (k)' are the curves of the intermediate variable position tracking signal of the tracking differentiator with and without initialization values, respectively. It can be seen that when the speed is initialized, the intermediate variable position tracking signal needs to be initialized so that it can start tracking from x1 (0) in advance instead of starting from zero.

如图5所示,根据本发明的速度检测方法的过程,根据所述第1个接收传感器输出脉冲计算得到的动子速度曲线。图5中,vref为参考速度曲线,其值等于速度初值vref=100m/s,x2(k)和x2(k)’分别为采用本发明的方法赋初值和传统不赋初值的跟踪微分器输出速度信号的曲线。可见x2(k)’的速度能够迅速跟踪实际速度,有效降低了采用传统不赋初值的跟踪微分器对阶跃信号的跟踪时间。As shown in FIG5 , according to the process of the speed detection method of the present invention, the mover speed curve is calculated based on the output pulse of the first receiving sensor. In FIG5 , v ref is a reference speed curve, whose value is equal to the initial speed value v ref =100 m/s, and x 2 (k) and x 2 (k)' are the curves of the output speed signal of the tracking differentiator with initial value assigned by the method of the present invention and the traditional one without initial value assigned, respectively. It can be seen that the speed of x 2 (k)' can quickly track the actual speed, effectively reducing the tracking time of the step signal of the tracking differentiator with no initial value assigned by the traditional one.

如图6所示,动子移动时,所述第一个接收传感器、所述第二个接收传感器、所述第三个接收传感器依次输出脉冲,图6中为分别采用传统不赋初值跟踪微分器以及跟踪微分器计算结果得到的所述各传感器输出脉冲对应的测速结果。其中vp_1、vp_2、vp_3为传统不赋初值的跟踪微分器计算结果,vG_1、vG_2、vG_3为赋初值的跟踪微分器计算结果,从图中可以看出,不赋初值的跟踪微分器计算结果具有很大的跟踪延迟,为输出全程平滑速度,需要相邻两个传感器输出速度的重叠区域进行速度切换,而在vp_1、vp_2切换区域很小,切换不及时可能导致速度的波动。而赋初值的跟踪微分器算法能够有效减少跟踪微分器对阶跃速度信号的跟踪时间,减小跟踪延迟,从而扩大切换区域,提高了系统的可靠性。As shown in FIG6 , when the mover moves, the first receiving sensor, the second receiving sensor, and the third receiving sensor output pulses in sequence. FIG6 shows the speed measurement results corresponding to the output pulses of each sensor obtained by using the traditional tracking differentiator without initialization and the tracking differentiator calculation results. Among them, v p_1 , v p_2 , and v p_3 are the calculation results of the traditional tracking differentiator without initialization, and v G_1 , v G_2 , and v G_3 are the calculation results of the tracking differentiator with initialization. It can be seen from the figure that the calculation result of the tracking differentiator without initialization has a large tracking delay. In order to output the smooth speed throughout the whole process, the overlapping area of the output speeds of two adjacent sensors is required for speed switching. However, the switching area of v p_1 and v p_2 is very small, and untimely switching may cause speed fluctuations. The tracking differentiator algorithm with initialization can effectively reduce the tracking time of the tracking differentiator for the step speed signal, reduce the tracking delay, thereby expanding the switching area and improving the reliability of the system.

所属技术领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的系统的具体工作过程及有关说明,可以参考前述方法实时例中的对应过程,在此不在赘述。Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working process and related instructions of the system described above can refer to the corresponding process in the aforementioned method real-time example, and will not be repeated here.

至此,已经结合附图所示的优选实施方式描述了本发明,但是,本领域技术人员容易理解的是,本发明的保护范围显然不局限于这些具体实施方式。在不偏离本发明的原理的前提下,本领域技术人员可以对相关技术特征做出等同的更改或替换,这些更改或替换之后的技术方案都将落入本发明的保护范围之内。So far, the present invention has been described in conjunction with the preferred embodiments shown in the accompanying drawings, but it is easy for those skilled in the art to understand that the protection scope of the present invention is obviously not limited to these specific embodiments. Without departing from the principle of the present invention, those skilled in the art can make equivalent changes or substitutions to the relevant technical features, and the technical solutions after these changes or substitutions will fall within the protection scope of the present invention.

Claims (5)

1.一种高速直线电机的位置和速度检测系统的检测方法,其特征在于:1. A detection method for a position and speed detection system of a high-speed linear motor, characterized in that: 所述位置和速度检测系统包括光栅尺、多个激光发生器、接收装置以及控制器;The position and speed detection system includes a grating ruler, a plurality of laser generators, a receiving device and a controller; 所述多个激光发生器,以固定间隔布置于所述高速直线电机上,用于发出激光并保持常亮状态;The plurality of laser generators are arranged at fixed intervals on the high-speed linear motor and are used to emit lasers and keep them in a constant light state; 所述光栅尺,具有固定等宽和等间距的栅格孔,用于遮挡和透过激光,以产生光脉冲信号;The grating ruler has grating holes of fixed equal width and equal spacing, which are used to block and transmit the laser to generate an optical pulse signal; 所述接收装置,包括接收传感器和信号处理器,用于接收多个激光发生器的光脉冲信号并进行计算;所述信号处理器包括光电转换、滤波电路、高速数字处理器和通信模块;所述接收传感器与所述激光发生器平行布置,用于接收光脉冲信号;所述高速数字处理器根据电脉冲信号、所述光栅尺的栅格孔间距计算速度和位置,然后通过所述通信模块将速度和位置信号传递给所述控制器;The receiving device includes a receiving sensor and a signal processor, which are used to receive and calculate the optical pulse signals of multiple laser generators; the signal processor includes a photoelectric conversion, a filtering circuit, a high-speed digital processor and a communication module; the receiving sensor is arranged in parallel with the laser generator, and is used to receive the optical pulse signal; the high-speed digital processor calculates the speed and position according to the electrical pulse signal and the grid hole spacing of the grating ruler, and then transmits the speed and position signals to the controller through the communication module; 控制器,用于接收来自接收装置计算得到的速度和位置信号;A controller, for receiving speed and position signals calculated from a receiving device; 所述位置的检测方法为:所述接收装置根据所述光脉冲信号脉冲数、所述光栅尺的栅格孔间距和所述接收传感器的绝对位置确定所述高速直线电机的动子的实时位置,包括:The position detection method is: the receiving device determines the real-time position of the mover of the high-speed linear motor according to the number of pulses of the optical pulse signal, the grid hole spacing of the grating ruler and the absolute position of the receiving sensor, including: 动子的实时位置=接收传感器绝对位置+信号脉冲数×光栅尺栅格孔间距;The real-time position of the mover = the absolute position of the receiving sensor + the number of signal pulses × the grid hole spacing of the grating ruler; 所述速度的检测方法,包括:The speed detection method comprises: 步骤S1,确定所述光栅尺的栅孔间距为w,相邻两个所述接收传感器间距为l1,所述多个接收传感器按照顺序分别定义为第一个接收传感器、第二个接收传感器,至第m个接收传感器;Step S1, determining that the grating hole spacing of the grating ruler is w, the spacing between two adjacent receiving sensors is l 1 , and the multiple receiving sensors are defined in order as a first receiving sensor, a second receiving sensor, to an mth receiving sensor; 步骤S2,所述接收装置接收各接收传感器输入脉冲信号并进行光电转换;所述接收装置首先根据第一个接收传感器输出脉冲进行速度检测,采用光栅尺栅格间距和相邻两个脉冲上升沿时间求得连续n个脉冲中,每一个脉冲对应的速度v1_1、v1_2 … v1_nStep S2, the receiving device receives the input pulse signals of each receiving sensor and performs photoelectric conversion; the receiving device first performs speed detection according to the output pulse of the first receiving sensor, and uses the grating scale grid spacing and the rising edge time of two adjacent pulses to obtain the speed v 1_1 , v 1_2 ... v 1_n corresponding to each pulse in the continuous n pulses; 步骤S3,求得所述第一个接收传感器连续输出的n个脉冲对应的平均速度vT_1,其中,vT_1=(v1_1+v1_2+… +v1_n)/n;Step S3, obtaining an average speed v T — 1 corresponding to n pulses continuously output by the first receiving sensor, wherein v T — 1 =(v 1 — 1 +v 1 — 2 +… +v 1 — n )/n; 步骤S4,将所述第一个接收传感器输出脉冲对应的平均速度vT_1作为跟踪微分器的初值,对所述跟踪微分器进行赋初值的操作;赋初值完成后,结合所述光栅尺栅格间距w以及第一个接收传感器输出脉冲数量N1,根据相对位移公式w×N1,得到所述第一个接收传感器检测到的动子板的相对位移X1作为所述跟踪微分器的输入,并启动所述跟踪微分器计算程序,得到所述第一个接收传感器输出脉冲对应的跟踪微分器计算的速度vG_1Step S4, taking the average speed v T_1 corresponding to the output pulse of the first receiving sensor as the initial value of the tracking differentiator, and performing the initial value assignment operation on the tracking differentiator; after the initial value assignment is completed, combining the grating scale grid spacing w and the number of output pulses N 1 of the first receiving sensor, according to the relative displacement formula w×N 1 , the relative displacement X 1 of the mover plate detected by the first receiving sensor is obtained as the input of the tracking differentiator, and the tracking differentiator calculation program is started to obtain the speed v G_1 calculated by the tracking differentiator corresponding to the output pulse of the first receiving sensor; 步骤S5,当所述第二个接收传感器连续输出n个脉冲后,根据上述步骤S3的方法,求得所述第二个接收传感器连续输出n个脉冲对应的平均速度vT_2;当第三个接收传感器输出脉冲后,根据上述步骤S3的方法,求得所述第三个接收传感器输出n个脉冲对应的平均速度vT_3;以此类推,当所述第m个接收传感器输出n个脉冲后,求得所述第m个传感器连续输出n个脉冲对应的平均速度vT_mStep S5, when the second receiving sensor continuously outputs n pulses, according to the method of the above step S3, the average speed v T_2 corresponding to the n pulses continuously output by the second receiving sensor is obtained; when the third receiving sensor outputs a pulse, according to the method of the above step S3, the average speed v T_3 corresponding to the n pulses continuously output by the third receiving sensor is obtained; and so on, when the m-th receiving sensor outputs n pulses, the average speed v T_m corresponding to the n pulses continuously output by the m-th sensor is obtained; 步骤S6,当所述第二个接收传感器连续输出n个脉冲后,根据上述步骤S4的方法,求得所述第二个传感器输出脉冲采用跟踪微分器计算的速度vG_2;当所述第三个接收传感器输出n个脉冲后,根据上述步骤S4的方法,求得所述第三个接收传感器输出脉冲采用跟踪微分器计算的速度vG_3,以此类推,当所述第m个传感器输出n个脉冲后,根据上述步骤S4的方法,求得所述第m个接收传感器输出脉冲采用跟踪微分器计算的速度vG_mStep S6, when the second receiving sensor continuously outputs n pulses, according to the method of step S4, the speed v G_2 of the second sensor output pulse calculated by the tracking differentiator is obtained; when the third receiving sensor outputs n pulses, according to the method of step S4, the speed v G_3 of the third receiving sensor output pulse calculated by the tracking differentiator is obtained; and so on, when the m-th sensor outputs n pulses, according to the method of step S4, the speed v G_m of the m-th receiving sensor output pulse calculated by the tracking differentiator is obtained; 步骤S7,动子在运动过程中,当vG_1跟踪上实际速度且稳定后,选择vG_1作为检测结果vf;当vG_2稳定后,在vG_1和vG_2重叠的区域内,选择vG_2作为检测结果vf;当vG_3稳定后,在vG_2和vG_3重叠的区域内,选择vG_3作为检测结果vf;以此类推,接收装置将vf传递到控制器;Step S7, during the movement of the mover, when v G_1 tracks the actual speed and becomes stable, v G_1 is selected as the detection result v f ; when v G_2 becomes stable, in the overlapping area of v G_1 and v G_2 , v G_2 is selected as the detection result v f ; when v G_3 becomes stable, in the overlapping area of v G_2 and v G_3 , v G_3 is selected as the detection result v f ; and so on, the receiving device transmits v f to the controller; 步骤S8,控制器选择不同接收装置上传的vf,最终实现全程范围内的速度检测。Step S8: The controller selects v f uploaded by different receiving devices, and finally realizes speed detection in the whole range. 2.根据权利要求1所述的检测方法,其特征在于,所述跟踪微分器的离散形式表示为:2. The detection method according to claim 1, characterized in that the discrete form of the tracking differentiator is expressed as: , 其中:;fhan(x1,x2,u,r,h)为离散最速控制综合函数,其算法公式如下:in: ; fhan(x 1 ,x 2 ,u,r,h) is the discrete fastest control comprehensive function, and its algorithm formula is as follows: , 为了简明的表示fhan(x1,x2,u,r,h),这里引入了d、d0、y、a0、a作为其中间变量;为符号函数,此处x为y或a; u为位置输入信号,x1为位置跟踪信号,属于中间变量,x2为速度输出信号,r为速度因子,h为滤波因子,两者是速度输出信号x2和参数γ1、γ2的自适应函数,r随x2的增大而快速增大,h随x2的增大快速减小;其中γ1和γ2为可调参数,调整它们的大小可以分别改变r和h的变化速率,同时γ1和γ2控制着跟踪微分器通频带的范围,因此需要根据输入信号u的频谱来调整,使得微分器对输入信号u有着良好的微分作用,以及能够滤除输入信号u的高频噪声;A为r的变化范围,T为离散化步长,k为离散时刻,其中k=0,1,2,3······;所述跟踪微分器采用参数自适应的形式,能够输出全程精准的速度信号。In order to concisely represent fhan(x 1 ,x 2 ,u,r,h), d, d 0 , y, a 0 , a are introduced as intermediate variables; is a sign function, where x is y or a; u is the position input signal, x1 is the position tracking signal, which is an intermediate variable, x2 is the speed output signal, r is the speed factor, and h is the filter factor. The two are adaptive functions of the speed output signal x2 and parameters γ1 and γ2 . r increases rapidly with the increase of x2 , and h decreases rapidly with the increase of x2 . γ1 and γ2 are adjustable parameters. Adjusting their sizes can change the change rates of r and h respectively. At the same time, γ1 and γ2 control the range of the tracking differentiator passband. Therefore, they need to be adjusted according to the frequency spectrum of the input signal u so that the differentiator has a good differential effect on the input signal u and can filter out the high-frequency noise of the input signal u. A is the range of r, T is the discretization step size, and k is the discrete moment, where k=0,1,2,3······; the tracking differentiator adopts the form of parameter adaptation and can output a fully accurate speed signal. 3.根据权利要求2所述的检测方法,其特征在于,所述步骤S4中的所述跟踪微分器赋初值的操作包括:3. The detection method according to claim 2, characterized in that the operation of assigning an initial value to the tracking differentiator in step S4 comprises: 步骤S40:所述接收装置计算得到的所述第一个接收传感器连续输出n个脉冲对应的平均速度vT_1作为跟踪微分器速度信号初值v0,即所述跟踪微分器速度信号x2(k)的初始值为x2(0)=vT_1Step S40: the average speed v T — 1 corresponding to the n pulses continuously output by the first receiving sensor calculated by the receiving device is used as the initial value v 0 of the tracking differentiator speed signal, that is, the initial value of the tracking differentiator speed signal x 2 (k) is x 2 (0)=v T — 1 ; 步骤S41:所述接收装置对所述跟踪微分器的位置输入初始值赋初值,即u的初始值u(0)为0;Step S41: the receiving device assigns an initial value to the position input initial value of the tracking differentiator, that is, the initial value u(0) of u is 0; 步骤S42:所述接收装置对所述跟踪微分器的位置跟踪信号赋初值,即中间变量位置跟踪信号x1(k) 的初始值为:Step S42: The receiving device assigns an initial value to the position tracking signal of the tracking differentiator, that is, the initial value of the intermediate variable position tracking signal x 1 (k) is: ; 其中,;计算出上述三种情况的x1(0)的值,对应各自的条件约束,选择满足约束的值。in, ; Calculate the values of x 1 (0) for the above three cases, correspond to the respective conditional constraints, and select the value that satisfies the constraints. 4.根据权利要求1所述的检测方法,其特征在于:各接收传感器输出的脉冲信号为独立处理并运算,以避免接收传感器绝对位置的误差造成的速度波动。4. The detection method according to claim 1 is characterized in that the pulse signals output by each receiving sensor are processed and calculated independently to avoid speed fluctuations caused by errors in the absolute position of the receiving sensor. 5.根据权利要求1所述的检测方法,其特征在于:所述光栅尺的长度大于相邻的接收传感器的间距以保证检测结果是连续的。5. The detection method according to claim 1 is characterized in that the length of the grating ruler is greater than the spacing between adjacent receiving sensors to ensure that the detection result is continuous.
CN202210655392.XA 2022-06-10 2022-06-10 Position and speed detection system and method for high-speed linear motor Active CN115060164B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210655392.XA CN115060164B (en) 2022-06-10 2022-06-10 Position and speed detection system and method for high-speed linear motor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210655392.XA CN115060164B (en) 2022-06-10 2022-06-10 Position and speed detection system and method for high-speed linear motor

Publications (2)

Publication Number Publication Date
CN115060164A CN115060164A (en) 2022-09-16
CN115060164B true CN115060164B (en) 2024-07-30

Family

ID=83199869

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210655392.XA Active CN115060164B (en) 2022-06-10 2022-06-10 Position and speed detection system and method for high-speed linear motor

Country Status (1)

Country Link
CN (1) CN115060164B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116298365A (en) * 2023-04-12 2023-06-23 中国科学院电工研究所 Hybrid positioning and speed measuring system and method for high-speed linear motor

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114545022A (en) * 2022-01-28 2022-05-27 中国科学院电工研究所 High-speed linear motor positioning and speed measuring real-time simulation method and system

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3358080A (en) * 1964-04-20 1967-12-12 Ampex Control system for wideband recording and reproducing systems
EP0074767B1 (en) * 1981-09-07 1988-01-27 Hugh-Peter Granville Kelly Improvements in or relating to linear motor and control circuitry therefor
IL136016A (en) * 2000-05-08 2005-11-20 Yaskawa Eshed Technology Ltd High sensor resolution position sensor device and method
CN102868336B (en) * 2012-09-12 2015-06-10 江苏大学 Three-motor synchronous control system based on fuzzy second-order active disturbance rejection controller
CN106026832A (en) * 2016-06-28 2016-10-12 浙江理工大学 Improved ADRC control algorithm-based permanent magnet synchronous linear motor control method
CN205754098U (en) * 2016-06-28 2016-11-30 浙江理工大学 Permanent magnet linear motor control system based on improved ADRC algorithm
CN113872481B (en) * 2021-10-20 2024-08-16 中国科学院电工研究所 Method for measuring speed of long primary linear induction motor
CN216348386U (en) * 2021-12-07 2022-04-19 上海市计量测试技术研究院 Non-contact piston displacement measuring device based on PSD position sensor

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114545022A (en) * 2022-01-28 2022-05-27 中国科学院电工研究所 High-speed linear motor positioning and speed measuring real-time simulation method and system

Also Published As

Publication number Publication date
CN115060164A (en) 2022-09-16

Similar Documents

Publication Publication Date Title
CN109240156B (en) Control system and method for laser radar galvanometer servo motor
CN108957470B (en) Time-of-flight ranging sensor and ranging method thereof
US10162912B2 (en) Friction identification method and friction identification device
CN115060164B (en) Position and speed detection system and method for high-speed linear motor
KR102183548B1 (en) Motor drive device
CN104101369A (en) Position detection apparatus
CN110815219A (en) Trajectory tracking method and device, electronic equipment and storage medium
JP5056853B2 (en) Speed detection method and motor control apparatus using the same
CN114545022B (en) Real-time simulation method and system for positioning and speed measurement of high-speed linear motor
CN107790873A (en) Laser control apparatus
CN104571142A (en) An Atmospheric Parameter Tracking and Measurement System
CN112129228A (en) Method and system for accurately measuring length dimension of high-temperature plate blank
US8660815B2 (en) Methods and apparatus for filtering noise in a three-dimensional position measurement system
CN118225139A (en) Method and related equipment for detecting rotor position information of multiple reading heads
US10216891B2 (en) Method and apparatus for supporting design improvement work of mechanical apparatus
CN116298365A (en) Hybrid positioning and speed measuring system and method for high-speed linear motor
CN110501899A (en) A PID follow-up control method based on genetic algorithm parameter self-tuning
CN112129217A (en) Accurate positioning system and method for slab edge
KR102684566B1 (en) FMCW lidar system with low power consumption and method of operation thereof
CN112622989A (en) Train positioning device and method based on vibration signals
RU2518685C1 (en) Method of controlling inertial antenna drive
KR101315640B1 (en) Anemometer and measuring method of wind velocity using ultrasonic
SU1262453A2 (en) Program device for controlling water-development seal
CN118977001A (en) A vibration suppression acceleration and deceleration motion control method for laser engraving machine
EP2112464A1 (en) Tracking type laser interferometer

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