Automatic walking positioning motion controller

Through the automatic walking positioning motion controller, the precision motion curve is used to control the trolley, which solves the problem of poor accuracy and operation fatigue caused by manual driving, and realizes the precise positioning and efficient operation of the trolley, improving safety and equipment life.

CN119045493APending Publication Date: 2024-11-29北京瓦特曼智能科技有限公司
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411160153.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-22
Publication Date
2024-11-29

AI Technical Summary

Technical Problem

In the prior art, the sky train operation relies on manual driving, which has problems such as poor accuracy, fatigue in operation, susceptible to external interference, inconsistent operation sequence, and sudden brakes, emergency starts and physical wear caused by bad habits, which limits production efficiency and equipment life. .

Method used

An automatic walking positioning motion controller is designed, including a walking positioning controller, a reference curve calculation module, a controller module and an S-type target speed curve generation module. Through precise motion curves, the movement speed of the sky car is controlled, and manual operation is reduced to achieve Accurate positioning and regular movement.

Benefits of technology

It realizes the precise positioning of the sky truck, reduces the phenomenon of emergency start and brake, improves operating efficiency and safety, extends the service life of the equipment, and reduces human operation errors and safety hazards.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119045493A_ABST
    Figure CN119045493A_ABST
Patent Text Reader

Abstract

The invention provides an automatic walking positioning motion controller which comprises a walking positioning controller, a reference curve calculation module, a controller module and an S-shaped target speed curve generation module. The controller module is used for controlling the traveling positioning controller to send a crown block traveling instruction according to the remaining traveling distance of the crown block; the reference curve calculation module is used for processing a crown block running instruction; the S-shaped target speed curve generation module is used for controlling the moving speed of the crown block through a long-distance motion curve; the S-shaped target speed curve comprises a long-distance movement curve and a short-distance movement curve, and each of the long-distance movement curve and the short-distance movement curve comprises a plurality of stages: a starting acceleration fillet section, a uniform acceleration section, an acceleration fillet section, a deceleration fillet section, a uniform deceleration section, a crawling fillet section, a low-speed crawling section and a parking brake section; and the reference curve calculation module selects a long-distance movement curve or a short-distance movement curve according to the traveling residual distance of the crown block, and sets a curve of each stage according to the traveling residual distance.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of intelligent logistics, and mainly to an automatic traveling and positioning motion controller. Background Art

[0002] In recent years, affected by safety, quality, cost and other factors, intelligent management of warehouse logistics has become increasingly important, especially in some high-risk and high-intensity operation areas. Overhead crane hoisting operations are frequent, and material management in the production warehouse is complex, requiring the coordinated work of overhead crane operators, ground commanders, ground workers, and warehouse management system input personnel. Not only is the labor cost high, but the operation level is uneven, and production efficiency is also limited by bottlenecks. Although overhead crane operations can be remotely controlled, overhead crane operations and warehouse management still rely mainly on manual operations, and operating efficiency has not been significantly improved.

[0003] In order to realize smart factories and improve corporate competitiveness, and realize less-manpowered operations, the intelligent transformation of overhead cranes is the general trend. The intelligent transformation of overhead cranes involves the problem of automatic operation of overhead cranes. The automatic operation of overhead cranes requires that the overhead cranes can accurately realize the travel positioning control. The use of automatic travel positioning motion controllers can enable the overhead cranes to accurately reach the target position. Even if the overhead cranes are only partially intelligentized, the use of automatic travel positioning motion controllers can also reduce the labor intensity of the overhead crane drivers.

[0004] In the prior art, the operation of the overhead crane mainly relies on manual driving, and the overhead crane grabs the suspended objects manually step by step, which has the following problems:

[0005] 1. Manual control has poor precision and requires constant concentration and observation of the distance between the overhead crane and the target.

[0006] 2. When under manual control, the overhead crane needs to be operated all the time, and the degree of intelligence is low.

[0007] 3. Human fatigue is prone to errors and operations are easily affected by external interference.

[0008] 4. The continuous working time is short and it is impossible to work uninterruptedly for 24 hours.

[0009] 5. Manual operation is subjective to a certain extent, and the order of operations cannot always be consistent.

[0010] 6. There are certain bad habits in manual operation, which may cause "sudden braking", "sudden starting" and "reverse driving". This will reduce the service life of mechanical equipment and easily cause physical wear and damage. Summary of the invention

[0011] The present invention provides an automatic walking and positioning motion controller, which includes a walking and positioning controller, a reference curve calculation module, a controller module and an S-shaped target speed curve generation module;

[0012] The controller module is used to control the traveling positioning controller to send the traveling instruction of the overhead crane according to the remaining traveling distance of the overhead crane;

[0013] The reference curve calculation module is used to process the overhead traveling instruction;

[0014] The S-shaped target speed curve generation module is used to control the moving speed of the overhead crane through a long-distance motion curve;

[0015] The S-shaped target speed curve includes a long-distance movement curve and a short-distance movement curve, and the long-distance movement curve and the short-distance movement curve each include multiple stages: a start-up acceleration rounded corner section, a uniform acceleration section, an acceleration rounded corner section, a deceleration rounded corner section, a uniform deceleration section, a creeping rounded corner section, a low-speed creeping section, and a parking brake section;

[0016] The reference curve calculation module selects a long-distance motion curve or a short-distance movement curve according to the remaining distance of the overhead traveling crane, and sets the curve of each stage according to the remaining distance of the traveling crane.

[0017] Furthermore, the curves of each stage in the long-distance motion curve are defined as:

[0018] Start the acceleration round section: with a constant acceleration j a Increase the acceleration from 0 to the locomotive setting a m , start the acceleration round corner section time t 0 , start acceleration radius displacement s 0 ;

[0019]

[0020] a represents the current acceleration, v represents the current speed value, s represents the current travel distance, t represents the current time, T 0 Indicates the moment when the acceleration rounding segment is completed;

[0021] Acceleration rounded corner section: with constant negative acceleration -j a Change the acceleration from a m Decreases to 0, and the speed reaches the maximum value v m , the time taken for the acceleration rounding section is t 2 , the displacement of the acceleration fillet segment s 2 ;

[0022]

[0023] T 2Indicates the moment when the acceleration rounding segment is completed;

[0024] Uniform speed segment: with a constant maximum speed v m Running, time for uniform speed section t 3 , displacement s in the uniform speed segment 3 ;

[0025]

[0026] T 3 Indicates the moment when the uniform speed segment is completed;

[0027] Deceleration radius: with constant negative deceleration acceleration j d Decrease the acceleration from 0 to -a md , the time taken for the deceleration round corner section is t 4 , displacement of the deceleration radius section s 4 ;

[0028]

[0029] T 4 Indicates the moment when the deceleration radius section is completed;

[0030] Uniform deceleration stage: with constant negative maximum acceleration -a md Deceleration operation, this section takes time t 5 , the total displacement s 5 ;

[0031]

[0032] T 4 Indicates the moment when the uniform deceleration phase is completed;

[0033] Crawling corner section: with constant deceleration j d Change the acceleration from -a md Increases to 0, the time taken for this segment is t 6 , the total displacement s 6 ;

[0034]

[0035] T 6 Indicates the moment when the crawling fillet segment is completed;

[0036] Slow-speed crawling section: The slow-speed crawling section crawls at a constant speed v 4 Running time t 7 , displacement of the low-speed crawling section s 7 ;

[0037]

[0038] T 7Indicates the moment when the low-speed crawling segment is completed;

[0039] Parking brake section: Mechanical braking section, using constant acceleration to decelerate to 0, parking brake section time t 8 ;

[0040]

[0041] T 8 Indicates the moment when the parking brake segment is completed, a b Indicates the deceleration used during the parking brake phase.

[0042] Furthermore, the long-distance motion curve also includes a uniform speed segment, and the uniform speed segment curve is defined as:

[0043] Uniform acceleration: with constant acceleration a m Accelerate to a certain speed value v 1 , time taken for uniform acceleration segment t 1 , displacement s in the uniform acceleration segment 1 ;

[0044]

[0045] T 1 represents the time when the uniform acceleration segment is completed, s 0 Indicates the distance traveled in the acceleration rounded corner section, v 0 represents the initial velocity value of the uniform acceleration segment, v 1 Indicates the velocity value at the end of the uniform acceleration segment.

[0046] Furthermore, the duration of each stage in the long-distance motion curve is:

[0047] The duration of the acceleration rounded corner segment is set to a fixed duration according to the scene, with a value range of 5-10 seconds;

[0048] The duration of the uniform acceleration segment is set to the duration of reaching 90% of the maximum speed limit;

[0049] The duration of the acceleration rounded corner segment is set to a fixed duration based on the scene, ranging from 2 to 5 seconds;

[0050] The duration of the deceleration rounded corner segment is set to a fixed duration based on the scenario, ranging from 2 to 5 seconds;

[0051] The duration of the uniform deceleration segment is set to the duration of reaching 20% ​​of the maximum speed limit;

[0052] The duration of the creeping rounded corner segment is set to the duration of the speed value reaching 10% of the maximum speed limit;

[0053] The duration of the low-speed crawling section is set based on the difference between the actual position and the target position, and when it reaches 0.5m / s, it enters the parking brake section;

[0054] The duration of the parking brake section is set to stop the vehicle immediately upon reaching the target position.

[0055] Furthermore, the duration of the constant speed segment is set based on the difference between the actual position and the target position.

[0056] Furthermore, the S-shaped target speed curve includes a short-distance motion curve, wherein:

[0057]

[0058] a′ m represents the acceleration set by the locomotive, t′ 0 Indicates the duration of the start acceleration rounded corner segment and the acceleration rounded corner segment, j′ a represents constant acceleration, t′ 4 represents the duration of the deceleration round section and the creeping round section, a′ md Indicates the acceleration value during the deceleration phase, j′ d represents constant deceleration, t′ 1 represents the duration of the uniform acceleration segment, v′ 4 Indicates the speed value of the low-speed crawling period, t′ 5 represents the duration of the uniform deceleration segment, S′ represents the total displacement value, and t′ 7 Indicates the duration of the low-speed crawling segment, a′ b Indicates the deceleration during the deceleration and stopping period.

[0059] Furthermore, the driving instructions include normal driving instructions, temporary speed limit instructions and temporary parking instructions;

[0060] The controller module selects the crane control mode according to the remaining distance of the crane and the travel instruction:

[0061]

[0062] Close means PID+feedforward closed-loop control, Open means open-loop control, Brake means brake output, delt s Indicates the remaining distance of the overhead crane, delt S1 Indicates that the remaining distance to the target position is far, delt S2 Indicates that the remaining distance is close to the target position, CMD indicates the command status, NORRun indicates no stop signal (the run signal is negated), LIMRun indicates limited run, PRORun indicates open loop selection, and EMERun indicates a stop signal.

[0063] Furthermore, the motion controller is based on an industrial computer with an X86 architecture, and communicates with the central control and other control systems via Ethernet using TCP / UDP or Modbus TCP / Profinet protocol.

[0064] Furthermore, the signal timing relationship between the motion controller and the central control running control logic is:

[0065] When there is no task on standby, the central control sends command 0;

[0066] When the pre-travel instruction 1 is issued, the target address is issued in the same frame. When the travel conditions are met, the motion controller returns the crane travel ready 1 to the central control, and the central control then issues the normal travel instruction 2. The motion controller returns the crane travel 2 to the central control;

[0067] When the overhead crane needs to be limited in speed, the central control can issue a temporary speed limit command 3 and a temporary speed limit ratio of 0 to 100; if the speed limit needs to be lifted, the normal running command 2 is issued again;

[0068] The crane needs to stop temporarily, and a temporary stop command 4 is issued. After stopping, the motion controller returns to the crane stop 0;

[0069] When the overhead crane needs to stop urgently, the central control issues an emergency stop command 5.

[0070] Furthermore, when the external environment of the reference curve calculation module changes during travel, the output of the motor or the adhesion coefficient of the overhead crane also changes accordingly, and the overhead crane is unable to follow the existing speed curve, the existing speed curve of the overhead crane is updated at this time;

[0071] At the same time, a positive position deviation is defined to indicate that the actual position is higher than the theoretical position calculated by the optimal speed curve, and a negative position deviation is defined to indicate that the actual position is lower than the theoretical position calculated by the optimal speed curve. When the position deviation reaches a certain threshold, the update of the optimal speed curve is triggered, and the setting of the threshold is determined by the length of the sliding segment.

[0072] The beneficial effects achieved by the present invention are:

[0073] The automatic walking and positioning motion controller provided by the present invention can achieve precise positioning during the movement process, with a positioning accuracy of ±10mm; and there will be no sudden start, sudden brake, or reverse movement during the movement process, thus achieving regular movement.

[0074] The automatic travel positioning motion controller provided by the present invention reduces manual operation actions and only requires inputting a target position, thereby improving the safety of crane operation.

[0075] The automatic traveling and positioning motion controller provided by the present invention improves the safe operation speed, further improves the use efficiency of the crane, reduces the training of operating staff, and reduces the labor intensity of operating staff.

[0076] The automatic traveling and positioning motion controller provided by the present invention can improve the intelligent information level of the overhead crane, realize the key foundation of the unmanned operation of the overhead crane, and extend the service life of the crane through a more reasonable control method.

[0077] The automatic travel positioning motion controller provided by the present invention meets the safety and efficiency requirements of on-site overhead crane operations. It lays a solid foundation for realizing the unmanned and automated operation of the overhead crane. It ensures the stable operation of the system. It helps enterprises to reduce staff and increase efficiency, reduce human operation errors, avoid safety hazards, and further promote the development of the overhead crane towards unmanned and automated operation. BRIEF DESCRIPTION OF THE DRAWINGS

[0078] Figure 1 This is a system block diagram of an automatic walking and positioning motion controller provided by the present invention;

[0079] Figure 2 This is a functional effect diagram of an automatic walking and positioning motion controller provided by the present invention;

[0080] Figure 3 It is a signal timing diagram of an automatic walking and positioning motion controller provided by the present invention;

[0081] Figure 4 It is a target speed curve diagram of an automatic walking and positioning motion controller provided by the present invention;

[0082] Figure 5 It is a real-time speed curve diagram of an automatic running and positioning motion controller provided by the present invention;

[0083] Figure 6 The invention provides an update diagram of a reference curve of an error exceeding limit during running of an automatic running positioning motion controller. DETAILED DESCRIPTION

[0084] The technical solution of the present invention is described in more detail below in conjunction with the accompanying drawings. The present invention includes but is not limited to the following embodiments.

[0085] The automatic walking and positioning motion controller provided by the present invention is based on an industrial computer with an X86 architecture, and can deploy complex control algorithms on a hardware platform through high-level language programming. It becomes a software standard function. It can communicate with the central control and other control systems through Ethernet using TCP / UDP or Modbus TCP / Profinet and other protocols, and supports field bus protocols such as Profibus / ModbusRTU.

[0086] Therefore, the automatic travel and positioning control system can be used for automated cranes that support network-based PLC controllers, and can also be used for simple manual crane modifications.

[0087] As attached Figure 2 As shown, the automatic walking and positioning motion controller includes the following main functional modules:

[0088] Walking positioning controller, reference curve calculation module, controller module, signal timing module and S-type target speed curve generation module.

[0089] The traveling positioning controller is used to control the overhead crane traveling instructions issued by the controller module. The overhead crane traveling instructions include normal traveling instructions, temporary speed limit instructions, temporary stop instructions, emergency stop instructions (as long as the status is issued) and normal traveling instructions triggered by excessive tracking displacement errors.

[0090] The reference curve calculation module is used to process the logic of the running command. It selects the long-distance motion curve or the short-distance moving curve according to the remaining distance of the overhead crane, and sets the curve for each stage according to the remaining distance of the running. When the current state of the overhead crane is in the deceleration stage, the temporary speed limit / temporary stop command issued by the central control will jump to the normal running command. The reference curve calculation includes the curve calculation under the normal running command, the curve calculation under the temporary speed limit command, and the curve calculation under the temporary stop command.

[0091] The controller module is used to perform open-loop and closed-loop control of the overhead crane speed tracking.

[0092]

[0093] Close means PID+feedforward closed-loop control, Open means open-loop control, Brake means brake output, delt s Indicates the remaining distance of the overhead crane, delt S1 Indicates that the remaining distance to the target position is far, delt S2 Indicates that the remaining distance is close to the target position, CMD indicates the command status, NORRun indicates no stop signal (the run signal is negated), LIMRun indicates limited run, PRORun indicates open loop selection, and EMERun indicates a stop signal.

[0094] The remaining distance of the vehicle on that day is greater than delt S1 When the running instruction is normal running or temporary speed limit, the controller adopts PID+feedforward closed-loop control;

[0095] The remaining distance of the vehicle on that day is greater than delt S2 and less than delt S1 , the overhead crane is crawling, and the open loop control is in place; when the remaining distance of the overhead crane is less than deltS2 When the crane is in the state of braking, the hydraulic signal is output.

[0096] During emergency stop, the controller output frequency command directly changes to zero and outputs a brake signal at the same time.

[0097] The signal timing relationship between the motion controller and the central control running control logic is as follows: Figure 3 As shown. When there is no task standby, the central control sends command 0. When the pre-travel command 1 is sent, the target address is sent in the same frame. The motion controller will perform self-checking. When the conditions are met, it returns the crane travel ready 1 to the central control. The central control then sends the normal travel command 2, and the motion controller returns the crane travel 2 to the central control. For safety reasons, the crane needs to be limited in speed. At this time, the central control can send a temporary speed limit command 3, and send a temporary speed limit ratio of 0 to 100. If the speed limit needs to be lifted, the normal travel command 2 is sent again. Due to work needs, the crane needs to stop temporarily. At this time, a temporary stop command 4 is sent. After stopping, the motion controller returns to the crane stop 0. In case of emergency, the crane needs to stop urgently. At this time, the central control sends an emergency stop command 5.

[0098] The S-type target speed curve generation module operates in a time-based manner and sends speed control instructions to the inverter according to the ideal given curve and the time value, such as Figure 4 The speed curve of the operation mode based on time is shown. Usually, the speed of the overhead crane is set to accelerate and decelerate according to the S curve. Its characteristic is that the acceleration curve changes continuously, rising or falling along a certain slope. The entire operation process of the overhead crane is divided into starting acceleration round corner operation, uniform acceleration operation, acceleration round corner operation, uniform speed operation, deceleration round corner operation, uniform deceleration operation, creeping round corner operation, low speed operation, and parking brake, and is controlled in this way. This speed curve has a low-speed creeping section. In order to find the appropriate parking control point, certain debugging work is required.

[0099] Long distance speed curve Figure 4 As shown in the middle line 2, the definition is:

[0100] Start acceleration rounded corner section (OA section): with constant acceleration j a Increase the acceleration from 0 to the locomotive setting a m , the time taken for this segment is t 0 , the displacement of the acceleration fillet section s 0 ;

[0101]

[0102] a represents the current acceleration, v represents the current speed value, s represents the current travel distance, t represents the current time, T 0 Indicates the moment when the OA curve segment is completed.

[0103] Uniform acceleration segment (AB segment): with constant acceleration a m Accelerate to a certain speed value v 1 , the time taken for this segment is t 1 , the total displacement s 1 ;

[0104]

[0105] T 1 Indicates the total time used by the curve segments from O to A and from A to B, s 0 Indicates the distance traveled by the OA segment, t 0 Indicates the total time used by the curve segment from O to A, v 0 represents the initial velocity value of the uniform acceleration segment, v 1 Indicates the velocity value at the end of the uniform acceleration segment;

[0106] Acceleration rounded corner section (BC section): with constant negative acceleration -j a Make the acceleration from a m Decreases to 0, and the speed reaches the maximum value v m , the time taken for this segment is t 2 , the total displacement s 2 ;

[0107]

[0108] T 2 Indicates the time of the O to C curve segment;

[0109] Uniform speed segment (CD segment): with a constant maximum speed v m Run, this section takes time t 3 , the total displacement s 3 ;

[0110]

[0111] T 3 Indicates the time of the O to D curve segment;

[0112] Deceleration radius section (DE section): with constant negative deceleration acceleration j d Decrease the acceleration from 0 to -a md , the time taken for this segment is t 4 , the total displacement s 4 ;

[0113]

[0114] T 4 Indicates the time of the O to E curve segment;

[0115] Uniform deceleration section (EF section): with constant negative maximum acceleration -a mdDeceleration operation, this section takes time t 5 , the total displacement s 5 ;

[0116]

[0117] T 5 Indicates the time of the O to F curve segment;

[0118] Creeping corner segment (FG segment): with constant deceleration j d Change the acceleration from -a md Increases to 0, the time taken for this segment is t 6 , the total displacement s 6 ;

[0119]

[0120] T 6 Indicates the time of the O to G curve segment;

[0121] Low-speed crawling section (GH section): at a constant crawling speed v 4 Running time t 7 , the total displacement s 7 ;

[0122]

[0123] T 7 Indicates the time of the O to H curve segment;

[0124] Parking brake section (HI section): mechanical braking section. The actual deceleration process needs to be debugged on site. In the simulation, a constant acceleration is used to decelerate to 0. The time taken for this section is t 8 ;

[0125]

[0126] T 8 Indicates the time of the O to I curve segment, a b Indicates the deceleration used in the HI phase;

[0127] The walking positioning controller uses the long distance curve if the difference between the target position and the actual position is greater than or equal to 10 meters, and the short distance curve if it is less than 10 meters.

[0128] The length (time) of each segment in the curve is determined according to the following logic:

[0129] The duration of the acceleration radius segment is set to 7 seconds, and the value range is 5-10 seconds based on different scenarios and vehicle types.

[0130] The duration of the uniform acceleration segment is dynamic and is set to 90% of the maximum speed limit. Combined with the acceleration, when the 90% speed value is reached, the next stage begins.

[0131] The duration of the acceleration rounded corner segment is set to 3 seconds. The value range is 2-5 seconds based on different scenarios and vehicle types.

[0132] The duration of the uniform speed segment depends on the difference between the actual position and the target position. The vehicle enters the remaining stage of deceleration and parking. When it is within 5 meters of the target position, it starts to move from uniform speed to deceleration and parking.

[0133] The time period of the deceleration radius is 3 seconds. The value range is 2-5 seconds according to different scenarios and vehicle types.

[0134] The time period of the uniform deceleration stage is 20% of the maximum speed limit. Combined with the acceleration, when the speed reaches 20%, the next stage begins.

[0135] The time period of the crawling radius section is 10% of the maximum speed limit. Combined with the acceleration, when the speed reaches 10%, the next stage begins.

[0136] The time period of the low-speed crawling segment depends on the difference between the actual position and the target position. When it is within 0.5 meters of the target position, it enters the HI stage.

[0137] The parking brake stage runs for 5-10 seconds, and the vehicle stops immediately when it reaches the target position.

[0138] The travel positioning controller makes different logic controls according to the temporary stop command, constant deceleration stop, uniform speed movement, temporary speed limit and other commands issued by the PLC (Programmable Logic Controller).

[0139] The S curve mainly describes the curve formed by the entire walking and positioning controller in a normal and complete action cycle.

[0140] Derivation of the formula for the speed curve of short-distance operation

[0141] like Figure 4 As shown in the middle curve 1, the target running distance of the electric locomotive at this time is not enough for it to complete the entire high-speed operation, and the maximum speed is v′ m ,but:

[0142]

[0143] a′ m represents the acceleration set by the locomotive (target value), t′ 0 represents the duration of the start acceleration rounded corner segment O'A' and the acceleration rounded corner segment B'C', j' aIndicates constant acceleration (fixed value), t' 4 represents the duration of the deceleration radius segment C'E' and the creep radius segment F'G', a' md Indicates the acceleration value during the deceleration phase, j′ d represents constant deceleration, t′ 1 represents the duration of the uniform acceleration segment A'B', v' 4 Indicates the speed value of the low-speed crawling segment G'H' time period, t' 5 represents the duration of the uniform deceleration segment E'F', S' represents the total displacement value, t' 7 Indicates the duration of the low-speed crawling segment G'H', a′ b Indicates the deceleration during the deceleration stop period H'I'.

[0144] By simplification, the relationship between the target displacement and the maximum velocity can be obtained, and the value of each time node can be obtained.

[0145] Real-time speed curve update during driving

[0146] The real-time speed curve update module during running is used in the actual running process. The external environment is complex. When a certain condition changes, the output of the motor or the adhesion coefficient of the overhead crane also changes. The overhead crane may not be able to follow the existing speed curve. At this time, the existing speed curve of the overhead crane should be updated.

[0147] First, change the central control command:

[0148] 1) Temporary speed limit instruction

[0149] 2) Temporary parking order

[0150] 3) Emergency stop command

[0151] 4) Target location update

[0152] like Figure 5 As shown:

[0153] The black color represents the speed curve of normal walking and positioning.

[0154] Red represents the speed curve after the temporary speed limit command is input.

[0155] Yellow represents the speed curve after the temporary stop command is input.

[0156] The blue color represents the speed curve after the emergency stop command is input.

[0157] The brown color represents the speed curve of the target position update.

[0158] Secondly, the tracking error exceeds the limit update

[0159] A positive position deviation means that the actual position is higher than the theoretical position calculated by the optimal speed curve, and a negative position deviation means that the actual position is lower than the theoretical position calculated by the optimal speed curve. When the position deviation reaches a certain threshold, the update of the optimal speed curve is triggered. The setting of the threshold is determined by the acceptable degree of the sliding segment length. Figure 6 shown.

[0160] The present invention is not limited to the above-mentioned specific implementation modes. A person skilled in the art may implement the present invention in various other specific implementation modes according to the embodiments and the disclosure of the drawings. Therefore, any design that adopts the design structure and concept of the present invention and makes some simple transformations or changes shall fall within the scope of protection of the present invention.

Claims

1. An automatic walking and positioning motion controller, characterized in that: The automatic running and positioning motion controller comprises a running and positioning controller, a reference curve calculation module, a controller module and an S-shaped target speed curve generation module; The controller module is used to control the traveling positioning controller to send the traveling instruction of the overhead crane according to the remaining traveling distance of the overhead crane; The reference curve calculation module is used to process the overhead traveling instruction; The S-shaped target speed curve generation module is used to control the moving speed of the overhead crane through a long-distance motion curve; The S-shaped target speed curve includes a long-distance movement curve and a short-distance movement curve, and the long-distance movement curve and the short-distance movement curve each include multiple stages: a start-up acceleration rounded corner section, a uniform acceleration section, an acceleration rounded corner section, a deceleration rounded corner section, a uniform deceleration section, a creeping rounded corner section, a low-speed creeping section, and a parking brake section; The reference curve calculation module selects a long-distance motion curve or a short-distance movement curve according to the remaining distance of the overhead traveling crane, and sets the curve of each stage according to the remaining distance of the traveling crane.

2. The automatic moving and positioning motion controller according to claim 1, characterized in that: The curves of each stage in the long-distance motion curve are defined as: Start the acceleration round section: with a constant acceleration j a Increase the acceleration from 0 to the locomotive setting a m , the time taken to start the acceleration fillet section is t0, and the displacement of the acceleration fillet section is s0; a represents the current acceleration, v represents the current speed value, s represents the current travel distance, t represents the current time, and T0 represents the moment when the acceleration rounding segment is completed; Acceleration rounded corner section: with constant negative acceleration -j a Make the acceleration from a m Decreases to 0, and the speed reaches the maximum value v m , the time taken for the acceleration rounded corner section is t2, and the displacement of the acceleration rounded corner section is s2; T2 represents the moment when the acceleration rounding segment is completed; Uniform speed segment: with a constant maximum speed v m Running, the time taken in the uniform speed section is t3, and the displacement in the uniform speed section is s3; T3 represents the time when the uniform speed segment is completed; Deceleration radius: with constant negative deceleration acceleration j d Decrease the acceleration from 0 to -a md , the time taken for the deceleration round corner section is t4, and the displacement of the deceleration round corner section is s4; T4 represents the time when the deceleration radius section is completed; Uniform deceleration stage: with constant negative maximum acceleration -a md The deceleration operation takes t5 time and the total displacement is s5. T4 represents the time when the uniform deceleration stage is completed; Crawling corner section: with constant deceleration j d Change the acceleration from -a md Increase to 0, the time taken for this section is t6, and the total displacement is s6; T6 represents the moment when the crawling fillet segment is completed; Low-speed crawling section: The low-speed crawling section runs at a constant crawling speed v4 for a duration of t7, and the displacement of the low-speed crawling section is s7; T7 indicates the moment when the low-speed crawling segment is completed; Parking brake section: Mechanical braking section, using constant acceleration to decelerate to 0, the parking brake section takes time t8; T8 represents the time when the parking brake section is completed, a b Indicates the deceleration used during the parking brake phase.

3. The automatic moving and positioning motion controller according to claim 2, characterized in that: The long-distance motion curve also includes a uniform speed segment, and the uniform speed segment curve is defined as: Uniform acceleration: with constant acceleration a m Accelerate to a certain speed value v1, the uniform acceleration segment takes time t1, and the displacement of the uniform acceleration segment is s1; T1 represents the moment when the uniform acceleration segment is completed, s0 represents the distance traveled when the acceleration rounded corner segment is started, v0 represents the initial speed value of the uniform acceleration segment, and v1 represents the final speed value of the uniform acceleration segment.

4. The automatic moving and positioning motion controller according to claim 2, characterized in that: The duration of each stage in the long-distance motion curve is: The duration of the acceleration rounded corner segment is set to a fixed duration according to the scene, with a value range of 5-10 seconds; The duration of the uniform acceleration segment is set to the duration of reaching 90% of the maximum speed limit; The duration of the acceleration rounded corner segment is set to a fixed duration based on the scene, ranging from 2 to 5 seconds; The duration of the deceleration rounded corner segment is set to a fixed duration based on the scenario, ranging from 2 to 5 seconds; The duration of the uniform deceleration segment is set to the duration of reaching 20% ​​of the maximum speed limit; The duration of the creeping rounded corner segment is set to the duration of the speed value reaching 10% of the maximum speed limit; The duration of the low-speed crawling section is set based on the difference between the actual position and the target position, and when it reaches 0.5m / s, it enters the parking brake section; The duration of the parking brake section is set to stop the vehicle immediately upon reaching the target position.

5. The automatic traveling and positioning motion controller according to claim 3, characterized in that: The duration of the constant speed segment is set based on the difference between the actual position and the target position.

6. The automatic traveling and positioning motion controller according to claim 1, characterized in that: The S-shaped target speed curve includes a short-distance motion curve, wherein: a′ m represents the acceleration set by the locomotive, t′0 represents the duration of the start acceleration rounded corner section and the acceleration rounded corner section, j′ a represents constant acceleration, t′4 represents the duration of the deceleration round section and the crawling round section, a′ md Indicates the acceleration value during the deceleration phase, j′ d represents constant deceleration, t′1 represents the duration of uniform acceleration, v′4 represents the speed value of the slow crawling section, t′5 represents the duration of uniform deceleration, S′ represents the total displacement value, t′7 represents the duration of the slow crawling section, a′ b Indicates the deceleration during the deceleration and stopping period.

7. The automatic traveling and positioning motion controller according to claim 1, characterized in that: The driving instructions include normal driving instructions, temporary speed limit instructions and temporary parking instructions; The controller module selects the control mode of the overhead crane according to the remaining distance of the overhead crane and the traveling instruction: Close means PID+feedforward closed-loop control, Open means open-loop control, Brake means brake output, delt s Indicates the remaining distance of the overhead crane, delt S1 Indicates that the remaining distance to the target position is far, delt S2 Indicates that the remaining distance is close to the target position, CMD indicates the command status, NORRun indicates no stop signal (the run signal is negated), LIMRun indicates limited run, PRORun indicates open loop selection, and EMERun indicates a stop signal.

8. The automatic traveling and positioning motion controller according to claim 1, characterized in that: The motion controller is based on an industrial computer with an X86 architecture and communicates with the central control and other control systems via Ethernet using TCP / UDP or Modbus TCP / Profinet protocol.

9. The automatic traveling and positioning motion controller according to claim 8, characterized in that: The signal timing relationship between the motion controller and the central control running control logic is: When there is no task on standby, the central control sends command 0; When the pre-travel instruction 1 is issued, the target address is issued in the same frame. When the travel conditions are met, the motion controller returns the crane travel ready 1 to the central control, and the central control then issues the normal travel instruction 2. The motion controller returns the crane travel 2 to the central control; When the overhead crane needs to be limited in speed, the central control can issue a temporary speed limit command 3 and a temporary speed limit ratio of 0 to 100; if the speed limit needs to be lifted, the normal running command 2 is issued again; The crane needs to stop temporarily, and a temporary stop command 4 is issued. After stopping, the motion controller returns to the crane stop 0; When the overhead crane needs to stop urgently, the central control issues an emergency stop command 5.

10. The automatic traveling and positioning motion controller according to claim 1, characterized in that: The reference curve calculation module updates the existing speed curve of the overhead crane when the external environment changes during the running, the output of the motor or the adhesion coefficient of the overhead crane also changes accordingly, and the overhead crane cannot follow the existing speed curve; At the same time, a positive position deviation is defined to indicate that the actual position is higher than the theoretical position calculated by the optimal speed curve, and a negative position deviation is defined to indicate that the actual position is lower than the theoretical position calculated by the optimal speed curve. When the position deviation reaches a certain threshold, the update of the optimal speed curve is triggered, and the setting of the threshold is determined by the length of the sliding segment.