A method and system for automatically centering and positioning anchor holes in concrete engineering foundations
By introducing a high-definition camera and attitude sensor into the anchor hole positioning system, combined with a three-dimensional coordinate system and machine vision feature recognition, the problems of positioning error accumulation and insufficient path planning are solved, achieving highly stable and efficient anchor hole positioning.
Patent Information
- Application Number
- CN202410979783.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-22
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2044-07-22
AI Technical Summary
Existing anchor positioning systems are susceptible to mechanical wear and environmental changes during long-term operation, leading to the accumulation of positioning errors. They also lack positioning verification mechanisms, and the unstable quality of GPS signal transmission affects positioning accuracy. Furthermore, insufficient planning of the actuator's insertion path results in low positioning efficiency and wasted resources.
A three-dimensional coordinate system is established using a high-definition camera and attitude sensor to perform real-time probe positioning and path planning. Combined with machine vision feature recognition and a positioning reference library, positioning verification and attitude adjustment are performed to optimize the probe path and reduce the frequency of positioning adjustments.
It improves the stability and flexibility of the positioning system, reduces error accumulation, enhances positioning accuracy and applicability, optimizes the movement efficiency of the actuator, simplifies the centering and adjustment process, and extends equipment life.
Smart Images

Figure CN118533153B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of anchor hole positioning management, and in particular relates to an automatic centering positioning method and system for a concrete engineering foundation anchor hole. Background Art
[0002] Anchor hole positioning is a positioning technology used in the fields of engineering and manufacturing. Its main purpose is to ensure the precise positioning of workpieces or components during assembly, processing or positioning. It is often used in complex positioning environments where manual positioning may be very difficult or even impossible. The anchor hole positioning system can be adaptively adjusted according to different workpiece types and anchor hole environments, and can cope with various complex assembly parts. In addition, it can achieve automatic positioning through sensors and feedback control systems, without the need for tedious manual adjustments and calibrations, greatly improving positioning efficiency.
[0003] The general operation process of anchor hole positioning is to first determine the target execution position of the part to be positioned in the anchor hole, then place the part to be positioned on an actuator such as a positioning platform or a fixture, and finally start the automatic positioning system to perform positioning control in the process of using the actuator to probe into the anchor hole until the probe position meets the target execution position for part assembly processing.
[0004] However, in the above-mentioned anchor hole positioning control, positioning only relies on the positioning system, resulting in a single positioning means and a lack of positioning verification. On the one hand, even if the anchor hole positioning system has high precision, positioning errors may gradually accumulate during long-term operation due to factors such as mechanical wear and environmental changes. The lack of a positioning verification mechanism may cause these errors to be ignored, resulting in the inability to timely discover error defects in the positioning system. On the other hand, most of the positioning systems currently used are GPS systems, which are greatly restricted by the quality of information transmission. When the environment of the anchor hole is relatively closed and complex, the signal transmission quality will be reduced, which will easily cause positioning delays and affect positioning accuracy.
[0005] In addition, there is currently a lack of planning for the actuator's exploration path in the anchor hole before anchor hole positioning, which results in blind exploration of the actuator in the anchor hole. Especially when the anchor hole is large in size, the frequency of positioning adjustments will be increased invisibly, which will not only reduce the positioning efficiency, but also cause a waste of resources. Summary of the invention
[0006] To this end, one purpose of an embodiment of the present application is to provide a method and system for automatic centering and positioning of anchor holes in a concrete engineering foundation, which effectively solves the problems mentioned in the background technology.
[0007] The purpose of the present invention can be achieved through the following technical solutions: The first aspect of the present invention provides a method for automatic centering and positioning of a concrete engineering foundation anchor hole, comprising the following steps: S1. A positioning device, a high-definition camera and a posture sensor are set on the actuator, and a three-dimensional coordinate system is established based on the anchor hole position.
[0008] S2 performs exploration path planning before the actuator is inserted, thereby using the positioning device to locate the insertion position in real time during the process of the actuator inserting along the anchor hole according to the planned exploration path.
[0009] S3 compares the probe position coordinates obtained by real-time positioning with the planned coordinates of the target execution position, thereby controlling the probe operation of the actuator.
[0010] S4: When the control actuator stops probing, a high-definition camera is used to scan the stop probing position to obtain images of the anchor hole walls around the stop probing position.
[0011] S5 identifies features and marks the coordinates of the feature positions in the images of the anchor hole walls around the stop probe position, thereby comparing the coordinates of the stop probe position with the position coordinates of the feature, obtaining the distance between the stop probe position and the feature, and comparing it with the planned feature distance in the anchor drilling image corresponding to the target execution position retrieved from the positioning reference library, to identify whether the stop probe position is the target execution position. If it is identified as the target execution position, execute S6, otherwise perform positioning anomaly analysis.
[0012] S6 uses the attitude sensor to obtain the angle and center axis of the end effector on the actuator relative to the plane where the anchor hole is located, thereby controlling the end effector to adjust the attitude centering.
[0013] After the centering is completed, S7 evaluates the positioning accuracy based on the actuator's penetration control and the adjustment of the end effector.
[0014] The second aspect of the present invention provides an automatic centering and positioning system for anchor holes in concrete engineering foundations, comprising the following modules: a positioning-related equipment setting module for setting a positioning device, a high-definition camera and a posture sensor on an actuator.
[0015] The coordinate positioning module is used to establish a three-dimensional coordinate system based on the anchor hole position, and thereby use the positioning device to locate the insertion position in real time during the process of the actuator probing along the anchor hole to obtain the insertion position coordinates.
[0016] The probe correction control module is used to compare the probe position coordinates obtained by real-time positioning with the planned coordinates of the target execution position, thereby controlling the probe operation of the actuator.
[0017] The feature positioning module is used to use a high-definition camera to scan the stop probe position when the control actuator stops probing, obtain the image of the anchor hole wall around the current probe position, and identify the feature object therefrom, and then obtain the distance between the stop probe position and the feature object according to the position of the feature object, thereby identifying whether the stop probe position is the target execution position.
[0018] The execution posture adjustment module is used to use the posture sensor to obtain the angle and the center axis of the end effector on the actuator relative to the plane where the anchor hole is located when the stop probe position is identified as the target execution position, thereby controlling the end effector to perform posture centering adjustment.
[0019] The positioning evaluation module is used to evaluate the positioning accuracy based on the penetration control of the actuator and the adjustment of the end effector after the centering positioning is completed.
[0020] The positioning reference library is used to store the planned coordinates of the target execution position and the anchor drilling images corresponding to the target execution position.
[0021] Compared with the prior art, the advantages of the present invention are as follows: 1. The present invention uses the positioning system to perform initial positioning during the positioning process of the actuator in the anchor hole, and uses machine vision to collect images of the anchor hole walls around the initial positioning position to verify the positioning of the feature object after the initial positioning is consistent. Therefore, the positioning accuracy is enhanced by combining preliminary positioning with fine positioning, and the robustness of the system can be enhanced. The positioning system may be affected by environmental interference or signal blocking, and machine vision can verify the positioning results through visual features, thereby reducing the possibility of positioning errors and reducing the accumulation of errors, thereby improving the stability of positioning.
[0022] 2. The positioning system used by the actuator in the process of anchor hole exploration in the present invention is based on the position coordinates obtained by constructing a coordinate system. Compared with GPS positioning, this positioning method can provide real-time position information without waiting for satellite signal transmission and processing, and has high positioning timeliness. At the same time, it does not rely on external signal sources and is not affected by factors such as signal shielding and atmospheric interference. It greatly increases the scope of application and flexibility of the positioning system, thereby improving the stability and reliability of the positioning system to a certain extent.
[0023] 3. Before positioning the anchor hole, the present invention can optimize the movement efficiency of the actuator during the insertion process by planning the insertion path of the actuator in the anchor hole based on the constructed three-dimensional coordinate system, minimize the frequency of positioning adjustment, and avoid waste of resources while improving the positioning efficiency. At the same time, when performing the centering adjustment of the workpiece to be positioned, it can ensure that the insertion position of the actuator is always maintained on the center line of the anchor hole, so that only the posture of the workpiece to be positioned needs to be adjusted to achieve centering positioning, which greatly reduces the complexity of the adjustment process, simplifies the centering adjustment process, saves time and human resources, and in addition avoids frequent adjustment of the actuator position, which helps to reduce mechanical wear and energy consumption and extend the service life of the equipment. BRIEF DESCRIPTION OF THE DRAWINGS
[0024] The present invention is further described using the accompanying drawings, but the embodiments in the accompanying drawings do not constitute any limitation to the present invention. A person skilled in the art can obtain other drawings based on the following drawings without creative work.
[0025] Figure 1 The present invention is a flowchart of the steps for implementing the method.
[0026] Figure 2 This is a system module connection diagram of the present invention.
[0027] Figure 3 It is a schematic diagram of constructing a three-dimensional coordinate system in the present invention. DETAILED DESCRIPTION
[0028] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0029] Example 1
[0030] See also Figure 1 As shown, the present invention provides a method for automatic centering and positioning of a concrete engineering foundation anchor hole, comprising the following steps: S1: arranging a positioning device, a high-definition camera and a posture sensor on an actuator, and establishing a three-dimensional coordinate system based on the anchor hole position.
[0031] As a preferred example, the actuator may be a clamp or a manipulator.
[0032] It should be noted that the positioning device mentioned in the above scheme is a positioning device used based on the constructed three-dimensional coordinate system. Specifically, it can be a diffuse reflection laser sensor, which is a common laser ranging sensor that uses a laser beam to emit onto the target surface and then measures the time required for the laser to reflect back to calculate the distance of the target. Unlike other laser sensors, diffuse reflection laser sensors do not require the target surface to be highly reflective because they measure diffusely reflected light rather than specularly reflected light. In the positioning system that constructs the coordinate system, diffuse reflection laser sensors are often used to obtain three-dimensional point cloud data of the surrounding environment in order to build an environmental map and determine the position of the actuator. Since diffuse reflection laser sensors are not limited by the reflectivity of the target surface, they can provide reliable measurement results on a variety of different surfaces and environmental conditions.
[0033] It should be added that the high-definition camera mentioned above is used to collect images of the anchor hole walls around the probe position where the actuator is located. The attitude sensor is a sensor used to measure the attitude or direction of an object. It is usually used to determine the rotation angle or direction of the object relative to a reference coordinate system. It is mainly used to detect the attitude of the end effector relative to the constructed three-dimensional coordinate system.
[0034] In a further implementation of the above scheme, the implementation of establishing a three-dimensional coordinate system is as follows: take the center point of the anchor hole as the origin, select a reference direction on the plane where the anchor hole is located as the X-axis, and take the direction perpendicular to the X-axis on the plane where the anchor hole is located as the Y-axis, and take the direction in which the actuator penetrates into the anchor hole as the Z-axis, thereby establishing a three-dimensional coordinate system, see Figure 3 shown.
[0035] S2 performs exploration path planning before the actuator is inserted, thereby using the positioning device to locate the insertion position in real time during the process of the actuator inserting along the anchor hole according to the planned exploration path.
[0036] As a further optimization of the above scheme, the insertion path planning is carried out before the actuator inserts as follows: a linear displacement sensor is installed on the actuator, and after the three-dimensional coordinate system is established, the linear displacement sensor is emitted in the z-axis direction to form an insertion path, and then the actuator inserts according to the insertion path.
[0037] It should be understood that a linear displacement sensor is a sensor used to measure the displacement or position of an object in a straight line. They are usually used to measure the linear displacement of machines or equipment in the fields of industry, automation, robotics, etc. to achieve precise position control and monitoring. In the present invention, the z-axis direction is the centerline direction of the anchor hole. When the linear displacement sensor is emitted in the z-axis direction, a straight line is formed. When the actuator is probed in accordance with the straight line formed by the emission, the actuator can always stay in the centerline of the anchor hole. When there is a deviation from the centerline, the linear displacement sensor will perform an early warning correction.
[0038] S3 compares the probe position coordinates obtained by real-time positioning with the planned coordinates of the target execution position, thereby controlling the probe operation of the actuator. The specific control is as follows: S31. Compare the coordinate value of the probe position along the z-axis obtained by real-time positioning with the planned coordinate value of the target execution position along the z-axis, where the coordinate value of the probe position along the z-axis is the penetration depth of the actuator in the anchor hole, and calculate the penetration depth proximity. The calculation expression is: , where Indicates the coordinate value of the probe position along the z-axis obtained in real time, Indicates the planned coordinate value of the target execution position along the z-axis.
[0039] S32, comparing the penetration depth proximity with the initially set proximity threshold. For example, the proximity threshold can be set to 90%, wherein the proximity threshold is initially set to assist in determining whether to continue to go deeper. If the penetration depth proximity is less than the proximity threshold, execute S33, otherwise execute S34-S35.
[0040] S33, controlling the actuator to continue to go deeper, and continuing to calculate the penetration depth proximity of the coordinate values along the z-axis obtained after going deeper, until the calculated penetration depth proximity is greater than or equal to the proximity threshold, and executing S34-S35.
[0041] S34, compare the coordinate values of the probe position along the x-axis and along the y-axis with the planned coordinate values of the target execution position along the x-axis and along the y-axis, and calculate Calculate the penetration position deviation , where , They represent the planned coordinate values of the target execution position along the x-axis and along the y-axis in the three-dimensional coordinate system, respectively. , They represent the coordinate values of the probe position along the x-axis and along the y-axis in the three-dimensional coordinate system, respectively. represents the reference offset distance, represents a natural constant, illustratively, It can be 1 cm, which is used to assist in the calculation of the probe position deviation.
[0042] It should be understood that when checking whether the coordinates of the actuator's insertion position in the anchor hole meet the planned coordinates of the target execution position, the insertion depth compliance analysis is performed first. When the insertion depth meets the requirements, the coordinates in other directions are analyzed. The purpose is that for the actuator's insertion position in the anchor hole, the coordinate value of the insertion depth is more important than the coordinate values in other directions. This is because the insertion depth determines the distance between the tool, fixture or work head and the workpiece. If the insertion depth is inaccurate, it may lead to incorrect work results or improper assembly of parts. If the insertion depth does not meet the requirements, the workpiece may need to be reprocessed or repaired, which increases costs and time. Therefore, only when the insertion depth meets the requirements will the coordinates in other directions be analyzed, which can avoid unnecessary operations and adjustments, save time and resources, and optimize execution efficiency.
[0043] S35. Compare the deviation of the probe position with the preset allowable deviation. For example, the allowable deviation can be preset to 0.2. If the deviation of the probe position is less than the allowable deviation, the actuator is controlled to stop probing, indicating that the probe position determined based on the positioning system meets the target execution position at this time. Otherwise, correction is performed based on a one-way comparison of the coordinate values of the probe position along the x-axis and along the y-axis with the planned coordinate values of the target execution position along the x-axis and along the y-axis to obtain the correction direction and correction amount, and after the correction, the probe position deviation calculation is continued until the correction is stopped when the calculation result is less than the allowable deviation.
[0044] It should be noted that the correction amount mentioned above is a theoretical correction amount, which is calculated based on the coordinate value. For example, when the coordinate value of the probe position along the x-axis is inconsistent with the planned coordinate value of the target execution position along the x-axis, the coordinate value of the probe position along the x-axis is subtracted from the planned coordinate value of the target execution position along the x-axis. The positive and negative sign of the difference result is the correction direction, and the specific value of the difference result is the correction amount. In the actual correction process, the actual correction amount will be greater than the theoretical correction amount due to the accumulated error of the system operation.
[0045] The preset allowable deviation mentioned above is an initial preset, and the preset purpose is to assist the actuator in determining whether to stop probing.
[0046] S4: When the control actuator stops probing, a high-definition camera is used to scan the stop probing position to obtain images of the anchor hole walls around the stop probing position.
[0047] S5 identifies features and marks the coordinates of the feature positions from the images of the anchor hole walls around the stop probe position, thereby comparing the coordinates of the stop probe position with the position coordinates of the feature, obtaining the distance between the stop probe position and the feature, and comparing it with the planned feature distance in the anchor drilling image corresponding to the target execution position retrieved from the positioning reference library, wherein the planned feature distance refers to the distance between the target execution position and the corresponding feature in the anchor drilling image corresponding to the target execution position, and identifies whether the stop probe position is the target execution position. If it is identified as the target execution position, execute S6, otherwise perform positioning anomaly analysis.
[0048] In the specific implementation of the above scheme, the following process is performed to identify feature objects from the images of the anchor hole walls around the stopping position: feature detection is performed from the images of the anchor hole walls around the stopping position, and the locations of the feature areas are marked, and the appearance structure and boundary contours corresponding to each feature area are extracted, wherein the contour area of the feature object corresponding to each feature area can be obtained based on the boundary contours corresponding to each feature area.
[0049] In the innovative implementation of the above scheme, the images of the surrounding anchor hole walls need to be preprocessed before feature detection, including denoising, image enhancement and edge detection, so as to improve the accuracy of feature detection and extraction.
[0050] Furthermore, feature detection specifically uses feature detection algorithms (such as Harris corner detection) to detect possible feature points in the image. Since there are generally rocks, holes, etc. on the walls of the surrounding anchor holes, the feature objects corresponding to these features may be rock blocks, holes, corner points, etc. on the wall.
[0051] The feature objects corresponding to each feature area are determined based on the appearance structures corresponding to each feature area.
[0052] In the above description, since different features have different appearance structures, descriptors (such as SIFT descriptor, SURF descriptor, ORB descriptor, etc.) can be used to describe the appearance structure of the feature area, thereby obtaining the corresponding feature object.
[0053] In a further implementation of the above scheme, the identification of whether the stop probe position is the target execution position is specifically implemented as follows: the feature objects identified in the anchor hole wall images around the stop probe position are mapped and matched with the feature objects in the anchor drilling image corresponding to the target execution position, and the distance between the stop probe position and the feature object is compared with the corresponding planned feature distance according to the matching result, and the feature conformity of the probe position is calculated. , the calculation expression is , where Indicates the stop position and the The distance between features, The number of the feature, , Indicates the target execution location and The distance between features, Indicates The outline area of the feature.
[0054] It should be understood that in the above-mentioned calculation of the compliance of the probe position feature, the contour area of the feature is used as the weight of the feature, so as to reflect that the larger the contour area of the feature, the greater its proportion in the calculation of the compliance of the probe position feature. The purpose of doing so is that the contour area of the feature is usually related to its importance in the image. A larger contour area usually means that the feature is more significant and is more likely to affect the compliance of the probe position feature. Therefore, using the contour area as a weight can ensure that more important features are given when calculating the compliance of the feature. In addition, considering the contour area of the feature as a weight can enhance the influence on larger features, thereby improving the accuracy of the calculation of the compliance of the probe position feature. Larger features are more likely to occupy a larger proportion in the features of the probe position, so giving a larger weight can better reflect its contribution to the overall compliance. Finally, considering the contour area of the feature as a weight can enhance the robustness of the algorithm. Even in the presence of multiple features, features with larger contour areas can still more significantly affect the calculation of the compliance of the probe position feature, making the algorithm more robust for feature extraction and matching in complex scenes.
[0055] The probe position feature conformity is compared with the standard conformity. If the probe position feature conformity is greater than or equal to the standard conformity, the stop probe position is identified as the target execution position. Otherwise, the stop probe position is not identified as the target execution position.
[0056] The compliance degree mentioned above is an initial setting. For example, the compliance degree is 0.85. The purpose of setting is to assist in the identification and judgment of whether the stop probe position is the target execution position.
[0057] It should be added that when the identification stop probe position is not the target execution position, it indicates that there is a positioning anomaly. When performing positioning anomaly analysis, the operating indicators of the high-definition camera when collecting images of the surrounding anchor hole walls are first retrieved, and compared with the normal operating indicators of the high-definition camera to identify whether there is an anomaly. If there is an anomaly, maintenance is performed. If there is no anomaly, the images of the surrounding anchor hole walls of the stop probe position are collected again, and feature object recognition, mapping matching and feature conformity calculation are performed again after collection.
[0058] S6 uses the attitude sensor to obtain the angle and center axis of the end effector on the actuator relative to the plane where the anchor hole is located, where the angle of the plane where the anchor hole is located is the xoy plane, and the end effector is the workpiece to be positioned, thereby controlling the end effector to adjust the attitude. The specific adjustment process is: compare the angle of the end effector relative to the plane where the anchor hole is located with the required execution angle range. Generally speaking, the end effector needs to be parallel to the plane where the anchor hole is located, that is, the required execution angle range can be If the angle of the end effector relative to the plane where the anchor hole is located is greater than the upper limit of the required execution angle range, the angle of the end effector relative to the plane where the anchor hole is located is compared with the upper limit of the required execution angle range to obtain the adjustment angle, so as to control the rotation of the end effector so that its angle relative to the plane where the anchor hole is located falls within the required execution angle range.
[0059] After the angle adjustment, the spacing distance between the center axis of the end effector and the z-axis direction line is obtained and compared with the permitted spacing distance. If it is greater than the permitted spacing distance, the difference between the spacing distance and the permitted spacing distance is calculated to obtain the adjusted spacing distance, thereby controlling the end effector to move along the plane where the anchor hole is located so that the spacing distance is less than or equal to the permitted spacing distance.
[0060] In the above description, since the z-axis direction line is the center line of the anchor hole, when the angle is adjusted, the end effector is parallel to the plane where the anchor hole is located. At this time, the central axis of the end effector is parallel to the z-axis direction line. It is only necessary to keep the central axis of the end effector and the center line of the anchor hole overlapping, specifically to reduce the spacing distance between them to meet the allowable spacing distance, wherein the allowable spacing distance can be 0.5cm.
[0061] It should be noted that the adjustment angle and adjustment interval distance mentioned above are based on calculated theoretical values. During actual adjustment, there may be system errors causing the actual values to be greater than the theoretical values.
[0062] After the centering positioning is completed, S7 evaluates the positioning accuracy based on the actuator's penetration control and the adjustment of the end effector. The specific evaluation process is: count the actuator's penetration control frequency, obtain the correction amount corresponding to each penetration control, and extract the maximum correction amount from it.
[0063] The frequency of posture adjustment of the end effector is counted, and the adjustment angle and adjustment interval distance corresponding to each posture adjustment are obtained, and the maximum adjustment angle and maximum adjustment interval distance are extracted from them.
[0064] Using evaluative Get positioning accuracy , where Indicates the maximum deviation correction amount. Indicates the frequency of actuator penetration control. represents the reference correction amount, exemplarily, The reference deviation correction amount is set to assist in the calculation of positioning accuracy. , Respectively represent the maximum adjustment angle and the maximum adjustment interval distance. Indicates the frequency of posture adjustment. Indicates the permitted separation distance, , They represent the weight proportions of penetration control and posture adjustment respectively, and , illustratively, , ,It can be seen from the formula that the more the actuator probes into the control frequency, the more the end effector posture is adjusted, the greater the correction amount, the larger the adjustment angle, the larger the adjustment interval distance, the greater the degree of positioning deviation that the system tries to correct, and the lower the positioning accuracy.
[0065] It is particularly important to note that the purpose of selecting the maximum correction amount, maximum adjustment angle, and maximum adjustment interval distance in the above positioning accuracy analysis process is to take into account that the anchor hole automatic centering positioning system has strict maximum allowable deviation requirements for positioning accuracy. The maximum value can help understand the performance of the system under the worst case scenario and provide a conservative estimate to ensure that the system can meet the requirements under any circumstances.
[0066] Furthermore, after obtaining the positioning accuracy, it can be judged whether the operation of the entire anchor hole automatic centering positioning system meets the standards, and problems in the system can be discovered and solved in a timely manner, reducing the cost of subsequent maintenance and replacement.
[0067] (8) Based on the deviation correction amount corresponding to each probe control and the adjustment angle and adjustment interval distance corresponding to each posture adjustment, analyze whether there is a control abnormality in the actuator. The specific analysis process is to compare the deviation correction amount corresponding to each probe control with the theoretical deviation correction amount, and compare the adjustment angle and adjustment interval distance corresponding to each posture adjustment with the corresponding theoretical values. The deviation correction amount, adjustment angle and adjustment interval distance mentioned here are actual operation values. The control error amount is calculated and compared with the allowable control error amount, where the allowable control error amount is obtained from the operating instructions of the actuator. If the control error amount is greater than the allowable error amount, it is analyzed that there is a control abnormality in the actuator.
[0068] The calculation of the control error in the above is: , where Indicates The correction amount corresponding to the first penetration control, Indicates The theoretical deviation correction amount corresponding to the secondary penetration control is: Indicates the probe control sub-number. , , Respectively represent The corresponding adjustment angle and interval distance of the posture adjustment are: , Respectively represent The theoretical adjustment angle and theoretical adjustment interval distance corresponding to the posture adjustment are: Indicates the posture adjustment number. .
[0069] The present invention can be used to evaluate the performance of the actuator by identifying whether there is a control anomaly in the actuator based on the control error of the actuator. If there is a control anomaly, it may affect the working efficiency and accuracy of the actuator, which is convenient for timely resolution. This can optimize the performance of the actuator, improve the working efficiency and accuracy of subsequent positioning operations, and minimize the impact of the excessive control error of the actuator itself on the positioning result.
[0070] Example 2
[0071] Reference Figure 2 As shown, the present invention proposes an automatic centering and positioning system for anchor holes in concrete engineering foundations, comprising the following modules: a positioning associated equipment setting module, which is used to set a positioning device, a high-definition camera and a posture sensor on an actuator.
[0072] The coordinate positioning module is connected to the positioning associated device setting module and is used to establish a three-dimensional coordinate system based on the anchor hole position, and thereby use the positioning device to locate the insertion position in real time during the process of the actuator probing along the anchor hole to obtain the insertion position coordinates.
[0073] The probe correction control module is connected to the coordinate positioning module and is used to compare the probe position coordinates obtained by real-time positioning with the planned coordinates of the target execution position, thereby controlling the probe operation of the actuator.
[0074] The feature positioning module is connected to the probe correction control module and the positioning associated equipment setting module respectively, and is used to use a high-definition camera to scan the stop probe position when the control actuator stops probing, obtain the image of the anchor hole wall around the current probe position, and identify the feature object therefrom, and then obtain the distance between the stop probe position and the feature object according to the position of the feature object, thereby identifying whether the stop probe position is the target execution position.
[0075] The execution posture adjustment module is connected to the feature positioning module and the positioning associated equipment setting module respectively. When the stop probe position is identified as the target execution position, the posture sensor is used to obtain the angle and the direction of the central axis of the end effector on the actuator relative to the plane where the anchor hole is located, thereby controlling the end effector to perform posture centering adjustment.
[0076] The positioning evaluation module is connected to the probe correction control module and the execution posture adjustment module respectively, and is used to evaluate the positioning accuracy based on the probe control of the actuator and the adjustment of the end actuator after the centering positioning is completed.
[0077] The positioning reference library is connected to the probe correction control module and the feature positioning module respectively, and is used to store the planned coordinates of the target execution position and the anchor drilling image corresponding to the target execution position.
[0078] The above contents are merely examples and explanations of the structure of the present invention. The technicians in this technical field may make various modifications or additions to the specific embodiments described or replace them in a similar manner. As long as they do not deviate from the structure of the invention or exceed the scope defined by the present invention, they should all fall within the protection scope of the present invention.
Claims
1. A method for automatically centering and positioning anchor holes in concrete engineering foundations, characterized in that: The following steps are involved: S1 sets the positioning device, high-definition camera and attitude sensor on the actuator, and establishes a three-dimensional coordinate system based on the anchor hole position; S2 performs exploration path planning before the actuator is inserted, thereby using the positioning device to locate the insertion position in real time during the process of the actuator inserting along the anchor hole according to the planned exploration path; S3 compares the probe position coordinates obtained by real-time positioning with the planned coordinates of the target execution position, thereby controlling the probe operation of the actuator; S4: When the control actuator stops probing, a high-definition camera is used to scan the stop probing position to obtain images of the anchor hole walls around the stop probing position; S5: identifying features and marking the coordinates of the feature positions from the anchor hole wall images around the stop probe position, thereby comparing the coordinates of the stop probe position with the position coordinates of the feature, obtaining the distance between the stop probe position and the feature, and comparing it with the planned feature distance in the anchor drilling image corresponding to the target execution position retrieved from the positioning reference library, identifying whether the stop probe position is the target execution position, if it is identified as the target execution position, executing S6, otherwise performing positioning abnormality analysis; S6 uses the attitude sensor to obtain the angle and center axis of the end effector on the actuator relative to the plane where the anchor hole is located, thereby controlling the end effector to adjust the attitude centering; After the centering is completed, S7 evaluates the positioning accuracy based on the actuator's penetration control and the adjustment of the end effector; The implementation of establishing the three-dimensional coordinate system is as follows: The center point of the anchor hole is taken as the origin, a reference direction is selected on the plane where the anchor hole is located as the x-axis, and the direction perpendicular to the x-axis is taken on the plane where the anchor hole is located as the y-axis, and the direction in which the actuator penetrates into the anchor hole is taken as the z-axis, thereby establishing a three-dimensional coordinate system; The control of the penetration operation of the actuator is described in the following process: S31, compare the coordinate value of the probe position along the z-axis obtained by real-time positioning with the planned coordinate value of the target execution position along the z-axis, and calculate the proximity of the probe depth. The calculation expression is: , where Indicates the coordinate value of the probe position along the z-axis obtained in real time, Indicates the planned coordinate value of the target execution position along the z-axis; S32, comparing the penetration depth proximity with the initially set proximity threshold, if the penetration depth proximity is less than the proximity threshold, executing S33, otherwise executing S34-S35; S33, controlling the actuator to continue to go deeper, and continuing to calculate the penetration depth proximity of the coordinate value along the z-axis obtained after going deeper, until the calculated penetration depth proximity is greater than or equal to the proximity threshold, and executing S34-S35; S34, compare the coordinate values of the probe position along the x-axis and along the y-axis with the planned coordinate values of the target execution position along the x-axis and along the y-axis, and calculate Calculate the penetration position deviation , where , They represent the planned coordinate values of the target execution position along the x-axis and along the y-axis in the three-dimensional coordinate system, respectively. , They respectively represent the coordinate values of the probe position along the x-axis and along the y-axis in the three-dimensional coordinate system. represents the reference offset distance, represents a natural constant; S35. Compare the deviation of the probe position with the preset allowable deviation. If the deviation of the probe position is less than the allowable deviation, the actuator is controlled to stop probing. Otherwise, correction is performed based on a one-way comparison between the coordinate values of the probe position along the x-axis and the y-axis and the planned coordinate values of the target execution position along the x-axis and the y-axis, and the probe position deviation calculation is continued after the correction, until the correction is stopped when the calculation result is less than the allowable deviation.
2. The method for automatically centering and positioning a concrete engineering foundation anchor hole according to claim 1, characterized in that: The specific implementation of the exploration path planning before the actuator is inserted is as follows: A linear displacement sensor is installed on the actuator. After the three-dimensional coordinate system is established, the linear displacement sensor is emitted in the z-axis direction to form a probe path, and then the actuator probes according to the probe path.
3. The method for automatically centering and positioning a foundation anchor hole in a concrete engineering project according to claim 1, characterized in that: The process of identifying features from the images of the anchor hole walls around the stop probe position is as follows: Perform feature detection from the surrounding anchor hole wall images, mark the location of the feature area, and extract the appearance structure and boundary contour corresponding to each feature area; The feature objects corresponding to each feature area are determined based on the appearance structures corresponding to each feature area.
4. The method for automatically centering and locating a foundation anchor hole in a concrete engineering project according to claim 1, characterized in that: The identification of whether the stop probe position is the target execution position is specifically implemented as follows: The features identified in the anchor hole wall images around the stop penetration position are mapped and matched with the features in the anchor drilling images corresponding to the target execution position. Based on the matching results, the distance between the stop penetration position and the features is compared with the corresponding planned feature distance to calculate the penetration position feature conformity. , the calculation expression is , where Indicates the stop position and the The distance between features, The number of the feature, , Indicates the target execution location and The distance between features, Indicates The outline area of the feature; The probe position feature conformity is compared with the standard conformity. If the probe position feature conformity is greater than or equal to the standard conformity, the stop probe position is identified as the target execution position. Otherwise, the stop probe position is not identified as the target execution position.
5. The method for automatically centering and positioning a concrete engineering foundation anchor hole according to claim 1, characterized in that: The control of the end effector to perform posture centering adjustment refers to the following process: The angle of the end effector relative to the plane where the anchor hole is located is compared with the required execution angle range. If the angle of the end effector relative to the plane where the anchor hole is located is greater than the upper limit of the required execution angle range, the end effector is controlled to rotate so that its angle relative to the plane where the anchor hole is located falls within the required execution angle range. After the angle adjustment, the spacing distance between the center axis of the end effector and the z-axis direction line is obtained and compared with the allowed spacing distance. If it is greater than the allowed spacing distance, the end effector is controlled to move along the plane where the anchor hole is located so that the spacing distance is less than or equal to the allowed spacing distance.
6. The method for automatically centering and positioning a foundation anchor hole in a concrete engineering project according to claim 1, characterized in that: The positioning accuracy evaluation refers to the following process: Count the frequency of the actuator's penetration control, obtain the deviation correction amount corresponding to each penetration control, and extract the maximum deviation correction amount; Count the frequency of posture adjustment of the end effector, and obtain the adjustment angle and adjustment interval distance corresponding to each posture adjustment, and extract the maximum adjustment angle and maximum adjustment interval distance; Using evaluative Get positioning accuracy , where Indicates the maximum deviation correction amount. Indicates the frequency of actuator penetration control. Indicates the reference correction amount. , Respectively represent the maximum adjustment angle and the maximum adjustment interval distance. Indicates the frequency of posture adjustment. Indicates the permitted separation distance, , They represent the weight proportions of penetration control and posture adjustment respectively, and .
7. A method for automatically centering and positioning a foundation anchor hole in a concrete engineering project as claimed in claim 6, characterized in that: It also includes analyzing whether there is a control abnormality in the actuator based on the correction amount corresponding to each probe control and the adjustment angle and adjustment interval distance corresponding to each posture adjustment. The specific analysis process is to compare the correction amount corresponding to each probe control with the theoretical correction amount, and compare the adjustment angle and adjustment interval distance corresponding to each posture adjustment with the corresponding theoretical values, thereby calculating the control error amount and comparing it with the allowable control error amount. If the control error amount is greater than the allowable error amount, it is analyzed that there is a control abnormality in the actuator.
8. An automatic centering and positioning system for anchor holes in concrete engineering foundations, characterized in that: Includes the following modules: Positioning-related equipment setting module, used to set positioning equipment, high-definition camera and attitude sensor on the actuator; A coordinate positioning module is used to establish a three-dimensional coordinate system based on the anchor hole position, and thereby use a positioning device to locate the insertion position in real time during the insertion of the actuator along the anchor hole to obtain the insertion position coordinates; The implementation of establishing the three-dimensional coordinate system is as follows: The center point of the anchor hole is taken as the origin, a reference direction is selected on the plane where the anchor hole is located as the x-axis, and the direction perpendicular to the x-axis is taken on the plane where the anchor hole is located as the y-axis, and the direction in which the actuator penetrates into the anchor hole is taken as the z-axis, thereby establishing a three-dimensional coordinate system; The probe correction control module is used to compare the probe position coordinates obtained by real-time positioning with the planned coordinates of the target execution position, thereby controlling the probe operation of the actuator; The control of the penetration operation of the actuator is described in the following process: S31, compare the coordinate value of the probe position along the z-axis obtained by real-time positioning with the planned coordinate value of the target execution position along the z-axis, and calculate the proximity of the probe depth. The calculation expression is: , where Indicates the coordinate value of the probe position along the z-axis obtained in real time, Indicates the planned coordinate value of the target execution position along the z-axis; S32, comparing the penetration depth proximity with the initially set proximity threshold, if the penetration depth proximity is less than the proximity threshold, executing S33, otherwise executing S34-S35; S33, controlling the actuator to continue to go deeper, and continuing to calculate the penetration depth proximity of the coordinate value along the z-axis obtained after going deeper, until the calculated penetration depth proximity is greater than or equal to the proximity threshold, and executing S34-S35; S34, compare the coordinate values of the probe position along the x-axis and along the y-axis with the planned coordinate values of the target execution position along the x-axis and along the y-axis, and calculate Calculate the penetration position deviation , where , They represent the planned coordinate values of the target execution position along the x-axis and along the y-axis in the three-dimensional coordinate system, respectively. , They respectively represent the coordinate values of the probe position along the x-axis and along the y-axis in the three-dimensional coordinate system. represents the reference offset distance, represents a natural constant; S35, comparing the probe position deviation with the preset allowable deviation, if the probe position deviation is less than the allowable deviation, the actuator is controlled to stop probing, otherwise, correction is performed based on a one-way comparison of the coordinate values of the probe position along the x-axis and along the y-axis with the planned coordinate values of the target execution position along the x-axis and along the y-axis, and the probe position deviation calculation is continued after the correction, until the correction is stopped when the calculation result is less than the allowable deviation; The feature positioning module is used to use a high-definition camera to scan the stop probe position when the control actuator stops probing, obtain the images of the anchor hole walls around the current probing position, and identify the feature objects therefrom, and then obtain the distance between the stop probe position and the feature objects according to the position of the feature objects, thereby identifying whether the stop probe position is the target execution position; An execution attitude adjustment module is used to use an attitude sensor to obtain the angle of the end effector on the actuator relative to the plane where the anchor hole is located and the direction of the central axis when the stop probe position is identified as the target execution position, thereby controlling the end effector to perform attitude centering adjustment; A positioning evaluation module is used to evaluate the positioning accuracy based on the penetration control of the actuator and the adjustment of the end effector after the centering positioning is completed; The positioning reference library is used to store the planned coordinates of the target execution position and the anchor drilling images corresponding to the target execution position.
