Control method and related device for multiple mover direct drive transport system

Abstract

The present invention provides a control method and related apparatus for a multiple mover direct drive transport system. The control method includes the steps of: detecting the real-time position of the moving part in the feedback segment in real time; judging in real time whether the moving part enters the boundary area between the feedback segment and the transition segment; setting the cooperative control mode of each stator winding within the transition segment range according to the real-time position of the moving part; judging in real time whether the moving part enters the boundary area between the transition segment and the feedback segment, and feeding back the real-time position of the moving part through the displacement sensor of the feedback segment if the judgement is affirmative. Compared with the prior art, the present invention has better control effect, lower cost and lower installation requirements.

Description

[Technical field]

[0001] The present invention relates to the technical field of transport system control, and more particularly to a control method and related device for a multiple mover direct drive transport system. [Background technology]

[0002] Multi-mover direct drive conveying systems are used in unmanned production lines, flow line transportation, etc., and conventional multi-mover direct drive conveying systems are composed of a stator unit and a plurality of mover units that move relative to the stator unit. The stator unit includes a stator body and a plurality of stator windings attached to the stator body and arranged sequentially along the extension direction of the stator body. Each mover unit is composed of a mover that is slidable relative to the stator body and magnetic steel fixed to the mover.

[0003] In the prior art multiple mover direct drive transport system, the stator body of the stator unit is divided into a straight section, a circular section, or a combination of a straight section and a circular section. Displacement sensors (encoder arrays) are arranged within the ranges of different sections to recognize the position of each mover. For example, in the multiple mover direct drive transport system, displacement sensors (encoder arrays) are arranged in the straight section and the circular section to recognize the position of each mover unit, thereby achieving accurate control of each mover unit. Summary of the Invention [Problem to be solved by the invention]

[0004] However, in the prior art multi-mover direct drive conveying system, the displacement sensor needs to be installed at every stator winding position corresponding to the stator body, which makes the installation complicated; and in application, it is not necessary to accurately control the position of the mover unit in the range of all stages, and some stations corresponding to the stator unit do not need to position the mover unit, but only perform simple transitions, and do not need to be accurately controlled by the displacement sensor, which makes the cost of the control method of the multi-mover direct drive conveying system high.

[0005] Therefore, in order to solve the above problems, it is necessary to provide a new control method and related device for a multiple mover direct drive transport system. [Means for solving the problem]

[0006] The control method and related device for a multi-mover direct drive transport system provided in the embodiments of the present invention aim to solve the problems of high cost and high installation requirements of the prior art.

[0007] As a first aspect, an embodiment of the present invention provides a control method for a multiple mover direct drive transport system, the multiple mover direct drive transport system including a stator unit and a multiple mover units moving relative to the stator unit, the stator unit including a stator body, a rail attached to the stator body, and a multiple stator winding attached to the stator body and sequentially arranged along an extension direction of the stator body, each mover unit including a mover forming a sliding connection with the rail and movable relative to the stator body, and a magnetic steel fixed to the mover, the stator body including feedback segments and transition segments alternating with each other, and a multiple displacement sensor attached to the feedback segment, each of the displacement sensors being provided corresponding to one of the stator windings, the control method including: Step S1: detecting a real-time position of the mover unit moving on the feedback segment in real time; Step S2: determining in real time whether the mover unit has entered a boundary region between the feedback segment and the transition segment, and if determined to be positive, calculating an electrical angle by which the mover unit moves in the transition segment using a preset algorithm, determining a real-time position of the mover unit according to the electrical angle, and setting a cooperative control mode for each stator winding within the transition segment range according to the real-time position of the mover unit; Step S3 includes a step of determining in real time whether the movable unit has entered a boundary area between the transition segment and the feedback segment, and if a positive determination is made, feeding back in real time the real-time position of the movable unit by the displacement sensor of the feedback segment.

[0008] More preferably, in step S2, when the feedback based on the last stator winding in the feedback segment along the movement direction of the movable unit reaches a first specific value, it is determined that the movable unit has entered a region at the boundary between the feedback segment and the transition segment.

[0009] More preferably, in step S2, calculating the electrical angle through which the mover unit moves in the transition segment using a preset algorithm includes: a sub-step of calculating, using a preset sensorless algorithm, a back electromotive force generated in the stator winding corresponding to when the mover unit enters the transition segment and moves through the transition segment; and calculating a real-time electrical angle based on the back electromotive force using a preset electrical angle extraction algorithm.

[0010] More preferably, the sensorless algorithm is any one of a sliding mode algorithm, a model reference adaptive algorithm, a state observer algorithm, a Kalman filter algorithm, and a Rumberger observation algorithm.

[0011] More preferably, the electrical angle extraction algorithm is one of a phase-locked loop algorithm and a direct calculation method.

[0012] More preferably, in step S2, the cooperative control mode is any one of master-slave control and master-slave control mode switching.

[0013] More preferably, in step S3, when the feedback of the first stator winding in the feedback segment adjacent to the last stator winding in the transition segment along the movement direction of the movable unit reaches a second specific value, it is determined that the movable unit has entered a region at the boundary between the transition segment and the feedback segment.

[0014] Preferably, each said displacement sensor is a set of encoder arrays.

[0015] As a second aspect, an embodiment of the present invention further provides a computer device, the computer device including a memory, a processor, and a computer program stored in the memory and executable by the processor, and when the processor executes the computer program, steps in the control method for the multiple mover direct drive transport system in the above embodiment are realized.

[0016] As a third aspect, an embodiment of the present invention further provides a computer-readable storage medium, wherein a computer program is stored in the computer-readable storage medium, and when the computer program is executed by a processor, steps in the control method for the multiple mover direct-drive transport system in the above embodiment are realized. Effect of the Invention

[0017] Compared with the prior art, the control method and related device of the multiple mover direct drive conveying system of the present invention installs a stator body in alternating feedback segments and transition segments, installs multiple displacement sensors in the feedback segments, each of the displacement sensors is provided corresponding to one of the stator windings, and determines in real time that the mover unit moves in the feedback segment or the transition segment, thereby providing accurate position feedback and control through the displacement sensors in the feedback segment, and uses the mover unit in the transition segment to generate a back electromotive force in the corresponding stator winding to calculate the electrical angle, thereby determining the real-time position of the mover unit, thereby achieving an overall control effect. The control method and related device omit the installation of the displacement sensors in the transition segments, which effectively reduces the installation and use of the displacement sensors, reduces the installation requirements, and reduces the costs. [Brief description of the drawings]

[0018] In order to more clearly describe the technical solutions in the embodiments of the present invention, the following will briefly describe the drawings that need to be used in the description of the embodiments. Obviously, the drawings in the following description are only some embodiments of the present invention, and those skilled in the art can further derive other drawings based on these drawings without any creative work. [Figure 1] 1 is a flowchart of a control method for a multiple mover direct drive transport system according to an embodiment of the present invention. [Diagram 2]1 is a schematic perspective view of a portion of a multiple mover direct drive transport system according to an embodiment of the present invention; [Diagram 3] 1 is a schematic diagram of an embodiment of a control method for a multiple mover direct drive transport system according to the present invention; [Figure 4] FIG. 2 is a schematic diagram of a computer device provided by an embodiment of the present invention. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0019] Hereinafter, the technical solutions in the embodiments of the present invention will be described clearly and completely with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only some of the embodiments of the present invention, and not all of the embodiments. All other embodiments obtained by those skilled in the art based on the embodiments of the present invention without creative labor are all within the scope of protection of the present invention.

[0020] 1 and 2, an embodiment of the present invention provides a control method for a multiple mover direct drive conveyance system for performing position control on a multiple mover direct drive conveyance system 100. As shown in Fig. 2, the multiple mover direct drive conveyance system 100 includes a stator unit 1, a plurality of mover units 2 that move relative to the stator unit 1, a driver 3 connected to each of the stator units 1, and a controller 4 connected to all of the drivers 3.

[0021] The stator unit 1 includes a stator body 11, a rail 12 attached to the stator body 11, and a plurality of stator windings 13 (also referred to as winding coils) attached to the stator body 11 and arranged sequentially along the extension direction of the stator body 11. The stator body 11 includes feedback segments (not numbered) and transition segments (not numbered) that alternate with each other, and a plurality of displacement sensors (not numbered) attached to the feedback segments, and each of the displacement sensors is provided corresponding to one of the stator windings 13.

[0022] In this embodiment, each of the displacement sensors is a set of encoder arrays.

[0023] The feedback segments and transition segments of the stator body 11 may both be multiple in number and are arranged alternately with each other.

[0024] Each mover unit 2 includes a mover 21 that forms a sliding connection with the rail 12 and is movable relative to the stator body 11, and a magnetic steel piece 22 that is fixed to the mover 21. When electricity is applied to the stator winding 13, an electromagnetic field is generated with the magnetic steel piece 22, thereby driving the magnetic steel piece 22 to move and move the mover 21.

[0025] The control method includes the following steps S1 to S3. In step S1, a real-time position where the mover unit 2 moves on the feedback segment is detected in real time.

[0026] When the mover unit 2 moves within the feedback segment range, a corresponding displacement sensor provides accurate position control.

[0027] Step S2: determining in real time whether the mover unit 2 has entered a boundary region between the feedback segment and the transition segment; If the determination is negative, it is determined that the mover unit 2 is still moving within the feedback segment range, and the position is accurately detected in real time by displacement sensors provided in the feedback segment and corresponding to each stator winding 13, and fed back to the controller 4. The controller 4 generates control information according to a preset control policy based on the feedback information and transmits it to the driver 3. The driver 3 generates a driving force in the corresponding stator winding 13, driving the mover unit 2 to continue moving. Also, it is determined in real time whether the mover unit 2 continues to enter the boundary area between the feedback segment and the transition segment.

[0028] If the determination is affirmative, a preset algorithm is used to calculate the electrical angle by which the mover unit 2 moves in the transition segment, and the electrical angle is used to determine the real-time position of the mover unit 2. A cooperative control mode for each stator winding 13 within the transition segment range is set based on the real-time position of the mover unit 2, thereby realizing the movement and position estimation of the mover unit 2 within the transition segment range.

[0029] The cooperative control mode is one of master-slave control and master-slave control mode switching. In this embodiment, the cooperative control mode is preferably master-slave control mode switching.

[0030] In an actual production line, the transition segments generally correspond to station sections where the position feedback requirements are not high or where no position feedback is required, whereas the feedback segments are station sections where the feedback position is precisely controlled.

[0031] When the mover unit 2 enters the transition segment region and moves, the mover unit 2 maintains the initial speed from its previous movement, and the initial speed drives the magnetic steel 22 in the mover unit 2 to move above the corresponding stator winding 13, and the stator winding 13 induces a back electromotive force.

[0032] Specifically, the method for determining whether the mover unit 2 has entered the boundary region between the feedback segment and the transition segment is as follows: That is, when the feedback by the last stator winding 13 in the feedback segment along the moving direction of the mover unit 2 reaches a first specific value a, it is determined that the mover unit 2 has entered the boundary region between the feedback segment and the transition segment (i.e., the mover unit 2 has entered the transition segment), and then the mover unit 2 moves within the region of the transition segment.

[0033] Here, calculating the electrical angle through which the mover unit 2 moves in the transition segment using a preset algorithm specifically includes the following sub-steps S21 to S22. In step S21, a preset sensorless algorithm is used to calculate a corresponding back electromotive force generated in the stator winding 13 when the mover unit 2 enters the transition segment and moves in the transition segment.

[0034] Here, the sensorless algorithm is any one of a sliding mode algorithm, a model reference adaptive algorithm, a state observer algorithm, a Kalman filter algorithm, and a Rumberger observation algorithm. In the present embodiment, the sensorless algorithm is preferably a sliding mode algorithm.

[0035] In step S22, a real-time electrical angle is calculated based on the back electromotive force using a preset electrical angle extraction algorithm.

[0036] The real-time electrical angle can be used to determine the real-time position of the mover unit 2 .

[0037] A cooperative control mode of each stator winding 13 within the transition segment range is set according to the real-time position of the mover unit 2 to realize the movement and position estimation of the mover unit 2 within the transition segment range.

[0038] Here, the electrical angle extraction algorithm is one of a phase-locked loop algorithm and a direct calculation method. In this embodiment, the electrical angle extraction algorithm is preferably a phase-locked loop algorithm.

[0039] In step S3, it is determined in real time whether the mover unit 2 has entered the boundary region between the transition segment and the feedback segment, and if the determination is affirmative, the real-time position of the mover unit is fed back in real time by the displacement sensor of the feedback segment. If the determination is negative, steps S21 and S22 are continued to be executed, and it is determined in real time whether the mover unit 2 has entered the boundary region between the transition segment and the feedback segment.

[0040] In this step, specifically, when the feedback based on the first stator winding 13 adjacent to the last stator winding 13 in the transition segment in the feedback segment along the moving direction of the mover unit 2 reaches a second specific value b, it is determined that the mover unit 2 has entered the boundary region between the transition segment and the feedback segment (i.e., the mover unit 2 has entered the feedback segment), and then moves in the feedback segment. When moving in the feedback segment, it moves according to the original preset precise control policy. The precise control policy of feeding back a specific position by a displacement sensor when moving in the feedback segment is a conventional technology and will not be repeated here.

[0041] Furthermore, the first specific value and the second specific value can be set according to the needs of actual situations, and the shape and size thereof are not limited here, which can be easily conceived and understood by those skilled in the art.

[0042] As shown in FIG. 3, a specific example is provided to further illustrate the present invention.

[0043] Take the stator body 11 as an example, which has a circular racetrack, which is made up of two straight sections and two arc sections. The straight sections are the feedback segments of the present invention, i.e., the straight sections are equipped with position sensors, and the arc sections are the transition segments of the present invention, i.e., no position sensors are equipped. Each straight section is made up of 1 to n straight stator windings closely arranged, and each arc section is made up of 1 to m arc stator windings closely arranged.

[0044] When the movable unit moves in the positive operating direction, if it is detected that the position feedback of the nth stator of the first linear stage tangent to the first arc stage has reached a first specific value a, it is determined that the movable unit has entered the first arc stage area.

[0045] When the mover unit enters the first arc stage, it still maintains the initial velocity from the previous movement, and the initial velocity drives the magnetic steel in the mover unit to move above the corresponding stator winding, which induces a back electromotive force.

[0046] The controller can estimate the back electromotive force using a preset algorithm (e.g., a sliding mode algorithm), calculate real-time electrical angle information using a preset algorithm (e.g., a phase-locked loop algorithm), and determine the real-time position of the mover unit based on the real-time electrical angle information.

[0047] The real-time position of the movable unit is estimated in real time, and cooperative control between different stator units in the first arc-stage region is performed, such as master-slave control mode switching, so as to calculate the specific real-time position of the movable unit in the first arc-stage region.

[0048] Similarly, when the position feedback of the first stator winding of the second linear stage that is in contact with (adjacent to) the end of the first circular arc stage reaches a second specific value b, it is determined that the mover unit has entered the control region of the second linear stage. The mover unit performs movement control based on accurate position control within the second linear stage region.

[0049] Compared with the prior art, the control method of the multiple mover direct drive conveying system of the present invention installs the stator body in alternating feedback segments and transition segments, installs multiple displacement sensors in the feedback segments, each of the displacement sensors is provided corresponding to one of the stator windings, determines whether the mover unit moves in the feedback segment or the transition segment, and uses the displacement sensors in the feedback segment to perform accurate position feedback and control, while the mover unit in the transition segment generates a back electromotive force in the corresponding stator winding to calculate the electrical angle to determine the real-time position of the mover unit, thereby achieving an overall control effect. The control method and related device omit the installation of the displacement sensors in the transition segments, which effectively reduces the installation and use of the displacement sensors, reduces the installation requirements, and reduces the cost.

[0050] An embodiment of the present invention further provides a computer device, as shown in Figure 4, which is a schematic diagram of a computer device provided by an embodiment of the present invention. The computer device 400 includes a processor 401, a memory 402, and a computer program stored in the memory 402 and executable by the processor 401.

[0051] The computer device 400 corresponds to the controller in the multiple mover direct drive transportation system according to the above embodiment of the present invention.

[0052] The processor 401 calls a computer program stored in the memory 402, and executes the computer program to realize the steps of the control method for the multiple mover direct drive transport system in the above embodiment.

[0053] The computer device 400 provided in the embodiment of the present invention can realize the steps in the control method for the multiple-mover direct-drive conveying system in the above embodiment, and can achieve similar technical effects. Therefore, it is sufficient to refer to the description in the above embodiment, and the description will not be repeated here.

[0054] An embodiment of the present invention further provides a computer-readable storage medium, in which a computer program is stored, and the computer program is executed by a processor to realize each process and step in the control method for a multiple-mover direct-drive conveyance system provided by the embodiment of the present invention, and can achieve similar technical effects, which will not be repeated here in order to avoid duplication.

[0055] Those skilled in the art will understand that the implementation of all or part of the steps in the above-mentioned embodiments of the method can be completed by instructing relevant hardware through a computer program, and the program can be stored in a computer-readable storage medium, and when the program is executed, the steps in the above-mentioned embodiments of the method can be included. Among them, the storage medium can be a magnetic disk, an optical disk, a read-only memory (ROM), a random access memory (RAM), etc.

[0056] It should be noted that, as used herein, the terms "comprise," "comprises," or any other variation thereof, are intended to include a non-exclusive inclusion, whereby a process, method, article, or apparatus of a set of elements not only includes those elements, but also includes other elements not expressly listed or includes elements inherent in such process, method, article, or apparatus. Absent more limitations, an element qualified by the phrase "comprises a..." does not exclude the presence of additional identical elements in the process, method, article, or apparatus that includes the element.

[0057] From the above description of the embodiments, those skilled in the art can understand that the methods of the above embodiments can be realized in the form of software and a necessary general-purpose hardware platform, and of course, hardware may also be used, but in many cases the former is a more preferred embodiment. Based on this understanding, the technical solution of the present invention can be essentially or in the form of a software product, and the computer software product is stored in a storage medium (e.g., ROM / RAM, magnetic disk, optical disk) and contains multiple commands to make a terminal (which may be a mobile phone, a computer, a server, an air conditioner, or a network device, etc.) execute the methods described in each embodiment of the present invention.

[0058] The above description is merely an embodiment of the present invention, and does not limit the patent scope of the present invention. Any equivalent structure or equivalent flow transformation made by utilizing the contents of the specification and drawings of the present invention, or any direct or indirect application in other related technical fields, is also included in the patent protection scope of the present invention.

Claims

1. A control method for a multiple mover direct drive conveyance system, comprising: The multiple mover direct drive transport system includes a stator unit and a plurality of mover units moving relative to the stator unit, the stator unit includes a stator body, a rail attached to the stator body, and a plurality of stator windings attached to the stator body and sequentially arranged along an extension direction of the stator body, each mover unit includes a mover that forms a sliding connection with the rail and is movable relative to the stator body, and a magnetic steel that is fixed to the mover, the stator body includes feedback segments and transition segments that alternate with each other, and a plurality of displacement sensors attached to the feedback segments, each of the displacement sensors is provided corresponding to the stator winding, and the control method includes: Step S1: detecting in real time a real-time position where the mover unit moves on the feedback segment; Step S2: determining in real time whether the mover unit has entered a boundary region between the feedback segment and the transition segment, and if determined to be positive, calculating an electrical angle by which the mover unit moves in the transition segment using a preset algorithm, determining a real-time position of the mover unit according to the electrical angle, and setting a cooperative control mode for each stator winding within the transition segment range based on the real-time position of the mover unit; and step S3: determining in real time whether the movable unit has entered a boundary area between the transition segment and the feedback segment, and if a positive determination is made, feeding back the real-time position of the movable unit by the displacement sensor in the feedback segment.

2. 2. The method for controlling a multiple mover direct drive transportation system according to claim 1, wherein in step S2, when a position feedback value of the last stator winding in the feedback segment along the moving direction of the mover unit reaches a first specific value, it is determined that the mover unit has entered a boundary region between the feedback segment and the transition segment.

3. In step S2, calculating the electrical angle by which the mover unit moves in the transition segment using a preset algorithm includes, specifically, a sub-step of calculating, using a preset sensorless algorithm, a back electromotive force generated in the stator winding corresponding to when the mover unit enters the transition segment and moves through the transition segment; 2. The method for controlling a multiple mover direct drive transportation system according to claim 1, further comprising the sub-step of: calculating a real-time electrical angle based on the back electromotive force by using a preset electrical angle extraction algorithm.

4. 4. The method for controlling a multiple mover direct drive conveyance system according to claim 3, wherein the sensorless algorithm is any one of a sliding mode algorithm, a model reference adaptive algorithm, a state observer algorithm, a Kalman filter algorithm, and a Rumberger observation algorithm.

5. 4. The method for controlling a multiple mover direct drive transportation system according to claim 3, wherein the electrical angle extraction algorithm is one of a phase-locked loop algorithm and a direct calculation method.

6. 2. The method for controlling a multiple mover direct drive transportation system according to claim 1, wherein in step S2, the cooperative control mode is either one of master-slave control and master-slave control mode switching.

7. 2. The control method for a multiple mover direct drive transportation system according to claim 1, wherein in step S3, when a position feedback value of a first stator winding in the feedback segment adjacent to a last stator winding in the transition segment along the moving direction of the mover unit reaches a second specific value, it is determined that the mover unit has entered a boundary area between the transition segment and the feedback segment.

8. 2. The method for controlling a multiple mover direct drive transportation system according to claim 1, wherein each of said displacement sensors is a set of encoder arrays.

9. 1. A computing device comprising:

9. A computer device comprising: a memory; a processor; and a computer program stored in the memory and executable by the processor, wherein the steps of the control method for a multiple mover direct drive transport system according to claim 1 are performed by the processor executing the computer program.

10. 1. A computer-readable storage medium, comprising: A computer-readable storage medium, characterized in that a computer program is stored in the computer-readable storage medium, and the computer program is executed by a processor to perform steps in the control method for a multiple mover direct drive transport system described in any one of claims 1 to 8.

Images