Rotor anti-collision control method and device and magnetic drive motor conveying system

By real-time monitoring and dynamically adjusting the safe spacing of the movers in the magnetic drive motor conveying system, the efficiency reduction problem caused by the mover collision is solved, and an efficient and safe transportation process is achieved.

CN118894375AActive Publication Date: 2024-11-05SHANGHAI GOLYTEC AUTOMATION CO LTD

Patent Information

Application Number
CN202411007229.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-25
Publication Date
2024-11-05
Estimated Expiration
2044-07-25

AI Technical Summary

Technical Problem

Collisions between the actuators in the magnetic drive motor conveying system lead to material damage, equipment failure and production interruption. The existing methods prevent collisions by increasing safety distances, but reduce the conveying efficiency.

Method used

The servo control components monitor the movement parameters of the mover in real time, dynamically adjust the safety spacing between adjacent movers, and control the mover to slow down or stop if there is a risk of collision to ensure that the appropriate safety spacing between the movers is maintained to avoid collision.

Benefits of technology

While maintaining efficient transportation, effectively prevent collisions between the movers, improve the safety and reliability of the system, optimize the conveying efficiency, and reduce downtime and maintenance costs caused by collisions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118894375A_ABST
    Figure CN118894375A_ABST
Patent Text Reader

Abstract

The invention discloses a rotor anti-collision control method and device and a magnetic drive motor conveying system.The magnetic drive motor conveying system comprises a conveying line body formed by sequentially splicing a plurality of stators in the direction of a conveying line, a rotor magnetically coupled with the stators and a servo control assembly; the method comprises the following steps: acquiring a current motion parameter of a rotor according to a servo frequency of a servo control assembly; determining a real-time interval between adjacent rotors according to the current motion parameters; according to the current motion parameters, the servo frequency and a preset anti-collision distance, the safety distance between the adjacent rotors is determined; judging whether there is a collision risk between the adjacent rotors according to the real-time spacing and the safety spacing; and if the collision risk exists, the corresponding rotor is controlled to decelerate or stop. According to the magnetic drive motor conveying system, the safety distance between different rotors can be dynamically adjusted, collision of the rotors is avoided, meanwhile, the conveying efficiency is maximized, and the conveying stability and high precision of the magnetic drive motor conveying system under various working conditions are ensured.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of automated conveying systems, and in particular to a mover anti-collision control method and device and a magnetic drive motor conveying system. Background Art

[0002] The magnetic drive motor conveying system, also known as the magnetic suspension conveying system, has gradually replaced the traditional belt conveying and chain drive conveying systems in many fields due to its advantages of high flexibility, high speed and high precision. The magnetic drive motor conveying system usually includes a stator and a mover. The stator is spliced ​​in sequence along the conveying direction to form a conveying line body, and the mover moves on the conveying line body. Although the magnetic drive motor conveying system has many advantages, the collision between movers has become a problem that cannot be ignored. The collision of movers may cause material damage, equipment failure and production interruption, resulting in economic losses and reduced production efficiency.

[0003] In the related art, magnetic drive motor conveying systems usually prevent collisions between movers by increasing the safety distance between movers. However, although this method can reduce the risk of collision, it also significantly reduces the conveying efficiency. Summary of the invention

[0004] The embodiments of the present application provide a mover anti-collision control method, device and magnetic drive motor conveying system, which can dynamically adjust the safety distance between different movers, control the movement of the movers based on the safety distance, avoid mover collision, maximize the conveying efficiency, and ensure the conveying stability and high precision of the magnetic drive motor conveying system under various working conditions. The above technical solutions are as follows:

[0005] In a first aspect, an embodiment of the present application provides a mover anti-collision control method, which is applied to a magnetic drive motor conveying system, wherein the magnetic drive motor conveying system includes a conveying line body formed by sequentially splicing a plurality of stators along a conveying line direction, a mover magnetically coupled to the stator, and a servo control component, and the method includes:

[0006] Acquire the current motion parameters of the mover according to the servo frequency of the servo control component;

[0007] Determine the real-time spacing between adjacent movers according to the above current motion parameters;

[0008] Determine the safety distance between the adjacent movers according to the current motion parameters, the servo frequency and the preset anti-collision distance; the preset anti-collision distance is used to characterize the preset minimum distance between the collision edges of adjacent movers;

[0009] Determine whether there is a collision risk between adjacent movers according to the real-time spacing and the safety spacing;

[0010] If there is a risk of collision, the corresponding mover is controlled to slow down or stop.

[0011] In a possible implementation, the current motion parameters include one or more of mover specifications, current position, motion direction, current speed, maximum speed limit, acceleration, and load status.

[0012] In a possible implementation, the real-time spacing and the safety spacing both represent the distance between the centers of adjacent movers; and the real-time spacing between adjacent movers is determined according to the current motion parameters, including:

[0013] The real-time spacing between adjacent movers is determined according to the current positions of the movers.

[0014] In a possible implementation, the above-mentioned determining the safety distance between adjacent movers according to the above-mentioned current motion parameters, the servo frequency of the above-mentioned servo control component and the preset anti-collision distance includes:

[0015] Determine the safety radius of the mover according to the mover specification and load state of the mover; the safety radius is used to characterize the distance between the center of the mover and the collision edge;

[0016] Determine the response distance of the mover according to the current speed or maximum speed limit of the mover and the servo frequency; the response distance is used to characterize the maximum moving distance of the mover within the predicted response time; the predicted response time includes at least one servo cycle;

[0017] The safety distance between adjacent movers is determined according to the safety radius, the response distance and the preset anti-collision distance corresponding to each of the movers.

[0018] In a possible implementation, both the real-time spacing and the safety spacing represent the distance between the collision edges of adjacent movers; and the real-time spacing between adjacent movers is determined according to the current motion parameters, including:

[0019] Determine the safety radius of the mover according to the mover specification and load state of the mover, wherein the safety radius is used to characterize the distance between the center of the mover and the collision edge;

[0020] The real-time spacing between adjacent movers is determined according to the safety radius corresponding to the movers and the current position.

[0021] In a possible implementation, the above-mentioned determining the safety distance between adjacent movers according to the above-mentioned current motion parameters, the servo frequency of the above-mentioned servo control component and the preset anti-collision distance includes:

[0022] Determine the response distance of the mover according to the current speed or maximum speed limit of the mover and the servo frequency; the response distance is used to characterize the maximum moving distance of the mover within the predicted response time; the predicted response time includes at least one servo cycle;

[0023] The safety distance between adjacent movers is determined according to the response distance corresponding to the movers and the preset anti-collision distance.

[0024] In a possible implementation, if there is a risk of collision, the corresponding mover is controlled to decelerate or stop, including:

[0025] If there is a collision risk, determining whether the adjacent movers are both in motion according to the current motion parameters corresponding to the adjacent movers;

[0026] When the adjacent movers are all in motion and move in the same direction, the rear mover among the adjacent movers is controlled to decelerate or stop;

[0027] When the adjacent movers are in motion and move toward each other, the adjacent movers are controlled to stop at the same time;

[0028] When there is a static mover among the adjacent movers, the moving mover among the adjacent movers is controlled to stop.

[0029] In a possible implementation, after the corresponding movers are controlled to slow down or stop, the distance between the collision edges of the adjacent movers is greater than or equal to the preset anti-collision distance.

[0030] In a possible implementation, determining the safety radius of the mover according to the mover specification and load state of the mover includes:

[0031] When the load state is no load, the safety radius of the mover is determined according to the mover specification of the mover;

[0032] When the load state is loaded, obtaining the load specification of the load, and judging whether the length or width of the load is greater than the corresponding mover according to the load specification;

[0033] If yes, the safety radius of the mover is determined according to the load specification of the load;

[0034] If not, the safety radius of the mover is determined according to the mover specifications of the mover.

[0035] In a possible implementation, there are one or more preset sections on the conveyor line; each of the preset sections is independently provided with an interval anti-collision distance and / or an interval maximum speed limit.

[0036] In a possible implementation, when the mover is located within the preset interval, the preset anti-collision distance corresponding to the mover is the interval anti-collision distance of the preset interval; the maximum speed limit corresponding to the mover is the interval maximum speed limit of the preset interval.

[0037] In a possible implementation, judging whether there is a collision risk between adjacent movers according to the real-time distance and the safety distance includes:

[0038] If the above real-time spacing between adjacent movers is smaller than the above safety spacing, there is a risk of collision between the above adjacent movers;

[0039] If the above-mentioned real-time distance between adjacent movers is not less than the above-mentioned safety distance, there is no risk of collision between the above-mentioned adjacent movers.

[0040] In a second aspect, an embodiment of the present application provides a mover anti-collision control device, which is configured in a magnetic drive motor conveying system, wherein the magnetic drive motor conveying system includes a conveying line body formed by sequentially splicing a plurality of stators along a conveying line direction, a mover magnetically coupled to the stator, and a servo control component, wherein the device includes:

[0041] An acquisition module, used for acquiring the current motion parameters of the mover according to the servo frequency of the servo control component;

[0042] A real-time spacing module is used to determine the real-time spacing between adjacent movers according to the above current motion parameters;

[0043] A safety spacing module, used to determine the safety spacing between the adjacent movers according to the current motion parameters, the servo frequency and a preset anti-collision spacing; the preset anti-collision spacing is used to characterize the preset minimum distance between the collision edges of adjacent movers;

[0044] A risk judgment module, used to judge whether there is a collision risk between adjacent movers according to the real-time spacing and the safety spacing;

[0045] The execution module is used to control the corresponding mover to slow down or stop if there is a risk of collision.

[0046] In a possible implementation, the current motion parameters include one or more of mover specifications, current position, motion direction, current speed, maximum speed limit, acceleration, and load status.

[0047] In a possible implementation, both the real-time spacing and the safety spacing represent the distance between the centers of adjacent movers; the real-time spacing module is specifically used for:

[0048] The real-time spacing between adjacent movers is determined according to the current positions of the movers.

[0049] In a possible implementation, the safety distance module is specifically used to:

[0050] Determine the safety radius of the mover according to the mover specification and load state of the mover; the safety radius is used to characterize the distance between the center of the mover and the collision edge;

[0051] Determine the response distance of the mover according to the current speed or maximum speed limit of the mover and the servo frequency; the response distance is used to characterize the maximum moving distance of the mover within the predicted response time; the predicted response time includes at least one servo cycle;

[0052] The safety distance between adjacent movers is determined according to the safety radius, the response distance and the preset anti-collision distance corresponding to each of the movers.

[0053] In a possible implementation, both the real-time spacing and the safety spacing represent the distance between the collision edges of adjacent movers; the real-time spacing module is specifically used for:

[0054] Determine the safety radius of the mover according to the mover specification and load state of the mover, wherein the safety radius is used to characterize the distance between the center of the mover and the collision edge;

[0055] The real-time spacing between adjacent movers is determined according to the safety radius corresponding to the movers and the current position.

[0056] In a possible implementation, the safety distance module is specifically used to:

[0057] Determine the response distance of the mover according to the current speed or maximum speed limit of the mover and the servo frequency; the response distance is used to characterize the maximum moving distance of the mover within the predicted response time; the predicted response time includes at least one servo cycle;

[0058] The safety distance between adjacent movers is determined according to the response distance corresponding to the movers and the preset anti-collision distance.

[0059] In a possible implementation, the execution module is specifically used to:

[0060] If there is a collision risk, determining whether the adjacent movers are both in motion according to the current motion parameters corresponding to the adjacent movers;

[0061] When the adjacent movers are all in motion and move in the same direction, the rear mover among the adjacent movers is controlled to decelerate or stop;

[0062] When the adjacent movers are in motion and move toward each other, the adjacent movers are controlled to stop at the same time;

[0063] When there is a static mover among the adjacent movers, the moving mover among the adjacent movers is controlled to stop.

[0064] In a possible implementation, after the corresponding movers are controlled to slow down or stop, the distance between the collision edges of the adjacent movers is greater than or equal to the preset anti-collision distance.

[0065] In a possible implementation, the real-time spacing module or the safety spacing module is further specifically used to:

[0066] When the load state is no load, the safety radius of the mover is determined according to the mover specification of the mover;

[0067] When the load state is loaded, obtaining the load specification of the load, and judging whether the length or width of the load is greater than the corresponding mover according to the load specification;

[0068] If yes, the safety radius of the mover is determined according to the load specification of the load;

[0069] If not, the safety radius of the mover is determined according to the mover specifications of the mover.

[0070] In a possible implementation, there are one or more preset sections on the conveyor line; each of the preset sections is independently provided with an interval anti-collision distance and / or an interval maximum speed limit.

[0071] In a possible implementation, when the mover is located within the preset interval, the preset anti-collision distance corresponding to the mover is the interval anti-collision distance of the preset interval; the maximum speed limit corresponding to the mover is the interval maximum speed limit of the preset interval.

[0072] In a possible implementation, the risk judgment module is specifically used to:

[0073] If the above real-time spacing between adjacent movers is smaller than the above safety spacing, there is a risk of collision between the above adjacent movers;

[0074] If the above-mentioned real-time distance between adjacent movers is not less than the above-mentioned safety distance, there is no risk of collision between the above-mentioned adjacent movers.

[0075] In a third aspect, an embodiment of the present application provides a computer storage medium, wherein the computer storage medium stores a plurality of instructions, and the instructions are suitable for being loaded by a processor and executing the above method steps.

[0076] In a fourth aspect, an embodiment of the present application provides a magnetically driven motor conveying system, the magnetically driven motor conveying system comprising a conveying line body formed by a plurality of stators sequentially spliced ​​along the conveying line direction, a mover magnetically coupled to the stator, and a servo control component, the servo control component comprising: a processor and a memory; wherein the memory stores a computer program, and the computer program is suitable for being loaded by the processor and executing the method steps.

[0077] In one or more embodiments of the present application, the current motion parameters of the above-mentioned mover are obtained according to the servo frequency of the above-mentioned servo control component; the real-time spacing between adjacent movers is determined according to the above-mentioned current motion parameters; the safety spacing between the above-mentioned adjacent movers is determined according to the above-mentioned current motion parameters, the above-mentioned servo frequency and the preset anti-collision spacing; the above-mentioned preset anti-collision spacing is used to characterize the preset minimum distance between the collision edges of adjacent movers; whether there is a collision risk between adjacent movers is determined according to the above-mentioned real-time spacing and the above-mentioned safety spacing; if there is a collision risk, the corresponding mover is controlled to slow down or stop. In this way, the mover anti-collision control method can be embedded in the servo loop of the magnetic drive motor conveying system, and the safety spacing between adjacent movers can be adjusted dynamically at high frequency, so as to effectively prevent the collision between movers while maintaining efficient conveying. Through servo control, the system can not only monitor and adjust the motion state of the mover in real time based on the servo frequency, but also dynamically adjust the safety spacing based on the current motion parameters of the mover, quickly respond to the state change of the mover in a short time, intelligently predict and avoid collision risks, ensure that the movers always maintain an appropriate safety spacing, and effectively avoid collisions. This method not only improves the safety and reliability of the system, but also optimizes the conveying efficiency and reduces the downtime and maintenance costs caused by collisions. In addition, since this method is implemented through a software algorithm and embedded in the servo loop of the magnetic drive motor conveying system, it has high control accuracy and controllability and does not require major modifications to hardware such as external sensors. Therefore, it can be easily integrated into the existing magnetic drive motor conveying system and has high applicability. BRIEF DESCRIPTION OF THE DRAWINGS

[0078] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0079] Figure 1 A schematic diagram of the structure of a magnetic drive motor conveying system provided in an embodiment of the present application;

[0080] Figure 2 A schematic flow chart of a mover anti-collision control method provided in an embodiment of the present application;

[0081] Figure 3 A schematic top view of the real-time distance between adjacent movers provided in an embodiment of the present application;

[0082] Figure 4 A schematic diagram of another real-time distance between adjacent movers provided in an embodiment of the present application;

[0083] Figure 5 A schematic flow chart of another mover anti-collision control method provided in an embodiment of the present application;

[0084] Figure 6 A schematic top view of a mover safety radius provided in an embodiment of the present application;

[0085] Figure 7 A schematic top view of a mover safety radius under different load conditions provided in an embodiment of the present application;

[0086] Figure 8 A schematic flow chart of another mover anti-collision control method provided in an embodiment of the present application;

[0087] Fig. 9 A schematic structural diagram of a mover anti-collision control device provided in an embodiment of the present application;

[0088] Fig.10 A schematic diagram of the structure of another magnetic drive motor conveying system provided in an embodiment of the present application. DETAILED DESCRIPTION

[0089] When the following description refers to the drawings, unless otherwise indicated, the same numbers in different drawings represent the same or similar elements. The embodiments described in the following exemplary embodiments do not represent all embodiments consistent with the present application. Instead, they are only examples of devices and methods consistent with some aspects of the present application as detailed in the attached claims.

[0090] In the description of the present application, it should be understood that the terms "first", "second", etc. are used for descriptive purposes only and should not be understood as indicating or implying relative importance. For those of ordinary skill in the art, the specific meanings of the above terms in the present application can be understood according to the specific circumstances. In addition, in the description of the present application, unless otherwise specified, "multiple" refers to two or more. "And / or" describes the association relationship of associated objects, indicating that three relationships may exist. For example, A and / or B can represent: A exists alone, A and B exist at the same time, and B exists alone. The character " / " generally indicates that the objects associated before and after are in an "or" relationship.

[0091] Please refer to the following Figure 1, which is a structural schematic diagram of a magnetic drive motor conveying system provided by an exemplary embodiment of this specification.

[0092] like Figure 1 As shown, the magnetic drive motor conveying system provided in the embodiment of the present application includes a stator and a mover magnetically coupled to the stator, and multiple stators are spliced ​​in sequence along the conveying line direction to form a conveying line body, and the mover can move on the conveying line body.

[0093] It can be understood that the magnetic drive motor conveying system in the embodiment of the present application refers to a conveying system based on a linear motor, such as a magnetic levitation conveying system. Among them, the stator is a fixed part, which can be spliced ​​in sequence along the conveying direction to form a conveying line body. The electromagnetic coil can be integrated in the stator to generate an electromagnetic force field by controlling the current. The mover is the moving part suspended on the stator. The mover is suspended and driven by the electromagnetic force generated by the stator, so that it moves along the conveying path.

[0094] The magnetic drive motor conveying system also includes a servo control component, which may include a servo controller, a sensor, a driver, etc. The sensor is used to monitor the motion parameters such as the position, speed and acceleration of the mover, and feed the data back to the servo controller. The servo controller is used to process the sensor data, run the control algorithm, and generate a control signal. The driver is used to receive the control signal of the servo controller, and control the stator to generate an electromagnetic force field by adjusting parameters such as current and voltage to drive the suspension and movement of the mover.

[0095] In some embodiments, each stator is equipped with an independent driver. The independent driver directly controls the electromagnetic coil in its corresponding stator, and can finely control the electromagnetic force field of each stator, thereby improving the flexibility and control accuracy of the system. In other embodiments, the driver can be integrated into a local controller, and multiple stators are connected to the local controller via signals. The local controller centrally manages the current and voltage control of these stators, which simplifies the system design and reduces the amount of hardware.

[0096] The servo controller can be integrated into the local controller or the host computer. Multiple local controllers can also be connected to a PLC (Programmable Logic Controller) or PC (Personal Computer) host computer, which monitors each local controller. The host computer is responsible for global data acquisition and control logic management, and communicates with multiple local controllers. The host computer can perform control tasks according to the servo frequency (such as 60Hz) through a high-precision timer or real-time operating system to ensure that the control signal is sent at a predetermined frequency.

[0097] The principle of the stator driving the mover to move is explained below. The stator may include an armature winding, in which a plurality of coils arranged in phase sequence are arranged. The armature winding is periodically energized to change the magnetic field around the armature winding, thereby achieving the purpose of driving the mover to move. For example, the mover may be provided with a permanent magnet array, which generates a constant magnetic field around the mover. When the energization direction and / or the magnitude of the energization current of the coil in the armature winding changes, a changing magnetic field will be generated around the armature winding. The changing magnetic field interacts with the constant magnetic field, which can drive the mover to move relative to the stator.

[0098] It should be noted that the mover is not limited to using a permanent magnetic array to achieve cooperation with the stator, and the mover may also use a coil or other device to achieve movement of the mover relative to the stator through cooperation between the changing magnetic field around the mover and the changing magnetic field around the stator. This embodiment of the application is not limited to this.

[0099] Optionally, the shape formed by the stator in the magnetic drive motor conveying system along the moving direction of the mover can be a straight line shape or an arc shape. Multiple stators can be spliced ​​together. According to the splicing conditions of the stators, in terms of shape, a conveying line body of a closed shape (circular, runway, square, etc.) or a conveying line body of a non-closed shape (S-shaped, straight, C-shaped, etc.) can be spliced ​​together.

[0100] Optionally, for a single non-closed conveyor line or multiple non-closed conveyor line bodies distributed at intervals, a transfer mechanism can be used to transfer the mover from one conveyor line body to another; or, the mover can be transferred from one end of the conveyor line body to the other end of the conveyor line body. The transfer mechanism can use mechanical transmission components (conveyor belt components, chain components, telescopic components) to transfer the mover to form a mixed conveyor line.

[0101] Next, combine Figure 1 , introduces the anti-collision control method of the mover provided in the embodiment of the present application. For details, please refer to Figure 2 , which is a flow chart of a method for controlling a mover anti-collision provided by an exemplary embodiment of this specification. Figure 2 As shown, the mover anti-collision control method includes the following steps:

[0102] S201, obtaining current motion parameters of the mover according to the servo frequency of the servo control component.

[0103] Specifically, the mover anti-collision control method provided in this embodiment can be embedded in the servo controller (local controller or host computer) of the magnetic drive motor conveying system; the servo control component will periodically obtain the current motion parameters of the mover at a specific frequency (i.e., the servo frequency). This periodic sampling enables the servo controller to monitor the state of the mover in real time and make corresponding control decisions based on these data to achieve mover anti-collision control.

[0104] The servo frequency of a servo control component refers to the number of control operations the servo control component performs per second. Specifically, this frequency determines how often the servo controller collects sensor data, runs control algorithms, and generates and sends control signals. The servo frequency can be preset according to the specific implementation scenario and can generally be set at tens to hundreds of hertz (Hz), for example:

[0105] The servo frequency is 60Hz: This means that the servo control component performs 60 control cycles per second, and each cycle is approximately 16.67 milliseconds.

[0106] The servo frequency is 100Hz: This means that the servo control component performs 100 control cycles per second, and each cycle takes about 10 milliseconds.

[0107] The current motion parameters of the mover refer to various physical quantities that describe the real-time state of the mover. In some embodiments, the current motion parameters may include but are not limited to one or more of the following:

[0108] Mover Specifications: Physical size and shape information of the mover, which can include length, width, and height. Mover specifications help determine the space the mover will occupy on the conveyor line.

[0109] Current position: The current coordinates or position of the mover on the conveyor line. Position data is usually obtained in real time through a position sensor (such as an encoder or laser sensor). The current position helps to accurately locate the mover.

[0110] Direction of motion: The current direction of motion of the mover, which can be expressed as a vector or angle. The direction of motion combined with the velocity and acceleration of the mover can predict the future trajectory of motion.

[0111] Current speed: The instantaneous speed of the mover, mainly including the linear speed of the mover along the conveyor line. The current speed is calculated by the rate of change of data from the speed sensor or position sensor. Speed ​​information helps to regulate the movement of the mover to ensure that it runs within the predetermined speed range.

[0112] Maximum speed limit: The maximum speed allowed for the mover in the conveying system. The maximum speed limit is determined by the design and safety requirements of the magnetic drive motor conveying system. It can prevent the mover from overspeeding and ensure that the mover operates within a safe and efficient range, thereby avoiding system failures or safety hazards.

[0113] Acceleration: The instantaneous acceleration of the mover, mainly including the linear acceleration of the mover along the conveyor line. The acceleration is obtained through an acceleration sensor or by calculating the rate of change of velocity. Acceleration information helps predict the dynamic behavior of the mover and make necessary control adjustments.

[0114] Load status: The status of the items carried by the mover, including the presence or absence of load, load weight, load size, etc. Load status information helps adjust the motion parameters of the mover to ensure stable and safe operation under different load conditions.

[0115] Exemplarily, in this embodiment, the servo control component can perform the following operations at a servo frequency (e.g., 60 Hz):

[0116] Data acquisition: The sensor collects the current motion parameters of the actuator every 16.67 milliseconds (corresponding to a servo frequency of 60 Hz).

[0117] Data processing: The servo controller receives and processes these sensor data and updates the current motion parameters of the actuator.

[0118] Control decision: Based on the latest current motion parameters, the servo controller runs the control algorithm to determine whether the motion state of the mover (such as speed, acceleration, etc.) needs to be adjusted.

[0119] Signal transmission: The servo controller generates a control signal and sends it to the drive to adjust the electromagnetic force field of the stator, thereby controlling the movement of the mover.

[0120] In the magnetic drive motor conveying system, obtaining the current motion parameters of the mover according to the servo frequency of the servo control component can ensure that the system can monitor the status of the mover in real time and make control decisions based on these data to maintain high-precision motion control and safety, which helps to avoid mover collisions while maximizing conveying efficiency.

[0121] S202, determining a real-time spacing between adjacent movers according to current motion parameters.

[0122] Specifically, after obtaining the current motion parameters of the mover, the current position of the mover can be determined, and the relative position between adjacent movers can be calculated based on the current positions of adjacent movers. The real-time spacing is the relative position between adjacent movers calculated after obtaining the current motion parameters of the mover each time according to the servo frequency. Calculating the real-time spacing between adjacent movers in real time according to the servo frequency helps monitor and manage the relative position between movers, thereby ensuring that adjacent movers maintain a safe distance and prevent collisions.

[0123] In this embodiment, the real-time spacing refers to the actual physical distance between two adjacent movers at the current moment. This distance changes dynamically because the movers are constantly moving in the magnetic drive motor conveying system. The current position of the mover can be determined by the center of the mover as a reference, expressed as the center coordinates of the mover on the conveying line. In some embodiments, the real-time spacing can represent the actual physical distance between the center coordinates of the previous mover and the center coordinates of the next mover.

[0124] For example, Figure 3 As shown, the distance between adjacent movers can be calculated using the Euclidean distance formula. For example, the current position coordinate value of the previous mover is (x1, y1), and the current position coordinate value of the next mover is (x2, y2). The real-time distance D between the adjacent movers is

[0125] In other embodiments, the real-time spacing can represent the actual physical distance between the collision edges of the preceding mover and the succeeding mover, and the collision edge with the shortest physical distance between adjacent movers can be used as a judgment basis, the collision edge being the edge portion corresponding to when adjacent movers collide.

[0126] For example, Figure 4 As shown, the distance D1 between the centers of adjacent movers can be determined based on the central coordinates of the current positions of the adjacent movers, and then the distances D2 (previous mover) and D3 (next mover) from the center of the mover to the collision edge of the mover can be determined based on the specifications and load conditions of the movers, thereby calculating the real-time spacing D between the adjacent movers to be D1-D2-D3.

[0127] S203, determining a safe distance between adjacent movers according to current motion parameters, servo frequency and a preset anti-collision distance.

[0128] Specifically, by comprehensively considering the current motion parameters of the movers, the servo frequency of the servo control component, and the preset anti-collision spacing, the safety spacing between adjacent movers can be calculated. The safety spacing is dynamically adjusted to ensure that there is enough space between the movers to avoid collisions while maximizing the conveying efficiency.

[0129] The current motion parameters of the mover may include but are not limited to the specifications of the mover, the current position, the direction of motion, the current speed, the maximum speed limit, the acceleration and the load state, etc. The real-time state of the mover can be determined by the current motion parameters of the mover. In this embodiment, corresponding optimal safety distances can be set for movers in different states. For example, the safety distance set when adjacent movers are moving towards each other is different from the safety distance when they are moving in the same direction; the safety distance set when adjacent movers are moving in a straight line is different from the safety distance when adjacent movers are turning; when adjacent movers use mover modules of different specifications, different safety distances are set according to the different specifications of the mover modules.

[0130] The servo control component performs control operations according to the servo frequency. When the servo frequency f of the servo control component is fixed, the time interval T (servo cycle) for performing the control operation is the same, and the servo control component needs a certain response time from detecting the state change to performing the control operation. Exemplarily, the servo controller obtains the current motion parameters of the mover from the sensor at time t1; the servo controller processes the acquired current motion parameters and runs the control algorithm, and sends a control signal to the driver at time t2 to adjust the motion of the mover; the servo controller obtains the current motion parameters of the mover from the sensor at time t3, and determines that the adjustment of the mover motion is complete. Among them, the interval time from time t1 to time t3 is the response time, specifically one or more time intervals T.

[0131] When the mover is running at high speed, if there is a risk of collision between adjacent movers, even if the system responds in time and controls the corresponding mover to slow down or stop, it may still continue to move forward a certain distance within the mover response time. That is, the response distance moved by the mover within the response time will affect the determination of the safety distance between adjacent movers. Among them, the servo frequency and the current motion parameters of the mover jointly affect the response distance of the mover, and a higher servo frequency means that the magnetic drive motor conveying system can detect and respond to changes in motion state faster, thereby reducing the required safety distance and improving the safety and efficiency of the system.

[0132] The preset anti-collision distance is used to characterize the preset minimum distance between the collision edges of adjacent movers. It can be understood that no matter what the circumstances, the distance between the collision edges of adjacent movers should always be greater than or equal to the preset anti-collision distance to meet the necessary safety requirements for running the movers.

[0133] In this embodiment, based on the preset anti-collision distance, combined with the current motion parameters of the mover and the servo frequency of the servo control component, the safety distance between adjacent movers is dynamically adjusted, which can realize real-time monitoring and rapid response of the motion state of the mover, and ensure that the magnetic drive motor conveying system can effectively avoid the risk of collision between movers while operating efficiently. Through high-frequency data acquisition and control operations, the system can detect potential collision risks in the shortest time, and adjust the motion trajectory and speed of the mover in time, so as to maintain the stability and safety of the entire conveying process. In addition, this dynamic adjustment mechanism not only improves the system's anti-collision capability, but also optimizes the spacing management between movers, so that the conveying system can maintain efficient and reliable operation under various working conditions.

[0134] S204: Determine whether there is a collision risk between adjacent movers according to the real-time spacing and the safety spacing.

[0135] Specifically, whether there is a risk of mover collision is determined by comparing the actual physical distance (real-time spacing) between adjacent movers with the calculated safety spacing.

[0136] In some embodiments, judging whether there is a collision risk between adjacent movers according to the real-time spacing and the safety spacing includes:

[0137] If the real-time spacing between adjacent movers is less than the safety spacing, there is a risk of collision between adjacent movers;

[0138] If the real-time spacing between adjacent movers is not less than the safety spacing, there is no risk of collision between adjacent movers.

[0139] Specifically, the real-time spacing is determined based on the current motion parameters of adjacent movers, and the safety spacing is determined based on the current motion parameters of adjacent movers, the servo frequency of the servo control component, and the preset anti-collision spacing. The safety spacing corresponding to different adjacent movers may be different.

[0140] It should be noted that the calculation form of the real-time spacing and the safety spacing should be unified. If the real-time spacing represents the actual physical distance between the center coordinates of the previous mover and the center coordinates of the next mover, then the safety spacing also represents the safety distance between the center coordinates of the previous mover and the center coordinates of the next mover; if the real-time spacing represents the actual physical distance between the collision edges of the previous mover and the next mover, then the safety spacing also represents the safety distance between the collision edges of the previous mover and the next mover.

[0141] S205: If there is a risk of collision, the corresponding mover is controlled to slow down or stop.

[0142] Specifically, if the real-time spacing between adjacent movers is smaller than the safety spacing, it is determined that the adjacent movers may collide if they continue to move in this way, and the corresponding movers should be decelerated or stopped to avoid the occurrence of mover collision.

[0143] In some embodiments, after the corresponding movers are decelerated or stopped, the distance between the collision edges of adjacent movers is greater than or equal to the preset anti-collision distance. The preset anti-collision distance is always maintained between adjacent movers, which can meet the necessary safety requirements for the movement of the movers.

[0144] In an embodiment of the present application, the current motion parameters of the above-mentioned mover are obtained according to the servo frequency of the above-mentioned servo control component; the real-time spacing between adjacent movers is determined according to the above-mentioned current motion parameters; the safety spacing between the above-mentioned adjacent movers is determined according to the above-mentioned current motion parameters, the above-mentioned servo frequency and the preset anti-collision spacing; the above-mentioned preset anti-collision spacing is used to characterize the preset minimum distance between the collision edges of adjacent movers; whether there is a collision risk between adjacent movers is determined according to the above-mentioned real-time spacing and the above-mentioned safety spacing; if there is a collision risk, the corresponding mover is controlled to slow down or stop. In this way, the mover anti-collision control method can be embedded in the servo loop of the magnetic drive motor conveying system, and the safety spacing between adjacent movers can be adjusted dynamically at high frequency, so as to effectively prevent the collision between movers while maintaining efficient conveying. Through servo control, the system can not only monitor and adjust the motion state of the mover in real time based on the servo frequency, but also dynamically adjust the safety spacing based on the current motion parameters of the mover, quickly respond to the state change of the mover in a short time, intelligently predict and avoid collision risks, ensure that the movers always maintain an appropriate safety spacing, and effectively avoid collisions. This method not only improves the safety and reliability of the system, but also optimizes the conveying efficiency and reduces the downtime and maintenance costs caused by collisions. In addition, since this method is implemented through a software algorithm and embedded in the servo loop of the magnetic drive motor conveying system, it has high control accuracy and controllability and does not require major modifications to hardware such as external sensors. Therefore, it can be easily integrated into the existing magnetic drive motor conveying system and has high applicability.

[0145] Please refer to the following Figure 5 , which is a flow chart of another mover anti-collision control method provided by an exemplary embodiment of this specification. Figure 5 As shown, the mover anti-collision control method includes the following steps:

[0146] S501, obtaining current motion parameters of the mover according to the servo frequency of the servo control component.

[0147] Specifically, S501 is consistent with S201 and will not be described in detail here.

[0148] S502, determining a real-time spacing between adjacent movers according to the current positions of the movers.

[0149] Specifically, the current motion parameters of the mover are obtained, and the current motion parameters include the current position of the mover. The relative positions between adjacent movers can be calculated based on the current positions of adjacent movers. In this embodiment, the current position of the mover can be determined by the center of the mover as a reference, expressed as the center coordinates of the mover on the conveyor line body, and the real-time spacing can represent the actual physical distance between the center coordinates of the previous mover and the center coordinates of the next mover. Exemplary, the calculation process of the real-time spacing can refer to Figure 3.

[0150] S503, determining a safety radius of the mover according to the mover specification and load state of the mover.

[0151] Specifically, the current motion parameters of the mover are obtained, and the current motion parameters include the mover specifications and load status of the mover. The mover specifications include the physical size and shape information of the mover, which may include length, width and height; the load status includes the status of the items carried by the mover, including whether there is a load, load weight, load size, etc.

[0152] In this embodiment, the position of the collision edge of the mover can be determined by the mover specifications and load state, and the collision edge is the edge portion corresponding to the collision of adjacent movers. The safety radius is used to characterize the distance between the center of the mover and the collision edge.

[0153] In practical applications, the edge position where a mover may collide with an adjacent mover may vary with the movement of the mover, e.g. Figure 6 As shown in FIG. 1 , when the mover moves in a straight line, the edge position where the mover may collide with the adjacent movers in front and behind is the edge of the moving direction ( Figure 6 (a). When the mover turns, the edge where the mover may collide with the adjacent movers in front and behind is the inner corner ( Figure 6 b). In some embodiments, the safety radius (L1) between the current mover and the previous adjacent mover, and the safety radius (L2) between the current mover and the next adjacent mover can be determined in real time based on the actual collision edge between the adjacent movers. In this case, the safety radius of the mover can correspond to different safety radii depending on the adjacent movers. In some embodiments, in order to reduce the computational complexity, the safety radius (L3) can be determined based on the distance between the center coordinates of the mover and the farthest collision edge of the mover. In this case, no matter how the mover rotates, the safety radius can meet the requirements of safe movement of the mover.

[0154] In some embodiments, the above-mentioned determining the safety radius of the mover according to the mover specification and load state of the mover includes:

[0155] When the load state is no load, the safety radius of the mover is determined according to the mover specifications of the mover;

[0156] When the load state is loaded, the load specification of the load is obtained, and whether the length or width of the load is greater than the corresponding mover is determined according to the load specification;

[0157] If so, determine the safe radius of the mover based on the load specification of the load;

[0158] If not, the safety radius of the mover is determined according to the mover specifications of the mover.

[0159] Specifically, when the mover operates at each workstation, the corresponding operation information will be stored, so the load status will also be recorded when a load is placed on the mover. Each mover is equipped with a unique mover ID. Based on the mover ID, the load status of the current mover can be obtained. The load status includes whether there is a load and the load specification. When the mover is unloaded, the collision edge of the mover is the edge of the mover module itself, and the safety radius of the mover can be calculated based on the mover specifications of the mover. When the mover is loaded, it is necessary to compare the specifications of the mover and the load. When the length and width of the load are both smaller than the mover, it means that the load is small and the load does not exceed the mover load-bearing area. The collision edge of the mover is still the edge of the mover module itself, and the safety radius of the mover is still calculated based on the mover specifications of the mover. When either the length or width of the load is larger than the mover, it means that the load is large and the load exceeds the mover load-bearing area. The collision edge of the mover is the edge of the load, and the safety radius of the mover should be calculated based on the load specifications of the load.

[0160] like Figure 7 As shown, mover A1 is provided with a load B1, and the length and width of mover A1 are both greater than the length and width of load B1. In this case, the safety radius L1 of mover A1 can be calculated based on the specifications of mover A1. Mover A2 is provided with a load B2, and the length of mover A2 is less than the length of load B2. In this case, the safety radius L2 of mover A2 can be calculated based on the specifications of load B2. Mover A3 is provided with a load B3, and the width of mover A3 is less than the width of load B1. In this case, the safety radius L3 of mover A3 can be calculated based on the specifications of load B3.

[0161] In this embodiment, the magnetic drive motor conveying system can use movers of different specifications and can place loads of different specifications. Whether in linear motion or curved motion, the safety distance can be dynamically adjusted based on the safety radius of the mover, so that the safety distance can both avoid mover collision and maximize the conveying efficiency.

[0162] S504, determining the response distance of the mover according to the current speed or maximum speed limit of the mover and the servo frequency.

[0163] Specifically, the response distance is used to characterize the maximum moving distance of the mover within the predicted response time, which can be calculated based on the current speed or maximum speed limit of the mover and the predicted response time. The predicted response time represents the longest response time of the magnetic drive motor conveying system from the start of detecting the current motion parameters of the mover to confirming that the mover has completed deceleration or stopping when there is a risk of collision of the mover. Since the magnetic drive motor conveying system obtains the current motion parameters of the mover based on the servo frequency, the servo frequency is used for judging the risk of collision of the mover and confirming that the mover has completed deceleration or stopping. Therefore, the predicted response time is an integer multiple of the servo cycle, that is, it includes at least one servo cycle, and the servo cycle can be calculated based on the servo frequency. Among them, the predicted response time can be preset based on the number of servo cycles occupied in actual applications. For example, the predicted response time can be 1 servo cycle, 2 servo cycles, or 3 servo cycles.

[0164] In this embodiment, the safety distance is dynamically adjusted based on the response distance of the mover. A reasonable response distance can be dynamically adjusted under different servo frequencies and different mover speeds. The safety distance can be dynamically adjusted based on the response distance of the mover, so that the safety distance can avoid mover collision and maximize the transportation efficiency.

[0165] S505 , determining a safety distance between adjacent movers according to the safety radius, response distance and preset anti-collision distance corresponding to each mover.

[0166] Specifically, when the real-time spacing represents the distance between the centers of adjacent movers, the safety spacing can also be correspondingly expressed as the distance between the centers of adjacent movers. When movers A and B move in the same direction, the calculation of the safety spacing only considers the response distance of the rear mover A, and the safety spacing = the safety radius L1 of mover A + the response distance L2 of mover A + the safety radius L3 of mover B + the preset anti-collision spacing L0; when movers A and B move in opposite directions, the calculation of the safety spacing needs to consider the response distances of movers A and B at the same time, and the safety spacing = the safety radius L1 of mover A + the response distance L2 of mover A + the safety radius L3 of mover B + the response distance L4 of mover B + the preset anti-collision spacing L0.

[0167] S506, judging whether there is a collision risk between adjacent movers according to the real-time spacing and the safety spacing;

[0168] Specifically, S506 is consistent with S204 and will not be described in detail here.

[0169] S507: If there is a risk of collision, the corresponding mover is controlled to slow down or stop.

[0170] Specifically, S507 is consistent with S205 and will not be described in detail here.

[0171] Please refer to the following Figure 8 , which is a flow chart of another mover anti-collision control method provided by an exemplary embodiment of this specification. Figure 8 As shown, the mover anti-collision control method includes the following steps:

[0172] S801, obtaining current motion parameters of the mover according to the servo frequency of the servo control component.

[0173] Specifically, S801 is consistent with S201 and will not be described in detail here.

[0174] S802, determining a safety radius of the mover according to the mover specification and load status of the mover.

[0175] Specifically, S802 is consistent with S503 and will not be described in detail here.

[0176] S803, determining a real-time spacing between adjacent movers according to a safety radius corresponding to the movers and a current position.

[0177] Specifically, in this embodiment, the current position of the mover can be determined based on the center of the mover, expressed as the center coordinate of the mover on the conveyor line, and the real-time spacing can represent the actual physical distance between the collision edges of the previous mover and the next mover. Figure 4 , the distance D1 between the centers of adjacent movers is determined based on the center coordinates of the current positions of the adjacent movers, and then the safe radii D2 (previous mover) and D3 (next mover) of the movers are determined based on the specifications and load conditions of the movers, thereby calculating the real-time spacing D between the adjacent movers to be D1-D2-D3.

[0178] S804, determining the response distance of the mover according to the current speed or maximum speed limit of the mover and the servo frequency.

[0179] Specifically, S804 is consistent with S504 and will not be described in detail here.

[0180] S805: Determine a safety distance between adjacent movers according to a response distance corresponding to the movers and a preset anti-collision distance.

[0181] Specifically, when the real-time spacing represents the distance between the collision edges of adjacent movers, the safety spacing can also be correspondingly expressed as the distance between the collision edges of adjacent movers. When movers A and B move in the same direction, the calculation of the safety spacing only considers the response distance of mover A behind, and the safety spacing = the response distance L2 of mover A + the preset anti-collision spacing L0; when movers A and B move toward each other, the calculation of the safety spacing needs to consider the response distances of movers A and B at the same time, and the safety spacing = the response distance L2 of mover A + the response distance L4 of mover B + the preset anti-collision spacing L0.

[0182] S806, judging whether there is a collision risk between adjacent movers according to the real-time spacing and the safety spacing;

[0183] Specifically, S806 is consistent with S204 and will not be described in detail here.

[0184] S807: If there is a risk of collision, the corresponding mover is controlled to slow down or stop.

[0185] Specifically, S807 is consistent with S205 and will not be described in detail here.

[0186] In some embodiments of the present application, if there is a risk of collision, controlling the corresponding mover to slow down or stop includes:

[0187] If there is a risk of collision, determine whether the adjacent movers are in motion according to the current motion parameters corresponding to the adjacent movers;

[0188] When the adjacent movers are in motion and move in the same direction, the rear mover among the adjacent movers is controlled to slow down or stop;

[0189] When the adjacent movers are in motion and moving toward each other, the adjacent movers are controlled to stop at the same time;

[0190] When there is a static mover among the adjacent movers, the moving mover among the adjacent movers is controlled to stop.

[0191] Specifically, if the magnetic drive motor conveying system determines that there is a risk of collision between adjacent movers, the current motion parameters corresponding to the adjacent movers are required to determine whether the adjacent movers are in motion. Whether the movers are in motion can be determined based on motion parameters such as the speed and acceleration of the movers.

[0192] When adjacent movers are in motion and moving in the same direction, the risk of collision at this time is caused by the excessive speed of the rear mover, and the rear mover can be controlled to slow down. When the rear mover slows down to the same speed as the front mover, the distance between the collision edges of the adjacent movers should be greater than or equal to the preset anti-collision spacing. In addition, the rear mover can be controlled to further slow down or stop, so that the real-time spacing between the adjacent movers is greater than or equal to the safety spacing, and then the normal motion control of the mover can be continued.

[0193] When the adjacent movers are both in motion and moving towards each other, the two adjacent movers should be controlled to stop at the same time to avoid collision. When the adjacent movers are both stopped, the distance between the collision edges of the adjacent movers should be greater than or equal to the preset anti-collision distance.

[0194] When one of the adjacent movers is stationary and the other is in motion, the collision risk is caused by the moving mover, and the moving mover should be controlled to stop. When the moving mover stops, the distance between the collision edges of the adjacent movers should be greater than or equal to the preset anti-collision distance.

[0195] In this embodiment, collision risk monitoring and corresponding mover control measures are performed in each servo control.

[0196] Through the control strategy in this embodiment, the magnetic drive motor conveying system can take the most appropriate control measures to avoid collision according to the specific relative position and motion state between the movers.

[0197] In some embodiments of the present application, there are one or more preset interval sections on the conveyor line; each preset interval section is independently provided with an interval anti-collision distance and / or an interval maximum speed limit.

[0198] Specifically, the conveyor line in this embodiment can uniformly adopt the same maximum speed limit and preset anti-collision distance, or it can be divided into preset intervals separately, and the interval anti-collision distance and / or interval maximum speed limit can be independently set within the preset interval. In different intervals, setting the anti-collision distance and maximum speed limit suitable for the specific conditions of the section can optimize the operating performance of the mover. For example, in sections with turns, intersections, or large load changes, stricter anti-collision distances and lower speed limits can be set to ensure safety; while in straight sections without obstacles, looser anti-collision distances and higher speed limits can be set to improve transportation efficiency.

[0199] In some embodiments, when the mover is located within a preset interval, the preset anti-collision distance corresponding to the mover is the interval anti-collision distance of the preset interval; the maximum speed limit corresponding to the mover is the interval maximum speed limit of the preset interval.

[0200] Please refer to the following Fig. 9 , Fig. 9 A mover anti-collision control device is provided for an exemplary embodiment of the present application, and is configured in a magnetic drive motor conveying system. The magnetic drive motor conveying system includes a conveying line body formed by splicing a plurality of stators in sequence along the conveying line direction, a mover magnetically coupled to the stator, and a servo control component, such as Fig. 9 As shown, the mover anti-collision control device 900 includes:

[0201] An acquisition module 910 is used to acquire the current motion parameters of the mover according to the servo frequency of the servo control component;

[0202] A real-time spacing module 920 is used to determine the real-time spacing between adjacent movers according to the above current motion parameters;

[0203] A safety spacing module 930 is used to determine the safety spacing between the adjacent movers according to the current motion parameters, the servo frequency and a preset anti-collision spacing; the preset anti-collision spacing is used to represent a preset minimum distance between the collision edges of adjacent movers;

[0204] A risk judgment module 940 is used to judge whether there is a collision risk between adjacent movers according to the real-time spacing and the safety spacing;

[0205] The execution module 950 is used to control the corresponding mover to decelerate or stop if there is a collision risk.

[0206] In some possible embodiments, the current motion parameters include one or more of mover specifications, current position, motion direction, current speed, maximum speed limit, acceleration and load status.

[0207] In some possible embodiments, the real-time spacing and the safety spacing both represent the distance between the centers of adjacent movers; the real-time spacing module 920 is specifically used for:

[0208] The real-time spacing between adjacent movers is determined according to the current positions of the movers.

[0209] In some possible embodiments, the safety distance module 930 is specifically used for:

[0210] Determine the safety radius of the mover according to the mover specification and load state of the mover; the safety radius is used to characterize the distance between the center of the mover and the collision edge;

[0211] Determine the response distance of the mover according to the current speed or maximum speed limit of the mover and the servo frequency; the response distance is used to characterize the maximum moving distance of the mover within the predicted response time; the predicted response time includes at least one servo cycle;

[0212] The safety distance between adjacent movers is determined according to the safety radius, the response distance and the preset anti-collision distance corresponding to each of the movers.

[0213] In some possible embodiments, both the real-time spacing and the safety spacing represent the distance between the collision edges of adjacent movers; the real-time spacing module 920 is specifically used for:

[0214] Determine the safety radius of the mover according to the mover specification and load state of the mover, wherein the safety radius is used to characterize the distance between the center of the mover and the collision edge;

[0215] The real-time spacing between adjacent movers is determined according to the safety radius corresponding to the movers and the current position.

[0216] In some possible embodiments, the safety distance module 930 is specifically used for:

[0217] Determine the response distance of the mover according to the current speed or maximum speed limit of the mover and the servo frequency; the response distance is used to characterize the maximum moving distance of the mover within the predicted response time; the predicted response time includes at least one servo cycle;

[0218] The safety distance between adjacent movers is determined according to the response distance corresponding to the movers and the preset anti-collision distance.

[0219] In some possible embodiments, the execution module 950 is specifically used to:

[0220] If there is a collision risk, determining whether the adjacent movers are both in motion according to the current motion parameters corresponding to the adjacent movers;

[0221] When the adjacent movers are all in motion and move in the same direction, the rear mover among the adjacent movers is controlled to decelerate or stop;

[0222] When the adjacent movers are in motion and move toward each other, the adjacent movers are controlled to stop at the same time;

[0223] When there is a static mover among the adjacent movers, the moving mover among the adjacent movers is controlled to stop.

[0224] In some possible embodiments, after the corresponding movers are controlled to slow down or stop, the distance between the collision edges of the adjacent movers is greater than or equal to the preset anti-collision distance.

[0225] In some possible embodiments, the real-time distance module 920 or the safety distance module 930 is further specifically used for:

[0226] When the load state is no load, the safety radius of the mover is determined according to the mover specification of the mover;

[0227] When the load state is loaded, obtaining the load specification of the load, and judging whether the length or width of the load is greater than the corresponding mover according to the load specification;

[0228] If yes, the safety radius of the mover is determined according to the load specification of the load;

[0229] If not, the safety radius of the mover is determined according to the mover specifications of the mover.

[0230] In some possible embodiments, there are one or more preset interval sections on the above-mentioned conveying line body; each of the above-mentioned preset interval sections is independently provided with an interval anti-collision distance and / or an interval maximum speed limit.

[0231] In some possible embodiments, when the above-mentioned mover is located in the above-mentioned preset interval segment, the above-mentioned preset anti-collision distance corresponding to the above-mentioned mover is the interval anti-collision distance of the above-mentioned preset interval; the maximum speed limit corresponding to the above-mentioned mover is the interval maximum speed limit of the above-mentioned preset interval.

[0232] In some possible embodiments, the risk determination module 940 is specifically used to:

[0233] If the above real-time spacing between adjacent movers is smaller than the above safety spacing, there is a risk of collision between the above adjacent movers;

[0234] If the above-mentioned real-time distance between adjacent movers is not less than the above-mentioned safety distance, there is no risk of collision between the above-mentioned adjacent movers.

[0235] The division of the modules in the above-mentioned mover anti-collision control device is only for illustration. In other embodiments, the mover anti-collision control device can be divided into different modules as needed to complete all or part of the functions of the above-mentioned mover anti-collision control device. The implementation of each module in the mover anti-collision control device provided in the embodiment of the present application may be in the form of a computer program. The computer program can be run on a terminal or a server. The program modules constituted by the computer program can be stored in the memory of a terminal or a server. When the computer program is executed by the processor, all or part of the steps of the mover anti-collision control method described in the embodiment of the present application are implemented.

[0236] See also Fig.10 , Fig.10 A schematic diagram of a magnetic drive motor conveying system provided as an exemplary embodiment of the present application. The magnetic drive motor conveying system 1000 includes a conveying line body formed by sequentially splicing a plurality of stators 1010 along the conveying line direction, a mover 1020 magnetically coupled to the stator 1010, and a servo control component 1030, wherein the servo control component 1030 includes: a processor 1031 and a memory 1032;

[0237] Among them, the processor 1031 may include one or more processing cores. The processor 1031 uses various interfaces and lines to connect various parts in the entire magnetic drive motor conveying system 1000, and executes various functions and processes data of the magnetic drive motor conveying system 1000 by running or executing instructions, programs, code sets or instruction sets stored in the memory 1032, and calling data stored in the memory 1032. Optionally, the processor 1031 can be implemented in at least one hardware form of digital signal processing (Digital Signal Processing, DSP), field programmable gate array (Field-Programmable Gate Array, FPGA), and programmable logic array (Programmable Logic Array, PLA). The processor 1031 can integrate one or a combination of a processor (Central Processing Unit, CPU), an image processor (Graphics Processing Unit, GPU) and a modem.

[0238] Among them, the memory 1032 may include a random access memory (Random Access Memory, RAM) and may also include a read-only memory (Read-Only Memory, ROM). Optionally, the memory 1032 includes a non-transitory computer-readable medium. The memory 1032 can be used to store instructions, programs, codes, code sets or instruction sets. The memory 1032 may include a program storage area and a data storage area, wherein the program storage area may store instructions for implementing an operating system, instructions for at least one function (such as an acquisition function, a judgment function, an execution function, etc.), instructions for implementing the above-mentioned various method embodiments, etc.; the data storage area may store data involved in the above-mentioned various method embodiments, etc. The memory 1032 may also be optionally at least one storage device located away from the aforementioned processor 1031. As Fig.10 As shown, the memory 1032 as a computer storage medium may include an operating system, a network communication module, a user interface module, and program instructions.

[0239] Specifically, the processor 1031 may be used to call the program instructions stored in the memory 1032, and specifically perform the following operations:

[0240] Acquire the current motion parameters of the mover according to the servo frequency of the servo control component;

[0241] Determine the real-time spacing between adjacent movers according to the above current motion parameters;

[0242] Determine the safety distance between the adjacent movers according to the current motion parameters, the servo frequency and the preset anti-collision distance; the preset anti-collision distance is used to characterize the preset minimum distance between the collision edges of adjacent movers;

[0243] Determine whether there is a collision risk between adjacent movers according to the real-time spacing and the safety spacing;

[0244] If there is a risk of collision, the corresponding mover is controlled to slow down or stop.

[0245] In some possible embodiments, the current motion parameters include one or more of mover specifications, current position, motion direction, current speed, maximum speed limit, acceleration and load status.

[0246] In some possible embodiments, the real-time spacing and the safety spacing both represent the distance between the centers of adjacent movers; when the processor 1031 determines the real-time spacing between adjacent movers according to the current motion parameters, it further specifically performs:

[0247] The real-time spacing between adjacent movers is determined according to the current positions of the movers.

[0248] In some possible embodiments, when the processor 1031 determines the safety distance between adjacent movers according to the current motion parameters, the servo frequency of the servo control component and the preset anti-collision distance, the processor 1031 further specifically performs:

[0249] Determine the safety radius of the mover according to the mover specification and load state of the mover; the safety radius is used to characterize the distance between the center of the mover and the collision edge;

[0250] Determine the response distance of the mover according to the current speed or maximum speed limit of the mover and the servo frequency; the response distance is used to characterize the maximum moving distance of the mover within the predicted response time; the predicted response time includes at least one servo cycle;

[0251] The safety distance between adjacent movers is determined according to the safety radius, the response distance and the preset anti-collision distance corresponding to each of the movers.

[0252] In some possible embodiments, both the real-time spacing and the safety spacing represent the distance between the collision edges of adjacent movers; when the processor 1031 determines the real-time spacing between adjacent movers according to the current motion parameters, it further specifically performs:

[0253] Determine the safety radius of the mover according to the mover specification and load state of the mover, wherein the safety radius is used to characterize the distance between the center of the mover and the collision edge;

[0254] The real-time spacing between adjacent movers is determined according to the safety radius corresponding to the movers and the current position.

[0255] In some possible embodiments, when the processor 1031 determines the safety distance between adjacent movers according to the current motion parameters, the servo frequency of the servo control component and the preset anti-collision distance, the processor 1031 further specifically performs:

[0256] Determine the response distance of the mover according to the current speed or maximum speed limit of the mover and the servo frequency; the response distance is used to characterize the maximum moving distance of the mover within the predicted response time; the predicted response time includes at least one servo cycle;

[0257] The safety distance between adjacent movers is determined according to the response distance corresponding to the movers and the preset anti-collision distance.

[0258] In some possible embodiments, when the processor 1031 controls the corresponding mover to decelerate or stop if there is a risk of collision, it further specifically executes:

[0259] If there is a collision risk, determining whether the adjacent movers are both in motion according to the current motion parameters corresponding to the adjacent movers;

[0260] When the adjacent movers are all in motion and move in the same direction, the rear mover among the adjacent movers is controlled to decelerate or stop;

[0261] When the adjacent movers are in motion and move toward each other, the adjacent movers are controlled to stop at the same time;

[0262] When there is a static mover among the adjacent movers, the moving mover among the adjacent movers is controlled to stop.

[0263] In some possible embodiments, after the corresponding movers are controlled to slow down or stop, the distance between the collision edges of the adjacent movers is greater than or equal to the preset anti-collision distance.

[0264] In some possible embodiments, when determining the safety radius of the mover according to the mover specification and load state of the mover, the processor 1031 further specifically executes:

[0265] When the load state is no load, the safety radius of the mover is determined according to the mover specification of the mover;

[0266] When the load state is loaded, obtaining the load specification of the load, and judging whether the length or width of the load is greater than the corresponding mover according to the load specification;

[0267] If yes, the safety radius of the mover is determined according to the load specification of the load;

[0268] If not, the safety radius of the mover is determined according to the mover specifications of the mover.

[0269] In some possible embodiments, there are one or more preset interval sections on the above-mentioned conveying line body; each of the above-mentioned preset interval sections is independently provided with an interval anti-collision distance and / or an interval maximum speed limit.

[0270] In some possible embodiments, when the above-mentioned mover is located in the above-mentioned preset interval segment, the above-mentioned preset anti-collision distance corresponding to the above-mentioned mover is the interval anti-collision distance of the above-mentioned preset interval; the maximum speed limit corresponding to the above-mentioned mover is the interval maximum speed limit of the above-mentioned preset interval.

[0271] In some possible embodiments, when the processor 1031 determines whether there is a collision risk between adjacent movers according to the real-time spacing and the safety spacing, the processor 1031 further specifically performs:

[0272] If the above real-time spacing between adjacent movers is smaller than the above safety spacing, there is a risk of collision between the above adjacent movers;

[0273] If the above-mentioned real-time distance between adjacent movers is not less than the above-mentioned safety distance, there is no risk of collision between the above-mentioned adjacent movers.

[0274] The embodiment of the present application also provides a computer-readable storage medium, which stores instructions, and when the instructions are executed on a computer or a processor, the computer or the processor executes one or more steps in the above embodiment. If the various component modules of the above-mentioned mover anti-collision control device are implemented in the form of software functional units and sold or used as independent products, they can be stored in the above-mentioned computer-readable storage medium.

[0275] In the above embodiments, it can be implemented in whole or in part by software, hardware, firmware or any combination thereof. When implemented using software, it can be implemented in whole or in part in the form of a computer program product. The above-mentioned computer program product includes one or more computer instructions. When the above-mentioned computer program instructions are loaded and executed on a computer, the above-mentioned process or function according to the embodiment of the present application is generated in whole or in part. The above-mentioned computer can be a general-purpose computer, a special-purpose computer, a computer network or other programmable devices. The above-mentioned computer instructions can be stored in a computer-readable storage medium or transmitted by the above-mentioned computer-readable storage medium. The above-mentioned computer instructions can be transmitted from a website site, a computer, a server or a data center to another website site, a computer, a server or a data center by wired (such as coaxial cable, optical fiber, digital subscriber line (Digital Subscriber Line, DSL)) or wireless (such as infrared, wireless, microwave, etc.) mode. The above-mentioned computer-readable storage medium can be any available medium that a computer can access or a data storage device such as a server, a data center, etc. that contains one or more available media integrated. The above-mentioned available media can be magnetic media (for example, floppy disks, hard disks, tapes), optical media (for example, digital versatile discs (DVD)), or semiconductor media (for example, solid state disks (SSD)), etc.

[0276] Those skilled in the art can understand that all or part of the processes in the above-mentioned embodiments can be implemented by instructing the relevant hardware through a computer program, and the program can be stored in a computer-readable storage medium. When the program is executed, it can include the processes of the embodiments of the above-mentioned methods. The aforementioned storage medium includes: ROM, RAM, magnetic disk or optical disk and other media that can store program codes. In the absence of conflict, the technical features in this embodiment and the implementation scheme can be combined arbitrarily.

[0277] The embodiments described above are merely preferred embodiments of the present application and are not intended to limit the scope of the present application. Without departing from the design spirit of the present application, various modifications and improvements made to the technical solutions of the present application by ordinary technicians in this field should fall within the protection scope determined by the claims.

[0278] The above describes a specific embodiment of the present application. Other embodiments are within the scope of the appended claims. In some cases, the actions or steps recorded in the claims and the specification can be performed in an order different from the order in the embodiments recorded in the specification and still achieve the desired results. In addition, the process depicted in the drawings does not necessarily require the specific order or continuous order shown to achieve the desired results. In some embodiments, multitasking and parallel processing are also possible or may be advantageous.

Claims

1. A mover anti-collision control method, It is characterized in that Applied to a magnetic drive motor conveying system, the magnetic drive motor conveying system includes a conveying line body formed by splicing a plurality of stators in sequence along the conveying line direction, a mover magnetically coupled to the stator, and a servo control component, the method includes: Acquiring the current motion parameters of the mover according to the servo frequency of the servo control component; Determine the real-time spacing between adjacent movers according to the current motion parameters; Determine the safety distance between the adjacent movers according to the current motion parameter, the servo frequency and a preset anti-collision distance; the preset anti-collision distance is used to characterize a preset minimum distance between the collision edges of adjacent movers; Determining whether there is a collision risk between adjacent movers according to the real-time spacing and the safety spacing; If there is a risk of collision, the corresponding mover is controlled to slow down or stop.

2. The mover anti-collision control method according to claim 1, It is characterized in that The current motion parameters include one or more of mover specifications, current position, motion direction, current speed, maximum speed limit, acceleration and load status.

3. The mover anti-collision control method according to claim 1, It is characterized in that The real-time spacing and the safety spacing both represent the distance between the centers of adjacent movers; and determining the real-time spacing between adjacent movers according to the current motion parameters includes: The real-time spacing between adjacent movers is determined according to the current position of the movers.

4. The mover anti-collision control method according to claim 3, It is characterized in that The step of determining the safety distance between adjacent movers according to the current motion parameter, the servo frequency of the servo control component and the preset anti-collision distance comprises: Determine the safety radius of the mover according to the mover specification and load state of the mover; the safety radius is used to characterize the distance between the center of the mover and the collision edge; Determine the response distance of the mover according to the current speed or maximum speed limit of the mover and the servo frequency; the response distance is used to characterize the maximum moving distance of the mover within the predicted response time; the predicted response time includes at least one servo cycle; The safety distance between adjacent movers is determined according to the safety radius, the response distance and the preset anti-collision distance corresponding to each of the movers.

5. The mover anti-collision control method according to claim 1, It is characterized in that The real-time spacing and the safety spacing both represent the distance between the collision edges of adjacent movers; the real-time spacing between adjacent movers is determined according to the current motion parameters, including: Determine a safety radius of the mover according to the mover specification and load state of the mover, wherein the safety radius is used to characterize the distance between the center of the mover and the collision edge; The real-time spacing between adjacent movers is determined according to the safety radius corresponding to the movers and the current position.

6. The mover anti-collision control method according to claim 5, It is characterized in that The step of determining the safety distance between adjacent movers according to the current motion parameter, the servo frequency of the servo control component and the preset anti-collision distance comprises: Determine the response distance of the mover according to the current speed or maximum speed limit of the mover and the servo frequency; the response distance is used to characterize the maximum moving distance of the mover within the predicted response time; the predicted response time includes at least one servo cycle; The safety distance between adjacent movers is determined according to the response distance corresponding to the movers and the preset anti-collision distance.

7. The mover anti-collision control method according to claim 1, It is characterized in that If there is a risk of collision, the corresponding mover is controlled to slow down or stop, including: If there is a risk of collision, determining whether the adjacent movers are both in motion according to the current motion parameters corresponding to the adjacent movers; When the adjacent movers are all in motion and move in the same direction, the rear mover among the adjacent movers is controlled to decelerate or stop; When the adjacent movers are both in motion and moving toward each other, the adjacent movers are controlled to stop simultaneously; When there is a static mover among the adjacent movers, the moving mover among the adjacent movers is controlled to stop.

8. The mover anti-collision control method according to claim 1, It is characterized in that After the corresponding movers are controlled to slow down or stop, the distance between the collision edges of adjacent movers is greater than or equal to the preset anti-collision distance.

9. The mover anti-collision control method according to claim 4 or 5, It is characterized in that Determining the safety radius of the mover according to the mover specification and load state of the mover includes: When the load state is no load, determining the safety radius of the mover according to the mover specification of the mover; When the load state is loaded, obtaining a load specification of the load, and judging whether the length or width of the load is greater than the corresponding mover according to the load specification; If yes, determining the safety radius of the mover according to the load specification of the load; If not, the safety radius of the mover is determined according to the mover specification of the mover.

10. The mover anti-collision control method according to claim 1, It is characterized in that There are one or more preset interval sections on the conveyor line; each of the preset interval sections is independently provided with an interval anti-collision distance and / or an interval maximum speed limit.

11. The mover anti-collision control method according to claim 10, It is characterized in that When the mover is located within the preset interval, the preset anti-collision distance corresponding to the mover is the interval anti-collision distance of the preset interval; and the maximum speed limit corresponding to the mover is the interval maximum speed limit of the preset interval.

12. The mover anti-collision control method according to claim 1, It is characterized in that The determining whether there is a collision risk between adjacent movers according to the real-time spacing and the safety spacing includes: If the real-time spacing between adjacent movers is smaller than the safety spacing, there is a risk of collision between the adjacent movers; If the real-time spacing between adjacent movers is not less than the safety spacing, there is no risk of collision between the adjacent movers.

13. A mover anti-collision control device, It is characterized in that The device is configured in a magnetic drive motor conveying system, wherein the magnetic drive motor conveying system comprises a conveying line body formed by splicing a plurality of stators in sequence along the conveying line direction, a mover magnetically coupled with the stator, and a servo control component. The device comprises: An acquisition module, used for acquiring the current motion parameters of the mover according to the servo frequency of the servo control component; A real-time spacing module, used to determine the real-time spacing between adjacent movers according to the current motion parameters; A safety spacing module, used to determine the safety spacing between the adjacent movers according to the current motion parameters, the servo frequency and a preset anti-collision spacing; the preset anti-collision spacing is used to characterize a preset minimum distance between the collision edges of adjacent movers; A risk judgment module, used for judging whether there is a collision risk between adjacent movers according to the real-time spacing and the safety spacing; The execution module is used to control the corresponding mover to slow down or stop if there is a risk of collision.

14. A magnetic drive motor conveying system, It is characterized in that The magnetically driven motor conveying system includes a conveying line body formed by a plurality of stators spliced ​​in sequence along the conveying line direction, a mover magnetically coupled to the stator, and a servo control component, wherein the servo control component includes: a processor and a memory; wherein the memory stores a computer program, and the computer program is suitable for being loaded by the processor and executing the method steps as claimed in any one of claims 1 to 12.

Citation Information

Patent Citations

  • Rotor control method and control system for long stator conveying system

    CN112027676A

  • Magnetic conveying line driving system, magnetic conveying line and magnetic conveying line driving method

    CN113726262A

  • Conveyor system and method for operating conveyor system with collision monitoring

    CN115477128A

  • Film coating equipment and film coating method

    CN117782992A

  • Motion control method of magnetic levitation conveying system and related equipment

    CN118004764A

Cited By

  • Rotor control method of magnetic drive conveying system and related equipment

    CN119429705A

  • Flexible magnetic suspension conveying method, device and equipment based on edge calculation and medium

    CN120004014A

  • Collision control method, device and system, electronic equipment and storage medium

    CN120406435A

  • Anti-collision control method and device, transmission system, electronic equipment and storage medium

    CN120406436A

  • Anti-collision control method and controller thereof

    CN122316174A