Method, device, electronic equipment and storage medium for controlling mover of synchronous track
By generating and applying the velocity planning parameters in the initial planning data, the problem of unsmooth movement in the synchronous track is solved, and the control smoothness and safety of the movement on the synchronous track is improved.
Patent Information
- Application Number
- CN202411034967.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-31
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2044-07-31
AI Technical Summary
In the synchronous track, during the control of the mover, the difference between the target control data and the initial running data is too large, resulting in the movement running unsmoothly, increasing the risk of failure.
By obtaining the initial running data of the actuator to reach the initial position and the target synchronization data of the target position, the initial planning data, including the speed planning data of the first speed adjustment stage and the second speed adjustment stage, and generating speed planning parameters based on these data, The control moves from the initial position to the target position to improve the smoothness of synchronous control.
It effectively improves the smoothness of the synchronous control of the mover on the synchronous track, reduces the risk of failure, and ensures the smooth operation of the mover in the synchronous transition track.
Smart Images

Figure CN118584874B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of control technology, and in particular to a method, device, electronic device and storage medium for controlling a mover of a synchronous track. Background Art
[0002] The use of magnetic levitation conveying technology to transport movers has a wide range of applications in the field of industrial automation, such as assembly and packaging of items on the conveying logistics line, and SMT of precision electronic components. In these applications, it is usually necessary to process the workpiece on the mover while the mover is in operation, and there is a synchronous track before the processing operation, and the operating data of the mover is controlled on the synchronous track to achieve the operating data corresponding to the processing operation.
[0003] In the prior art, when controlling the mover in a synchronous track, the initial operation data when the mover enters the synchronous track is usually directly increased to the target operation data at the maximum acceleration to meet the synchronous control requirements. However, due to the large difference between the target control data and the initial operation data, the mover control in the synchronous track using this control method is prone to uneven operation of the mover control, which may lead to the risk of mover failure. Summary of the invention
[0004] The embodiments of the present application provide a method, device, electronic device and storage medium for controlling a mover on a synchronous track, which can improve the smoothness of synchronous control of the mover on the synchronous track.
[0005] To achieve the above-mentioned purpose, a first aspect of an embodiment of the present application provides a method for controlling a mover of a synchronous track, wherein the synchronous track includes an initial position and a target position, and the method includes:
[0006] Acquiring initial operation data when the mover reaches the initial position, and target synchronization data required when the mover reaches the target position;
[0007] Generate initial planning data based on the initial operation data and the target synchronization data, the initial planning data including first speed planning data of a first speed adjustment stage, second speed planning data of a second speed adjustment stage, and an initial adjustment position between the two speed adjustment stages;
[0008] A speed planning parameter is obtained according to the initial planning data, and the mover is controlled to move from the initial position to the target position according to the speed planning parameter.
[0009] In some embodiments, generating initial planning data based on the initial operation data and the target synchronization data includes:
[0010] obtaining an adjustment time based on the initial position, the initial operation data, the target position, and the target synchronization data;
[0011] Obtaining a first operation planning parameter based on the adjustment time, and obtaining a second operation planning parameter based on the adjustment time and the first operation planning parameter;
[0012] Based on the first operation planning parameters, at least a first position, a first speed and a first acceleration at each moment of the first speed adjustment phase are generated to obtain the first speed planning data; and based on the second operation planning parameters, at least a second position, a second speed and a second acceleration at each moment of the second speed adjustment phase are generated to obtain the second speed planning data;
[0013] The adjustment position is determined according to the first position corresponding to the adjustment time.
[0014] In some embodiments, when the initial adjustment position is between the initial position and the target position, obtaining the speed planning parameter according to the initial planning data includes:
[0015] When there is no speed reversal in the first speed in the first speed planning data and the second speed in the second speed planning data, obtaining the speed planning parameter according to the first speed planning data and the second speed planning data;
[0016] When there is a speed reversal in the first speed in the first speed planning data or the second speed in the second speed planning data, the position of the first speed reversal is used as the target adjustment position, and the speed planning parameters are obtained based on the target adjustment position.
[0017] In some embodiments, obtaining the speed planning parameter based on the target adjustment position includes:
[0018] Acquire the initial planning data between the target adjustment position and the initial position to obtain first target planning data, wherein the first target planning data includes first target planning parameters at each moment;
[0019] The target adjustment position is used to update the initial position, and the initial operation data is updated using the first target planning parameter at a time corresponding to the target adjustment position;
[0020] Obtaining a second target planning parameter corresponding to the initial planning data based on the updated initial position and the updated initial operation data;
[0021] The speed planning parameter is obtained based on the first target planning parameter and the second target planning parameter.
[0022] In some embodiments, obtaining the speed planning parameter according to the initial planning data includes:
[0023] Determining, according to the initial planning data, that the initial adjustment position is outside the initial position and the target position;
[0024] Generate third speed planning data corresponding to the overall adjustment phase from the initial position to the target position based on the initial operation data and the target synchronization data, the third speed planning data at least including a third position, a third speed and a third acceleration at each moment;
[0025] When there is no speed reversal at the third speed, obtaining the speed planning parameter according to the third speed planning data;
[0026] When the third speed has a speed reversal, the third speed that is less than zero is set to zero, the third speed in the third speed planning data is updated, and the speed planning parameter is obtained according to the third speed planning data.
[0027] In some embodiments, the initial operation data includes an initial speed and an initial acceleration, the target synchronization data includes a target speed, a target time, and a target acceleration, and obtaining the adjusted time based on the initial position, the initial operation data, the target position, and the target synchronization data includes:
[0028] Obtaining a first time multiplier based on the product of the target time and the target speed, obtaining a second time multiplier based on the product of the target time and the initial speed, and obtaining a third time multiplier based on the product of the square of the target time and the target acceleration;
[0029] obtaining a fourth time multiplier based on the product of the target acceleration and the target time, and obtaining a fifth time multiplier based on the product of the initial acceleration and the target time;
[0030] Based on the sum of the target position and the third time multiplier, subtract the initial position, the first time multiplier, and the second time multiplier one by one to obtain a first adjustment time term;
[0031] Based on the difference between the initial speed and the target speed, the fourth time multiplier and the fifth time multiplier are added one by one to obtain a second adjustment time term;
[0032] The adjustment time is obtained based on a ratio of the first adjustment time item to the second adjustment time item.
[0033] In some embodiments, the first operation planning parameter includes a first sub-planning parameter, a second sub-planning parameter, a third sub-planning parameter, and a fourth sub-planning parameter, and obtaining the first operation planning parameter based on the adjustment time includes:
[0034] Obtaining a first planning multiplication term based on the product of the target acceleration and the adjustment time, obtaining a second planning multiplication term based on the product of the initial acceleration and the adjustment time, and obtaining a third planning multiplication term based on the product of the target speed and the adjustment time;
[0035] Based on the sum of the target speed and the first planning multiplier, the initial speed, the fourth time multiplier, the fifth time multiplier and the second planning multiplier are subtracted one by one to obtain a first planning parameter item, and based on the ratio of the first planning parameter item to the third planning multiplier, the first sub-planning parameter is obtained;
[0036] The second sub-planning parameter is obtained based on half of the initial acceleration, the third sub-planning parameter is obtained based on the initial velocity, and the fourth sub-planning parameter is obtained based on the initial position.
[0037] In some embodiments, the second operation planning parameter includes a fifth sub-planning parameter, a sixth sub-planning parameter, a seventh sub-planning parameter, and an eighth sub-planning parameter, and obtaining the second operation planning parameter based on the adjustment time and the first operation planning parameter includes:
[0038] Based on the sum of the initial speed, the fourth time multiplier and the second planning multiplier, and subtracting the target speed and the first planning multiplier one by one, a second planning parameter item is obtained, and based on the ratio of the second planning parameter item to the third planning multiplier, the fifth sub-planning parameter is obtained;
[0039] Based on the product of the first sub-planning parameter and the adjustment time, and adding the second sub-planning parameter, obtain the sixth sub-planning parameter;
[0040] The seventh sub-planning parameter is obtained based on the product of the square of the adjustment time and the first sub-planning parameter plus the product of the second sub-planning parameter and the adjustment time, and the third sub-planning parameter.
[0041] The eighth sub-planning parameter is obtained based on the product of the cube of the adjustment time and the first sub-planning parameter, the product of the square of the adjustment time and the second sub-planning parameter, the third sub-planning parameter and the parameter of the adjustment time, and the fourth sub-planning parameter.
[0042] To achieve the above object, the synchronous orbit includes an initial position and a target position, and the device includes:
[0043] A data acquisition module, used to acquire initial operation data when the mover reaches the initial position, and target synchronization data required when the mover reaches the target position;
[0044] A data generation module, configured to generate initial planning data based on the initial operation data and the target synchronization data, wherein the initial planning data includes first speed planning data of a first speed adjustment stage, second speed planning data of a second speed adjustment stage, and an initial adjustment position between the two speed adjustment stages;
[0045] A control module is used to obtain speed planning parameters according to the initial planning data, and control the mover to move from the initial position to the target position according to the speed planning parameters.
[0046] To achieve the above-mentioned purpose, the third aspect of an embodiment of the present application proposes an electronic device, which includes a memory and a processor, the memory stores a computer program, and when the processor executes the computer program, it implements the mover control method of the synchronous track as described in the first aspect.
[0047] To achieve the above-mentioned purpose, the fourth aspect of an embodiment of the present application proposes a storage medium, which is a computer-readable storage medium, and the storage medium stores a computer program. When the computer program is executed by a processor, the mover control method of the synchronous track described in the first aspect above is implemented.
[0048] The embodiment of the present application proposes a method, device, electronic device and storage medium for controlling a mover of a synchronous track, wherein the synchronous track includes an initial position and a target position, and the method includes: first, obtaining initial operation data when the mover reaches the initial position, and target synchronization data required when the mover reaches the target position; then, generating initial planning data based on the initial operation data and the target synchronization data, wherein the initial planning data includes first speed planning data of the first speed adjustment stage, second speed planning data of the second speed adjustment stage and the initial adjustment position between the two speed adjustment stages; finally, obtaining speed planning parameters according to the initial planning data, and controlling the mover to move from the initial position to the target position according to the speed planning parameters. The embodiment of the present application utilizes the first speed planning data generated by the first operation data when the mover arrives at the first position and the second operation data required for the mover to arrive at the second position, and gradually generates speed control parameters for smooth control between the first position and the second position, thereby effectively improving the smoothness of the synchronous operation control of the mover in the synchronous transition track.
[0049] Other features and advantages of the present application will be described in the following description, and partly become apparent from the description, or understood by practicing the present application. The purpose and other advantages of the present application can be realized and obtained by the structures specifically pointed out in the description, claims and drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0050] Figure 1 It is a schematic diagram of the structure of a magnetic levitation conveyor track provided in yet another embodiment of the present application.
[0051] Figure 2 This is a schematic diagram of the synchronization control phase provided by another embodiment of the present application.
[0052] Figure 3 This is a flow chart of a method for controlling a mover of a synchronous track provided in yet another embodiment of the present application.
[0053] Figure 4 yes Figure 3 Flow chart of step 302 in FIG.
[0054] Figure 5 yes Figure 4 Flow chart of step 401 in FIG.
[0055] Figure 6 yes Figure 4 Flowchart of step 402 in FIG.
[0056] Figure 7 yes Figure 4 Another flow chart of step 402 in FIG.
[0057] Figure 8 It is a schematic diagram of first speed planning data and second speed planning data provided by another embodiment of the present application.
[0058] Fig. 9 This is a flowchart of the first method of determining speed planning parameters provided by another embodiment of the present application.
[0059] Fig.10 It is a schematic diagram of a first speed curve and a second speed curve provided by another embodiment of the present application.
[0060] Fig.11 This is a schematic diagram of a first speed in which speed reversal occurs according to another embodiment of the present application.
[0061] Fig.12 yes Fig. 9 Flowchart of step 902 in FIG.
[0062] Fig.13 It is a schematic diagram of the first type of first target planning data and second target planning data provided by another embodiment of the present application.
[0063] Fig.14 It is a schematic diagram of the second type of first target planning data and the second target planning data provided by another embodiment of the present application.
[0064] Fig.15 This is a second flow chart for determining speed planning parameters provided by another embodiment of the present application.
[0065] Fig.16 This is a schematic diagram of an incorrect initial adjustment position provided by another embodiment of the present application.
[0066] Fig.17 It is a schematic diagram of the third speed planning data provided by another embodiment of the present application.
[0067] Fig.18 This is a schematic diagram of a third speed inversion provided by another embodiment of the present application.
[0068] Fig.19 It is a schematic diagram of updating the third speed provided by yet another embodiment of the present application.
[0069] Fig. 20 It is a schematic structural diagram of a mover control device for a synchronous track provided in one embodiment of the present application.
[0070] Fig.21 It is a schematic diagram of the hardware structure of an electronic device provided in one embodiment of the present application. DETAILED DESCRIPTION
[0071] In order to make the purpose, technical solution and advantages of the present application more clearly understood, the present application is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present application and are not used to limit the present application.
[0072] It should be noted that although the functional modules are divided in the device schematic and the logical order is shown in the flowchart, in some cases, the steps shown or described may be performed in a different order than the module division in the device or the order in the flowchart.
[0073] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those commonly understood by those skilled in the art to which this application belongs. The terms used herein are only for the purpose of describing the embodiments of this application and are not intended to limit this application.
[0074] The use of magnetic levitation conveying technology to transport movers has a wide range of applications in the field of industrial automation, such as assembly and packaging of items on the conveying logistics line, and SMT of precision electronic components. In these applications, it is usually necessary to process the workpiece on the mover while the mover is in operation, and there is a synchronous track before the processing operation, and the operating data of the mover is controlled on the synchronous track to achieve the operating data corresponding to the processing operation.
[0075] In the prior art, when controlling the mover in a synchronous track, the initial operation data when the mover enters the synchronous track is usually directly increased to the target operation data at the maximum acceleration to meet the synchronous control requirements. However, due to the large difference between the target control data and the initial operation data, the mover control in the synchronous track using this control method is prone to uneven operation of the mover control, which may lead to the risk of mover failure.
[0076] In order to improve the smoothness of the synchronous control of the mover in the synchronous orbit, the embodiment of the present application uses the initial operation data of the starting position and the target synchronization data of the target position to plan the operation data of the mover in two speed adjustment stages in the synchronous orbit, and combines the initial adjustment position as the transition position of the two speed adjustment stages, so that the mover is synchronously controlled at the speed adjustment speeds of the two speed adjustment stages in the control stage of the synchronous orbit, thereby improving the smoothness of the mover operation control in the synchronous orbit and avoiding the risk of the mover failing due to low smoothness.
[0077] In order to better illustrate the mover control method of the synchronous track provided in the embodiment of the present application, this embodiment first describes the magnetic levitation conveyor track to which the mover control method is applied. Figure 1 As shown in FIG. 1 , it is a schematic diagram of the structure of a magnetic levitation conveyor track provided in an embodiment of the present application. Figure 1 As shown, the mover runs on a magnetic levitation conveying track, and the magnetic levitation conveying track includes a synchronous track, and the synchronous track includes an initial position and a target position.
[0078] In some application scenarios, the mover needs to perform corresponding control operations at the target position, and these control operations have precise requirements for the operating data, that is, the car needs to maintain the same speed, acceleration and other motion characteristics as the external axis within a specific position range. The external axis is the dominant one, responsible for guiding the motion characteristics of the car in the synchronization area. The car, as a slave axis, must follow the motion characteristics of the external axis to move in a specific area. Therefore, when the mover runs to the initial position, in order for the operating data to meet the target synchronization data when the mover runs to the target position, it is necessary to plan the data of the synchronous control track for the mover to run on the synchronous track at the initial position, and then perform the synchronous operation control of the mover on the synchronous track.
[0079] Reference Figure 2 As shown, it is a schematic diagram of the synchronization control stage provided by the embodiment of the present application. Figure 2 As shown, there are four main stages in the synchronous operation control of the mover. Specifically, it includes: the preparation synchronization stage, the start synchronization stage, the synchronization stage and the exit synchronization stage. Among them, the preparation synchronization stage is when the mover is about to reach the initial position. At this time, the synchronous operation planning of the mover will be prepared. At this time, the jerk of the mover needs to be reduced to 0 and the acceleration needs to be kept stable, so as to facilitate the subsequent operation data control of the mover; the start synchronization stage is when the mover just reaches the initial position. It is the most important stage in the synchronization stage. At this time, it is necessary to plan the operation data of the mover according to the initial operation data of the mover reaching the initial position and the target synchronization data required for the mover to reach the target position; the synchronization stage is when the mover is running in the synchronous track. At this time, the mover is synchronously controlled according to the mover operation data planned in the start synchronization stage, so that the mover can reach the target synchronization data when it reaches the target position; the exit synchronization stage is when the mover reaches the target position and the corresponding control operation is completed. The mover will exit this synchronization control stage.
[0080] Based on the above-mentioned magnetic levitation conveyor track, the mover control method of the synchronous track in the embodiment of the present application will be described in detail below. Figure 3 , which is an optional flow chart of the mover control method of the synchronous track provided in the embodiment of the present application, Figure 3 The method in the embodiment may include but is not limited to steps 301 to 303. Figure 3 The order of step 301 to step 303 is not specifically limited, and the order of steps can be adjusted or some steps can be reduced or added according to actual needs. The mover control method of the synchronous track provided in the embodiment of the present application can be applied to intelligent terminals, servers, computers, etc. connected to the maglev conveyor track.
[0081] Step 301: Acquire initial operation data when the mover reaches an initial position, and target synchronization data required when the mover reaches a target position.
[0082] Step 301 is described in detail below.
[0083] In some embodiments, when the mover moves to the initial position When the initial operation data of the mover at the current moment is obtained, the initial operation data includes the mover reaching the initial position Initial speed at and speed acceleration At the same time, it is also necessary to obtain the actuator to reach the target position The target synchronization data required when the target synchronization data includes the target speed , target time and the target acceleration The target time It means that the actuator moves from the initial position Run to the target location The length of time between runs.
[0084] Step 302: Generate initial planning data based on the initial operation data and the target synchronization data.
[0085] Step 302 is described in detail below.
[0086] In some embodiments, after obtaining the initial operation data and the target synchronization data, in order to ensure that the mover can pass the target time After the target speed and target acceleration To reach the target location, you need to be at the initial location (i.e. Figure 2 The starting synchronization phase shown in the figure) performs operation data planning of the mover according to the initial operation data and the target synchronization data to generate initial planning data, wherein the initial planning data includes the first speed planning data of the first speed adjustment phase, the second speed planning data of the second speed adjustment phase, and the initial adjustment position between the two speed adjustment phases. The specific parameter calculation is based on the cubic polynomial programming formula, as shown in the following formula (1).
[0087] (1)
[0088] in, is the position parameter, is the speed parameter, is the acceleration parameter, is the acceleration parameter, is the time parameter, are all control planning parameters. Formula (1) is the ABCD description form of position, speed and time. According to the planning shown in formula (1), when determining the control planning parameters Afterwards, the position, velocity, and acceleration information at each moment can be determined.
[0089] Next, according to formula (1), at the initial position and target location Two-stage planning is performed between the two speed adjustment stages to determine the first speed planning data of the first speed adjustment stage, the second speed planning data of the second speed adjustment stage, and the initial adjustment position between the two speed adjustment stages. .
[0090] When planning two segments, multiple conditions need to be met, including segmentation point conditions, start and end point conditions, and continuity conditions. The segmentation point conditions are shown in the following formula (2).
[0091] (2)
[0092] in, Indicates that in the first speed adjustment stage, the position corresponding to time 0 (i.e. the starting time) is the starting position ; Indicates that in the second speed adjustment stage, the time (i.e. target time) is the target position ; It means that in the operation plan, the mover moves to the initial adjustment position So the transition time corresponding to Indicates the last moment of the first speed adjustment phase (i.e. transition time ), and at the initial moment of the second speed adjustment stage (i.e., transition time ) is the initial transition position. .
[0093] The start and end conditions are shown in the following formula (3).
[0094] (3)
[0095] in, and Indicates that in the first speed adjustment stage, the speed corresponding to time 0 (i.e. the starting time) is the initial speed and acceleration is the initial acceleration ; and Indicates that in the second speed adjustment stage, the time The speed corresponding to the target time is the target speed and the acceleration is the target acceleration .
[0096] The continuity condition is shown in the following formula (4).
[0097] (4)
[0098] Formula (4) indicates that at the last moment of the first speed adjustment stage (i.e., transition time ), and at the initial moment of the second speed adjustment stage (i.e., transition time ) have the same velocity and acceleration.
[0099] After determining the above constraints, the control planning parameters of the two speed adjustment stages can be further calculated. The control planning parameters of the first speed adjustment stage are used as the first operation planning parameters. , the control planning parameters of the first speed adjustment stage are used as the second operation planning parameters .
[0100] In addition, in order to improve the calculation of the first run planning parameters and the second operation planning parameters In order to improve efficiency and accuracy, the time parameters in the first speed adjustment stage and the second speed adjustment stage are normalized as shown in the following formula (5).
[0101] (5)
[0102] Next, the first operation planning parameters are adjusted according to the above constraints, initial operation data and target synchronization data. and the second operation planning parameters Parameters are solved by forming a set of equations as shown in the following equation (6) based on the above constraints, initial operation data and target synchronization data.
[0103] (6)
[0104] Then, by solving the equation group in the above formula (6) through relevant mathematical solution steps, the first operation planning parameter can be further obtained: , Second operation planning parameters And the mover reaches the initial adjustment position Adjustment time The following will further describe how to generate initial planning data based on the initial operation data and the target synchronization data.
[0105] Reference Figure 4 , generating initial planning data based on initial operation data and target synchronization data, including the following steps 401 to 404.
[0106] Step 401: Obtain adjustment time based on the initial position, initial operation data, target position and target synchronization data.
[0107] Step 401 is described in detail below.
[0108] In some embodiments, after obtaining the initial operation data, the target synchronization data and the equation group (6), firstly according to the initial position , Target location , target time , Target speed , initial speed , initial acceleration and the target acceleration , get the adjustment time . This will be described in further detail below.
[0109] Reference Figure 5 , based on the initial position, the target position, the target time, the target speed, the initial speed, the initial acceleration and the target acceleration, the adjustment time is obtained, including the following steps 501 to 505.
[0110] Step 501: A first time multiplier is obtained based on the product of the target time and the target speed, a second time multiplier is obtained based on the product of the target time and the initial speed, and a third time multiplier is obtained based on the product of the square of the target time and the target acceleration.
[0111] Step 502: Obtain a fourth time multiplier based on the product of the target acceleration and the target time, and obtain a fifth time multiplier based on the product of the initial acceleration and the target time.
[0112] Step 503: Based on the sum of the target position and the third time multiplier, the initial position, the first time multiplier and the second time multiplier are subtracted one by one to obtain a first adjusted time term.
[0113] Step 504: Based on the difference between the initial speed and the target speed, the fourth time multiplier and the fifth time multiplier are added one by one to obtain a second adjusted time term.
[0114] Step 505: Obtain the adjustment time based on the ratio of the first adjustment time item to the second adjustment time item.
[0115] Steps 501 to 505 are described in detail below.
[0116] In some embodiments, in order to obtain accurate adjustment time , first based on the target time and target speed The product of gets the first time multiplication term , based on the target time and initial velocity The product of gets the second time multiplication term , and based on the square of the target time and target acceleration The product of gets the third time multiplication term ; Next, based on the target acceleration and target time The product of gets the fourth time multiplication term , and based on the initial acceleration and target time The product of gets the fifth time multiplier Then, based on six times the number of target positions Multiply by the third time The sum of the six times the initial position is subtracted one by one , four times the number of first-time multiplications Multiply the second time by twice the number , get the first adjustment time item , and the initial velocity based on twice the number With twice the target speed The difference is added with the fourth time multiplication term one by one and the fifth time multiplier , get the second adjustment time term Finally, the adjustment time is obtained based on the ratio of the first adjustment time item to the second adjustment time item. As shown in the following formula (7).
[0117] (7)
[0118] Step 402: Obtain a first operation planning parameter based on the adjustment time, and obtain a second operation planning parameter based on the adjustment time and the first operation planning parameter.
[0119] Step 402 is described in detail below.
[0120] In some embodiments, after obtaining the initial operation data, the target synchronization data, the adjustment time and the equation group (6), according to the target time , adjust time , Target speed , initial speed , initial acceleration , target acceleration and the initial position , get the first operation planning parameters , the first operation planning parameters include the first sub-speed planning parameters , the second sub-speed planning parameters , the third sub-speed planning parameters And the fourth sub-speed planning parameters . This will be described in further detail below.
[0121] Reference Figure 6 , obtaining the first operation planning parameter based on the adjustment time includes the following steps 601 to 605.
[0122] Step 601: obtain a first planning multiplier based on the product of target acceleration and adjustment time, obtain a second planning multiplier based on the product of initial acceleration and adjustment time, and obtain a third planning multiplier based on the product of target speed and adjustment time.
[0123] Step 602: Based on the sum of the target speed and the first planning multiplier, the initial speed, the fourth time multiplier, the fifth time multiplier and the second planning multiplier are subtracted one by one to obtain a first planning parameter item, and a first sub-planning parameter is obtained based on the ratio of the first planning parameter item to the third planning multiplier.
[0124] Step 603: obtaining a second sub-planning parameter based on half of the initial acceleration, obtaining a third sub-planning parameter based on the initial velocity, and obtaining a fourth sub-planning parameter based on the initial position.
[0125] Steps 601 to 603 are described in detail below.
[0126] In some embodiments, in order to obtain accurate first operation planning parameters , first based on the target acceleration and adjust time The product of gets the first planning multiplication term , based on the initial acceleration and adjust time The product of gets the second planning multiplication term , and based on the target speed and adjust time The product of gets the third planning multiplication term .
[0127] Next, based on twice the target speed Multiply by the first plan The sum of the initial speed is subtracted by twice the initial speed. , the fourth time multiplication , the fifth time multiplication And the second planning multiplication , get the first planning parameter item , and based on the first planning parameter term and six times the number of the third planning multiplication term The ratio of is used to obtain the first sub-planning parameter as shown in the following formula (8).
[0128] (8)
[0129] In addition, based on the initial acceleration The second sub-planning parameters are obtained by taking half of , based on the initial velocity Get the third sub-planning parameters , and based on the initial position Get the fourth sub-planning parameters .
[0130] In some embodiments, after obtaining the initial operation data, the target synchronization data, the adjustment time, the first operation planning parameters and the equation group (6), according to the target time , adjust time , Target speed , initial speed , initial acceleration , target acceleration And the first operation planning parameters , get the second operation planning parameters , the second operation planning parameters include the fifth sub-speed planning parameters 、Sixth sub-speed planning parameters 、Seventh sub-speed planning parameters And the eighth sub-speed planning parameters . This will be described in further detail below.
[0131] Reference Figure 7 , based on the adjustment time and the first operation planning parameters, obtaining the second operation planning parameters, including the following steps 701 to 704.
[0132] Step 701: Based on the sum of the initial speed, the fourth time multiplier and the second planning multiplier, and subtracting the target speed and the first planning multiplier one by one, a second planning parameter item is obtained, and a fifth sub-planning parameter is obtained based on the ratio of the second planning parameter item to the third planning multiplier.
[0133] Step 702: A sixth sub-planning parameter is obtained based on the product of the first sub-planning parameter and the adjustment time and the second sub-planning parameter.
[0134] Step 703: A seventh sub-planning parameter is obtained based on the product of the square of the adjustment time and the first sub-planning parameter plus the product of the second sub-planning parameter and the adjustment time and the third sub-planning parameter.
[0135] Step 704: Obtain an eighth sub-planning parameter based on the product of the cube of the adjustment time and the first sub-planning parameter, the product of the square of the adjustment time and the second sub-planning parameter, the product of the third sub-planning parameter and the adjustment time, and the fourth sub-planning parameter.
[0136] Steps 701 to 704 are described in detail below.
[0137] In some embodiments, in order to obtain accurate second operation planning parameters, based on twice the initial speed , twice the number of fourth time multipliers and the second planning multiplier and subtract twice the target speed from it. and the first planning multiplication , get the second planning parameter item , and based on the second planning parameter term and six times the number of third planning multiplication terms The ratio of is used to obtain the fifth sub-planning parameter as shown in the following formula (9).
[0138] (9)
[0139] Next, based on the product of six times the number of first sub-planning parameters and the adjustment time , plus twice the number of second subplan parameters , get the sixth sub-planning parameters .
[0140] And, based on the product of the square of the adjustment time and three times the number of the first sub-programming parameters Add twice the number of second subplanning parameters multiplied by the adjustment time , and add the third sub-planning parameter , get the seventh sub-planning parameters .
[0141] And, based on the product of the cube of the adjustment time and the first sub-planning parameter , plus the product of the square of the adjustment time and the second subplanning parameter , plus the product of the third sub-planning parameter and the adjustment time , and add the fourth sub-planning parameter , get the eighth sub-planning parameters .
[0142] Step 403: Based on the first operation planning parameters, at least the first position, first speed and first acceleration at each moment of the first speed adjustment phase are generated to obtain first speed planning data, and based on the second operation planning parameters, at least the second position, second speed and second acceleration at each moment of the second speed adjustment phase are generated to obtain second speed planning data.
[0143] Step 403 is described in detail below.
[0144] In some embodiments, after obtaining the first operation planning parameter Afterwards, the cubic polynomial planning formula of the above formula (1) can be further used to generate the first position, first speed and first acceleration at each moment of the first speed adjustment stage, thereby obtaining the first speed planning data of the first speed adjustment stage; and obtaining the second operation planning parameters Afterwards, the cubic polynomial planning formula of the above formula (1) can be further used to generate the second position, second speed and second acceleration at each moment of the second speed adjustment stage, thereby obtaining the second speed planning data of the second speed adjustment stage.
[0145] Step 404: Determine the adjustment position according to the first position corresponding to the adjustment time.
[0146] Step 404 is described in detail below.
[0147] In some embodiments, after determining the first position at each moment of the first speed adjustment stage, due to the segmentation point condition (2) mentioned above, that is, the adjustment position corresponding to the adjustment time is the end position of the first speed adjustment stage and also the starting position of the second speed adjustment stage, the first position corresponding to the adjustment time can be directly determined as the adjustment position.
[0148] Reference Figure 8 , is a schematic diagram of first speed planning data and second speed planning data provided in an embodiment of the present application. Figure 8 As shown in , when the mover runs to the initial position, two-segment three-step operation planning is performed using the initial operation data and the target synchronization data required for the target position to determine the initial adjustment position, and the position-time curve corresponding to the first speed planning data of the first speed adjustment stage (i.e., from the initial position to the initial adjustment position, and from the start time to the adjustment time) is obtained, and the position-time curve corresponding to the second speed planning data of the second speed adjustment stage (i.e., from the initial adjustment position to the target position, and from the adjustment time to the target time) is obtained.
[0149] Through the above steps 401 to 404, the operation data of the mover on the synchronous track is preliminarily planned using the initial operation data corresponding to the initial position and the target synchronization data corresponding to the target position, so as to determine the first speed planning data of the first speed adjustment stage from the initial position to the initial transition position, and determine the second speed adjustment data from the initial transition position to the target position, thereby effectively improving the smoothness of the synchronous operation control of the mover on the synchronous track.
[0150] Step 303: Obtain speed planning parameters according to the initial planning data, and control the mover to move from the initial position to the target position according to the speed planning parameters.
[0151] Step 303 is described in detail below.
[0152] In some embodiments, after determining the first speed planning data of the first speed adjustment stage from the initial position to the initial transition position, and determining the second speed adjustment data from the initial transition position to the target position, since in actual application, the initial adjustment position should normally be between the initial position and the target position, it is necessary to first determine whether the generated initial adjustment position is between the initial position and the target position, and according to the judgment result, determine the speed planning parameters for controlling the mover to perform synchronous operation control based on the first speed planning data and the second speed planning data. How to determine the speed planning parameters based on the judgment result and the first speed planning data and the second speed planning data will be further described below.
[0153] Reference Fig. 9 When the initial adjustment position is between the initial position and the target position, the speed planning parameters are obtained according to the initial planning data, including the following steps 901 to 902.
[0154] Step 901: When there is no speed reversal in the first speed planning data and the second speed planning data, a speed planning parameter is obtained according to the first speed planning data and the second speed planning data.
[0155] Step 901 is described in detail below.
[0156] In some embodiments, when it is determined that the generated initial adjustment position is between the initial position and the target position, it is proved that the generated initial adjustment position is normal and correct. In addition, in order to avoid the failure of the magnetic levitation conveying track during the actual synchronous control of the mover, the mover cannot move in the opposite direction (i.e., the running speed direction is opposite to the initial speed), so it is necessary to further judge the first speed planning data and the second speed planning data to determine whether there is a speed reversal between the first speed and the second speed initially planned.
[0157] In some embodiments, after generating the first speed at each moment in the first speed adjustment stage and the second speed at each moment in the second speed adjustment stage, the first speed curve and the second speed curve can be directly generated. Fig.10 , is a schematic diagram of a first speed curve and a second speed curve provided in an embodiment of the present application. Fig.10As shown in , after generating the first speed at each moment in the first speed adjustment stage and the second speed at each moment in the second speed adjustment stage, the first speed time curve from the initial moment to the adjustment time and the second speed time curve from the adjustment time to the target time can be directly generated. Then, it can be determined from the first speed time curve and the second speed time curve whether there is a speed point less than 0, so as to determine whether there is a speed reversal in the first speed planning data and the second speed planning data. Fig.11 , is a schematic diagram of a first speed reversed according to an embodiment of the present application. Fig.11 As shown, when it is determined that the first speed time curve generated by the first speed in the first speed planning data is less than 0, it is determined that there is a speed reversal in the first speed in the first speed planning data.
[0158] In some embodiments, determining whether there is a speed reversal between the first speed in the first speed planning data and the second speed in the second speed planning data can also be determined by another method, which is specifically described as follows. For the first speed planning data in the first speed adjustment stage, first use the first sub-planning parameter obtained and the second subplanning parameter The acceleration formula in the above formula (1) is used to calculate the time point at which the first acceleration is 0 in the first speed planning data: As shown in the following formula (10).
[0159] (10)
[0160] Next, the speed formula in the above formula (1) is used to calculate the time point at which the first acceleration is 0 in the first speed planning data: The corresponding first speed As shown in the following formula (11).
[0161] (11)
[0162] Then determine the time point The corresponding first speed Is it related to the initial velocity? Whether they are of opposite signs can determine whether there is a speed reversal in the first speed planning data; in addition, determining whether there is a speed reversal in the second speed planning data is similar to determining whether there is a speed reversal in the first speed planning data.
[0163] When it is determined that the initial adjustment position is between the initial position and the target position, and when it is determined that there is no speed reversal in the first speed planning data and the second speed in the second speed planning data, it is proved that the first speed planning data and the second speed planning data obtained by the initial planning meet the safety requirements of the magnetic levitation conveyor track, that is, the first speed planning data and the second speed planning data are directly combined as speed planning parameters, and the mover is controlled to move from the initial position to the target position according to the speed planning parameters.
[0164] Step 902: When there is a speed reversal in the first speed in the first speed planning data or the second speed in the second speed planning data, the position of the first speed reversal is used as the target adjustment position, and the speed planning parameters are obtained based on the target adjustment position.
[0165] Step 902 is described in detail below.
[0166] In some embodiments, when it is determined that there is a speed reversal in the first speed in the first speed planning data or the second speed in the second speed planning data, the position of the first speed reversal is first determined. This can be done by Fig.11 In the first speed-time curve shown in FIG. 1 , the position corresponding to the time point when the first speed is 0 (i.e., the first speed reversal point) is found as the first speed reversal position. The speed reversal point equation group shown in the following formula (12) can also be obtained by using the speed formula in the above formula (1).
[0167] (12)
[0168] Then by solving formula (12), we can get two solution roots: , the smaller of the two solved roots As the first time point with a speed of 0, then set the time point in the first speed planning data The corresponding first position is used as the position of the first speed reversal. It is understandable that determining the position of the first speed reversal in the second speed planning data is similar to determining the position of the first speed reversal in the first speed planning data. Then, the position of the first speed reversal is used as the target adjustment position, and the speed planning parameters are obtained based on the target adjustment position. How to use the target adjustment position to obtain the speed planning parameters will be further described below.
[0169] Reference Fig.12 , obtaining speed planning parameters based on the target adjustment position, including the following steps 1201 to 1204.
[0170] Step 1201: Acquire initial planning data between a target adjustment position and an initial position to obtain first target planning data.
[0171] Step 1202: Update the initial position with the target adjustment position, and update the initial operation data using the first target planning parameter at the time corresponding to the target adjustment position.
[0172] Step 1203: Obtain second target planning parameters corresponding to the initial planning data based on the updated initial position and the updated initial operation data.
[0173] Step 1204: Obtain speed planning parameters based on the first target planning parameters and the second target planning parameters.
[0174] Steps 1201 to 1204 are described in detail below.
[0175] In some embodiments, after determining the target adjustment position, the initial planning data between the target adjustment position and the initial position is first obtained to obtain the first target planning data, and the first target planning data includes the first target planning parameters at each moment. It can be understood that when the target adjustment position is between the initial position and the initial adjustment position, the first target planning data obtained is the first speed planning data from the initial position to the target adjustment position (i.e., part of the first speed planning data), and the first target planning parameter is the first speed planning data of the part; when the target adjustment position is between the initial adjustment position and the target position, the first target planning data obtained includes the first speed planning data from the initial position to the initial adjustment position (i.e., all the first speed planning data) and the second speed planning data from the initial adjustment position to the target adjustment position (i.e., part of the second speed planning data), and the first target planning parameter includes all the first speed planning data and the second speed planning data of the part.
[0176] Next, the target adjustment position is used as the new initial position, and the first target planning parameter at the time corresponding to the target adjustment position is used as the new initial operation data as shown in the following formula (13).
[0177] (13)
[0178] Then, based on the updated initial position, the updated initial operation data, the target position and the target synchronization data, the operation data planning of the two speed adjustment stages is performed through similar steps from step 401 to step 404, and the second target planning parameters similar to the initial planning data are obtained, wherein the second target planning parameters include the updated first speed adjustment data of the new first speed adjustment stage and the updated second speed adjustment data of the new second speed adjustment stage. Next, the speed planning parameters are obtained based on the first target planning parameters and the second target planning parameters, and the mover is controlled to move from the initial position to the target position according to the speed planning parameters.
[0179] Reference Fig.13 , is a schematic diagram of the first type of first target planning data and second target planning data provided by the embodiment of the present application. Fig.13 As shown, when the target adjustment position at the time point of the first speed reversal is before the initial adjustment position, the first speed planning data between the initial position and the target adjustment position is retained and used as the first target planning data, and then the updated first speed adjustment data, updated second speed adjustment data and updated adjustment position of the two new speed adjustment stages are obtained according to the target adjustment position and the first speed and first acceleration corresponding to the target adjustment position, as well as the target position and target synchronization data, and the updated first speed adjustment data, updated second speed adjustment data and updated adjustment position are used as the second target planning data, and the first target planning data and the second target planning data are used as speed planning parameters.
[0180] Reference Fig.14 , is a schematic diagram of the second type of first target planning data and second target planning data provided by the embodiment of the present application. Fig.14 As shown, when the target adjustment position at the time point of the first speed reversal is after the initial adjustment position, the first speed planning data between the initial position and the initial adjustment position and the second speed planning data between the initial adjustment position and the target adjustment position are retained and used as the first target planning data, and then the updated first speed adjustment data, updated second speed adjustment data and updated adjustment position of the two new speed adjustment stages are obtained according to the target adjustment position and the corresponding second speed and second acceleration at the target adjustment position and the target position and the target synchronization data, and the updated first speed adjustment data, updated second speed adjustment data and updated adjustment position are used as the second target planning data, and the first target planning data and the second target planning data are used as speed planning parameters.
[0181] Through the above steps 901 to 902 and 1201 to 1204, it is judged one by one whether there is speed reversal in the initial adjustment position and the initial speed, and when there is speed reversal, while retaining the first target planning data, the second operation data planning is re-performed, thereby avoiding failure of the magnetic levitation conveying system and improving the reliability and safety of the mover in the synchronous operation planning.
[0182] When it is determined that the initial adjustment position is outside the initial position and the target position, it is proved that the initial adjustment position obtained by the initial planning is incorrect, and it is necessary to re-plan the synchronous data. The following will further describe how to re-plan the synchronous data of the mover when it is determined that the initial adjustment position is outside the initial position and the target position.
[0183] Reference Fig.15, obtaining speed planning parameters according to the initial planning data, including the following steps 1501 to 1504.
[0184] Step 1501: Determine, based on initial planning data, that an initial adjustment position is outside an initial position and a target position.
[0185] Step 1501 is described in detail below.
[0186] Reference Fig.16 , is a schematic diagram of an initial adjustment position error provided by an embodiment of the present application. Fig.16 As shown, when the initial adjustment position is determined to be outside the initial position and the target position according to the initial planning data obtained from the initial planning (i.e. or ), or determine that the adjustment time obtained by the initial planning is outside the initial time and the target time (i.e. or ), it is proved that the initial adjustment position obtained by the initial planning is wrong, and the first speed planning data and the second speed planning data obtained by the initial planning cannot be used to control the synchronous operation of the mover, and the synchronous data planning needs to be re-performed.
[0187] Step 1502: Generate third speed planning data corresponding to the overall adjustment phase from the initial position to the target position based on the initial operation data and the target synchronization data.
[0188] Step 1502 is described in detail below.
[0189] In some embodiments, since the first speed planning data and the second speed planning data obtained from the initial two-stage synchronous operation data planning cannot be used, the third speed planning data corresponding to the overall adjustment stage from the initial position to the target position is generated directly based on the initial operation data of the initial position and the target synchronization data of the target position.
[0190] The generation of the specific third speed planning data is still based on the cubic polynomial planning formula shown in the above formula (1), and the third operation planning parameters can be obtained based on formula (1), the initial operation data of the initial position and the target synchronization data of the target position. As shown in the following formula (14).
[0191] (14)
[0192] After obtaining the third operation planning parameters Afterwards, the third speed, third position and third acceleration at each moment can be obtained by using the cubic polynomial planning formula shown in formula (1) again, and the third speed planning data can be obtained based on the third speed, third position and third acceleration.
[0193] Reference Fig.17 , is a schematic diagram of a third speed planning data provided in an embodiment of the present application. Fig.17 As shown, a third position time curve corresponding to the third speed planning data obtained by performing a section of synchronous operation data planning based on the initial operation data of the mover reaching the initial position and the target synchronization data required for the mover to reach the target position is displayed.
[0194] Step 1503: When there is no speed reversal at the third speed, obtain speed planning parameters according to the third speed planning data.
[0195] Steps 1502 to 1503 are described in detail below.
[0196] In some embodiments, after obtaining the third speed planning data, similar to the above steps 901 to 902, it is also necessary to determine whether the third speed corresponding to the third speed planning data has a speed reversal. When it is determined that the third speed corresponding to the third speed planning data does not have a speed reversal point, the third speed planning data is directly used as a speed planning parameter, and the mover is controlled to move from the initial position to the target position according to the speed planning parameter.
[0197] Step 1504: When the third speed has a speed reversal, the third speed that is less than zero is set to zero, the third speed in the third speed planning data is updated, and the speed planning parameters are obtained according to the third speed planning data.
[0198] Step 1504 is described in detail below.
[0199] Reference Fig.18 , is a schematic diagram of a third speed reversed according to an embodiment of the present application. Fig.18 As shown, when it is determined that the third speed corresponding to the third speed planning data has a speed reversal, in order to avoid failure of the magnetic levitation conveying track, the third speed planning data needs to be adjusted.
[0200] When it is determined that the third speed has a speed direction, the third speed corresponding to the time point less than 0 in the third speed is set to 0, and the third speed corresponding to the time point greater than 0 in the third speed is retained, thereby updating the third speed in the third speed planning data. Fig.19 As shown in FIG. 1 , it is a schematic diagram of updating the third speed provided by an embodiment of the present application. Fig.19 As shown, firstly, the time period in which the speed direction appears is determined according to the third speed time curve corresponding to the third speed, and then the third speed of the time period is set to 0 (such as Fig.19), and update the third speed planning data, thereby obtaining the third position time curve in the updated third speed planning data (as shown in the figure above). Fig.19 Then, the speed planning parameters are obtained according to the updated third speed planning data, and the mover is controlled to move from the initial position to the target position according to the speed planning parameters.
[0201] Through the above steps 1501 to 1504, the synchronous operation data is re-planned in case of an error in the initial adjustment position, and whether a speed reversal occurs is simultaneously considered, and the third speed planning data is updated and adjusted in response to the speed reversal, thereby improving the reliability and accuracy of the synchronous operation control of the mover in the synchronous track.
[0202] The embodiments of the present application propose a method, device, electronic device and storage medium for controlling a mover of a synchronous track, wherein the synchronous track includes an initial position and a target position, and the method includes: first, obtaining initial operation data when the mover reaches the initial position, and target synchronization data required when the mover reaches the target position; then, obtaining an adjustment time based on the initial position, the initial operation data, the target position and the target synchronization data, obtaining a first operation planning parameter based on the adjustment time, and obtaining a second operation planning parameter based on the adjustment time and the first operation planning parameter, generating at least a first position, a first speed and a first acceleration at each moment of a first speed adjustment phase based on the first operation planning parameter to obtain first speed planning data, and generating at least a second position, a second speed and a second acceleration at each moment of a second speed adjustment phase based on the second operation planning parameter to obtain second speed planning data, and determining the adjustment position according to the first position corresponding to the adjustment time; next, when the initial adjustment position is between the initial position and the target position, when there is no speed reversal in the first speed in the first speed planning data and the second speed in the second speed planning data, obtaining a speed planning parameter according to the first speed planning data and the second speed planning data; when the first speed or the second speed in the first speed planning data When there is a speed reversal in the second speed in the speed planning data, the position of the first speed reversal is used as the target adjustment position, and the initial planning data between the target adjustment position and the initial position is obtained to obtain the first target planning data, the target adjustment position is updated to the initial position, and the initial operation data is updated using the first target planning parameters at the corresponding moment of the target adjustment position, and the second target planning parameters corresponding to the initial planning data are obtained based on the updated initial position and the updated initial operation data, and the speed planning parameters are obtained based on the first target planning parameters and the second target planning parameters; according to the initial planning data, it is determined that the initial adjustment position is outside the initial position and the target position, and the third speed planning data corresponding to the overall adjustment stage from the initial position to the target position is generated based on the initial operation data and the target synchronization data. The third speed planning data at least includes a third position, a third speed and a third acceleration at each moment. When there is no speed reversal in the third speed, the speed planning parameters are obtained according to the third speed planning data. When there is a speed reversal in the third speed, the third speed less than zero is set to zero, the third speed in the third speed planning data is updated, and the speed planning parameters are obtained according to the third speed planning data. Finally, the mover is controlled to move from the initial position to the target position according to the speed planning parameters.
[0203] The embodiment of the present application utilizes the initial operation data of the starting position and the target synchronization data of the target position to plan the operation data of the two speed adjustment stages for the operation of the mover in the synchronous track, and combines the initial adjustment position as the transition position of the two speed adjustment stages, so that in the control stage of the synchronous track, the mover is synchronously controlled at the speed adjustment speed of the two speed adjustment stages, thereby improving the smoothness of the mover operation control in the synchronous track and avoiding the risk of failure of the mover due to low smoothness; in addition, by judging the initial adjustment position and whether there is a speed reversal one by one, and when there is a speed reversal, while retaining the first target planning data, re-planning the second operation data, thereby avoiding failure of the magnetic levitation conveying system, so as to improve the reliability and safety of the mover in the synchronous operation planning; and, by re-planning the synchronous operation data in the case of an error in the initial adjustment position, synchronously considering whether there is a speed reversal, and updating and adjusting the third speed planning data according to the speed reversal, the reliability and accuracy of the synchronous operation control of the mover in the synchronous track are improved.
[0204] The embodiment of the present application also provides a moving element control device for a synchronous track, which can implement the moving element control method for the synchronous track. Fig. 20 , the device 2000 comprises:
[0205] The data acquisition module 2010 is used to acquire the initial operation data when the mover reaches the initial position, and the target synchronization data required when the mover reaches the target position;
[0206] A data generation module 220 is used to generate initial planning data based on the initial operation data and the target synchronization data, wherein the initial planning data includes first speed planning data of the first speed adjustment stage, second speed planning data of the second speed adjustment stage, and an initial adjustment position between the two speed adjustment stages;
[0207] The control module 2030 is used to obtain speed planning parameters according to the initial planning data, and control the mover to move from the initial position to the target position according to the speed planning parameters.
[0208] In some embodiments, the data generation module 2020 is further configured to:
[0209] obtaining an adjustment time based on the initial position, the initial operation data, the target position, and the target synchronization data;
[0210] Obtaining a first operation planning parameter based on the adjustment time, and obtaining a second operation planning parameter based on the adjustment time and the first operation planning parameter;
[0211] Based on the first operation planning parameters, at least a first position, a first speed and a first acceleration at each moment of the first speed adjustment phase are generated to obtain the first speed planning data; and based on the second operation planning parameters, at least a second position, a second speed and a second acceleration at each moment of the second speed adjustment phase are generated to obtain the second speed planning data;
[0212] The adjustment position is determined according to the first position corresponding to the adjustment time.
[0213] In some embodiments, the mover control device 2000 of the synchronous track further includes a planning parameter determination module 2040. When the initial adjustment position is between the initial position and the target position, the planning parameter determination module 2040 is used to:
[0214] When there is no speed reversal in the first speed in the first speed planning data and the second speed in the second speed planning data, obtaining the speed planning parameter according to the first speed planning data and the second speed planning data;
[0215] When there is a speed reversal in the first speed in the first speed planning data or the second speed in the second speed planning data, the position of the first speed reversal is used as the target adjustment position, and the speed planning parameters are obtained based on the target adjustment position.
[0216] In some embodiments, the planning parameter determination module 2040 is further configured to:
[0217] Acquire the initial planning data between the target adjustment position and the initial position to obtain first target planning data, wherein the first target planning data includes first target planning parameters at each moment;
[0218] The target adjustment position is used to update the initial position, and the initial operation data is updated using the first target planning parameter at a time corresponding to the target adjustment position;
[0219] Obtaining a second target planning parameter corresponding to the initial planning data based on the updated initial position and the updated initial operation data;
[0220] The speed planning parameter is obtained based on the first target planning parameter and the second target planning parameter.
[0221] In some embodiments, the planning parameter determination module 2040 is further configured to:
[0222] Determining, according to the initial planning data, that the initial adjustment position is outside the initial position and the target position;
[0223] Generate third speed planning data corresponding to the overall adjustment phase from the initial position to the target position based on the initial operation data and the target synchronization data, the third speed planning data at least including a third position, a third speed and a third acceleration at each moment;
[0224] When there is no speed reversal at the third speed, obtaining the speed planning parameter according to the third speed planning data;
[0225] When the third speed has a speed reversal, the third speed that is less than zero is set to zero, the third speed in the third speed planning data is updated, and the speed planning parameter is obtained according to the third speed planning data.
[0226] In some embodiments, the data generation module 2020 is further configured to:
[0227] Obtaining a first time multiplier based on the product of the target time and the target speed, obtaining a second time multiplier based on the product of the target time and the initial speed, and obtaining a third time multiplier based on the product of the square of the target time and the target acceleration;
[0228] obtaining a fourth time multiplier based on the product of the target acceleration and the target time, and obtaining a fifth time multiplier based on the product of the initial acceleration and the target time;
[0229] Based on the sum of the target position and the third time multiplier, subtract the initial position, the first time multiplier, and the second time multiplier one by one to obtain a first adjustment time term;
[0230] Based on the difference between the initial speed and the target speed, the fourth time multiplier and the fifth time multiplier are added one by one to obtain a second adjustment time term;
[0231] The adjustment time is obtained based on a ratio of the first adjustment time item to the second adjustment time item.
[0232] In some embodiments, the data generation module 2020 is further configured to:
[0233] Obtaining a first planning multiplication term based on the product of the target acceleration and the adjustment time, obtaining a second planning multiplication term based on the product of the initial acceleration and the adjustment time, and obtaining a third planning multiplication term based on the product of the target speed and the adjustment time;
[0234] Based on the sum of the target speed and the first planning multiplier, the initial speed, the fourth time multiplier, the fifth time multiplier and the second planning multiplier are subtracted one by one to obtain a first planning parameter item, and based on the ratio of the first planning parameter item to the third planning multiplier, the first sub-planning parameter is obtained;
[0235] The second sub-planning parameter is obtained based on half of the initial acceleration, the third sub-planning parameter is obtained based on the initial velocity, and the fourth sub-planning parameter is obtained based on the initial position.
[0236] In some embodiments, the data generation module 2020 is further configured to:
[0237] Based on the sum of the initial speed, the fourth time multiplier and the second planning multiplier, and subtracting the target speed and the first planning multiplier one by one, a second planning parameter item is obtained, and based on the ratio of the second planning parameter item to the third planning multiplier, the fifth sub-planning parameter is obtained;
[0238] Based on the product of the first sub-planning parameter and the adjustment time, and adding the second sub-planning parameter, obtain the sixth sub-planning parameter;
[0239] The seventh sub-planning parameter is obtained based on the product of the square of the adjustment time and the first sub-planning parameter plus the product of the second sub-planning parameter and the adjustment time, and the third sub-planning parameter.
[0240] The eighth sub-planning parameter is obtained based on the product of the cube of the adjustment time and the first sub-planning parameter, the product of the square of the adjustment time and the second sub-planning parameter, the third sub-planning parameter and the parameter of the adjustment time, and the fourth sub-planning parameter.
[0241] In the above embodiments, the description of each embodiment has its own emphasis. For the part that is not described in detail in a certain embodiment, the specific implementation of the mover control device of the synchronous track is basically the same as the specific implementation of the mover control method of the synchronous track, and will not be repeated here.
[0242] In the embodiment of the present application, the mover control device of the synchronous track uses the initial operation data of the starting position and the target synchronization data of the target position to plan the operation data of the mover in two speed adjustment stages in the synchronous track, and combines the initial adjustment position as the transition position of the two speed adjustment stages, so that the mover is synchronously controlled at the speed adjustment speed of the two speed adjustment stages in the control stage of the synchronous track, thereby improving the smoothness of the mover operation control in the synchronous track and avoiding the risk of failure of the mover due to low smoothness; in addition, by judging the initial adjustment position and whether there is a speed reversal one by one, and when there is a speed reversal, while retaining the first target planning data, re-planning the second operation data, thereby avoiding failure of the magnetic levitation conveying system, so as to improve the reliability and safety of the mover in the synchronous operation planning; and, by re-planning the synchronous operation data in the case of an error in the initial adjustment position, synchronously considering whether there is a speed reversal, and updating and adjusting the third speed planning data according to the speed reversal, the reliability and accuracy of the synchronous operation control of the mover in the synchronous track are improved.
[0243] The present application also provides an electronic device, including:
[0244] at least one memory;
[0245] at least one processor;
[0246] at least one program;
[0247] The program is stored in the memory, and the processor executes the at least one program to implement the above-mentioned method for controlling the mover of the synchronous track in the present application. The electronic device can be any intelligent terminal including a mobile phone, a tablet computer, a personal digital assistant (PDA), a vehicle-mounted computer, etc.
[0248] See also Fig.21 , Fig.21 The hardware structure of an electronic device of another embodiment is illustrated, and the electronic device includes:
[0249] The processor 2101 may be implemented by a general-purpose CPU (Central Processing Unit), a microprocessor, an application-specific integrated circuit (Application Specific Integrated Circuit, ASIC), or one or more integrated circuits, and is used to execute relevant programs to implement the technical solutions provided in the embodiments of the present application;
[0250] The memory 2102 can be implemented in the form of ROM (Read Only Memory), static storage device, dynamic storage device or RAM (Random Access Memory). The memory 2102 can store operating systems and other applications. When the technical solutions provided in the embodiments of this specification are implemented by software or firmware, the relevant program codes are stored in the memory 2102, and the processor 2101 calls and executes the mover control method of the synchronous track in the embodiments of this application;
[0251] Input / output interface 2103, used to implement information input and output;
[0252] Communication interface 2104, used to realize communication interaction between the device and other devices, which can be realized through wired mode (such as USB, network cable, etc.) or wireless mode (such as mobile network, WIFI, Bluetooth, etc.);
[0253] A bus 2105 that transmits information between the various components of the device (e.g., the processor 2101, the memory 2102, the input / output interface 2103, and the communication interface 2104);
[0254] The processor 2101 , the memory 2102 , the input / output interface 2103 and the communication interface 2104 are connected to each other in communication within the device via the bus 2105 .
[0255] An embodiment of the present application further provides a storage medium, which is a computer-readable storage medium and stores a computer program. When the computer program is executed by a processor, the above-mentioned mover control method of the synchronous track is implemented.
[0256] The memory, as a non-transient computer-readable storage medium, can be used to store non-transient software programs and non-transient computer executable programs. In addition, the memory may include a high-speed random access memory, and may also include a non-transient memory, such as at least one disk storage device, a flash memory device, or other non-transient solid-state storage device. In some embodiments, the memory may optionally include a memory remotely disposed relative to the processor, and these remote memories may be connected to the processor via a network. Examples of the above-mentioned network include, but are not limited to, the Internet, an intranet, a local area network, a mobile communication network, and combinations thereof.
[0257] The embodiments described in the embodiments of the present application are intended to more clearly illustrate the technical solutions of the embodiments of the present application and do not constitute a limitation on the technical solutions provided in the embodiments of the present application. Those skilled in the art will appreciate that with the evolution of technology and the emergence of new application scenarios, the technical solutions provided in the embodiments of the present application are also applicable to similar technical problems.
[0258] Those skilled in the art will appreciate that the technical solutions shown in the figures do not constitute a limitation on the embodiments of the present application, and may include more or fewer steps than shown in the figures, or a combination of certain steps, or different steps.
[0259] The device embodiments described above are merely illustrative, and the units described as separate components may or may not be physically separated, that is, they may be located in one place or distributed on multiple network units. Some or all of the modules may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
[0260] Those skilled in the art will appreciate that all or some of the steps in the methods disclosed above, and the functional modules / units in the systems and devices may be implemented as software, firmware, hardware, or a suitable combination thereof.
[0261] The terms "first", "second", "third", "fourth", etc. (if any) in the specification of the present application and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchangeable where appropriate, so that the embodiments of the present application described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any of their variations are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device comprising a series of steps or units is not necessarily limited to those steps or units clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.
[0262] It should be understood that in the present application, "at least one (item)" means one or more, and "plurality" means two or more. "And / or" is used to describe the association relationship of associated objects, indicating that three relationships may exist. For example, "A and / or B" can mean: only A exists, only B exists, and A and B exist at the same time, where A and B can be singular or plural. The character " / " generally indicates that the objects associated before and after are in an "or" relationship. "At least one of the following" or similar expressions refers to any combination of these items, including any combination of single or plural items. For example, at least one of a, b or c can mean: a, b, c, "a and b", "a and c", "b and c", or "a and b and c", where a, b, c can be single or multiple.
[0263] In the several embodiments provided in the present application, it should be understood that the disclosed devices and methods can be implemented in other ways. For example, the device embodiments described above are only schematic. For example, the division of the above units is only a logical function division. There may be other division methods in actual implementation, such as multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. The mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of devices or units, which can be electrical, mechanical or other forms.
[0264] The units described above as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
[0265] In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit. The above-mentioned integrated unit may be implemented in the form of hardware or in the form of software functional units.
[0266] If the integrated unit is implemented in the form of 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 application, 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, and the computer software product is stored in a storage medium, including multiple instructions to enable a computer device (which can be a personal computer, server, or network device, etc.) to execute all or part of the steps of the methods of various embodiments of the present application. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (Read-Only Memory, referred to as ROM), random access memory (Random Access Memory, referred to as RAM), disk or optical disk and other media that can store programs.
[0267] The preferred embodiments of the present invention are described above with reference to the accompanying drawings, but the scope of the rights of the present invention is not limited thereto. Any modification, equivalent substitution and improvement made by a person skilled in the art without departing from the scope and essence of the present invention should be within the scope of the rights of the present invention.
Claims
1. A method for controlling a mover of a synchronous track, characterized in that: The synchronous orbit includes an initial position and a target position, and the method includes: Acquiring initial operation data when the mover reaches the initial position, and target synchronization data required when the mover reaches the target position; Generate initial planning data based on the initial operation data and the target synchronization data, the initial planning data including first speed planning data of a first speed adjustment stage, second speed planning data of a second speed adjustment stage, and an initial adjustment position between the two speed adjustment stages; Obtaining speed planning parameters according to the initial planning data, and controlling the mover to move from the initial position to the target position according to the speed planning parameters; The generating initial planning data based on the initial operation data and the target synchronization data includes: obtaining an adjustment time based on the initial position, the initial operation data, the target position, and the target synchronization data; Obtaining a first operation planning parameter based on the adjustment time, and obtaining a second operation planning parameter based on the adjustment time and the first operation planning parameter; Based on the first operation planning parameters, at least a first position, a first speed and a first acceleration at each moment of the first speed adjustment phase are generated to obtain the first speed planning data; and based on the second operation planning parameters, at least a second position, a second speed and a second acceleration at each moment of the second speed adjustment phase are generated to obtain the second speed planning data; determining the adjustment position according to the first position corresponding to the adjustment time; When the initial adjustment position is between the initial position and the target position, obtaining the speed planning parameter according to the initial planning data includes: When there is no speed reversal in the first speed in the first speed planning data and the second speed in the second speed planning data, obtaining the speed planning parameter according to the first speed planning data and the second speed planning data; When there is a speed reversal in the first speed in the first speed planning data or the second speed in the second speed planning data, the position of the first speed reversal is used as the target adjustment position, and the speed planning parameters are obtained based on the target adjustment position.
2. The method for controlling a mover of a synchronous track according to claim 1, characterized in that: The obtaining of the speed planning parameter based on the target adjustment position includes: Acquire the initial planning data between the target adjustment position and the initial position to obtain first target planning data, wherein the first target planning data includes first target planning parameters at each moment; The target adjustment position is used to update the initial position, and the initial operation data is updated using the first target planning parameter at a time corresponding to the target adjustment position; Obtaining a second target planning parameter corresponding to the initial planning data based on the updated initial position and the updated initial operation data; The speed planning parameter is obtained based on the first target planning parameter and the second target planning parameter.
3. The method for controlling a mover of a synchronous track according to claim 1, characterized in that: The obtaining of speed planning parameters according to the initial planning data comprises: Determining, according to the initial planning data, that the initial adjustment position is outside the initial position and the target position; Generate third speed planning data corresponding to the overall adjustment phase from the initial position to the target position based on the initial operation data and the target synchronization data, the third speed planning data at least including a third position, a third speed and a third acceleration at each moment; When there is no speed reversal at the third speed, obtaining the speed planning parameter according to the third speed planning data; When the third speed has a speed reversal, the third speed that is less than zero is set to zero, the third speed in the third speed planning data is updated, and the speed planning parameter is obtained according to the third speed planning data.
4. The method for controlling a mover of a synchronous track according to claim 1, characterized in that: The initial operation data includes an initial speed and an initial acceleration, the target synchronization data includes a target speed, a target time, and a target acceleration, and the adjusting time is obtained based on the initial position, the initial operation data, the target position, and the target synchronization data, including: Obtaining a first time multiplier based on the product of the target time and the target speed, obtaining a second time multiplier based on the product of the target time and the initial speed, and obtaining a third time multiplier based on the product of the square of the target time and the target acceleration; obtaining a fourth time multiplier based on the product of the target acceleration and the target time, and obtaining a fifth time multiplier based on the product of the initial acceleration and the target time; Based on the sum of the target position and the third time multiplier, subtract the initial position, the first time multiplier, and the second time multiplier one by one to obtain a first adjustment time term; Based on the difference between the initial speed and the target speed, the fourth time multiplier and the fifth time multiplier are added one by one to obtain a second adjustment time term; The adjustment time is obtained based on a ratio of the first adjustment time item to the second adjustment time item.
5. The method for controlling a mover of a synchronous track according to claim 4, characterized in that: The first operation planning parameter includes a first sub-planning parameter, a second sub-planning parameter, a third sub-planning parameter, and a fourth sub-planning parameter, and obtaining the first operation planning parameter based on the adjustment time includes: Obtaining a first planning multiplication term based on the product of the target acceleration and the adjustment time, obtaining a second planning multiplication term based on the product of the initial acceleration and the adjustment time, and obtaining a third planning multiplication term based on the product of the target speed and the adjustment time; Based on the sum of the target speed and the first planning multiplier, the initial speed, the fourth time multiplier, the fifth time multiplier and the second planning multiplier are subtracted one by one to obtain a first planning parameter item, and based on the ratio of the first planning parameter item to the third planning multiplier, the first sub-planning parameter is obtained; The second sub-planning parameter is obtained based on half of the initial acceleration, the third sub-planning parameter is obtained based on the initial velocity, and the fourth sub-planning parameter is obtained based on the initial position.
6. The method for controlling a mover of a synchronous track according to claim 5, characterized in that: The second operation planning parameter includes a fifth sub-planning parameter, a sixth sub-planning parameter, a seventh sub-planning parameter and an eighth sub-planning parameter, and obtaining the second operation planning parameter based on the adjustment time and the first operation planning parameter includes: Based on the sum of the initial speed, the fourth time multiplier and the second planning multiplier, and subtracting the target speed and the first planning multiplier one by one, a second planning parameter item is obtained, and based on the ratio of the second planning parameter item to the third planning multiplier, the fifth sub-planning parameter is obtained; Based on the product of the first sub-planning parameter and the adjustment time, and adding the second sub-planning parameter, obtain the sixth sub-planning parameter; The seventh sub-planning parameter is obtained based on the product of the square of the adjustment time and the first sub-planning parameter plus the product of the second sub-planning parameter and the adjustment time, and the third sub-planning parameter. The eighth sub-planning parameter is obtained based on the product of the cube of the adjustment time and the first sub-planning parameter, the product of the square of the adjustment time and the second sub-planning parameter, the third sub-planning parameter and the parameter of the adjustment time, and the fourth sub-planning parameter.
7. A mover control device for a synchronous track, characterized in that: The synchronous track includes an initial position and a target position, and the device includes: A data acquisition module, used to acquire initial operation data when the mover reaches the initial position, and target synchronization data required when the mover reaches the target position; A data generation module, configured to generate initial planning data based on the initial operation data and the target synchronization data, wherein the initial planning data includes first speed planning data of a first speed adjustment stage, second speed planning data of a second speed adjustment stage, and an initial adjustment position between the two speed adjustment stages; A control module, used to obtain a speed planning parameter according to the initial planning data, and control the mover to move from the initial position to the target position according to the speed planning parameter; The generating initial planning data based on the initial operation data and the target synchronization data includes: obtaining an adjustment time based on the initial position, the initial operation data, the target position, and the target synchronization data; Obtaining a first operation planning parameter based on the adjustment time, and obtaining a second operation planning parameter based on the adjustment time and the first operation planning parameter; Based on the first operation planning parameters, at least a first position, a first speed and a first acceleration at each moment of the first speed adjustment phase are generated to obtain the first speed planning data; and based on the second operation planning parameters, at least a second position, a second speed and a second acceleration at each moment of the second speed adjustment phase are generated to obtain the second speed planning data; determining the adjustment position according to the first position corresponding to the adjustment time; When the initial adjustment position is between the initial position and the target position, obtaining the speed planning parameter according to the initial planning data includes: When there is no speed reversal in the first speed in the first speed planning data and the second speed in the second speed planning data, obtaining the speed planning parameter according to the first speed planning data and the second speed planning data; When there is a speed reversal in the first speed in the first speed planning data or the second speed in the second speed planning data, the position of the first speed reversal is used as the target adjustment position, and the speed planning parameters are obtained based on the target adjustment position.
8. An electronic device comprising a memory and a processor, wherein the memory stores a computer program, wherein: When the processor executes the computer program, the mover control method of the synchronous track according to any one of claims 1 to 6 is implemented.
9. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the mover control method of the synchronous track as claimed in any one of claims 1 to 6 is implemented.
Citation Information
Patent Citations
Method for controlling the normal force of a transport unit of a linear motor with guideway stator
CN108631540A
Rotor control method and control system for long stator conveying system
CN112027676A
Magnetic levitation conveying system braking method and device, magnetic levitation conveying system and storage medium
CN117125489A
Mover motion planning method and system, electronic equipment and storage medium
CN117383189A
Control method for moving component of magnetic drive system and related equipment
CN117566383A
