Method and device for controlling direct drive transport system
The control method for direct drive conveyance systems employs incremental position feedback devices with zero point marks to enhance positioning accuracy and reduce costs, addressing the inefficiencies of existing systems by ensuring accurate and cost-effective feedback.
Patent Information
- Application Number
- JP2022560356
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Priority Date
- 2022-06-30
- Filing Date
- 2022-09-09
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2042-09-09
AI Technical Summary
Existing direct drive conveyance systems face challenges in balancing the cost of feedback units with positioning accuracy, as absolute grid rulers or magnetic grid rulers are expensive while linear holes and grid rulers offer low accuracy, leading to poor positioning and inefficient feedback effects.
A control method for direct drive conveyance systems using incremental position feedback devices with preset zero point marks and a controller to facilitate zero return and accurate position detection, incorporating incremental grid rulers and read heads for real-time feedback, reducing costs while maintaining high accuracy.
The method achieves high positioning accuracy and effective cost reduction by utilizing incremental position feedback devices with zero point marks, enabling precise position feedback and efficient system operation.
Smart Images

Figure 0007590447000001 
Figure 0007590447000002 
Figure 0007590447000003
Abstract
Description
[Technical field]
[0001] The present invention relates to the field of control technology for transport systems, and more particularly to a control method and related device for a direct drive transport system. [Background technology]
[0002] With the development of the technology of the direct drive conveying system, the control method of the direct drive conveying system is widely applied in various direct drive motors.
[0003] The direct drive conveying system of the prior art is composed of a multi-stage stator and a multi-stage movable element, and the stator drives the movable element to move, thereby achieving the effect of linear driving. In the prior art direct drive conveying system, the absolute position feedback scheme is often adopted to realize the feedback function of the moving position. Here, the feedback unit often adopts an absolute lattice ruler or a magnetic lattice ruler, a linear hole and a lattice ruler. Summary of the Invention [Problem to be solved by the invention]
[0004] However, in the prior art, the absolute lattice ruler or magnetic lattice ruler has high positioning accuracy but is relatively expensive. The linear hole and lattice ruler has low cost but low position detection accuracy. In such cases, it is difficult to balance the cost of the feedback unit and the positioning accuracy, resulting in low position feedback effect and poor positioning accuracy.
[0005] Therefore, in order to solve the above problems, it is necessary to provide a new control method and related device for a direct drive transport system. [Means for solving the problem]
[0006] SUMMARY OF THE PRESENT EMBODIMENT An object of the present invention is to provide a control method and related device for a direct drive transport system, which has a good position feedback effect, high positioning accuracy, and effectively reduces costs.
[0007] In order to solve the above technical problems, in a first aspect, the present invention provides a control method for a direct drive conveying system, the direct drive conveying system including: a plurality of stages of stators connected in sequence and forming an entire stator unit; a guide rail attached to the stator unit; a plurality of movers forming a sliding connection with the guide rail and movable relative to the plurality of stages of stators; a plurality of first incremental type position feedback devices; a plurality of second incremental type position feedback devices; a plurality of actuators; and a controller, each of the movers is attached with one of the first incremental type position feedback devices, each of the stages of the stators is attached with one of the second incremental type position feedback devices, each of the first incremental type position feedback devices is preset with a first zero point mark and a second zero point mark spaced apart from each other, a distance between the first zero point mark and the second zero point mark is a preset value, the plurality of actuators are respectively connected to the plurality of second incremental type position feedback devices, and all of them are connected to the controller, the control method comprising: S1: starting the direct drive transport system to perform a total zero resetting operation, and moving all of the movers in the same direction; S2, reading a zero point signal of the first incremental type position feedback device recognized by the corresponding second incremental type position feedback device by each of the actuators; S3: determining whether any of the drivers have read two of the zero point signals, and if so, executing step S4; otherwise, returning to step S1; S4: determining that the corresponding mover has completed zero reset according to a distance between the two zero point signals fed back by the actuator, and further completing zero reset of the direct drive conveyance system; S5, the controller acquires position information of each of the movers based on a direct drive transport system after resetting to zero, and drives each of the movers to move.
[0008] Preferably, step S4 specifically comprises the steps of: S41, when the distance between the two zero point signals is a preset value, it is determined that the corresponding mover has completed zero reset, and the position information of the stator next to the mover corresponding to the mover for which zero reset has been completed is specified as accurate position information of the mover for which zero reset has been completed; S42: establishing a coordinate system of the direct drive transport system based on the accurate position information, and realizing zero resetting of the direct drive transport system.
[0009] Preferably, the first incremental type position feedback device is mounted directly opposite the second incremental type position feedback device.
[0010] Preferably, the first incremental position feedback device is an incremental grid ruler.
[0011] Preferably, the second incremental position feedback device is a read head, the read head being disposed directly opposite the incremental grating ruler.
[0012] Preferably, the incremental grating ruler is a grating ruler or a magnetic grating ruler.
[0013] Preferably, the plurality of stators are disposed adjacent to each other.
[0014] Preferably, a first pulley and a second pulley are provided below the mover to face each other, the first pulley and the second pulley abutting on both sides of the guide rail, respectively, and forming a sliding connection.
[0015] In 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 direct drive transport system in the above embodiment are performed.
[0016] In a third aspect, an embodiment of the present invention further provides a computer-readable storage medium having a computer program stored therein, the computer program causing a processor to execute the steps of the method for controlling a direct drive transport system in the above embodiment. Effect of the Invention
[0017] Compared with the prior art, the control method and related device of the direct drive conveying system of the present invention is such that each movable element is provided with a first incremental type position feedback device, each stage of the stator is provided with a second incremental type position feedback device, a first zero point mark and a second zero point mark spaced apart from each other are preset in each first incremental type position feedback device, the distance between the first zero point mark and the second zero point mark is a preset value, the multiple actuators are respectively connected to the multiple second incremental type position feedback devices, and are all connected to a controller, the direct drive conveying system is started to perform a global zero reset, all movable elements are moved in the same direction, and the first incremental type position feedback device recognized by the corresponding second incremental type position feedback device is detected by each actuator. The controller reads the zero point signal of the incremental type position feedback device, and when any of the actuators reads two zero point signals, it determines that the corresponding movable element has completed zero reset based on the distance between the two zero point signals fed back by the actuator, and further completes zero reset of the direct drive conveyor system. The controller obtains the position information of each movable element based on the direct drive conveyor system after zero reset, and drives each movable element to move. The second incremental type position feedback device attached to each stator feeds back the position information of the corresponding movable element in real time based on the recognized zero point, and transmits the position information during operation to the direct drive conveyor system to control the drive of the movable element, thereby achieving a high position feedback effect of the movable element, high positioning accuracy, and reduced 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 obtain other drawings based on these drawings without creative work, among which: [Figure 1]1 is a block diagram of a direct drive transport system according to the present invention. [Diagram 2] 4 is a flow chart of a control method for a direct drive transport system according to the present invention. [Diagram 3] 3 is a method flowchart of step S4 shown in FIG. 2. [Figure 4] 1 is a schematic diagram illustrating a configuration of a direct drive transport system according to the present invention. [Diagram 5] FIG. 5 is a cross-sectional view taken along the line AA shown in FIG. [Figure 6] FIG. 5 is a left side view of FIG. [Figure 7] FIG. 2 is a specific schematic diagram of preset values in the control method of the direct drive transport system according to the present invention; [Figure 8] FIG. 2 is a block diagram of a computer device according to 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] As shown in FIGS. 1 to 7, a method for controlling a direct drive conveyance system is provided, and the direct drive conveyance system 100 includes a plurality of stages of stators 1 connected in sequence to form a stator unit (not shown), a guide rail 3 attached to the stator unit, a plurality of movers 2 that form a sliding connection with the guide rail 3 and are movable relative to the plurality of stages of stators 1, a plurality of first incremental type position feedback devices 4, a plurality of second incremental type position feedback devices 5, a plurality of actuators 6, and a controller 7. Each of the movers 2 is provided with one front The first incremental type position feedback device 4 is installed, and one of the second incremental type position feedback devices 5 is installed on the stator 1 of each stage, a first zero point mark and a second zero point mark spaced apart from each other are preset in each of the first incremental type position feedback devices 4, the distance between the first zero point mark and the second zero point mark is a preset value, and the multiple actuators 6 are respectively connected to the multiple second incremental type position feedback devices 5, and all of them are connected to the controller 7.
[0021] Here, the multi-stage fixed element 1 includes two stages and more than two stages, and specifically, can be selected and installed according to actual needs.
[0022] Specifically, a first zero point mark and a second zero point mark are engraved at both ends of the first incremental type position feedback device 4, respectively, so as to meet the requirement of recognizing the zero point of the forward and reverse movement of the movable element 2. When the first zero point mark and the second zero point mark in the first incremental type position feedback device 4 move and pass the second incremental type position feedback device 5, the second incremental type position feedback device 5 will output a zero point level signal, where the zero point level signal is the Z point signal output.
[0023] Here, the first zero point mark and the second zero point mark may be scale lines, scale points, etc. Alternatively, the first zero point mark and the second zero point mark may be mark lines of other shapes, and specifically may be selected according to the actual situation.
[0024] Here, the preset value is set to ΔL, the zero point signals of the first zero point mark and the second zero point mark are Z respectively, and ΔL is the feedback distance between the two Z's.
[0025] The control method includes the following steps S1 to S4. In step S1, the direct drive transport system 100 is started to perform a total zero reset, and all of the movers 2 are moved in the same direction.
[0026] Specifically, by performing a global reset, it becomes easier to complete dynamic selection of the zero point position.
[0027] Here, the actuator 6 controls all of the movers 2 to move in the forward or reverse direction, so that the second incremental type position feedback device 5 reads information from the first incremental type position feedback device 4 in real time and feeds back the information to the actuator 6.
[0028] In S2, each of the actuators 6 reads zero point signals of the first incremental type position feedback devices 4 recognized by the corresponding second incremental type position feedback devices 5.
[0029] Specifically, the position information of the mover 2 can be obtained in real time, and movement positioning can be easily performed. The second incremental type position feedback device 5 reads the information of the first incremental type position feedback device 4 in real time to generate feedback information, and the driver 6 reads the zero point signal of the feedback of the second incremental type position feedback device 5.
[0030] At S3, it is determined whether any of the drivers 6 have read two of the zero point signals, and if so, execute step S4, otherwise return to step S1.
[0031] In step S4, it is determined that the corresponding mover 2 has completed zero reset based on the distance between the two zero point signals fed back by the actuator 6, and the zero reset of the direct drive transport system is also completed.
[0032] In S5, the controller 7 obtains position information of each of the movers based on the direct drive transport system after the resetting to zero, and drives each of the movers to move.
[0033] Here, based on the recognized zero point, the second incremental type position feedback device 5 attached to each stator 1 feeds back the position information of the corresponding mover 2 in real time, and transmits the position information during operation to the drive control system to control the drive of the mover 2. Therefore, the position feedback effect of the mover 2 is good, the positioning accuracy is high, and the cost is effectively reduced.
[0034] Specifically, a first incremental type position feedback device 4 is attached to each mover 2, and a second incremental type position feedback device 5 is attached to each stage of the stator 1. A first zero point mark and a second zero point mark spaced apart from each other are preset in each first incremental type position feedback device 4, and the distance between the first zero point mark and the second zero point mark is a preset value. A plurality of actuators 6 are respectively connected to a plurality of second incremental type position feedback devices 5, and are all connected to a controller 7. The direct drive transport system 100 is started to perform a global zero reset, thereby: All the movers 2 are moved in the same direction, and each actuator 6 reads the zero point signal of the first incremental type position feedback device 4 recognized by the corresponding second incremental type position feedback device 5. When any actuator 6 reads two zero point signals, it is determined whether the corresponding mover 2 has completed zero reset based on whether the distance between the two zero point signals fed back by the actuator 6 is a preset value, and further the zero reset of the direct drive conveyance system 100 is completed. The controller 7 obtains the position information of the movers based on the direct drive conveyance system 100 after zero reset, and drives each mover to move. The second incremental type position feedback device 5 reads the position information of the first incremental type position feedback device 4 in real time. The second incremental type position feedback device 5 recognizes two zero point signals from the first incremental type position feedback device 4. When the position feedback distance between the two zero point signals is a set value, the second incremental type position feedback device 5 attached to each stator 1 feeds back the position information of the corresponding mover 2 based on the recognized zero point, and feeds back the position information during operation to the drive control system, thereby controlling the drive of the mover 2. Therefore, the position feedback effect of the mover 2 is good, the positioning accuracy is high, and the cost can be effectively reduced.
[0035] In this embodiment, step S4 specifically includes the following steps: In S41, when the distance between the two zero point signals is a preset value, it is determined that the resetting of the corresponding mover is completed, and the position information fed back in real time by the second incremental type position feedback device 5 attached to the next stator corresponding to the mover that has completed the resetting of the zero point is specified as the accurate position information of the mover that has completed the resetting of the zero point.
[0036] Specifically, the two zero point signals are zero point signals of two zero point marks read by the position passing through the second incremental type position feedback device 5 corresponding to the first incremental type position feedback device 4, and when the feedback distance of the position between the two zero point signals is a preset value, it is determined that the mover 2 has completed zero resetting, and the zero reset effect of the mover 2 is good. At the same time, it can also be determined that the feedback position of the second incremental type position feedback device 5 of the next stator 1 is the exact position of the mover 2.
[0037] Here, the preset value may be 1 mm, 10 mm, 100 mm, etc., and specifically, can be selected according to the actual situation.
[0038] In step S42, a coordinate system of the direct drive transport system is established based on the accurate position information, and a zero reset of the direct drive transport system is realized.
[0039] Specifically, a global position coordinate system is established based on the position feedback information of the mover 2, and the position coordinates of the first incremental type position feedback device 4 and the second incremental type position feedback device 5 are formed by the global position coordinate system. Thus, the actuator 6 can quickly and accurately read the zero point signal of the second incremental type position feedback device 5 feedback, which is used by the controller 7 to drive and control, thereby realizing the completion of zero resetting of the direct drive conveying system.
[0040] In this embodiment, the first incremental type position feedback device 4 is attached directly opposite to the second incremental type position feedback device 5. This makes it easy for the second incremental type position feedback device 5 to read position information of the first incremental type position feedback device 4 in real time.
[0041] In this embodiment, the first incremental type position feedback device 4 is an incremental type grating ruler 41. The measurement principle of the incremental type optical grating ruler is to modulate light into Moire fringes by two relatively moving gratings, count and subdivide the Moire fringes, obtain the displacement change amount, and set one or more reference points on the scale grating to identify the position. Optionally, the incremental type grating ruler 41 is attached to the mover 2, and the feedback position accuracy of the incremental type optical grating ruler 41 is high.
[0042] In this embodiment, the second incremental type position feedback device 5 is a read head 51, and the read head 51 is arranged directly opposite the incremental type lattice ruler 41. This makes it easy for the read head 51 to recognize information from the incremental type lattice ruler 41 in real time, and improves the efficiency of reading recognition.
[0043] Optionally, the read head 51 is attached to the stator 1, and when the first incremental type position feedback device 4 of the mover 2 passes through the read head 51, the read head 51 can acquire information of the first incremental type position feedback device 4 in real time, and the acquired position accuracy is high.
[0044] In this embodiment, the incremental grating ruler 41 is an optical grating ruler or a magnetic grating ruler, and the cost of the optical grating ruler or the magnetic grating ruler is low. Here, the incremental grating ruler 41 is not limited to an optical grating ruler or a magnetic grating ruler.
[0045] In this embodiment, the plurality of stators 1 are disposed adjacent to each other. By disposing the plurality of stators 1 closely together, the effect of driving control of the stators 1 with respect to the movers 2 is good.
[0046] In this embodiment, a first pulley 8 and a second pulley 9 are provided below the mover 2 to face each other, and the first pulley 8 and the second pulley 9 are provided in contact with both sides of the guide rail 3, respectively. This makes it easier for the mover 2 to slide on the guide rail 3.
[0047] Specifically, the mover 2 is provided with a magnetic steel 11 and a magnetic conductor 12, and the stator 1 is provided with a plurality of adjacent winding coils 10, and the winding coils 10 and the read head 51 are provided on the stator 1, and the winding coils 10 and the read head 51 are each connected to the driver 6 via a cable. When the lattice ruler passes the read head 51, by utilizing a method of quickly marking zero, the driver 6 can quickly and accurately read the zero point signal fed back by the read head 51. Here, one driver 6 is respectively connected to one winding coil 10 and one read head 51. One controller 7 is respectively connected to a plurality of drivers 6, and the same controller 7 controls a plurality of different drivers 6 to realize systematic direct drive movement.
[0048] Here, the magnetic steel 11 is first attached to the magnetic conductive body 12, and then the magnetic conductive body 12 is attached to the movable member 2, so that both the magnetic conductive body 12 and the magnetic steel 11 are fixed to the movable member 2. This makes it easy for the winding coil 10 to drive the magnetic steel 11 to move, and the movable member 2 and the stator 1 are guided in movement by the guide rails 3.
[0049] Specifically, when electricity is passed through the winding coil 10 to generate an electromagnetic field together with the magnetic steel 12, the magnetic steel 12 is driven to move, and the mover 2 is moved along the guide rail.
[0050] An embodiment of the present invention further provides a computer device 200, see FIG. 8, the computer device 200 includes a memory 202, a processor 201, and a computer program stored in the memory and executable by the processor, and when the processor 201 executes the computer program, steps in the control method of the direct drive transport system in the above embodiment are realized.
[0051] The computer device 200 corresponds to the controller 7 in the direct drive transport system 100 according to the embodiment of the present invention.
[0052] The processor 201 calls a computer program stored in the memory 202, and when executing the computer program, steps in the control method for the direct drive transport system in the above embodiment are realized.
[0053] An embodiment of the present invention further provides a computer-readable storage medium, in which a computer program is stored, which, when executed by a processor, can realize the steps in the control method for the direct drive transport system in the above embodiment and achieve similar technical effects, which will not be repeated here to avoid duplication.
[0054] As can be understood by those skilled in the art, the implementation of all or part of the flow of the above-mentioned embodiment methods can be completed by instructing relevant hardware by a computer program, and the above-mentioned program can be stored in a computer-readable storage medium, and when the program is executed, the flow of each of the above-mentioned embodiment methods can be included. Here, the above-mentioned storage medium can be a magnetic disk, an optical disk, a read-only memory (ROM), a random access memory (RAM), etc.
[0055] 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.
[0056] 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 the part that contributes to the prior art can be expressed 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.
[0057] What has been described above is merely an embodiment of the present invention, and what should be pointed out here can be further improved by those skilled in the art without departing from the creative idea of the present invention, all of which fall within the scope of protection of the present invention.
Claims
1. A method for controlling a direct drive transport system, comprising: The direct drive transport system includes a plurality of stages of stators connected in sequence to form a stator unit, a guide rail attached to the stator unit, a plurality of movers that form a sliding connection with the guide rail and are movable relative to the plurality of stages of stators, a plurality of first incremental type position feedback devices, a plurality of second incremental type position feedback devices, a plurality of actuators, and a controller, wherein each of the movers is attached with one of the first incremental type position feedback devices, and each of the stages of the stators is attached with one of the second incremental type position feedback devices, each of the first incremental type position feedback devices is preset with a first zero point mark and a second zero point mark spaced apart from each other, and the distance between the first zero point mark and the second zero point mark is a preset value, and the plurality of actuators are respectively connected to the plurality of second incremental type position feedback devices, and are all connected to the controller, and the control method includes: S1: starting the direct drive transport system to perform a total zero resetting process to move all of the movers in the same direction; S2, reading a zero point signal of the first incremental type position feedback device recognized by the corresponding second incremental type position feedback device by each of the actuators; S3: determining whether any of the drivers have read two of the zero point signals, and if so, executing step S4; otherwise, returning to step S1; S4: determining that the corresponding mover has completed zero reset based on a distance between the two zero point signals fed back by the actuator, and further completing zero reset of the direct drive transport system; S5, in which the controller acquires position information of each of the movable elements based on the direct drive conveyance system after resetting to zero, and drives each of the movable elements to move.
2. Specifically, step S4 is S41, when the distance between the two zero point signals is a preset value, it is determined that the resetting of the corresponding mover is completed, and the position information of the stator next to the mover corresponding to the mover for which the resetting of the zero has been completed is specified as accurate position information of the mover for which the resetting of the zero has been completed; 2. The method for controlling a direct drive conveying system according to claim 1, further comprising: (S42) establishing a coordinate system of the direct drive conveying system based on the accurate position information, and realizing zero resetting of the direct drive conveying system.
3. 2. The method for controlling a direct drive transport system according to claim 1, wherein the first incremental type position feedback device is attached directly opposite the second incremental type position feedback device.
4. 2. The method for controlling a direct drive transport system according to claim 1, wherein the first incremental type position feedback device is an incremental type grid ruler.
5. 5. The method for controlling a direct drive transport system according to claim 4, wherein the second incremental type position feedback device is a read head, and the read head is provided directly opposite the incremental type grid ruler.
6. 5. The method for controlling a direct drive transport system according to claim 4, wherein the incremental type grating ruler is an optical grating ruler or a magnetic grating ruler.
7. 2. The method for controlling a direct drive transport system according to claim 1, characterized in that a first pulley and a second pulley are provided opposite each other below the mover, and the first pulley and the second pulley abut on either side of the guide rail, respectively, and form a sliding connection.
8. 1. A computing device comprising: A computer device comprising a memory, a processor, and a computer program stored in the memory and executable by the processor, wherein when the processor executes the computer program, steps in the method for controlling a direct drive transport system according to any one of claims 1 to 7 are performed.
9. 1. A computer-readable storage medium, comprising: A computer-readable storage medium having a computer program stored therein, the computer-readable storage medium being characterized in that, when the computer program is executed by a processor, steps in the method for controlling a direct drive transport system according to any one of claims 1 to 7 are performed.
Citation Information
Patent Citations
Linear encoder device, linear motor, and single-axis robot
JP2005051856A
Method of setting origin of linear motor
JP2008289345A
Transport device and method of manufacturing article
JP2020096514A
Linear conveyance system and control method of linear conveyance system
JP2023019218A
Linear motor unit and electronic component placing apparatus provided with the linear motor unit
WO2009119648A1
