Digital debugging method and system based on three-dimensional (3D) data

By establishing a three-dimensional model and calculating the transport disturbance parameters, and digitally adjusting the preset parameters of the control system, the problem of external factors affecting the hoisting process was solved, achieving higher control accuracy and stability.

CN119002498APending Publication Date: 2024-11-22MOMENTUM ROAD (SUZHOU) TECHNOLOGY CO LTD
View PDF 9 Cites 0 Cited by

Patent Information

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

AI Technical Summary

Technical Problem

Existing control systems are unable to cope with external factors during cargo hoisting, resulting in poor control performance and low stability. In particular, the control signals of the hoisting equipment are not accurate enough under external factors such as strong winds.

Method used

By establishing a 3D model based on the cargo loading and unloading environment, the crane's operating path is planned, and the transport disturbance parameters are calculated based on speed and position data. Digital debugging is then carried out, and preset control parameters are adjusted to improve control accuracy and stability.

Benefits of technology

It improves control and stability during the hoisting process, reduces safety hazards, and ensures the safety and efficiency of cargo loading and unloading.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119002498A_ABST
    Figure CN119002498A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of control system debugging, in particular to a digital debugging method and system based on three-dimensional (3D) data, and the digital debugging method based on the 3D data comprises the steps: determining a three-dimensional model established based on the three-dimensional data of a cargo loading and unloading environment, and planning an operation path of a crane for loading and unloading cargoes according to the three-dimensional model. A basis is provided for automatically controlling loading and unloading of goods; in the process of controlling cargo loading and unloading according to the operation path, speed data and position data of the cargo are determined, conveying disturbance parameters in the cargo loading and unloading process are calculated according to the speed data and the position data, the conveying disturbance parameters represent the interference degree caused by external factors, and digital debugging is conducted on preset control parameters. The digital debugging result is obtained, the influence of external factors can be dealt with, and therefore the control effect and the control stability are improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of control system debugging, and in particular to a digital debugging method and system based on three-dimensional (3D) data. Background Art

[0002] In the process of loading and unloading cargo on ships, the traditional method mainly uses lifting equipment on board or on the shore to load and unload cargo, and the lifting equipment usually requires human control. With the improvement of 3D scanning technology, sensor technology and computing power, the relative positions of cargo containers, spreaders and other equipment can be sensed by using 3D point cloud data, combined with sensor technology to assist the control system, and control the spreader to grab and release cargo more accurately, which can greatly improve the efficiency of cargo loading and unloading when the ship is docked.

[0003] In order to avoid potential safety hazards during the lifting of goods, the control signal sent by the control system to the lifting equipment needs to be accurate enough. For example, during the lifting process, the goods may be affected by external factors such as strong winds. At this time, the existing method of presetting control parameters in the control system is difficult to cope with the impact of external factors, and the control effect is poor and the stability is low. Summary of the invention

[0004] In order to solve at least one of the above technical problems, the purpose of the present invention is to provide a digital debugging method and system based on three-dimensional 3D data, and the technical solution adopted is as follows:

[0005] In a first aspect, an embodiment of the present application provides a digital debugging method based on three-dimensional 3D data, comprising:

[0006] Determine a three-dimensional model established based on three-dimensional data of a cargo loading and unloading environment, and plan an operation path for a crane to load and unload cargo according to the three-dimensional model;

[0007] In the process of controlling the loading and unloading of the cargo according to the operation path, determining the speed data and the position data of the cargo;

[0008] Calculating a transport disturbance parameter during cargo loading and unloading according to the speed data and the position data, wherein the transport disturbance parameter represents a degree of disturbance caused by external factors;

[0009] According to the transport disturbance parameters, the preset control parameters are digitally debugged to obtain digital debugging results.

[0010] In one embodiment, calculating the transport disturbance parameter in the cargo loading and unloading process according to the speed data and the position data includes:

[0011] Determine the target loading and unloading stage currently belonging to the operation path according to the position data;

[0012] Determining the loading and unloading phase parameters of the crane operation according to the target loading and unloading phase;

[0013] determining cargo movement characteristic parameters based on the speed data;

[0014] According to the loading and unloading stage parameters and the cargo movement characteristic parameters, transportation disturbance parameters during the cargo loading and unloading process are calculated.

[0015] In one embodiment, determining the target loading and unloading stage currently belonging to the operation path according to the position data includes:

[0016] Determine the distance the cargo has moved from the starting point based on the location data;

[0017] When the moved distance is less than or equal to the first distance value, determining that the target loading and unloading stage currently belonging to the operation path is a lifting stage;

[0018] When the moved distance is greater than the first distance value and less than the second distance value, determining that the target loading and unloading phase currently in the operation path is a translation phase;

[0019] When the moved distance is greater than or equal to the second distance value, it is determined that the target loading and unloading phase currently belonging to the operation path is the putting down phase.

[0020] In one embodiment, determining the loading and unloading phase parameters of the crane operation according to the target loading and unloading phase includes:

[0021] When the target loading and unloading phase is the lifting phase or the lowering phase, determining that the loading and unloading phase parameter of the crane operation is a preset value;

[0022] When the target loading and unloading phase is the translation phase, the midpoint moving distance from the midpoint position of the translation phase to the midpoint of the starting point is determined, and the loading and unloading phase parameters of the crane operation are determined based on the midpoint moving distance, the moved distance and the exponential function.

[0023] In one embodiment, determining the cargo movement characteristic parameter according to the speed data includes:

[0024] Determining, based on the speed data, a current cargo delivery speed and a maximum cargo delivery speed of the cargo during the target loading and unloading phase;

[0025] Performing fitting processing on the speed data to determine the derivative of the cargo delivery speed in the time series;

[0026] A cargo movement characteristic parameter is determined according to the range normalization function, the maximum cargo delivery speed, the current cargo delivery speed, and the derivative.

[0027] In one embodiment, the calculating of the transport disturbance parameter during cargo loading and unloading according to the loading and unloading stage parameter and the cargo movement characteristic parameter comprises:

[0028] Obtain the angle between the unit vector of the line connecting the crane to the center of mass of the cargo and the unit vector of the velocity direction of the cargo, and obtain the weight of the cargo;

[0029] Determine a conversion value corresponding to the cosine value of the angle, and determine a first product according to the conversion value, the cargo weight, and the inverse of the cargo movement characteristic parameter;

[0030] A calculation result is determined according to the hyperbolic tangent function and the first product, and a transport disturbance parameter in the cargo loading and unloading process is calculated according to the calculation result and the second product of the loading and unloading stage parameter.

[0031] In one embodiment, the speed data includes a plurality of sampled cargo transportation speeds, and the transportation disturbance parameters include a plurality of sampled corresponding transportation disturbance amplitudes; and the digital debugging of the preset control parameters according to the transportation disturbance parameters includes:

[0032] Determining the internal loss of the crane during the process of loading and unloading cargo according to the cargo transportation speed, the transportation disturbance amplitude and the sampling number;

[0033] Determining a current transport loss according to the internal loss and an average of the transport disturbance amplitudes currently sampled;

[0034] According to the current transport loss, the preset control parameters are digitally debugged to obtain digital debugging results.

[0035] In one embodiment, determining the internal loss during the crane loading and unloading of cargo according to the cargo transportation speed, the transportation disturbance amplitude and the sampling number includes:

[0036] Determine the corresponding speed change rate according to the cargo delivery speeds of adjacent sampling times respectively;

[0037] Determining the corresponding disturbance amplitude change rate according to the transport disturbance amplitudes of adjacent sampling times respectively;

[0038] Determine the sum of a number of the speed change rates and a number of the disturbance amplitude change rates, and calculate the difference mean according to the sum and the number of sampling times;

[0039] The difference means are normalized to obtain the internal loss of the crane during the process of loading and unloading cargo.

[0040] In one embodiment, the digital debugging of the preset control parameters according to the current transportation loss to obtain the digital debugging result includes:

[0041] Determining an adjustment ratio parameter according to the current transportation loss;

[0042] According to the product of the adjustment ratio parameter and the preset control parameter, the preset control parameter is digitally debugged to obtain a digital debugging result;

[0043] The digital debugging result is used to input the control system so that the control system can output the adjusted control signal acting on the crane.

[0044] In a second aspect, an embodiment of the present application provides a digital debugging system based on three-dimensional 3D data, including:

[0045] A first determination module is used to determine a three-dimensional model established based on three-dimensional data of a cargo loading and unloading environment, and plan an operation path for a crane to load and unload cargo according to the three-dimensional model;

[0046] A second determination module is used to determine speed data and position data of the cargo during the process of controlling the loading and unloading of the cargo according to the operation path;

[0047] A calculation module, used to calculate a transport disturbance parameter in the cargo loading and unloading process according to the speed data and the position data, wherein the transport disturbance parameter represents the degree of interference caused by external factors;

[0048] The debugging module is used to digitally debug the preset control parameters according to the transport disturbance parameters to obtain digital debugging results.

[0049] The present invention has the following beneficial effects:

[0050] By determining a three-dimensional model established based on the three-dimensional data of the cargo loading and unloading environment, and planning the operating path of the crane loading and unloading cargo according to the three-dimensional model, a basis is provided for automatically controlling the loading and unloading of cargo; in the process of controlling the loading and unloading of cargo according to the operating path, the speed data and position data of the cargo are determined, and the transportation disturbance parameters in the cargo loading and unloading process are calculated based on the speed data and position data. The transportation disturbance parameters characterize the degree of interference caused by external factors, and the preset control parameters are digitally debugged to obtain digital debugging results that can cope with the influence of external factors, thereby improving the control effect and control stability. BRIEF DESCRIPTION OF THE DRAWINGS

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

[0052] Figure 1 A schematic diagram of a step flow of a digital debugging method based on three-dimensional 3D data provided by an embodiment of the present invention;

[0053] Figure 2 A structural block diagram of a digital debugging system based on three-dimensional 3D data provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0054] In order to further explain the technical means and effects adopted by the present invention to achieve the predetermined invention purpose, the following is a detailed description of a digital debugging method and system based on three-dimensional 3D data proposed by the present invention, its specific implementation, structure, features and effects, in conjunction with the accompanying drawings and preferred embodiments. In the following description, different "one embodiment" or "another embodiment" does not necessarily refer to the same embodiment. In addition, specific features, structures or characteristics in one or more embodiments may be combined in any suitable form.

[0055] Unless defined otherwise, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs.

[0056] The specific scheme of a digital debugging method and system based on three-dimensional 3D data provided by the present invention is described in detail below with reference to the accompanying drawings.

[0057] See also Figure 1 , which shows a flow chart of a digital debugging method based on three-dimensional 3D data provided by an embodiment of the present invention. The method may include steps S100-S400:

[0058] S100, determining a three-dimensional model established based on three-dimensional data of a cargo loading and unloading environment, and planning an operation path for a crane to load and unload cargo according to the three-dimensional model.

[0059] S200. In the process of controlling the loading and unloading of goods according to the operation path, determine the speed data and the position data of the goods.

[0060] S300: Calculate the transport disturbance parameter in the cargo loading and unloading process according to the speed data and the position data, where the transport disturbance parameter represents the degree of disturbance caused by external factors.

[0061] S400, digitally debugging the preset control parameters according to the transport disturbance parameters to obtain digital debugging results.

[0062] The digital debugging method based on three-dimensional 3D data in the embodiment of the present application can be executed by a control system, and the control system can be a processor in a computer, a mobile phone, a tablet, a vehicle-mounted terminal, an industrial computer or a server, etc., without limitation.

[0063] The technical solution of the embodiment of the present application provides a basis for automatically controlling the loading and unloading of cargo by determining a three-dimensional model established based on three-dimensional data of the cargo loading and unloading environment, and planning the operating path of the crane for loading and unloading cargo according to the three-dimensional model; in the process of controlling the loading and unloading of cargo according to the operating path, the speed data and position data of the cargo are determined, and the transportation disturbance parameters in the cargo loading and unloading process are calculated based on the speed data and the position data. The degree of interference caused by external factors is characterized by the transportation disturbance parameters, and the preset control parameters are digitally debugged to obtain digital debugging results, which can cope with the influence of external factors, thereby improving the control effect and control stability.

[0064] In one embodiment, in step S100, the three-dimensional model established based on the three-dimensional data of the cargo loading and unloading environment can be obtained from a local database or from the network. For example, when the cargo loading and unloading environment is an environment that has been used before, the three-dimensional model may have been established and stored in advance, and the three-dimensional model of the cargo loading and unloading environment can be directly obtained. When the cargo loading and unloading environment is a new environment, the cargo loading and unloading environment can be scanned by a 3D scanning device set on the spreader to obtain the three-dimensional data of the cargo loading and unloading environment, and then professional three-dimensional model software (such as AutoCAD, SketchUp, Revit, etc.) is used to model and determine the three-dimensional model.

[0065] In one embodiment, after determining the three-dimensional model, the size data and weight of the cargo can be measured by measuring tools, and combined with the three-dimensional model, the operation path for the crane to load and unload the cargo can be planned through A* algorithm analysis. The operation path is a three-dimensional path used to move the cargo from the starting point to the final target position (i.e., the end point).

[0066] In one embodiment, after determining the operation path, the control system (processor) controls the crane according to the operation path to achieve the purpose of controlling the loading and unloading of goods. Among them, in step S200, in the process of controlling the loading and unloading of goods according to the operation path, the speed data and position data of the goods can be determined. For example, the real-time position of the goods is sampled by identifying and positioning through technologies such as the Internet of Things and RFID. The real-time position is represented by three-dimensional coordinates, and the real-time positions corresponding to multiple sampling measurements constitute the position data of the goods; and the real-time cargo delivery speed of the goods can be obtained through a speed measurement device, or according to the real-time position change (three-dimensional coordinate change) within a unit time, the real-time cargo delivery speed of the goods is calculated. It should be noted that each cargo delivery speed is obtained as a sampling, so the cargo delivery speeds sampled several times constitute the speed data of the goods.

[0067] It should be noted that the loading and unloading process of the operation path can be roughly divided into the loading and unloading stages of "lifting - moving (translation) - lowering", and different stages may encounter different interference factors. Therefore, the loading and unloading stages of the goods and the operating characteristics within the stages can be judged, and different loading and unloading stages can be reflected by the speed of the goods and the position on the path.

[0068] In one implementation, step S300 includes steps S301-S304:

[0069] S301. Determine the target loading and unloading stage currently in the operation path according to the position data.

[0070] Optionally, according to the current real-time position of the goods in the position data, the distance between the current real-time position and the starting point is calculated to obtain the distance d that the goods have moved from the starting point. It should be noted that the distance d that has been moved refers to the distance actually moved along the operation path. For example, the starting point is A, the crane lifts the goods from A to position B, then translates the goods from position B to position C, and then lowers the goods from position C to position D. Assuming that the midpoint position O of BC is passed when translating from position B to position C, then assuming that the current real-time position of the goods is C, the distance d that has been moved is AB+BC; similarly, assuming that the current real-time position of the goods is O, the distance d that has been moved is AB+BO.

[0071] It should be noted that, from the above example, it can be seen that the operation path includes three loading and unloading stages, namely the lifting stage, the translation stage and the lowering stage. The segmentation point between the lifting stage and the translation stage is B, AB is recorded as the first distance value z1, and the segmentation point between the translation stage and the lowering stage is C, AB+BC is recorded as the distance and recorded as the second distance value z2.

[0072] Specifically, when the moved distance d is less than or equal to the first distance value z1, it is determined that the target loading and unloading stage currently belonging to the operation path is the lifting stage;

[0073] When the moved distance d is greater than the first distance value z1 and less than the second distance value z2, it is determined that the target loading and unloading phase currently in the operation path is the translation phase;

[0074] When the moved distance d is greater than or equal to the second distance value z2, it is determined that the target loading and unloading phase currently in the operation path is the putting down phase.

[0075] S302. Determine the loading and unloading phase parameters of the crane operation according to the target loading and unloading phase.

[0076] Optionally, when the target loading and unloading stage is the lifting stage or the lowering stage, the loading and unloading stage parameter J of the crane operation is determined to be a preset value. When the target loading and unloading stage is the translation stage, the moving distance from the midpoint position O of the translation stage to the midpoint of the starting point A is determined. That is, AB+BO. Then, in the embodiment of the present application, the exponential function is taken as the natural exponential function exp as an example, and other embodiments may be other types of exponential functions, according to the midpoint moving distance The moved distance d and the exponential function exp determine the loading and unloading phase parameter J of the crane operation. At this time, the loading and unloading phase parameter of the crane operation is

[0077] In the embodiment of the present application, the preset value is 1 as an example, and other values ​​may be used in other embodiments. Therefore, based on the above content, the formula of the loading and unloading stage parameter J is:

[0078]

[0079] It should be noted that during the lifting and lowering stages of the goods, the impact of interference on transportation is relatively low, while during the translation stage of the goods, the impact on transportation is relatively large; except for the lifting and lowering stages, the goods in the translation stage are mainly traveling at a constant speed. In order to amplify the stage characteristics of the constant speed travel process, it is normalized through the exp correction logic, and this value is used as the loading and unloading stage parameter J corresponding to the translation stage.

[0080] S303: Determine cargo movement characteristic parameters based on speed data.

[0081] It should be noted that the cargo delivery speeds in the speed data are sorted in the order of sampling time. Optionally, the current cargo delivery speed v sampled at the current moment and the maximum cargo delivery speed v of the cargo in the target loading and unloading stage are determined from the speed data. max, for example, if the target loading and unloading phase is the translation phase, determine the maximum cargo delivery speed v in the translation phase max .

[0082] Optionally, taking the least square method as an example, the cargo delivery speeds arranged in time sequence in the speed data are fitted with a moving curve using the least square method, and the derivatives of the curve at different time points, that is, the derivative v′ of the cargo delivery speed in time sequence, are calculated.

[0083] Then, according to the range normalization function norm, the maximum cargo delivery speed v max , the current cargo delivery speed v and derivative v′, determine the cargo movement characteristic parameter T. The specific formula is:

[0084]

[0085] In this application, in order to improve the control accuracy of cargo loading and unloading, after obtaining the parameters of the cargo loading and unloading stages, it is necessary to analyze the external interference factors in the current cargo loading and unloading process, and then further evaluate the deviation of the current cargo operation stage, and adjust the loading and unloading process based on the deviation (deviation). Among them, in the cargo loading and unloading stage, the main impact on the operation of the sling is caused by external interference factors. When the cargo is affected by other forces on the outside, the originally set control parameters corresponding to the crane are difficult to achieve the loading and unloading purpose. In different loading and unloading stages of the cargo, the impact of interference factors on it is also different. By combining the loading and unloading parameters of the cargo at different loading and unloading stages, the transportation disturbance parameters of the current cargo loading and unloading process are judged. Transport disturbance parameters The larger the value, the greater the external interference.

[0086] S304: Calculate the transport disturbance parameters during the cargo loading and unloading process according to the loading and unloading stage parameters and cargo movement characteristic parameters.

[0087] Optionally, the angle θ between the unit vector of the line connecting the crane to the center of mass of the cargo and the unit vector of the speed direction of the cargo can be determined through position data or measuring devices such as sensors and angle measuring devices, and the cargo weight m can be obtained through measuring tools to calculate the conversion value corresponding to the cosine value cosθ of the angle And determine the first product: Then the calculation result is determined based on the hyperbolic tangent function and the first product And according to the second product of the calculation result and the loading and unloading stage parameter J, the transportation disturbance parameter during the cargo loading and unloading process is calculated The specific formula is:

[0088]

[0089] It should be noted that according to the above analysis, after the loading and unloading process is divided into three loading and unloading stages, the cargo transportation speed in each loading and unloading stage is different. At the beginning and end of each loading and unloading stage, the acceleration direction and speed direction of the cargo are different. It is difficult to reflect the movement characteristics of the cargo only by speed, because the derivative of the cargo transportation speed in time series to obtain v' can represent the acceleration of the current object. Using the absolute value of the speed derivative, the maximum cargo delivery speed v max , the current cargo delivery speed v is calculated, and the calculation result when the acceleration is large is improved. The larger the calculation result, the closer the current cargo is to the start and end positions of a certain loading and unloading stage. After the calculation result is standardized, the value is used as the cargo movement characteristic parameter T of the current target loading and unloading stage.

[0090] It should be noted that to analyze the disturbance amplitude of external interference factors in the current target loading and unloading stage, the deviation angle of the current cargo during loading and unloading can be combined for analysis: when the cargo is subject to external interference including but not limited to strong winds during the target loading and unloading stage, the angle between the sling and the cargo will change. The angle is converted into a number between [0,1] and the logical relationship is adjusted to use it as one of the factors reflecting the external disturbance amplitude. In addition, when the cargo weight is greater, the change of the angle can better reflect the current external disturbance intensity. It is taken as the main parameter of external interference factors.

[0091] In this application, in order to minimize the interference of cargo angle deviation caused by acceleration and deceleration on the calculation of external influencing factors, it is necessary to analyze the cargo loading and unloading stages. The cargo movement characteristic parameter T of the current target loading and unloading stage is calculated. The larger the value, the greater the probability that the target loading and unloading stage is in the acceleration stage. At this time, the acceleration of the spreader may affect the deviation angle of the cargo. In order to reduce the interference caused by the normal spreader operation acceleration, and After multiplication, the calculation result is normalized using tanh as the main part of the disturbance amplitude. In different loading and unloading stages of the sling operation, the interference effect of the cargo deviation angle is different: for the lifting stage and the lowering stage, the movement direction, acceleration direction and speed direction of the cargo are all on the same straight line. When the cargo deviates from the angle, the greater the external interference it reflects. Therefore, the main part of the disturbance amplitude is adjusted by the loading and unloading stage parameter J to obtain the transportation disturbance parameter of the previous cargo

[0092] It should be noted that the transport disturbance parameter Includes the transport disturbance amplitude corresponding to several samples N is the number of sampling times, for example, the cargo delivery speed v through the i-th sampling i The above formula is used to calculate the transport disturbance amplitude

[0093] In this application, in order to achieve precise control of the sling, it is also necessary to analyze the actual losses in the loading and unloading process. The actual loss refers to the deviation between the current loading and unloading and the expected delivery of the operation path. This deviation is recorded as the internal loss of the crane during the loading and unloading of goods. Because in the process of loading and unloading of goods, the gap between the actual loading and unloading results and the expected operating results is affected by external interference factors, and may also include the influence of internal losses.

[0094] In one implementation, step S400 includes steps S401-S403:

[0095] S401. Determine the internal loss of the crane during the process of loading and unloading cargo according to the cargo transportation speed, transportation disturbance amplitude and sampling times.

[0096] Optionally, the cargo delivery speed (v i-1 、v i ), determine the corresponding speed change rate: According to the transport disturbance amplitude of adjacent sampling times (i-1th, ith) Determine the corresponding disturbance amplitude change rate

[0097] Then, when i takes different times, the sum of several speed change rates and several disturbance amplitude change rates is determined, and the difference mean is calculated according to the sum and the sampling times. The specific calculation formula of the difference mean is:

[0098]

[0099] Finally, the difference mean is normalized by the sigmoid function to obtain the internal loss l during the crane loading and unloading process. The specific calculation formula of the internal loss l is:

[0100]

[0101] S402: Determine the current transport loss according to the internal loss and the average value of the currently sampled transport disturbance amplitude.

[0102] Specifically, the internal loss l and the transport disturbance amplitude of the current sample are calculated by the mean function E ', and get the current transportation loss ρ. The specific formula is:

[0103]

[0104] It should be noted that, assuming that the current moment is the third sampling, that is, i=3, the current cargo delivery speed v is v3, and the corresponding calculated current sampling transport disturbance amplitude is That is at this time

[0105] In this application, the internal loss 1 is analyzed, which is reflected by the difference between the actual cargo delivery speed and the external interference factors: the difference between the actual speed change fluctuation and the external interference change reflects the internal interference factors. The change rate of the external disturbance amplitude in different adjacent sampling times was calculated, and the change rate of the speed was obtained using the same method Ideally, when the external disturbance changes, the speed decreases, and the increase and decrease are the same. However, when there is internal loss in the system, there is a difference between the change in external disturbance and the change in speed. The difference between the external disturbance amplitude change rate and the speed change rate at each sampling time was calculated. Since the speed change is negatively correlated with the disturbance amplitude change, the difference is expressed by the sum of the two change rates.

[0106] S403. Digitally debug the preset control parameters according to the current transportation loss to obtain digital debugging results.

[0107] Optionally, the present application embodiment takes the control system as a PID controller as an example for explanation, and other embodiments may be other types of controllers without specific limitation. Among them, the control system has preset control parameters, or called initial control parameters. Taking the PID (proportional-integral-differential (PID) controller as an example, the PID controller has preset control parameters including the proportional gain coefficient K p , integration parameter K i and the differential parameter K d The PID controller controls the crane through the PID control algorithm. The greater the current transportation loss ρ during the loading and unloading process, the greater the error generated by the crane during the cargo loading and unloading process. Therefore, the proportional gain coefficient K can be adjusted. p Adjustments are made so that the PID controller can output the control quantity (control signal) as stably as possible under nonlinear operating conditions.

[0108] Optionally, the embodiment of the present application takes the preset value 1 as an example to adjust the proportional parameter, and uses the proportional gain coefficient K p As the adjusted parameter in the preset control parameter, in other embodiments, the adjustment ratio parameter can be adjusted using other preset quantities or using other methods, and the adjusted parameter can also be other parameters.

[0109] Specifically, according to the current transport loss ρ, the adjustment ratio parameter (1+ρ) is determined, and then the adjustment ratio parameter (1+ρ) and the proportional gain coefficient K are used to calculate the p The product of the proportional gain coefficient K p Perform digital debugging and obtain the digital debugging result, that is, the adjusted proportional gain coefficient K p ′,K p ′=(1+ρ)×K p .

[0110] Then, the digital debugging result, that is, the adjusted proportional gain coefficient K p ′ can be compared with K i and K d They are input together into the PID controller, which calculates and outputs the adjusted control signal acting on the crane. The control signal is a signal that fully considers the influence of external factors. Therefore, controlling the crane by using the control signal can effectively improve the real-time control effect and control stability of the crane.

[0111] The present invention combines a three-dimensional model with real-time speed data, position data, etc. to analyze the actual cargo loading and unloading process, thereby ensuring the accuracy and timeliness of data analysis. The data collection utilized is simple, and transportation losses can be analyzed without significantly increasing costs, thereby obtaining more accurate system adjustment parameters that take into account external factors and internal losses, namely, digital debugging results, making the debugging process of the control system more accurate, which is beneficial to reducing potential safety hazards that may occur during the loading and unloading process and improving the safety and stability of the loading and unloading process.

[0112] Reference Figure 2 , shows a structural block diagram of a digital debugging system based on three-dimensional 3D data according to an embodiment of the present application, the system may include:

[0113] A first determination module is used to determine a three-dimensional model established based on three-dimensional data of a cargo loading and unloading environment, and plan an operation path for a crane to load and unload cargo according to the three-dimensional model;

[0114] A second determination module is used to determine the speed data and position data of the cargo during the process of controlling the loading and unloading of the cargo according to the operation path;

[0115] A calculation module is used to calculate the transport disturbance parameter in the cargo loading and unloading process according to the speed data and the position data, and the transport disturbance parameter represents the degree of interference caused by external factors;

[0116] The debugging module is used to digitally debug the preset control parameters according to the transport disturbance parameters to obtain digital debugging results.

[0117] The functions of each module in the system of the embodiment of the present application can be found in the corresponding description in the above method, and will not be repeated here.

[0118] It should be noted that the sequence of the above embodiments of the present invention is only for description and does not represent the advantages and disadvantages of the embodiments. The processes depicted in the accompanying drawings do not necessarily require the specific order or continuous order shown to achieve the desired results. In some embodiments, multitasking and parallel processing are also possible or may be advantageous.

[0119] The various embodiments in this specification are described in a progressive manner, and the same and similar parts between the various embodiments can be referenced to each other. Each embodiment focuses on the differences from other embodiments.

Claims

1. A digital debugging method based on three-dimensional 3D data, characterized in that: The method comprises: Determine a three-dimensional model established based on three-dimensional data of a cargo loading and unloading environment, and plan an operation path for a crane to load and unload cargo according to the three-dimensional model; In the process of controlling the loading and unloading of the cargo according to the operation path, determining the speed data and the position data of the cargo; Calculating a transport disturbance parameter during cargo loading and unloading according to the speed data and the position data, wherein the transport disturbance parameter represents a degree of disturbance caused by external factors; According to the transport disturbance parameters, the preset control parameters are digitally debugged to obtain digital debugging results.

2. The digital debugging method based on three-dimensional 3D data according to claim 1, characterized in that: Calculating the transport disturbance parameter during cargo loading and unloading according to the speed data and the position data includes: Determine the target loading and unloading stage currently belonging to the operation path according to the position data; Determining the loading and unloading phase parameters of the crane operation according to the target loading and unloading phase; determining cargo movement characteristic parameters based on the speed data; According to the loading and unloading stage parameters and the cargo movement characteristic parameters, transportation disturbance parameters during the cargo loading and unloading process are calculated.

3. The digital debugging method based on three-dimensional 3D data according to claim 2, characterized in that: Determining the target loading and unloading stage currently belonging to the operation path according to the position data includes: Determine the distance the cargo has moved from the starting point based on the location data; When the moved distance is less than or equal to the first distance value, determining that the target loading and unloading stage currently belonging to the operation path is a lifting stage; When the moved distance is greater than the first distance value and less than the second distance value, determining that the target loading and unloading phase currently in the operation path is a translation phase; When the moved distance is greater than or equal to the second distance value, it is determined that the target loading and unloading phase currently belonging to the operation path is the putting down phase.

4. The digital debugging method based on three-dimensional 3D data according to claim 3, characterized in that: Determining the loading and unloading phase parameters of the crane operation according to the target loading and unloading phase includes: When the target loading and unloading phase is the lifting phase or the lowering phase, determining that the loading and unloading phase parameter of the crane operation is a preset value; When the target loading and unloading phase is the translation phase, the midpoint moving distance from the midpoint position of the translation phase to the midpoint of the starting point is determined, and the loading and unloading phase parameters of the crane operation are determined based on the midpoint moving distance, the moved distance and the exponential function.

5. The digital debugging method based on three-dimensional 3D data according to claim 2, characterized in that: Determining cargo movement characteristic parameters according to the speed data includes: Determining, based on the speed data, a current cargo delivery speed and a maximum cargo delivery speed of the cargo during the target loading and unloading phase; Performing fitting processing on the speed data to determine the derivative of the cargo delivery speed in the time series; A cargo movement characteristic parameter is determined according to the range normalization function, the maximum cargo delivery speed, the current cargo delivery speed, and the derivative.

6. The digital debugging method based on three-dimensional 3D data according to claim 2, characterized in that: The calculating of the transport disturbance parameter in the cargo loading and unloading process according to the loading and unloading stage parameter and the cargo movement characteristic parameter comprises: Obtain the angle between the unit vector of the line connecting the crane to the center of mass of the cargo and the unit vector of the velocity direction of the cargo, and obtain the weight of the cargo; Determine a conversion value corresponding to the cosine value of the angle, and determine a first product according to the conversion value, the cargo weight, and the inverse of the cargo movement characteristic parameter; A calculation result is determined according to the hyperbolic tangent function and the first product, and a transport disturbance parameter in the cargo loading and unloading process is calculated according to the calculation result and the second product of the loading and unloading stage parameter.

7. The digital debugging method based on three-dimensional 3D data according to any one of claims 1 to 6, characterized in that: The speed data includes a number of sampled cargo transportation speeds, and the transportation disturbance parameters include a number of sampled corresponding transportation disturbance amplitudes; the preset control parameters are digitally debugged according to the transportation disturbance parameters, and the digital debugging results include: Determining the internal loss of the crane during the process of loading and unloading cargo according to the cargo transportation speed, the transportation disturbance amplitude and the sampling number; Determining a current transport loss according to the internal loss and an average of the transport disturbance amplitudes currently sampled; According to the current transport loss, the preset control parameters are digitally debugged to obtain digital debugging results.

8. The digital debugging method based on three-dimensional 3D data according to claim 7, characterized in that: Determining the internal loss of the crane during the cargo loading and unloading process according to the cargo transportation speed, the transportation disturbance amplitude and the sampling number includes: Determine the corresponding speed change rate according to the cargo delivery speeds of adjacent sampling times respectively; Determining the corresponding disturbance amplitude change rate according to the transport disturbance amplitudes of adjacent sampling times respectively; Determine the sum of a number of the speed change rates and a number of the disturbance amplitude change rates, and calculate the difference mean according to the sum and the number of sampling times; The difference means are normalized to obtain the internal loss of the crane during the process of loading and unloading cargo.

9. The digital debugging method based on three-dimensional 3D data according to claim 7, characterized in that: The digital debugging of the preset control parameters according to the current transportation loss to obtain the digital debugging result includes: Determining an adjustment ratio parameter according to the current transportation loss; According to the product of the adjustment ratio parameter and the preset control parameter, the preset control parameter is digitally debugged to obtain a digital debugging result; The digital debugging result is used to input the control system so that the control system can output the adjusted control signal acting on the crane.

10. A digital debugging system based on three-dimensional 3D data, characterized in that: include: A first determination module is used to determine a three-dimensional model established based on three-dimensional data of a cargo loading and unloading environment, and plan an operation path for a crane to load and unload cargo according to the three-dimensional model; A second determination module is used to determine speed data and position data of the cargo during the process of controlling the loading and unloading of the cargo according to the operation path; A calculation module, used to calculate a transport disturbance parameter in the cargo loading and unloading process according to the speed data and the position data, wherein the transport disturbance parameter represents the degree of interference caused by external factors; The debugging module is used to digitally debug the preset control parameters according to the transport disturbance parameters to obtain digital debugging results.

Citation Information

Patent Citations

  • Rescheduling method for automatic container terminal handling equipment

    CN106651049A

  • Container loading and unloading method based on motion planning

    CN111170153A

  • Anti-swing positioning control method based on disturbance observer and generalized load position tracking

    CN112506049A

  • PER-DDQN-based exoskeleton assistance movable carrying system control method

    CN113103210A

  • Crane risk prevention method and device

    CN114014188A