Movement control method for moving sub-modules and control device for linear motor equipment
By controlling the interaction between the moving submodule and external equipment at specific times based on the position information of the moving submodule and external equipment in the automated transportation system, the problem of low interaction efficiency caused by the non-uniform time distribution of the moving submodule is solved, and efficient and stable interaction between the moving submodule and external equipment is achieved.
Patent Information
- Application Number
- CN202611466898.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-09-20
- Publication Date
- 2026-11-17
AI Technical Summary
In automated transportation systems, the time it takes for multiple moving sub-modules to pass through the detection point is not uniformly distributed, resulting in the moving sub-module spacing not meeting the requirements and affecting the interaction efficiency between the moving sub-modules and external equipment.
By acquiring the real-time position information of the first moving submodule among multiple moving submodules and the initial position information of the reference point of the external device, the initial coordinate position of the first moving submodule when interacting with the external device is determined, and the first interaction time is recorded. Subsequent non-first moving submodules are controlled to reach the initial coordinate position at predetermined intervals to interact with the external device, ensuring that the moving submodules are evenly arranged in space and time.
It improves the success rate of interaction between the moving submodule and external devices and the stability of transported objects, reduces the frequency of control parameter adjustment, and enhances the overall efficiency and stability of the automated transportation system.
Smart Images

Figure CN123113592A_ABST
Abstract
Description
Technical Field
[0001] This disclosure relates to the field of motor control technology or other related technical fields, specifically to a method for controlling the movement of a moving submodule and a control device for a linear motor device. Background Technology
[0002] In automated transportation systems, multiple moving submodules often need to achieve high-precision synchronous linkage to complete interactive operations with external equipment, such as material transfer and collaborative processing. Related technologies typically employ the linkage between moving submodules and external equipment; however, this approach has significant drawbacks: due to the non-uniform distribution of time for multiple moving submodules to pass through the detection point, and the non-uniform arrangement of master and slave moving submodules, the operating equipment needs to make corresponding adjustments to the operation process based on the actual arrangement of the moving submodules, increasing the control complexity of the operating equipment and affecting the interaction efficiency between the moving submodules and external equipment.
[0003] There is currently no effective solution to the above problems. Summary of the Invention
[0004] This invention provides a method for controlling the movement of a moving submodule and a control device for a linear motor device, to at least solve the technical problem in related technologies where the time for multiple moving submodules to pass through detection points is not uniformly distributed, which easily leads to the moving submodule spacing not meeting the requirements, resulting in reduced interaction efficiency between the moving submodules and external devices.
[0005] To achieve the above objectives, according to one aspect of this application, a method for controlling the movement of a moving submodule is provided, comprising: determining the initial coordinate position of the first moving submodule when interacting with the external device based on the real-time position information of the first moving submodule among a plurality of moving submodules and the initial position information of the reference point of an external device, and recording a first interaction time; controlling subsequent non-first moving submodules of the first moving submodule to reach the initial coordinate position at a predetermined interval time to interact with the external device, wherein the predetermined interval time is determined by the first interaction time combined with the interval duration corresponding to the distance between the reference point of the external device and the target movement distance.
[0006] Optionally, determining the initial coordinate position of the first moving submodule when interacting with the external device, based on the real-time position information of the first moving submodule among multiple moving submodules and the initial position information of the reference point of the external device, includes: acquiring the real-time position information of the first moving submodule and the initial position information of the reference point of the external device; calculating a first distance from the first moving submodule to a first interaction position based on the real-time position information, wherein the first interaction position is the position of the first moving submodule when interacting with the external device; when the first distance information and the second distance information are the same, controlling the first moving submodule to interact with the external device, and recording the coordinate position of the first moving submodule during the interaction to obtain the initial coordinate position.
[0007] Optionally, before obtaining the real-time position information of the first and second moving submodules and the initial position information of the reference point of the external device, the method further includes: determining the start-up timing and start-up position of the first and second moving submodules based on the operation of the external device; if the start-up timing is met, triggering the start-up of the first and second moving submodules according to the start-up position, so that the first and second moving submodules accelerate to a target linear velocity that matches the target rotation speed of the external device, and run to the first interactive position.
[0008] Optionally, when the first distance information and the second distance information are the same, the first moving submodule is controlled to interact with the external device, and the coordinate position of the first moving submodule during the interaction is recorded to obtain the initial coordinate position. This includes: determining whether the first distance information from the first moving submodule to the first interaction position is the same as the second distance information from the reference point of the external device to the second interaction position; when the first distance information and the second distance information are the same, determining that the first moving submodule is in a state suitable for linkage with the external device, recording the current time, taking the current time as the first interaction time, and obtaining the coordinate position of the first moving submodule when interacting with the external device at the first interaction time to obtain the initial coordinate position.
[0009] Optionally, controlling the non-first-first moving submodules following the first moving submodule to reach the initial coordinate position at a predetermined interval to interact with the external device includes: obtaining the real-time movement position of the non-first-first moving submodules following the first moving submodule; calculating the target distance between the real-time movement position of the non-first-first moving submodules and the initial coordinate position; and calculating the interval time required for the reference point of the external device to move the target distance; accumulating the interval time based on the first interaction time to obtain the predetermined interval time; and controlling the non-first-first moving submodules to follow the first moving submodule until the predetermined interval time is reached, controlling the non-first-first moving submodules to reach the initial coordinate position to interact with the external device.
[0010] Optionally, controlling the non-first-to-last moving submodule to follow the first-to-last moving submodule until the predetermined interval time is reached, controlling the non-first-to-last moving submodule to reach the initial coordinate position for interaction with the external device, includes: controlling the non-first-to-last moving submodule to follow the first-to-last moving submodule until the predetermined interval time is reached, controlling the non-first-to-last moving submodule to reach the initial coordinate position; upon reaching the initial coordinate position, controlling the moving speed of the non-first-to-last moving submodule to be the same as the moving speed of the first-to-last moving submodule, and controlling the non-first-to-last moving submodule to interact with the external device.
[0011] Optionally, when reaching the initial coordinate position, controlling the moving speed of the non-first and first moving submodules to be the same as the moving speed of the first and first moving submodule includes: determining the single-movement distance of the reference point corresponding to a single external signal under the uniform motion state of the external device; calculating the single-movement increment of the moving submodule corresponding to a single external signal based on the single-movement distance of the reference point and the initial distance from the first and first moving submodule to the initial coordinate position; and dynamically adjusting the moving speed of the non-first and first moving submodules according to the single-movement increment, so that when the non-first and first moving submodules reach the initial coordinate position, the moving speed of the non-first and first moving submodules is the same as that of the first and first moving submodule, so as to control the uniform arrangement of multiple moving submodules.
[0012] Optionally, obtaining the real-time movement position of the non-first moving submodules after the first moving submodule includes: collecting motion state signals after the external device is started, and determining the real-time position of the external device reference point based on the initial position of the external device reference point and the total number of motion state signals collected after the external device is started, thereby obtaining the real-time movement position.
[0013] According to another aspect of the present invention, a control device for a linear motor device is also provided, including a processor and a memory, wherein the memory is used to store a program, and the processor is used to run the program, wherein the program executes the movement control method of the moving submodule described in any one of the above embodiments.
[0014] According to another aspect of the present invention, an automated transportation system is also provided, comprising a plurality of moving sub-modules, a stator module, and a control device, wherein: the moving sub-modules move along the stator track, and the total number of the moving sub-modules is even; the control device is used to control at least two moving sub-modules to grasp items to be transported on the stator track; after receiving a movement command, the control device determines the initial coordinate position of the first moving sub-module when interacting with the external device based on the real-time position information of the first moving sub-module and the initial position information of the reference point of the external device, and records a first interaction time; and controls subsequent non-first moving sub-modules of the first moving sub-module to reach the initial coordinate position at a predetermined interval time to interact with the external device, wherein the predetermined interval time is determined by the first interaction time combined with the interval time corresponding to the distance between the reference point of the external device and the target movement distance.
[0015] According to another aspect of the present invention, a computer-readable storage medium is also provided, the computer-readable storage medium including a stored computer program, wherein, when the computer program is executed, it controls the device where the computer-readable storage medium is located to execute the movement control method of any of the above-mentioned moving sub-modules.
[0016] According to another aspect of the present invention, an electronic device is also provided, including one or more processors and a memory, the memory being used to store one or more programs, wherein when the one or more programs are executed by the one or more processors, the one or more processors cause the one or more processors to implement the motion control method of the moving submodule described above.
[0017] According to another aspect of the present invention, a computer program product is also provided, including a computer program that, when executed by a processor, implements the steps of the motion control method for the moving submodule described in any of the above embodiments.
[0018] In this embodiment, the initial coordinate position of the first moving submodule when interacting with the external device is first determined based on the real-time position information of the first moving submodule among multiple moving submodules and the initial position information of the reference point of the external device, and the first interaction time is recorded; the subsequent non-first moving submodules of the first moving submodule are controlled to reach the initial coordinate position at a predetermined interval to interact with the external device, wherein the predetermined interval is determined by the first interaction time and the interval time corresponding to the distance of the reference point of the external device moving target.
[0019] In this disclosure, the initial coordinate position of the first moving submodule when interacting with the external device can be determined first. The first moving submodule and the subsequent driven submodules are controlled to reach the initial coordinate position after a predetermined time interval to interact with the external device. This ensures that multiple moving submodules are evenly arranged in space and time, avoiding the accumulation of moving submodules at the interaction position. The external device can perform interactive operations based on a fixed rhythm and logic without frequent adjustment of control parameters, reducing waiting time and invalid actions. This improves the overall efficiency of the interaction between the moving submodules and the external device, enabling the efficient and stable operation of the automated transportation system. This solves the technical problem in related technologies where the time of multiple moving submodules passing through the detection point is not uniformly distributed, which easily leads to the moving submodule spacing not meeting the requirements, resulting in a decrease in the interaction efficiency between the moving submodules and the external device.
[0020] Other features and advantages of this disclosure will be described in detail in the following detailed description section. Attached Figure Description
[0021] The accompanying drawings are provided to further illustrate the present disclosure and form part of the specification. They are used together with the following detailed description to explain the present disclosure, but do not constitute a limitation thereof. In the drawings: Figure 1 This is a schematic diagram of an automated transportation scenario in related technologies.
[0022] Figure 2 This is a flowchart of an optional movement control method for a moving submodule according to an embodiment of the present invention.
[0023] Figure 3 This is a schematic diagram of the movement control method for the moving submodule provided in the embodiments of this application. Figure 1 .
[0024] Figure 4 This is a schematic diagram of the movement control method for the moving submodule provided in the embodiments of this application. Figure 2 .
[0025] Figure 5 This is a schematic diagram of an optional automated transportation system according to an embodiment of this application. Detailed Implementation
[0026] To enable those skilled in the art to better understand the present invention, the technical solutions of the present invention will be clearly and completely described below with reference to the accompanying drawings of the embodiments of the present invention. Obviously, the described embodiments are only some embodiments of the present invention, and not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative effort should fall within the scope of protection of the present invention.
[0027] It should be noted that the terms "first," "second," etc., in the specification, claims, and accompanying drawings of this invention are used to distinguish similar objects and are not necessarily used to describe a specific order or sequence. It should be understood that such data can be interchanged where appropriate so that the embodiments of the invention described herein can be implemented in orders other than those illustrated or described herein. Furthermore, the terms "comprising" and "having," and any variations thereof, are intended to cover a non-exclusive inclusion; for example, a process, method, system, product, or apparatus that comprises a series of steps or units is not necessarily limited to those steps or units explicitly listed, but may include other steps or units not explicitly listed or inherent to such processes, methods, products, or apparatus.
[0028] To facilitate understanding of the present invention by those skilled in the art, some terms or nouns involved in the various embodiments of the present invention are explained below: The moving module is configured to move along the stator track.
[0029] Stator module: configured to be magnetically coupled to the mover module to control the movement or stationary position of the mover module relative to the stator module.
[0030] Stator track: It is formed by splicing multiple stator modules, and there are electrical connections between the stator modules for power supply and communication.
[0031] In this embodiment of the invention, it is applicable to automated transport line scenarios for transporting multiple types of goods. During the movement of the moving sub-modules, the real-time position information of the first moving sub-module and the initial position information of the reference point of the external device can be obtained. Then, the initial coordinate position of the first moving sub-module when interacting with the external device is determined, the first interaction time is recorded, and then the subsequent non-first moving sub-modules are controlled to reach the initial coordinate position at a predetermined interval to interact with the external device. This allows multiple driven sub-modules to reach the target distance, maintaining a uniform spatial spacing and improving the success rate of interaction between the moving sub-modules and the external device, as well as the stability of the transported objects.
[0032] It should be noted that there are multiple possibilities for the positional relationship between the mover and the stator in the embodiments of the present invention, such as the mover being located above, to the side or below the stator module, which is not limited here.
[0033] The motion control method for moving submodules provided in this invention is applicable to automated logistics scenarios, such as industrial automation scenarios where reliable material transfer, positioning, or clamping is required between intelligent transportation equipment and external devices, and sorting or transmission systems in automated production lines. It improves the success rate and consistency of interaction between moving submodules and external devices, ensuring a uniform arrangement of multiple driven submodules and enhancing the stability of transported objects. Therefore, the motion control method for moving submodules provided by this invention can improve the success rate of interaction between moving submodules and external devices during movement, as well as the stability of transported objects.
[0034] It should also be noted that the steps shown in the flowcharts of the accompanying drawings can be executed in a computer system such as a set of computer-executable instructions. Furthermore, although a logical order is shown in the flowcharts, in some cases, the steps shown or described may be executed in a different order than that presented here. Additionally, the moving parts, stators, etc., shown in the accompanying drawings of this application are for illustrative purposes only and do not limit the number of moving parts, the number of stators, the shape of the movement path, etc.
[0035] Currently, in automated transportation scenarios, the moving module can carry objects along the stator track to transport them to the target location. Figure 1 This is a schematic diagram of an automated transportation scenario within related technologies. For example... Figure 1 As shown, including but not limited to at least one moving submodule ( Figure 1 The diagram shows four moving sub-modules (first moving sub-module 101, second moving sub-module 102, third moving sub-module 103, and fourth moving sub-module 104) and a stator track 105. The stator track 105 can drive the moving sub-modules to move via magnetic coupling. The stator track 105 may include at least one stator module; in the case of multiple stator modules, adjacent stator modules are spliced together. Each moving sub-module may include a permanent magnet, and each stator module in the stator track 105 may include a coil. When the coil is energized, it generates a changing magnetic field. This changing magnetic field interacts with the permanent magnet, thereby generating a thrust on the moving sub-module, allowing it to move along the stator track 105.
[0036] refer to Figure 1 External equipment can be distributed around the stator track 105, such as... Figure 1The external device 106 interacts with the moving submodule to perform specific processing, assembly, or handling tasks. For example, when the moving submodule moves along the stator track 105 to a designated position while carrying goods, it needs to interact with the external device 106. For instance, the moving submodule may need to stop at the gripping position of the external device 106 so that the robotic arm can load the goods onto the moving submodule; or the moving submodule may need to stop at the processing position of the external device 106 so that the external device can perform processing operations on the goods, etc.
[0037] However, as the number of movers running on the stator track 105 increases, if they are arranged according to the spacing requirements of the mover modules under actual working conditions, the non-uniform distribution of the time for multiple movers to pass the detection point and the non-uniform arrangement between the master and slave mover modules in the related technology make it necessary for the operating equipment to make corresponding adjustments to the operation process according to the actual arrangement of multiple mover modules, which increases the control difficulty of the operating equipment and affects the interaction efficiency between the mover modules and external equipment.
[0038] To address the technical problems raised in this application, this application provides the following: Figure 2 The control method of the moving submodule is shown.
[0039] Figure 2 This is a flowchart of an optional movement control method for a moving submodule according to an embodiment of the present invention, such as... Figure 2 As shown, the method includes the following steps S201 to S202. The present invention will be described in detail below with reference to each implementation step.
[0040] First, this embodiment can collect the real-time position data of the first moving submodule and the initial state of the external device reference point, and calculate the critical conditions for the first moving submodule and the external device to meet at the interaction point.
[0041] Step S201: Based on the real-time position information of the first moving submodule among multiple moving submodules and the initial position information of the reference point of the external device, determine the initial coordinate position of the first moving submodule when interacting with the external device, and record the first interaction moment.
[0042] Optionally, the initial coordinate position of the first moving submodule when interacting with the external device is determined based on the real-time position information of the first moving submodule among multiple moving submodules and the initial position information of the reference point of the external device. This includes: acquiring the real-time position information of the first moving submodule and the initial position information of the reference point of the external device; calculating the first distance information from the first moving submodule to the first interaction position based on the real-time position information, wherein the first interaction position is the position of the first moving submodule when interacting with the external device; and when the first distance information is the same as the second distance information, controlling the first moving submodule to interact with the external device and recording the coordinate position of the first moving submodule during the interaction to obtain the initial coordinate position.
[0043] Among them, obtaining the real-time position information of the first moving submodule can include reading the instantaneous coordinates of the first moving submodule on the stator track from each stator on the stator track (or through sensors); at the same time, obtaining the initial position information of the external device reference point can refer to recording the spatial attitude or linear position of the external device at the moment of system startup or control command issuance.
[0044] In some embodiments, the first distance information can refer to a straight-line distance or an arc distance, depending on the motion trajectory of the moving submodule. The first distance information reflects the travel distance required for the first and second moving submodules to reach the predetermined interaction point from their current positions, which helps to predict the arrival time. Further, second distance information can be determined. Based on the initial position of the external device reference point and the received external signals, the distance from the external device reference point to the interaction position is calculated. The second distance information determines the travel distance required for the external device to reach the interaction point from its initial state. Then, by comparing the first and second distance information, it can be determined whether the two (the first and second moving submodules and the external device) have the conditions for synchronous intersection in time and space.
[0045] It should be noted that when the first distance information and the second distance information are the same, the first moving submodule can be controlled to interact with the external device, and the coordinate position of the first moving submodule during the interaction can be recorded to obtain the initial coordinate position (the record of the initial coordinate position can include X, Y, Z coordinate information and attitude information). Then, the time corresponding to this initial coordinate position (i.e., position P1) can be recorded to establish a fixed spatial reference point. Thus, this initial coordinate position can not only identify the spatial location where the interaction occurs, but also implicitly contain the time attribute at this time.
[0046] Optionally, before obtaining the real-time position information of the first and second moving submodules and the initial position information of the reference point of the external device, the method further includes: determining the start-up timing and start-up position of the first and second moving submodules based on the operation of the external device; if the start-up timing is met, triggering the start-up of the first and second moving submodules based on the start-up position, so that the first and second moving submodules accelerate to the target linear velocity that matches the target rotation speed of the external device, and run to the first interactive position.
[0047] Determining the start-up timing and position of the first and second moving parts based on the operating status of external equipment can include analyzing the current speed, position, and upcoming interaction cycle of the external equipment. This ensures that the initial movement of the first and second moving parts matches the rhythm of the external equipment, reducing the magnitude of subsequent adjustments. Furthermore, if the start-up timing is suitable, the first and second moving parts are triggered based on the start-up position. The start-up timing can refer to the moment when the external equipment reaches a specific phase or position, or to a predetermined time window after the control system receives the interaction command. Triggering the start-up based on the start-up position ensures that the first and second moving parts begin moving from a suitable initial point, thereby shortening the time and distance required to reach the target state.
[0048] Optionally, after triggering the start of the first moving submodule based on the start position, the first moving submodule is accelerated to a target linear velocity matching the target rotational speed of the external device, and then runs to the first interaction position. The target linear velocity can be obtained by converting the target rotational speed of the external device. If the external device is a rotating mechanism, the target linear velocity can be a tangential velocity calculated based on the rotation radius and angular velocity. Specifically, during the acceleration of the first moving submodule, a constant acceleration strategy can be adopted to smooth the motion state of the sliding submodule and avoid mechanical shock. Furthermore, when the first moving submodule reaches the first interaction position, its velocity state is consistent with or proportional to the linear velocity of the external device at that position. This helps to achieve smooth energy transfer or signal synchronization at the moment of interaction, reducing control errors or interaction failure risks caused by speed differences, and improving the stability and accuracy of the interaction process.
[0049] Optionally, when the first distance information and the second distance information are the same, the first moving submodule is controlled to interact with the external device, and the coordinate position of the first moving submodule during the interaction is recorded to obtain the initial coordinate position. This includes: determining whether the first distance information from the first moving submodule to the first interaction position is the same as the second distance information from the reference point of the external device to the second interaction position; when the first distance information and the second distance information are the same, determining that the first moving submodule is in a state suitable for linkage with the external device, recording the current time, taking the current time as the first interaction time, and obtaining the coordinate position of the first moving submodule when interacting with the external device at the first interaction time to obtain the initial coordinate position.
[0050] The determination of whether the first distance information from the first moving submodule to the first interaction position is the same as the second distance information from the reference point of the external device to the second interaction position can be understood as determining whether the two have the potential to arrive at a specific spatial position synchronously in the time dimension. The first distance information reflects the remaining travel of the first moving submodule, and the second distance information reflects the remaining travel of the external device. The equality of the two values indicates that if the current speed is maintained, the two will arrive at the interaction area at the same time.
[0051] It should be noted that when the first distance information and the second distance information are the same, it can be determined that the first moving submodule is in a state suitable for linkage with external devices. At this time, the control logic tends to establish a linkage relationship to reduce the complexity and adjustment of subsequent control algorithms. Then, the current time is recorded as the first interaction time, which marks the absolute time of the first linkage instance. Recording this time can construct the timeline of the entire multi-body cooperative system, providing a time reference for the delay control of subsequent moving submodules. For example, subsequent driven submodules can calculate their time offset relative to the first moving submodule based on this time.
[0052] Furthermore, the coordinate position of the first moving submodule interacting with the external device at the first interaction moment is obtained to obtain the initial coordinate position, which is the aforementioned point P1. This defines the specific point where the interaction occurs in space. Obtaining this coordinate position may include reading the encoder data of the moving submodule or the feedback from the vision system and mapping it to the system coordinate system. The initial coordinate position serves as the "anchor point" for the subsequent synchronous control of the moving submodule. This allows the subsequent driven submodule to calculate the time increment or speed adjustment strategy required to reach this point, thereby achieving the uniform arrangement and synchronous linkage of multiple moving submodules.
[0053] like Figure 3 As shown, multiple moving submodules ( Figure 3 The diagram shows three moving sub-modules: a first moving sub-module 301, two driven sub-modules (moving from left to right, including a second moving sub-module 302 and a third moving sub-module 303 following the first moving sub-module 301) arranged statically on a stator track 304, an external device 305, a first interactive position A1, and a second interactive position A2.
[0054] First, the start-up timing and start-up position of the first moving submodule 301 are determined based on the operation of the external device 305. If the start-up timing is met, the first moving submodule 301 is triggered to start according to the start-up position so that the first moving submodule 301 accelerates to the target linear velocity that matches the target rotation speed of the external device 305 and runs to the first interactive position A1.
[0055] Next, the real-time position information of the first moving submodule 301 and the initial position information of the reference point of the external device 305 are obtained. Then, the first interaction position A1 of the first moving submodule 301 when interacting with the external device 305 is determined. Based on the aforementioned real-time position information, the first distance information A1 from the first moving submodule 301 to the first interaction position is calculated. Finally, when the first distance information is the same as the second distance information, the first moving submodule 301 is controlled to interact with the external device 305, and the coordinate position of the first moving submodule during the interaction is recorded to obtain the initial coordinate position. Specifically, when it is determined that the first distance information is the same as the second distance information, it is determined that the first moving submodule 301 is in a state suitable for linkage with the external device 305. The current time is recorded, and the current time is taken as the first interaction time. The coordinate position of the first moving submodule 301 when interacting with the external device 305 during the first interaction time is obtained to obtain the initial coordinate position.
[0056] Step S202: Control the non-first moving submodules following the first moving submodule to reach the initial coordinate position at a predetermined interval to interact with the external device. The predetermined interval is determined by the first interaction time and the interval time corresponding to the distance between the reference point and the target distance of the external device.
[0057] Optionally, controlling the non-first-first-second moving submodules following the first-first-second moving submodule to reach the initial coordinate position at a predetermined interval to interact with the external device includes: obtaining the real-time movement position of the non-first-first-second moving submodules following the first-first-second ...
[0058] The target spacing refers to the straight-line or arc distance between the current position of the non-first moving submodule and the preset interaction point (i.e., the initial coordinate position P1). Calculating this spacing quantifies the remaining travel distance required for the non-first moving submodule to reach the interaction point. Then, the time interval required for the reference point of the external device to move this target spacing is calculated. Since the external device usually moves at a constant or predictable speed, the time required for its reference point to move a specific distance can be obtained by dividing the distance by the speed. This time interval reflects the amount of time required for the external device to transition from one interaction state to the next equivalent interaction state, thus transforming the uniform spatial arrangement into a uniform temporal distribution.
[0059] Furthermore, the interval duration can be accumulated based on the first interaction time to obtain the predetermined interval time. The predetermined interval time is the target time point when the non-first and second moving sub-modules should reach the initial coordinate position. By adding the first interaction time (the interaction time of the first and second moving sub-modules) to the interval duration, the time offset of the non-first and second moving sub-modules relative to the first and second moving sub-modules can be determined, thereby constructing a unified time series so that multiple moving sub-modules can enter the interaction state sequentially according to their respective time windows.
[0060] Subsequently, the non-first-first moving submodule can be controlled to follow the first-first moving submodule until it reaches its initial coordinate position at a predetermined interval, enabling interaction with external devices. Here, "following" can mean that the non-first-first moving submodule maintains the same trajectory and speed curve as the first-first moving submodule, or that it dynamically adjusts its speed according to the predetermined interval to accurately reach the target position. When the non-first-first moving submodule reaches its initial coordinate position at the predetermined interval, its state is similar to that of the first-first moving submodule during interaction, thus maintaining the consistency and stability of the interaction process and improving the overall system operation's orderliness.
[0061] Optionally, controlling the non-first-first moving submodule to follow the first-first moving submodule until a predetermined interval is reached, controlling the non-first-first moving submodule to reach the initial coordinate position for interaction with external devices, includes: controlling the non-first-first moving submodule to follow the first-first moving submodule until a predetermined interval is reached, controlling the non-first-first moving submodule to reach the initial coordinate position; upon reaching the initial coordinate position, controlling the movement speed of the non-first-first moving submodule to be the same as the movement speed of the first-first moving submodule, and controlling the non-first-first moving submodule to interact with external devices.
[0062] Controlling non-leading submodules to follow the lead submodule until they reach their initial coordinate positions at predetermined intervals can include setting target paths and velocity curves for the non-leading submodules. Following the lead submodules allows them to use it as a reference, reducing path planning complexity and maintaining relative consistency in spatial distribution. Upon reaching the initial coordinate positions, the non-leading submodules are controlled to move at the same speed as the lead submodule, emphasizing kinematic consistency at the moment of interaction. It should be noted that the lead submodule's speed during interaction can be a verified, suitable speed. Replicating this speed by the non-leading submodules reduces interaction errors or mechanical shocks caused by speed differences, allowing them to participate in subsequent operations under the same dynamic conditions as the lead submodule.
[0063] Under the dual conditions of speed matching and position arrival, the non-first and first moving submodules enter the interaction mode. This interaction can include signal exchange, physical docking, and other operations. It should be noted that because the non-first and first moving submodules have the same speed and position reference as the first moving submodule when reaching the interaction point, their interaction behavior is predictable and repeatable. This allows external devices to respond to each moving submodule with a unified processing logic, thereby simplifying the control strategy of external devices and improving the overall system efficiency. Furthermore, this control process can be fine-tuned based on real-time feedback. For example, by monitoring the deviation between the actual speed of the non-first and first moving submodules and the target speed (i.e., the speed of the first moving submodule), the drive commands can be dynamically adjusted to reduce the deviation. This allows the non-first and first moving submodules to more accurately meet the kinematic conditions required for interaction when reaching the initial coordinate position, improving the success rate of interaction and system stability.
[0064] Optionally, upon reaching the initial coordinate position, controlling the movement speed of the non-first and second moving submodules to be the same as that of the first and second moving submodules includes: determining the single movement distance of the reference point corresponding to a single external signal under the condition of uniform motion of the external device; calculating the single movement increment of the moving submodule corresponding to a single external signal based on the single movement distance of the reference point and the initial distance from the first and second moving submodules to the initial coordinate position; and dynamically adjusting the movement speed of the non-first and second moving submodules according to the single movement increment so that when the non-first and second moving submodules reach the initial coordinate position, the movement speed of the non-first and second moving submodules is the same as that of the first and second moving submodules, so as to control the uniform arrangement of multiple moving submodules.
[0065] When an external device is moving at a constant speed, determining the single movement distance of a reference point corresponding to a single external signal can be achieved by acquiring pulses from the external device's motor shaft or feedback signals from the actuator. Since the external device's speed is constant, each signal interval corresponds to a fixed spatial displacement. This single movement distance reflects the minimum step size of the external device over a time period, discretizing the continuous motion process into a countable control unit.
[0066] Furthermore, based on the single-movement distance of the reference point and the initial distance between the first and second moving submodules and their initial coordinate positions, the single-movement increment of the moving submodule corresponding to a single external signal is calculated. The initial distance refers to the spatial or temporal interval between the first and second moving submodules at the moment of linkage. By establishing a mapping relationship between the displacement of the external device reference point and the displacement of the moving submodules, the single-movement distance of the external device can be converted into the single-movement increment required by the moving submodules. This single-movement increment reflects the distance the moving submodule needs to move for each external signal received to maintain synchronization with the external device reference point, thus establishing a direct correlation between the moving submodule speed and the external device signal frequency. Then, based on the single-movement increment, the moving speed of the non-first and second moving submodules is dynamically adjusted. This dynamic adjustment refers to the non-first and second moving submodules cumulatively calculating their target position or speed based on the number of external signals received in real time. By controlling the speed of the non-first and second moving submodules to match the distance they move per unit time with the single-movement increment, the movement rhythm of the non-first and second moving submodules can be kept consistent with the signal rhythm of the external device.
[0067] Finally, when the non-first and second moving sub-modules reach the initial coordinate position, their moving speed is the same as that of the first and second moving sub-modules. This ensures that the multiple moving sub-modules are evenly distributed. That is, when the non-first and second moving sub-modules adjust their speed according to the single movement increment and reach the initial coordinate position, their instantaneous speed tends to be consistent with the speed of the first and second moving sub-modules at that position. The consistency of speed can ensure that the multiple moving sub-modules have the same dynamic characteristics at the interaction point, which helps to maintain a uniform spatial distribution among the moving sub-modules, avoid the moving sub-modules from clustering or dispersing, and enable the operating equipment to be uniformly controlled based on a fixed arrangement rule.
[0068] Optionally, obtaining the real-time movement position of the non-first moving submodules after the first moving submodule includes: collecting motion state signals after the external device is started, and determining the real-time position of the external device reference point based on the initial position of the external device reference point and the total number of motion state signals collected after the external device is started, thereby obtaining the real-time movement position.
[0069] The initial position of the external device reference point is used as the zero point or reference point for calculation. The total number of motion state signals represents the cumulative number of steps or cycles experienced by the external device from the start time to the current time. By adding the initial position to the displacement derived from the total number of signals, the spatial coordinates of the external device reference point at the current time can be obtained, so that the real-time state of the external device can still be accurately estimated even in the absence of direct position feedback.
[0070] Furthermore, the final real-time movement position refers to the real-time position of the external device reference point. This position information is used in subsequent steps to calculate the target distance between the non-first-to-last moving submodule and the initial coordinate position, or as a reference for determining the start-up timing and speed of the non-first-to-last moving submodule. Its position is determined by utilizing the total number of signals from the external device, thus tightly coupling the control logic of the moving submodule with the operating rhythm of the external device. Furthermore, this real-time position information can be used to estimate the expected arrival time or required speed of the non-first-to-last moving submodule. For example, by combining the moving speed of the external device and the real-time position of the reference point, it is possible to predict under what conditions the non-first-to-last moving submodule will meet the external device at the interaction point.
[0071] In some embodiments, such as Figure 4 The schematic diagram shown includes a first moving submodule 301, non-first moving submodules (including a second moving submodule 302 and a third moving submodule 303), a stator 304, an external device 410, and a first interaction position A1. In state 1, the start-up timing and start-up position of the first moving submodule 301 can be determined based on the operation of the external device 410. The real-time position information of the first moving submodule 301 and the initial position information of the reference point of the external device 401 are obtained to determine the initial coordinate position of the first moving submodule when interacting with the external device. Then, it is determined whether the first distance information h1 from the first moving submodule 301 to the first interaction position A1 is the same as the second distance information h2 from the reference point of the external device 401 to the second interaction position A2. If they are the same, it is determined that the first moving submodule 301 is in a state suitable for linkage with the external device. The current time is recorded and used as the first interaction time. The coordinate position of the first moving submodule 301 when interacting with the external device 401 is obtained to obtain the initial coordinate position. In state 2, after the first moving submodule 301 is started and moves to the first interactive position, the real-time moving position of the second moving submodule 302 is determined, the target distance between the real-time moving position of the second moving submodule 302 and the initial coordinate position B1 is calculated, the time interval required for the reference point of the external device to move to the target distance is calculated, and the second moving submodule 302 is controlled to follow the first moving submodule until the predetermined interval time is reached and the second moving submodule 302 reaches the initial coordinate position B1. In state 3, after the second moving submodule 302 is started, the third moving submodule 303 is controlled to move according to the second moving submodule 302 until the predetermined interval time is reached and the third moving submodule 303 reaches the initial coordinate position B1. At this time, the distance between any two adjacent moving submodules is the target distance.
[0072] Through the above implementation steps, the initial coordinate position of the first moving submodule when interacting with the external device is determined based on the real-time position information of the first moving submodule among multiple moving submodules and the initial position information of the reference point of the external device, and the first interaction time is recorded; the subsequent non-first moving submodules of the first moving submodule are controlled to reach the initial coordinate position at a predetermined interval to interact with the external device, wherein the predetermined interval is determined by the first interaction time and the interval time corresponding to the distance of the reference point of the external device moving target. In this embodiment, the initial coordinate position of the first moving submodule when interacting with the external device can be determined first. The first moving submodule and the subsequent driven submodules are controlled to reach the initial coordinate position after a predetermined time interval to interact with the external device. This ensures that multiple moving submodules are evenly arranged in space and time, avoiding the accumulation of moving submodules at the interaction position. The external device can perform interactive operations based on a fixed rhythm and logic without frequent adjustment of control parameters, reducing waiting time and invalid actions. This improves the overall efficiency of the interaction between the moving submodules and the external device, enabling the automated transportation system to operate efficiently and stably. This solves the technical problem in related technologies where the time of multiple moving submodules passing through the detection point is not uniformly distributed, which easily leads to the moving submodule spacing not meeting the requirements, resulting in a decrease in the interaction efficiency between the moving submodules and the external device.
[0073] According to another aspect of the present invention, a control device for a linear motor device is also provided, including a processor and a memory, wherein the memory is used to store a program, and the processor is used to run the program, wherein the program executes the movement control method of the moving submodule described above during runtime.
[0074] This application also provides an automated transportation system. Figure 5 This is a schematic diagram of an optional automated transportation system according to an embodiment of this application, such as... Figure 5 As shown, the automated transportation system may include multiple moving submodules 501, a stator module 502, and a control device 503. The moving submodules 501 move along the stator module 502, and the total number of moving submodules is even. Upon receiving a movement command, the control device determines the initial coordinate position of the first moving submodule when interacting with the external device, based on the real-time position information of the first moving submodule and the initial position information of the external device's reference point, and records the first interaction time. It then controls subsequent non-first moving submodules to reach the initial coordinate position at a predetermined interval to interact with the external device. The predetermined interval is determined by the first interaction time combined with the interval corresponding to the distance between the reference point and the target movement distance of the external device.
[0075] Embodiments of this application also provide a storage medium. Optionally, in this embodiment, the storage medium can be used to store the program code executed by the movement control method of the moving submodule provided in Embodiment 1.
[0076] According to another aspect of the present invention, a computer-readable storage medium is also provided, the computer-readable storage medium including a stored computer program, wherein, when the computer program is running, it controls the device where the computer-readable storage medium is located to execute the movement control method of any of the moving sub-modules in the first embodiment described above.
[0077] Optionally, in this embodiment, the storage medium may be located in any computer terminal in a group of computer terminals in a computer network, or in any mobile terminal in a group of mobile terminals.
[0078] This application also provides a computer program product, including a computer program that, when executed by a processor, implements the steps of the movement control method for the moving submodule described in various embodiments of this application.
[0079] This application also provides a computer program product, including a non-volatile computer-readable storage medium storing a computer program, which, when executed by a processor, implements the steps of the movement control method of the moving submodule described in various embodiments of this application.
[0080] The sequence numbers of the above embodiments of the present invention are for descriptive purposes only and do not represent the superiority or inferiority of the embodiments.
[0081] In the above embodiments of the present invention, the descriptions of each embodiment have different focuses. For parts not described in detail in a certain embodiment, please refer to the relevant descriptions of other embodiments.
[0082] In the several embodiments provided in this application, it should be understood that the disclosed technical content can be implemented in other ways. The device embodiments described above are merely illustrative; for example, the division of units can be a logical functional division, and in actual implementation, there may be other division methods. For instance, multiple units or components may be combined or integrated into another system, or some features may be ignored or not executed. Furthermore, the displayed or discussed mutual coupling, direct coupling, or communication connection may be through some interfaces; the indirect coupling or communication connection between units or modules may be electrical or other forms.
[0083] The units described as separate components may or may not be physically separate. The components shown as units may or may not be physical units; that is, they may be located in one place or distributed across multiple units. Some or all of the units can be selected to achieve the purpose of this embodiment according to actual needs.
[0084] Furthermore, the functional units in the various embodiments of the present invention can be integrated into one processing unit, or each unit can exist physically separately, or two or more units can be integrated into one unit. The integrated unit can be implemented in hardware or as a software functional unit.
[0085] If the integrated unit is implemented as a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, in essence, or the part that contributes to the prior art, or all or part of the technical solution, can be embodied in the form of a software product. This computer software product is stored in a storage medium and includes several instructions to cause a computer device (which may be a personal computer, server, or network device, etc.) to execute all or part of the steps of the methods described in the various embodiments of the present invention. The aforementioned storage medium includes various media capable of storing program code, such as USB flash drives, read-only memory (ROM), random access memory (RAM), portable hard drives, magnetic disks, or optical disks.
[0086] The above description is only a preferred embodiment of the present invention. It should be noted that for those skilled in the art, several improvements and modifications can be made without departing from the principle of the present invention, and these improvements and modifications should also be considered within the scope of protection of the present invention.
Claims
1. A method for controlling the movement of a moving submodule, characterized in that, include: Based on the real-time position information of the first moving submodule among multiple moving submodules and the initial position information of the reference point of the external device, the initial coordinate position of the first moving submodule when interacting with the external device is determined, and the first interaction moment is recorded. The non-first moving submodules following the first moving submodule are controlled to reach the initial coordinate position at a predetermined interval to interact with the external device. The predetermined interval is determined by the first interaction time and the interval time corresponding to the distance between the reference point and the target distance of the external device.
2. The movement control method for the moving submodule according to claim 1, characterized in that, Based on the real-time position information of the first moving submodule among multiple moving submodules and the initial position information of the reference point of the external device, the initial coordinate position of the first moving submodule when interacting with the external device is determined, including: Obtain the real-time position information of the first moving submodule and the initial position information of the reference point of the external device; Based on the real-time location information, the first distance information from the first moving submodule to the first interactive position is calculated, wherein the first interactive position is the position of the first moving submodule when it interacts with the external device; When the first distance information and the second distance information are the same, the first and second moving submodules are controlled to interact with the external device, and the coordinate position of the first and second moving submodules during the interaction is recorded to obtain the initial coordinate position.
3. The movement control method for the moving submodule according to claim 2, characterized in that, Before acquiring the real-time position information of the first moving submodule and the initial position information of the reference point of the external device, the process also includes: The start-up timing and start-up position of the first moving submodule are determined based on the operating status of the external equipment; When the start-up timing is met, the first and second moving submodules are triggered to start according to the start-up position, so that the first and second moving submodules accelerate to a target linear velocity that matches the target rotation speed of the external device, and run to the first interaction position.
4. The movement control method for the moving submodule according to claim 2, characterized in that, When the first distance information and the second distance information are the same, the first and second moving submodules are controlled to interact with the external device, and the coordinate position of the first and second moving submodules during the interaction is recorded to obtain the initial coordinate position, including: Determine whether the first distance information from the first moving submodule to the first interactive position is the same as the second distance information from the reference point of the external device to the second interactive position; When the first distance information is determined to be the same as the second distance information, the first and second moving submodules are determined to be in a state suitable for linkage with the external device. The current time is recorded, and the current time is taken as the first interaction time. The coordinate position of the first and second moving submodules when interacting with the external device at the first interaction time is obtained, and the initial coordinate position is obtained.
5. The movement control method for the moving submodule according to claim 1, characterized in that, Controlling the subsequent non-first moving submodules of the first moving submodule to reach the initial coordinate position at predetermined intervals to interact with the external device includes: Obtain the real-time movement position of the non-first and second moving sub-modules after the first moving sub-module, calculate the target distance between the real-time movement position of the non-first and second moving sub-modules and the initial coordinate position, and calculate the time interval required for the reference point of the external device to move to the target distance. The predetermined interval time is obtained by accumulating the interval duration based on the first interaction time; The non-first moving submodule is controlled to follow the first moving submodule until the predetermined interval time is reached, at which point the non-first moving submodule is controlled to reach the initial coordinate position so as to interact with the external device.
6. The movement control method for the moving submodule according to claim 5, characterized in that, Controlling the non-first-hand moving submodule to follow the first-hand moving submodule until reaching the predetermined interval time, controlling the non-first-hand moving submodule to reach the initial coordinate position, so as to interact with the external device, includes: Control the non-first and first moving submodule to follow the first and first moving submodule until the predetermined interval time is reached, and control the non-first and first moving submodule to reach the initial coordinate position; Upon reaching the initial coordinate position, the movement speed of the non-first moving submodule is controlled to be the same as that of the first moving submodule, and the non-first moving submodule is controlled to interact with external devices.
7. The movement control method for the moving submodule according to claim 6, characterized in that, Upon reaching the initial coordinate position, controlling the movement speed of the non-first moving submodule to be the same as the movement speed of the first moving submodule includes: Under the condition of uniform motion of external equipment, determine the single movement distance of the reference point corresponding to a single external signal; Based on the single movement distance of the reference point and the initial distance from the first and second moving sub-modules to the initial coordinate position, calculate the single movement increment of the moving sub-module corresponding to a single external signal; Based on the single movement increment, the moving speed of the non-first and first moving sub-modules is dynamically adjusted so that when the non-first and first moving sub-modules reach the initial coordinate position, the moving speed of the non-first and first moving sub-modules is the same as that of the first and first moving sub-modules, so as to control the uniform arrangement of multiple moving sub-modules.
8. The movement control method for the moving submodule according to claim 5, characterized in that, Obtaining the real-time movement position of the non-first and second moving submodules following the first moving submodule includes: The motion status signal of the external device after startup is collected, and the real-time position of the external device reference point is determined based on the initial position of the external device reference point and the total number of motion status signals collected after the external device is started, so as to obtain the real-time movement position.
9. A motion control device for a linear motor, comprising a processor and a memory, characterized in that, The memory is used to store programs. The processor is used to run a program, wherein the program executes the movement control method of the moving submodule according to any one of claims 1 to 8 when it runs.
10. An automated transportation system, characterized in that, It includes multiple moving sub-modules, stator rails, and control devices, among which: The moving submodule moves along the stator track, and the total number of the moving submodules is even. The control device is used to control at least two moving submodules to grip the item to be transported on the stator track. After receiving a movement command, the control device determines the initial coordinate position of the first moving submodule when interacting with the external device based on the real-time position information of the first moving submodule and the initial position information of the reference point of the external device, and records the first interaction time. The control device controls the subsequent non-first moving submodules to reach the initial coordinate position at a predetermined interval to interact with the external device, wherein the predetermined interval is determined by the first interaction time and the interval duration corresponding to the distance between the reference point and the target movement distance of the external device.
