One-key positioning calculation method based on gate bridge crane equipment of hydropower station
By introducing one-key positioning calculation method and dynamic path planning into the gate and bridge equipment of hydropower stations, the problems of large positioning errors and insufficient path planning are solved, the positioning accuracy and path planning efficiency of the equipment are improved, and the efficient and safe operation of the equipment is ensured.
Patent Information
- Application Number
- CN202510342834.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2025-03-21
- Publication Date
- 2025-06-20
AI Technical Summary
The existing gate bridge positioning technology has large positioning errors in complex hydropower station environments and insufficient dynamic path planning, which affects the operating efficiency and safety of the equipment.
A one-key positioning calculation method based on the gate bridge equipment of hydropower stations is proposed, combining obstacle avoidance and environmental adaptability to dynamic path planning method, and by adjusting the path in real time, avoid new obstacles and respond to environmental changes.
It significantly improves the positioning accuracy and path planning efficiency of the door bridge equipment, improves the operating efficiency and safety of the equipment, and improves the automation level and operation reliability of the door bridge machine of the hydropower station.
Smart Images

Figure CN120176662A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of hydropower equipment, and particularly to a one-key positioning calculation method based on the gantry crane equipment of a hydropower station. Background Art
[0002] The gantry crane equipment of a hydropower station is a heavy machinery used for key tasks such as controlling the opening and closing of water gates, material handling, and equipment scheduling in a hydropower station. With the progress of automation and intelligence, the requirements for the gantry crane equipment in terms of high-precision positioning, path planning, and operation efficiency are increasing day by day. To ensure that the equipment can perform tasks efficiently and safely in the complex environment of a hydropower station, accurate equipment positioning and path planning are crucial. The existing gantry crane positioning technologies mainly rely on sensors such as GPS, lidar, and IMU for data collection and analysis. However, in a dynamically changing environment, the traditional positioning methods have the following deficiencies:
[0003] Large positioning error: The existing positioning methods often ignore the synergistic effect between sensors and cannot effectively fuse the data of different sensors, resulting in a large positioning error. Especially in a complex environment, such as when there are multiple obstacles and dynamic factors in a hydropower station, the error is further amplified.
[0004] Insufficient dynamic path planning: Most of the existing path planning methods are static planning, ignoring the impact of real-time environmental changes (such as wind force, water flow, etc.) on the movement of the equipment, resulting in inflexible path selection and affecting the operation efficiency and safety of the equipment. Summary of the Invention
[0005] The present invention aims to solve at least one of the technical problems in the related technologies to some extent.
[0006] The present invention proposes a one-key positioning calculation method based on the gantry crane equipment of a hydropower station, combined with a dynamic path planning method for obstacle avoidance and environmental adaptability, which can adjust the path in real time, avoid new obstacles, and cope with environmental changes.
[0007] To achieve the above object, on the one hand, the present invention proposes a one-key positioning calculation method based on the gantry crane equipment of a hydropower station, including:
[0008] Initializing the sensor parameters in the gantry crane positioning system;
[0009] Configuring the working parameters of the sensors and using the gantry crane positioning system to obtain the current position information of the gantry crane in real time;
[0010] Establishing a reference coordinate system based on the current position information of the gantry crane;
[0011] Calculating the positioning error of the gantry crane position based on the reference coordinate system and correcting the positioning error to obtain the corrected positioning data;
[0012] Perform dynamic path planning based on the corrected positioning data to construct a dynamic path planning model;
[0013] Perform one-key positioning calculation of the portal bridge crane based on the dynamic path planning model, so that the portal bridge crane equipment executes the path through autonomous navigation.
[0014] Furthermore, the sensors in the portal bridge crane positioning system include lidar, inertial measurement unit IMU, and GPS module; the initialization of the sensor parameters in the portal bridge crane positioning system includes:
[0015] Convert the sensor data collected by the lidar, inertial measurement unit IMU, and GPS module respectively to obtain the converted sensor data;
[0016] Map the converted sensor data to a unified range; and,
[0017] Perform deviation compensation on the sensor data.
[0018] Furthermore, use the portal bridge crane positioning system to obtain the current position information of the portal bridge crane in real time, including:
[0019] Obtain global positioning data using the GPS module;
[0020] Measure the distance between the portal bridge crane and the target object using lidar;
[0021] Obtain the real-time motion information of the portal bridge crane using IMU to correct or compensate for the errors caused by motion;
[0022] Perform data fusion on the data collected by the lidar, IMU, and GPS module through the Kalman filter algorithm to obtain the current position information of the portal bridge crane in real time.
[0023] Furthermore, the positioning error includes: GPS error ∈ GPS , lidar error ∈ LiDAR , IMU error ∈ IMU and environmental error ∈ env .
[0024] Furthermore, set the position of the portal bridge crane in the reference coordinate system as P = [x, y, z], set the theoretical position P meas = [x meas , y meas , z meas measured by the sensor, set the real position as P true = [x true , y true , z true , the real position is affected by errors, combine the errors to construct an error model, and the error model is:
[0025] P error = P true -P meas = f(∈ GPS , ∈ LiDAR , ∈ IMU , ∈ env , P true )
[0026] Among them, the error function f is expressed in the following form:
[0027]
[0028] Based on the error model, error correction is performed. The magnitude of the error is estimated according to the noise characteristics of each sensor and environmental factors, and the influence of each error on the position is obtained. The positioning error of the portal crane is corrected in real time through the Kalman filtering algorithm, and the position P of the portal crane after error correction is output current = [x current , y current , z current
[0029] Furthermore, the error represented by the error function f is composed of a linear combination of each sensor error and environmental error. Each component of the error function is expressed as:
[0030] f x (∈ CPS , ∈ LiDAR , ∈ IMU , ∈ env , P true ) =
[0031] w1·∈ GPS + w2·∈ LiDAR + w3·∈ IMU + w4·∈ env + δ x (P true )
[0032] Among them, w1, w2, w3, u4 are the weight coefficients of each error source, indicating the contribution of different sensors and environmental factors to the error; δ x (P true ) is the dynamic correction term of the portal crane position, and f y and f z are the error calculation formulas along the y and z directions respectively.
[0033] Furthermore, in the error model:
[0034] The GPS error ∈ GPS , is estimated using the Gaussian noise model:
[0035]
[0036] LiDAR error ∈ LiDAR , the error is proportional to the nature of the target reflection surface and the square of the distance, so the magnitude of the error is:
[0037]
[0038] where d is the target distance, and k LiDAR is the LiDAR error coefficient;
[0039] IMU error ∈ IMU , the IMU error is estimated using a linear relationship based on changes in acceleration and angular velocity:
[0040] ∈ IMU = k IMU ·(Δa + Δθ)
[0041] where Δa is the change in acceleration, Δθ is the change in angle, and kIMU is the IMU error coefficient; the environmental error ∈ env , which is estimated by observing the behavior of the gantry crane under different working conditions and is set as a constant or a function that varies according to environmental factors such as wind force and vibration.
[0042] Furthermore, the input of the dynamic path planning model includes:
[0043] The current position P of the gantry crane current ;
[0044] The target position P goal ;
[0045] Obstacle information: represented as where O i = [x i , y i , z i is the coordinate of the i-th obstacle;
[0046] The dynamic constraints of the device: including the maximum speed and acceleration, represented as v max , a max
[0047] Environmental changes: including water flow speed and wind speed factors, which affect path selection by dynamically adjusting weights, represented as ε = [e1, e2,..., e i , where each e i represents the influence of an environmental factor.
[0048] Furthermore, in the dynamic path planning model, a cost function is designed. The cost function finds a path from P currentTo P goal The optimal path to goal , while avoiding obstacles and reducing the movement time, energy consumption, and environmental factor sensitivity of the portal crane. The objective function considers path length, motion constraints, obstacle avoidance, and environmental adaptability:
[0049]
[0050] Among them, v(t) is the velocity vector of the device at time t; a(t) is the acceleration vector of the device at time t; ρ(P(t), O i ) is the distance function between the current position P(t) of the portal crane and the obstacle O i ; ε j is the weight of the j-th environmental factor, and ∈ j is the influence value of this factor on path planning, including environmental factors such as wind speed and water flow velocity, which are updated in real time.
[0051] Furthermore, in the dynamic path planning model, design constraint conditions, which include the motion constraints of the portal crane and the constraints of obstacles;
[0052] Set the speed and acceleration of the portal crane not to exceed the maximum values:
[0053] ||v(t)|| ≤ v max , ||a(t)|| ≤ a max
[0054] At the same time, the path avoids obstacles, that is, the distance between the portal crane and any obstacle is greater than the safety distance d safe :
[0055]
[0056] The one-key positioning calculation method based on the portal crane equipment of the embodiment of the present invention significantly improves the positioning accuracy and path planning efficiency of the portal crane equipment by introducing an error model based on sensor data and a dynamic path planning model. Through the data of sensors such as GPS, lidar, and IMU, the positioning deviation caused by environmental changes, sensor errors, and equipment movement can be dynamically corrected. The dynamic path planning method combining obstacle avoidance and environmental adaptability can adjust the path in real time, avoid new obstacles, and cope with environmental changes, thereby improving the operation efficiency and safety of the equipment. In addition, the optimization of equipment positioning and path planning will greatly improve the automation level and operation reliability of the portal crane in the hydropower station, reduce manual intervention, reduce operation risks, and ensure the stable operation of the hydropower station facilities.
[0057] The additional aspects and advantages of the present invention will be partially given in the following description, partially become obvious from the following description, or be understood through the practice of the present invention. Description of the Drawings
[0058] The above and / or additional aspects and advantages of the present invention will become apparent and be readily understood from the following description of embodiments in conjunction with the accompanying drawings, where:
[0059] Figure 1 is a flowchart of a one-key positioning calculation method based on a hydroelectric power station portal bridge crane device according to an embodiment of the present invention. Detailed implementation manners
[0060] It should be noted that, without conflict, the embodiments in the present invention and the features in the embodiments may be combined with each other. The present invention will be described in detail below with reference to the drawings and in conjunction with the embodiments.
[0061] In order to enable those skilled in the art to better understand the solution of the present invention, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention. Obviously, the described embodiments are only a part of the embodiments of the present invention, rather than all the embodiments. All other embodiments obtained by those of ordinary skill in the art based on the embodiments of the present invention without making creative efforts shall fall within the protection scope of the present invention.
[0062] The one-key positioning calculation method, device and storage medium based on a hydroelectric power station portal bridge crane device according to an embodiment of the present invention will be described below with reference to the drawings.
[0063] Figure 1 is a flowchart of a one-key positioning calculation method based on a hydroelectric power station portal bridge crane device according to an embodiment of the present invention, as Figure 1 shown, the method includes:
[0064] S1, initialize the sensor parameters in the portal bridge crane positioning system.
[0065] It can be understood that initializing the sensors in the portal bridge crane positioning system can ensure that the device maintains a high positioning accuracy in different working environments.
[0066] In this embodiment, the sensors in the portal bridge crane positioning system include a lidar, an inertial measurement unit IMU, and a GPS module.
[0067] Specifically, the initialization process includes converting the data output by each sensor into a unified unit and mapping the data to a unified range so that the data output by different sensors has the same scale; performing deviation compensation on the data.
[0068] The position information of GPS may be longitude and latitude, the distance data of lidar is the actual physical distance, and the angle data of IMU is expressed in degrees or radians. In order to effectively fuse these data in the Kalman filtering algorithm, unified processing is required to ensure that all data is within a unified scale and unit range. This can be achieved through standardization (such as linear transformation, normalization, etc.) or standard benchmarking methods (such as zero mean, unit variance).
[0069] S2. Configure the working parameters of the sensors, and use the gantry crane positioning system to obtain the current position information of the gantry crane in real time.
[0070] It can be understood that after initialization, set the working parameters of the sensors, and based on the gantry crane positioning system, actually obtain the real-time position information of the gantry crane.
[0071] In this embodiment, actually obtaining the real-time position information of the gantry crane includes:
[0072] Based on the GPS module to provide global positioning data;
[0073] Based on lidar to measure the distance between the gantry crane and the target object;
[0074] Based on IMU to provide the real-time motion information of the gantry crane to correct or compensate for the errors caused by motion;
[0075] After fusing the data output by the lidar, inertial measurement unit, and GPS module through the Kalman filtering algorithm, remove the noise and redundant data to ensure the stability and accuracy of the position data, and obtain the real-time position information of the gantry crane.
[0076] S3. Establish a reference coordinate system based on the current position information of the gantry crane.
[0077] It can be understood that after obtaining the real-time position of the gantry crane, establish a reference coordinate system as the basis for positioning calculation.
[0078] In this embodiment, the positioning information of the gantry crane needs to be converted into a unified coordinate system for subsequent positioning calculation and operation. The environment inside the hydropower station is complex and the terrain fluctuates greatly. Therefore, according to the current real-time position of the equipment, a spatial coordinate system based on the global coordinate system or the internal coordinate system of the hydropower station needs to be established. The establishment of this coordinate system is based on the position information of the gantry crane and combines the ranging data provided by the lidar and IMU to optimize the coordinate calculation accuracy. Through the three-dimensional coordinate system, the motion trajectory, attitude change, and other spatial parameters of the gantry crane can be better understood and mastered, making the operation of the entire equipment more accurate and efficient. In addition, the establishment of the coordinate system can provide a basis for functions such as autonomous navigation and path planning of the equipment.
[0079] S4. Calculate the positioning error of the portal crane position based on the reference coordinate system, and correct the positioning error to obtain the corrected positioning data.
[0080] It can be understood that, based on the reference coordinate system, calculate the error of the portal crane position and correct the positioning data for the error.
[0081] In this embodiment, even though the real-time position of the device is obtained through data fusion of multiple sensors, due to environmental factors (such as occlusion, signal interference, etc.) and the accuracy limitation of the device itself, there may still be a certain error in the positioning result. The error of the portal crane position includes GPS error, lidar error, IMU error, and environmental error;
[0082] GPS error: Due to factors such as satellite signal interference and occlusion, there is a deviation in the positioning result measured by GPS, and the set error is ∈ GPS ;
[0083] Lidar error: When the lidar performs distance measurement, the error is affected by the nature of the reflection surface and the line-of-sight limitation, and the error is expressed as ∈ LiDAR ;
[0084] IMU error: The IMU measures the attitude and acceleration of the device, and the error is affected by dynamic factors such as device vibration and rotation speed, and the error is represented by ∈ IMU ;
[0085] Environmental error: It includes the influence of external environmental factors such as wind force and vibration on the movement of the device, and the error is expressed as ∈ env .
[0086] Furthermore, the position of the portal crane is set as P = [x, y, z] in the reference coordinate system. Set the theoretical position P meas = [x meas , y meas , z meas measured by the sensor, and set the real position as P true = [x true , y true , z true . The real position is affected by errors. Combine the errors to construct an error model, combine the characteristics of multi-sensor data (such as GPS, lidar, and IMU), and consider factors such as environmental influence and device movement. The error model is as follows:
[0087] P error = P true - P meas = f(∈ GPS , ∈ LiDAR , ∈ IMU , ∈ env , Ptrue );
[0088] Among them, the error function f is expressed in the following form:
[0089]
[0090] Based on the error model, error correction is performed. According to the noise characteristics of each sensor and environmental factors, the magnitude of the error is estimated, the influence of each error on the position is obtained, and through the Kalman filtering algorithm, the positioning error of the gantry crane is corrected in real time, so as to output the position P of the gantry crane after error correction current = [x current , y current , z current .
[0091] Furthermore, the error represented by the error function f is composed of a linear combination of the errors of each sensor and the environmental error, and each component of the error function is expressed as:
[0092] f x (∈ GPS , ∈ LiDAR , ∈ IMU , ∈ env , P true ) =
[0093] w1·∈ GPS + w2·∈ LiDAR + u3·∈ IMU + w4·∈ env + δ x (P true );
[0094] Among them, w1, w2, w3, w4 are the weight coefficients of each error source, representing the contributions of different sensors and environmental factors to the error; δ x (P true ) is the dynamic correction term of the gantry crane position, considering the influence of the gantry crane state including speed and direction on the error;
[0095] Similarly, f y and f z are the error calculation formulas along the y and z directions respectively.
[0096] In order to perform error correction through this model, first, according to the noise characteristics of each sensor and environmental factors, the magnitude of these errors needs to be estimated. The estimation of the error source is usually determined based on the standard deviation of the sensor or through statistical analysis of historical data. In the error model:
[0097] The GPS error ∈ GPS , is estimated using the following Gaussian noise model:
[0098]
[0099] LiDAR error ∈ LiDAR , the error is proportional to the nature of the target reflection surface and the square of the distance, and the magnitude of the error is:
[0100]
[0101] where d is the target distance, and k LiDAR is the error coefficient of the LiDAR;
[0102] IMU error ∈ IMU , the IMU error is estimated using a linear relationship based on changes in acceleration and angular velocity:
[0103] ∈ IMU = k IMU ·(Δa + Δθ)
[0104] where Δa is the change in acceleration, Δθ is the change in angle, and k IMU is the error coefficient of the IMU; environmental error ∈ env , estimated by observing the behavior of the gantry crane under different operating conditions, set as a constant or a function that varies according to environmental factors such as wind and vibration, and the function is as follows:
[0105]
[0106] where ∈ env : the estimated value of the environmental error. v wind : the current wind speed (unit: m / s). a vib : the acceleration amplitude of the equipment vibration (unit: m / s 2 ). ΔT: the temperature change range of the equipment (unit: °C). kk1, kk2, kk3: empirical coefficients used to balance the effects of wind speed, vibration, and temperature on the error, and are adjusted according to actual data.
[0107] This function can calculate the influence value of the environment on positioning ∈ env in real time and is used in the error correction model. It can be added to the adjustment steps of the positioning system to dynamically correct the positioning value of the equipment by sensing data on wind speed, vibration, and temperature changes.
[0108] In practical applications, the error model can be used through the following steps:
[0109] Step 1: Estimate the error of each sensor based on the measurement data of the sensors.
[0110] Step 2: Calculate the overall error P of the equipment through the error analysis formula error, that is, estimating the deviation between the position of the gantry crane equipment and the actual position through the error function f.
[0111] Step 3: Through algorithms such as Kalman filtering, according to the status information of the gantry crane equipment and the error estimation result, correct the equipment position to make the positioning result more accurate.
[0112] Step 4: According to the corrected positioning result, perform path planning and control on the gantry crane to ensure that the equipment runs along the predetermined path and avoid collisions or other dangers.
[0113] S5. Perform dynamic path planning according to the corrected positioning data to construct a dynamic path planning model.
[0114] It can be understood that dynamic path planning is performed according to the positioning data corrected by the error.
[0115] In this embodiment, a dynamic path planning model is constructed, and the inputs of the model include:
[0116] The current position P of the gantry crane current ;
[0117] The target position P goal ;
[0118] Obstacle information: expressed as where O i =[x i , y i , z i is the coordinate of the i-th obstacle;
[0119] The dynamic constraints of the equipment: including the maximum speed and acceleration, expressed as v max , a max ;
[0120] Environmental changes: including water flow speed and wind speed factors, which affect path selection by dynamically adjusting weights, expressed as ε = [e1, e2,..., e i , where each e i represents the influence of an environmental factor.
[0121] Furthermore, in the dynamic path planning model, a target function is designed. The target function finds an optimal path from P current to P goal , while avoiding obstacles and reducing the movement time, energy consumption, and sensitivity to environmental factors of the gantry crane. The target function considers path length, movement constraints, obstacle avoidance, and environmental adaptability:
[0122]
[0123] Among them, v(t) is the velocity vector of the device at time t, and the goal is to minimize the total time integral of the velocity to reduce the motion time; a(t) is the acceleration vector of the device at time t, and the goal is to minimize the total integral of the acceleration to reduce the energy consumption; ρ(P(t), O i ) is the distance function between the current position P(t) of the gantry crane and the obstacle O i , to avoid collisions, and the influence of the obstacle is quantified through the distance function; ε j is the weight of the j-th environmental factor, and ∈ j is the influence value of this factor on the path planning, including environmental factors such as wind speed and water flow velocity, which are updated in real time.
[0124] Among them, the distance function ρ(P(t), O i ) selects a non-linear function, such as a Gaussian function:
[0125]
[0126] Based on the Gaussian function, the influence of the obstacle decreases as the distance increases.
[0127] Furthermore, in the dynamic path planning model, design constraint conditions, which include the motion constraints of the gantry crane and the constraints of the obstacles;
[0128] Set the speed and acceleration of the gantry crane not to exceed the maximum values:
[0129] ||v(t)|| ≤ v max , ||a(t)|| ≤ a max
[0130] At the same time, the path avoids obstacles, that is, the distance between the gantry crane and any obstacle is greater than the safety distance d safe :
[0131]
[0132] Based on the objective function J and the constraint conditions, we can use sampling-based algorithms (such as RRT, A*, etc.) or optimization-based algorithms (such as MPC, optimal control) for path planning. In this scenario, assume that the Rapidly-Exploring Random Tree (RRT) algorithm is used to update the path in combination with real-time data.
[0133] Step 1: Initialize the starting point P current and the target point P goal .
[0134] Step 2: Generate a preliminary path P(t) and calculate the objective function.
[0135] Step 3: Adjust the path in real time according to the dynamic constraints and environmental changes of the gantry crane equipment. Calculate the speed and acceleration at each step to ensure that the path planning complies with the maximum speed v max and the maximum acceleration a max
[0136] Step 4: Update the obstacle influence function ρ(P(t), O i ) using the real-time data of the obstacles, and replan the path to avoid newly emerged obstacles.
[0137] Step 5: Monitor the changes of environmental factors (such as wind speed, water flow, etc.) in real time, and adjust the weight ∈ of the objective function of the path planning according to these changes j to optimize the path selection.
[0138] In summary, when the dynamic path planning model is used, it includes:
[0139] Initial path planning: At the beginning of each path planning, obtain the current device position P current and the target position P goal , as well as the current obstacle and environmental data.
[0140] Calculate the objective function J: According to the device state, obstacle distribution, environmental changes and dynamic constraints, calculate the objective function of the path and determine the optimal path.
[0141] Real-time path update: During the path execution, dynamically update the obstacles and environmental factors, and adjust the path planning. Use dynamic constraints to ensure that the device does not exceed the speed or undergo violent acceleration, and avoid collisions and energy consumption waste.
[0142] Adjust the path planning: Whenever the environment or obstacles change, the model will re-evaluate the path to ensure that the device can always reach the target position along the optimal path.
[0143] By combining the positioning data after error correction, environmental changes, device dynamic constraints and obstacle avoidance, an optimal or sub-optimal path can be generated to reduce the movement time, energy consumption, and avoid collisions. The path planning model can dynamically respond to environmental changes and device states by adjusting the objective function and constraint conditions in real time, ensuring that the gantry crane equipment can complete tasks efficiently and accurately in the hydropower station environment.
[0144] S6. Perform one-key positioning calculation of the gantry crane based on the dynamic path planning model, so that the gantry crane equipment executes the path through autonomous navigation.
[0145] It can be understood that after the dynamic path planning is completed, the one-key positioning calculation of the gantry crane is completed, and the gantry crane equipment executes the path through autonomous navigation.
[0146] In this embodiment, once the path planning is completed, the portal crane needs to use autonomous navigation technology to track and execute the path in real time. The autonomous navigation system can perform precise control based on the real-time position information and the target path. By seamlessly connecting with the positioning system, the navigation system continuously adjusts the movement trajectory of the device to ensure that the portal crane precisely follows the predetermined path. At this time, the combined use of lidar and IMU provides real-time feedback on the direction and motion state of the device, while the GPS module provides global positioning data. When the device deviates from the predetermined path, the system automatically adjusts the driving direction of the device according to the set deviation correction algorithm to ensure that it quickly and safely returns to the correct track.
[0147] This embodiment also provides a computer device applicable to a case of a one-key positioning calculation method based on a hydropower station portal crane device, including a memory and a processor; the memory is used to store computer-executable instructions, and the processor is used to execute the computer-executable instructions to implement a one-key positioning calculation method based on a hydropower station portal crane device as proposed in the above embodiment.
[0148] This embodiment also provides a storage medium on which a computer program is stored, and when the program is executed by a processor, it implements a one-key positioning calculation method based on a hydropower station portal crane device as proposed in the above embodiment.
[0149] According to the one-key positioning calculation method based on a hydropower station portal crane device of the embodiment of the present invention, combined with a dynamic path planning method for obstacle avoidance and environmental adaptability, the path can be adjusted in real time to avoid new obstacles and cope with environmental changes, thereby improving the operation efficiency and safety of the device. In addition, the optimization of device positioning and path planning will greatly enhance the automation level and operation reliability of the hydropower station portal crane, reduce manual intervention, lower operation risks, and ensure the stable operation of the hydropower station facilities.
[0150] In the description of this specification, the descriptions referring to terms such as "one embodiment", "some embodiments", "example", "specific example", or "some examples" mean that the specific features, structures, materials, or characteristics described in connection with the embodiment or example are included in at least one embodiment or example of the present invention. In this specification, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials, or characteristics described can be combined in a suitable manner in any one or more embodiments or examples. In addition, without contradiction, those skilled in the art can combine and combine the different embodiments or examples described in this specification and the features of different embodiments or examples.
[0151] Furthermore, the terms "first" and "second" are used for descriptive purposes only and should not be construed as indicating or implying relative importance or implicitly specifying the quantity of the indicated technical features. Thus, features defined with "first" and "second" may explicitly or implicitly include at least one of such features. In the description of the present invention, "a plurality of" means at least two, such as two, three, etc., unless otherwise specifically defined.
Claims
1. A one-key positioning calculation method based on hydropower station gantry crane equipment, characterized in that: include: Initialize the sensor parameters in the gantry crane positioning system; Configure the working parameters of the sensor and use the gantry crane positioning system to obtain the current position information of the gantry crane in real time; Establish a reference coordinate system based on the current position information of the gantry crane; Calculate the positioning error of the gantry crane based on the reference coordinate system, and correct the positioning error to obtain corrected positioning data; Perform dynamic path planning according to the corrected positioning data to build a dynamic path planning model; Based on the dynamic path planning model, one-click positioning calculation of the gantry crane is performed, so that the gantry crane equipment executes the path through autonomous navigation.
2. The method according to claim 1, characterized in that: The sensors in the gantry crane positioning system include a laser radar, an inertial measurement unit IMU and a GPS module; the initialization of the sensor parameters in the gantry crane positioning system includes: The sensor data collected by the laser radar, the inertial measurement unit IMU and the GPS module are respectively converted to obtain converted sensor data; Mapping the converted sensor data to a uniform range; and, Perform bias compensation on sensor data.
3. The method according to claim 2, characterized in that The gantry crane positioning system is used to obtain the current position information of the gantry crane in real time, including: Use the GPS module to obtain global positioning data; Use LiDAR to measure the distance between the gantry crane and the target object; Use IMU to obtain real-time motion information of the gantry crane to correct or compensate for the errors caused by the motion; The Kalman filter algorithm is used to fuse the data collected by the lidar, IMU, and GPS modules to obtain the current position information of the gantry crane in real time.
4. The method according to claim 3, characterized in that The positioning error includes: GPS error ∈GPS, laser radar error ∈LiDAR, IMU error ∈IMU and environmental error ∈ env .
5. The method according to claim 4, characterized in that The position of the gantry crane is set to P = [x, y, z] in the reference coordinate system, and the theoretical position P measured by the sensor is set to meas =[x meas ,y meas , z meas ], set the real position to P true =[x true ,y true , z true ], the true position is affected by the error, and the errors are combined to construct the error model, which is: P error =P true -P meas =f(∈ GPS ,∈ LiDAR ,∈ IMU ,∈ env ,P true ) Among them, the error function f is expressed as follows: Based on the error model, the error correction is performed, the error size is estimated according to the noise characteristics of each sensor and environmental factors, and the influence of each error on the position is obtained. The positioning error of the gantry crane is corrected in real time through the Kalman filter algorithm, and the gantry crane position P after error correction is output. current =[x current ,y current , z current ].
6. The method according to claim 5, characterized in that The error represented by the error function f is composed of a linear combination of the sensor errors and the environmental errors. Each component of the error function is expressed as: f x (∈ GPS ,∈ LiDAR ,∈ IMU ,∈ env ,P true )= w1·∈ GPS +w2·∈ LiDAR +w3·∈ IMU +w4·∈ env +δ x (P true ) Among them, w1, w2, w3, w4 are the weight coefficients of each error source, indicating the contribution of different sensors and environmental factors to the error; δ x (P true ) is the dynamic correction term of the gantry crane position, f y and f z are the error calculation formulas along the y and z directions respectively.
7. The method according to claim 6, characterized in that In the error model: GPS error∈ GPS , estimated using the Gaussian noise model: LiDAR error ∈ LiDAR , the error is proportional to the properties of the target reflection surface and the square of the distance, so the error is: Where d is the target distance, κ LiDAR is the error coefficient of the lidar; IMU error ∈ IMU , IMU error is estimated based on the change of acceleration and angular velocity using a linear relationship: ∈ IMU =k IMU ·(Δa+Δθ); Among them, Δa is the acceleration change, Δθ is the angle change, and κ IMU is the error coefficient of IMU; environmental error ∈ env , by estimating the behavior of the gantry crane under different working conditions, it is set as a constant or a function that changes according to environmental factors such as wind and vibration.
8. The method according to claim 7, characterized in that The input of the dynamic path planning model includes: Gantry crane current position P current ; Target position P goal ; Obstacle information: represented by Among them, i =[x i ,y i , z i ] is the coordinate of the ith obstacle; the dynamic constraints of the device: including the maximum speed and acceleration, respectively expressed as v max , a max ; Environmental changes: including water flow velocity and wind speed factors, which affect path selection by dynamically adjusting weights, expressed as ε = [e1, e2, …, e i ], where each e i Represents the influence of an environmental factor.
9. The method according to claim 8, characterized in that In the dynamic path planning model, an objective function is designed to find a path from P current To P goal The optimal path is to avoid obstacles and reduce the movement time, energy consumption and sensitivity to environmental factors of the gantry crane. The objective function considers path length, motion constraints, obstacle avoidance and environmental adaptability: Where V(t) is the velocity vector of the device at time t; a(t) is the acceleration vector of the device at time t; ρ(P(t), O i ) is the distance between the current position of the gantry crane P(t) and the obstacle O i The distance function of j is the weight of the jth environmental factor, ∈ j It is the impact value of this factor on path planning, including real-time updates of environmental factors such as wind speed and water flow speed.
10. The method according to claim 9, characterized in that In the dynamic path planning model, constraints are designed, and the constraints include motion constraints of the gantry crane and constraints of obstacles; Set the speed and acceleration of the gantry crane not to exceed the maximum value: ||v(t)||≤v max ,||a(t)||≤a max ; At the same time, the path avoids obstacles, that is, the distance between the gantry crane and any obstacle is greater than the safety distance d safe :
Citation Information
Cited By
Port portal crane operation state identification method
CN121253203A
