Disclosure of Invention
This section is intended to outline some aspects of embodiments of the application and to briefly introduce some preferred embodiments. Some simplifications or omissions may be made in this section as well as in the description of the application and in the title of the application, which may not be used to limit the scope of the application.
In order to solve the technical problems, the invention provides the following technical scheme that the outdoor visual positioning system of the intelligent defect eliminating robot for the power transmission line mainly comprises the following components:
the environment sensing module is used for collecting surrounding environment data through the sensor;
the illumination compensation module dynamically adjusts the parameters of the camera according to the illumination data provided by the environment sensing module;
The visual inertial fusion module is used for fusing the data of the visual sensor and the inertial sensor and compensating the instability of the visual data of the robot in the moving or vibrating process by adopting a visual inertial odometer technology;
The vibration compensation module is used for analyzing the vibration frequency and amplitude of the power transmission line monitored by the environment sensing module and correcting visual positioning deviation caused by line vibration;
the self-adaptive visual algorithm module can dynamically adjust the parameter setting of the visual system according to the environmental change;
The multi-sensor fusion module adopts a multi-sensor fusion algorithm to fuse sensor data;
And the path planning and navigation module is used for carrying out accurate path planning by analyzing the position information and the surrounding environment information of the current robot on the power transmission line according to the data of the multiple sensors.
The intelligent defect eliminating robot outdoor visual positioning system for the power transmission line is characterized in that the sensor comprises an illumination sensor, a wind speed sensor, a temperature and humidity sensor and a vibration sensor, wherein the illumination sensor is used for monitoring illumination intensity and change in real time, the wind speed sensor is used for collecting wind speed information of the environment where the power transmission line is located, the temperature and humidity sensor is used for collecting temperature and humidity information of the environment where the power transmission line is located, and the vibration sensor is used for detecting vibration frequency and amplitude of the power transmission line and judging line change caused by wind power or mechanical movement.
As a preferable scheme of the intelligent defect eliminating robot outdoor visual positioning system for the power transmission line, the parameters of the camera comprise exposure, gain and contrast.
As a preferable scheme of the intelligent defect eliminating robot outdoor visual positioning system for the power transmission line, the intelligent defect eliminating robot outdoor visual positioning system for the power transmission line further comprises a feedback control module, a remote monitoring module and a fault detection module;
the feedback control module adjusts the motion parameters of the robot in real time according to the feedback data of each module;
the remote monitoring module can check the running state and positioning information of the robot on the power transmission line in real time through a remote monitoring system, and is matched with an AR technology to help ground operators to remotely adjust the robot;
the fault detection module is used for detecting faults and timely reporting sensor abnormality or data failure.
As a preferable scheme of the intelligent defect eliminating robot outdoor visual positioning system for the power transmission line, the invention comprises the following steps of:
S11, setting a threshold value of illumination change by the system, and triggering a dynamic adjustment flow when the illumination intensity change exceeds the set threshold value;
s12, classifying current illumination conditions according to the monitored illumination data, evaluating the type and the amplitude of illumination change through a preset algorithm, and judging whether parameter adjustment is needed;
s13, calculating a required compensation amount according to the deviation between the current illumination data and the normal working illumination range, and then converting the compensation amount into adjustment values of exposure time, gain and contrast according to a mapping formula;
S14, calling a control interface of the camera, and adjusting exposure time, gain and contrast according to the calculated compensation value;
S15, the camera feeds back the adjusted image data to the system, and the vision system checks the brightness, definition and noise level of the picture through an image analysis algorithm to judge whether the adjustment effect reaches the expected value;
s16, when the illumination condition is stable, the system locks the current parameter setting, unnecessary adjustment is avoided, and the vision system is ensured to continuously provide high-quality images in the illumination stable stage.
As a preferable scheme of the intelligent defect eliminating robot outdoor visual positioning system for the power transmission line, the formula for calculating the required compensation quantity is as follows:
,
wherein:
is shown at the moment Is used for the illumination compensation amount of the lens;
Representing an initial time;
Representing time;
setting the ideal image brightness expected by the camera as the standard brightness required by the system;
indicating the current time The brightness of the actual image captured by the lower camera;
Indicating the moment of time The ambient illumination intensity of (2) is acquired in real time through an illumination sensor;
indicating the current time Is measured by an ambient noise detector;
indicating the current time Gain of the camera, parameters that the system can dynamically adjust;
indicating the current time The exposure time of the camera, the parameter that the system can adjust dynamically;
indicating the current time The contrast of the camera image is a measure of the difference of the brightness of the image;
Is an exponential decay function, is used for controlling the influence of gain and contrast adjustment at the past moment on the current compensation quantity, The degree of influence of the past adjustment on the current is determined for the attenuation coefficient to be positive, the larger the value is, the smaller the influence of the past adjustment is,A small scale for representing a summation term for discrete adjustment calculations in the time dimension;
The square of the difference between ideal brightness and actual brightness is represented, the square is amplified, and the system can also react to small deviation of brightness;
representing the superposition effect of the ambient illumination intensity and noise, the illumination intensity And noiseTwo key factors influencing the image quality, the larger the two sums, the stronger the environmental influence is, and the less compensation is required for brightness difference;
Representing an exponential function And gainAnd contrast ratioReflecting their common effect in the time dimension, the exponential decay controls the effect of the past time on the current compensation,AndThe adjustment strength of the gain and the contrast to the image is determined;
Indicating exposure time And the intensity of ambient lightEnsuring a balance between exposure time and illumination conditions in the compensation calculation, avoiding excessive adjustment;
Representing cumulative adjustment in the time dimension by an exponential decay function To ensure that the past gain and contrast have progressively less impact on the current, the summation expressing the time accumulation effect in camera parameter adjustment, ensuring that the system is able to respond dynamically to the environment over time;
From the initial time To the current timeThe accumulated compensation quantity of the brightness difference along with time is calculated through integration, so that the system can track illumination change and perform dynamic adjustment;
Value range meaning:
Value range of formula At the position ofAn inner part;
when (when) When the image quality is close to 0, the illumination condition is ideal, the image quality is close to the expected value, and great adjustment is not needed;
when (when) When the value increases, indicating that the light conditions deviate from expected, the system needs to increase the exposure or gain, or make contrast adjustments.
As a preferable scheme of the intelligent defect eliminating robot outdoor visual positioning system for the power transmission line, the invention comprises the following steps of:
step 21, initializing a visual sensor and an inertial sensor, ensuring the data time stamps of the visual sensor and the inertial sensor to be synchronous, then acquiring visual frame sequence data through the visual sensor, and acquiring acceleration and angular velocity through the inertial sensor;
Step 22, detecting and extracting characteristic points in the current image frame, tracking the matching relation of the characteristic points between adjacent frames, and recording the displacement information of the characteristic points;
Step 23, integrating the acquired acceleration and angular velocity data, and calculating the position and posture change quantity of the robot at each moment;
step 24, fusing the inertial data and the visual data through a Kalman filter or an extended Kalman filter, filtering noise and errors, and updating the current position information of the robot according to the fused result;
Step 25, performing visual inertial odometer calculation on each continuous frame, calculating pose changes of the robot at continuous moments according to image data provided by a visual sensor and motion data of the inertial sensor, and accumulating pose results of each frame with results of previous frames to obtain a complete moving track of the robot;
Step 26, analyzing high-frequency vibration information in the inertial sensor, identifying the motion characteristic of the robot at the vibration moment, dynamically correcting the visual positioning data according to the vibration characteristic, and smoothing noise caused by high-frequency vibration;
step 27, updating the position information of the robot on the power transmission line in real time according to the corrected vision and inertia data, and feeding back the current position information to a path planning and navigation module so as to carry out the next movement decision;
and 28, monitoring the positioning accuracy in real time, feeding back to the control system, and adjusting the compensation algorithm and the sensor parameters according to the environmental change.
As a preferable scheme of the intelligent defect eliminating robot outdoor visual positioning system for the power transmission line, the invention comprises the following steps of:
Step 31, monitoring vibration frequency and vibration amplitude of the power transmission line in real time by a sensor, and analyzing the vibration frequency and the vibration amplitude in each time period to determine the vibration characteristics of the line;
step 32, acquiring inertial data of the robot, ensuring time synchronization with vibration data, synchronizing the inertial data with vibration sensor data, and facilitating subsequent fusion calculation;
Step 33, performing spectrum analysis on the vibration data, determining high-frequency vibration components, and identifying main vibration components affecting visual positioning accuracy according to analysis results;
step 34, extracting and tracking characteristic points in the image, detecting the offset of the characteristic points between adjacent frames, comparing the data of the visual sensor and the inertial sensor, and calculating a visual positioning error;
Step 35, establishing a vibration compensation model based on frequency and amplitude, calculating compensation quantity, correcting sensor data and filtering high-frequency interference;
And 36, adjusting the positions of the visual characteristic points in real time according to the vibration compensation model, correcting visual data deviation, updating corrected position information and ensuring the visual positioning stability of the robot.
The invention relates to an optimal scheme of an intelligent defect eliminating robot outdoor visual positioning system for a power transmission line, wherein the method for establishing a vibration compensation model based on frequency and amplitude and calculating compensation quantity comprises the following steps:
step 351, preprocessing data acquired by a vibration sensor arranged on a power transmission line by using a filtering algorithm, and extracting key information of frequency and amplitude from the filtered data;
Step 352, performing Fourier transform on the acquired vibration data to obtain a spectrogram of vibration frequency, classifying high-frequency and low-frequency vibration components according to the spectrogram, and analyzing the change of amplitude;
step 353 defining a vibration compensation function Constructing a compensation model;
Vibration compensation function:
wherein:
And Representing the amplitudes of the high-frequency and low-frequency vibrations, respectively;
And The frequencies of the high-frequency and low-frequency vibrations, respectively;
And Is an influence coefficient for adjusting the influence of high-frequency and low-frequency vibration on the compensation amount;
And Is an adjustment parameter, controlling the response of the compensation function to frequency;
step 354, the acquired frequency and amplitude data is brought into a compensation function Calculating real-time compensation quantity, and adjusting characteristic points acquired by the visual sensor by using the compensation quantity to reduce positioning errors;
and 355, applying the calculated compensation quantity to the vision positioning system in real time, correcting the position of the characteristic point, and automatically adjusting the compensation model parameters by the feedback system according to the correction result to ensure that the vision positioning system is suitable for different vibration conditions.
The positioning method using the intelligent defect eliminating robot outdoor visual positioning system of the power transmission line comprises the following steps:
Collecting environmental data around the power transmission line by various sensors in the environmental perception module, wherein the environmental data comprise illumination intensity, wind speed, temperature and humidity and line vibration data;
Starting a visual sensor, acquiring a visual image sequence, and synchronously starting an inertial sensor to ensure that the time stamps of visual data and inertial data are synchronous;
Triggering an illumination compensation module according to illumination data acquired by the environment sensing module, and dynamically adjusting camera parameters to adapt to current illumination conditions so as to ensure stable image quality;
extracting visual characteristic points from a current image frame, tracking the displacement of the characteristic points in adjacent frames, and recording the displacement information of the characteristic points to perform preliminary visual positioning;
integrating acceleration and angular velocity data of the inertial sensor, calculating pose variation of the robot at each moment, and estimating displacement and angle variation of the robot;
The visual inertial fusion module is used for fusing visual data with inertial sensor data, and a Kalman filter or an extended Kalman filter is used for carrying out data filtering, so that noise and errors are eliminated, and the position information of the robot is updated in real time;
Monitoring the vibration frequency and amplitude of the power transmission line through a vibration sensor, performing spectrum analysis on vibration data, and extracting high-frequency vibration components affecting visual positioning;
Calculating vibration compensation quantity according to a frequency and amplitude-based compensation model constructed by the vibration compensation module, correcting visual positioning deviation caused by line vibration, and correcting the position of a characteristic point in visual data;
the multi-sensor fusion module is used for fusing the environment data, the visual data, the inertia data and the vibration compensation data to acquire more accurate robot position information;
According to the fused positioning data, combining with the geographical position information of the power transmission line, planning a moving path of the robot on the power transmission line through a path planning and navigation module, so as to ensure that the robot can stably and accurately travel;
the positioning accuracy of the robot is monitored in real time through a feedback control module, the motion parameters of the robot are adjusted if necessary, and the compensation algorithm and the sensor parameters are dynamically adjusted according to the environmental change;
The ground operator can check the positioning information and the running state of the robot in real time through the remote monitoring module to carry out remote adjustment, and meanwhile, the fault detection module is used for monitoring system abnormality and alarming in time.
The invention has the beneficial effects that:
1. According to the invention, through comprehensive use of the environment sensing module, the illumination compensation module, the visual inertia fusion module and the vibration compensation module, the system can effectively process the illumination change, the instability of visual data and the interference caused by line vibration, in addition, the camera parameters are dynamically adjusted through the illumination compensation module so as to adapt to different illumination conditions, and the visual inertia fusion module and the vibration compensation module can reduce positioning errors caused by vibration and movement, so that the positioning accuracy and stability of the robot in a complex environment are ensured by the measures, and the accuracy and efficiency of the defect elimination task are improved.
2. The self-adaptive vision algorithm module in the system can automatically adjust the parameter settings of the vision system, such as exposure time, contrast and the like, according to the change of the external environment so as to adapt to different vision environments and ensure the validity and accuracy of vision information. The self-adaptive capacity greatly enhances the adaptability of the robot to complex and changeable outdoor environments. Meanwhile, the multi-sensor fusion module integrates data from different sensors, so that the reliability and redundancy of the data are improved, the system can sense and understand the surrounding environment more comprehensively, and more accurate and rich information support is provided for subsequent path planning and navigation. The path planning and navigation module is based on the multi-source fusion data and combines an intelligent algorithm to realize accurate path planning and navigation, so that the operation of the robot on the power transmission line is more efficient and safer. The characteristics improve the intelligent level of the system together, and provide powerful technical support for intelligent inspection and maintenance of the power transmission line.
Detailed Description
In order that the above-recited objects, features and advantages of the present invention will become more readily apparent, a more particular description of the invention will be rendered by reference to specific embodiments thereof which are illustrated in the appended drawings.
In the following description, numerous specific details are set forth in order to provide a thorough understanding of the present invention, but the present invention may be practiced in other ways other than those described herein, and persons skilled in the art will readily appreciate that the present invention is not limited to the specific embodiments disclosed below.
Further, reference herein to "one embodiment" or "an embodiment" means that a particular feature, structure, or characteristic can be included in at least one implementation of the invention. The appearances of the phrase "in one embodiment" in various places in the specification are not necessarily all referring to the same embodiment, nor are separate or alternative embodiments mutually exclusive of other embodiments.
Further, in describing the embodiments of the present invention in detail, the cross-sectional view of the device structure is not partially enlarged to a general scale for convenience of description, and the schematic is only an example, which should not limit the scope of protection of the present invention. In addition, the three-dimensional dimensions of length, width and depth should be included in actual fabrication.
Referring to fig. 1, for one embodiment of the present invention, an outdoor visual positioning system of an intelligent defect eliminating robot for a power transmission line is provided, which mainly includes:
the environment sensing module is used for collecting surrounding environment data including illumination intensity, wind speed, temperature, humidity, vibration frequency of the power transmission line and the like through the sensor. The module provides environmental information input for parameter adjustment of the vision system and optimization of the overall positioning system.
The sensor comprises:
The illumination sensor is used for monitoring illumination intensity and change in real time;
the wind speed sensor is used for collecting wind speed information of the environment where the power transmission line is located;
The temperature and humidity sensor is used for collecting temperature and humidity information of the environment where the power transmission line is located;
And the vibration sensor is used for detecting the vibration frequency and amplitude of the power transmission line and judging line variation caused by wind power or mechanical motion.
And the illumination compensation module dynamically adjusts camera parameters according to illumination data provided by the environment sensing module, wherein the parameters comprise exposure, gain, contrast and the like, so that the definition and stability of the vision system can be maintained under the condition that illumination is severely changed (such as strong light, shadow and night). The module cooperates with the environment sensing module to adjust the image acquisition quality in real time.
The visual inertial fusion module is used for fusing the data of the visual sensor and the inertial sensor, adopting a visual inertial odometer technology to compensate the instability of the visual data of the robot in the moving or vibrating process, and particularly carrying out position correction through the inertial data under the condition of larger vibration.
And the vibration compensation module is used for analyzing the vibration frequency and amplitude of the power transmission line monitored by the environment sensing module and correcting the visual positioning deviation caused by line vibration. The module can effectively improve the positioning accuracy of the robot in the windy weather or under the condition of mechanical movement of the line.
The adaptive vision algorithm module can dynamically adjust the parameter setting of the vision system according to environmental changes (such as wind speed, temperature, humidity and the like). The module acquires real-time environmental data through the environmental perception module, and adjusts algorithm parameters to enhance the anti-interference capability of the system, so that higher visual positioning accuracy can be maintained in severe weather.
The multi-sensor fusion module adopts a multi-sensor fusion algorithm to fuse sensor data, so that the overall positioning accuracy of the robot is improved, and other sensors can provide effective compensation especially when a single sensor fails or the data is unreliable.
And the path planning and navigation module performs accurate path planning by analyzing the position information and the surrounding environment information of the current robot on the power transmission line according to the data of the multiple sensors. The module ensures that the robot can avoid obstacles and travel according to a planned path on the basis of high-precision positioning.
The system also comprises a feedback control module, a remote monitoring module and a fault detection module;
The feedback control module adjusts the motion parameters of the robot in real time according to the feedback data of each module, including speed, gesture and position control, so as to ensure that the robot can stably and accurately travel and operate in a complex environment;
The remote monitoring module can check the running state and positioning information of the robot on the power transmission line in real time through a remote monitoring system, and the remote monitoring module is matched with an AR technology to help ground operators to remotely adjust the robot;
the fault detection module is used for detecting faults and timely reporting sensor abnormality or data failure.
The modules cooperate with each other, and the outdoor visual positioning precision and stability of the intelligent defect eliminating robot of the power transmission line can be enhanced.
Specifically, dynamically adjusting the camera parameters includes the following steps:
S11, setting a threshold value of illumination change by the system, and triggering a dynamic adjustment flow when the illumination intensity change exceeds the set threshold value;
s12, classifying current illumination conditions, such as strong light, weak light, backlight or shadow environments, according to the monitored illumination data, evaluating the type and the amplitude of illumination change through a preset algorithm, and judging whether parameter adjustment is needed;
s13, calculating a required compensation amount according to the deviation between the current illumination data and the normal working illumination range, and then converting the compensation amount into adjustment values of exposure time, gain and contrast according to a mapping formula;
The mapping formula is as follows:
wherein:
wherein:
For the amount of adjustment of the exposure time, For the weight coefficient of exposure time adjustment, the sensitivity of exposure to illumination compensation is controlled,For a nonlinear mapping function, the illumination compensation quantityMapped to an appropriate exposure time adjustment value,The sensitivity coefficient is adjusted to control the influence of the compensation quantity on exposure adjustment;
For the amount of adjustment of the gain, For the weight coefficient of the gain adjustment,Converting the illumination compensation amount into an adjustment value of the gain as a nonlinear mapping function,The amplitude of gain change is controlled, so that the gain is increased when the light is insufficient, and the gain is reduced when the light is too strong;
as the amount of adjustment of the contrast ratio, For the weight coefficient of the contrast adjustment,As a function, the illumination compensation amount is converted into a contrast adjustment value,Controlling the frequency and amplitude of contrast adjustment to ensure that the contrast fluctuates within a proper range;
Combining all adjustments, the final exposure time, gain and contrast values can be expressed as:
,,
wherein, 、、The initial exposure time, gain and contrast set values of the camera are respectively calculated to obtain adjustment amounts of three parameters through calculation of illumination compensation amounts, so that the adaptability of the camera in different illumination environments is ensured;
Weighting of 、、The setting may be made according to the priority of the actual scene. In general, exposure time is preferentially adjusted in a low-light environment, and adjustment of gain and contrast should be fine-tuned based on exposure adjustment. The adjustment of the weight can be changed in real time according to the environmental conditions, so that the accuracy of the overall compensation is ensured.
S14, calling a control interface of the camera, and adjusting exposure time, gain and contrast according to the calculated compensation value;
S15, the camera feeds back the adjusted image data to the system, and the vision system checks the brightness, definition and noise level of the picture through an image analysis algorithm to judge whether the adjustment effect reaches the expected value;
s16, when the illumination condition is stable, the system locks the current parameter setting, unnecessary adjustment is avoided, and the vision system is ensured to continuously provide high-quality images in the illumination stable stage.
Further, the formula for calculating the required compensation amount is as follows:
wherein:
is shown at the moment Is used for the illumination compensation amount of the lens;
Representing an initial time;
Representing time;
setting the ideal image brightness expected by the camera as the standard brightness required by the system;
indicating the current time The brightness of the actual image captured by the lower camera;
Indicating the moment of time The ambient illumination intensity of (2) is acquired in real time through an illumination sensor;
indicating the current time Is measured by an ambient noise detector;
indicating the current time Gain of the camera, parameters that the system can dynamically adjust;
indicating the current time The exposure time of the camera, the parameter that the system can adjust dynamically;
indicating the current time The contrast of the camera image is a measure of the difference of the brightness of the image;
Is an exponential decay function, is used for controlling the influence of gain and contrast adjustment at the past moment on the current compensation quantity, The degree of influence of the past adjustment on the current is determined for the attenuation coefficient, which is usually a positive value, and the larger the value is, the smaller the influence of the past adjustment is,The subscript used to represent the summation term, typically used for discrete adjustment calculations in the time dimension;
The square of the difference between ideal brightness and actual brightness is represented, the square is amplified, and the system can also react to small deviation of brightness;
representing the superposition effect of the ambient illumination intensity and noise, the illumination intensity And noiseTwo key factors influencing the image quality, the larger the two sums, the stronger the environmental influence is, and the less compensation is required for brightness difference;
Representing an exponential function And gainAnd contrast ratioReflecting their common effect in the time dimension, the exponential decay controls the effect of the past time on the current compensation,AndThe adjustment strength of the gain and the contrast to the image is determined;
Indicating exposure time And the intensity of ambient lightEnsuring a balance between exposure time and illumination conditions in the compensation calculation, avoiding excessive adjustment;
Representing cumulative adjustment in the time dimension by an exponential decay function To ensure that the past gain and contrast have progressively less impact on the current, the summation expressing the time accumulation effect in camera parameter adjustment, ensuring that the system is able to respond dynamically to the environment over time;
From the initial time To the current timeThe accumulated compensation quantity of the brightness difference along with time is calculated through integration, so that the system can track illumination change and perform dynamic adjustment;
Value range meaning:
Value range of formula At the position ofAn inner part;
when (when) When the image quality is close to 0, the illumination condition is ideal, the image quality is close to the expected value, and great adjustment is not needed;
when (when) When the value increases, indicating that the light conditions deviate from expected, the system needs to increase the exposure or gain, or make contrast adjustments.
Specifically, the method for compensating the instability of visual data of the robot in the moving or vibrating process comprises the following steps:
step 21, initializing a visual sensor and an inertial sensor, ensuring the data time stamps of the visual sensor and the inertial sensor to be synchronous, then acquiring visual frame sequence data through the visual sensor, and acquiring acceleration and angular velocity through the inertial sensor;
Step 22, detecting and extracting characteristic points in the current image frame by using image data in a visual sensor and adopting a characteristic extraction algorithm (such as SIFT, ORB and the like), tracking the characteristic point matching relation between adjacent frames, and recording the displacement information of the characteristic points;
step 23, acquiring acceleration and angular velocity data by using an inertial sensor, integrating the acquired acceleration and angular velocity data, and calculating the position and posture change of the robot at each moment;
step 24, fusing the inertial data and the visual data through a Kalman filter or an extended Kalman filter, filtering noise and errors, and updating the current position information of the robot according to the fused result;
Step 25, performing visual inertial odometer calculation on each continuous frame, calculating pose changes of the robot at continuous moments according to image data provided by a visual sensor and motion data of the inertial sensor, and accumulating pose results of each frame with results of previous frames to obtain a complete moving track of the robot;
Step 26, analyzing high-frequency vibration information in the inertial sensor, identifying the motion characteristic of the robot at the vibration moment, dynamically correcting the visual positioning data according to the vibration characteristic, and smoothing noise caused by high-frequency vibration;
step 27, updating the position information of the robot on the power transmission line in real time according to the corrected vision and inertia data, and feeding back the current position information to a path planning and navigation module so as to carry out the next movement decision;
and 28, monitoring the positioning accuracy in real time, feeding back to the control system, and adjusting the compensation algorithm and the sensor parameters according to the environmental change.
Through the steps, the system can effectively fuse vision and inertial data, and the position information of the robot on the power transmission line is accurately calculated by utilizing a Vision Inertial Odometer (VIO) technology, particularly when the robot is subjected to external vibration or movement, the error of the vision data can be compensated in real time, so that the positioning accuracy is maintained.
Specifically, correcting the visual positioning deviation due to line vibration includes the steps of:
Step 31, installing vibration sensors (such as an accelerometer and a gyroscope) on a power transmission line, monitoring the vibration frequency and the vibration amplitude of the power transmission line in real time through the vibration sensors, acquiring real-time data of the line vibration through an environment sensing module, and analyzing the vibration frequency and the vibration amplitude in each time period to determine the characteristics of the line vibration;
step 32, acquiring inertial data of the robot through an inertial measurement unit of the robot, ensuring time synchronization with vibration data, synchronizing the inertial data with vibration sensor data, and facilitating subsequent fusion calculation;
Step 33, carrying out frequency spectrum analysis on the vibration frequency and amplitude of the circuit, determining high-frequency vibration components, and identifying main vibration components affecting the visual positioning accuracy according to analysis results;
Step 34, acquiring real-time visual data from a robot camera, including image frames of environmental feature points, extracting and tracking feature points in the images, detecting the offset of the feature points between adjacent frames, comparing the data of a visual sensor and an inertial sensor, and calculating a visual positioning error;
step 35, establishing a vibration compensation model according to the vibration frequency, amplitude and visual positioning error, calculating compensation quantity, correcting sensor data by using the technology such as Kalman filtering, and filtering high-frequency interference;
And 36, adjusting the positions of the vision characteristic points in real time according to the correction amount output by the vibration compensation model, correcting vision data deviation, updating corrected position information and ensuring the vision positioning stability of the robot.
Through the steps, the system can effectively analyze the vibration characteristics of the power transmission line and correct the visual positioning deviation caused by the vibration characteristics. The vibration compensation module combines the data of multiple sensors, realizes the dynamic correction of instability of visual data through a compensation model and a filtering algorithm, and ensures the accurate positioning of the robot in a complex environment.
Further, a vibration compensation model based on frequency and amplitude is established, and the compensation amount is calculated by the following steps:
step 351, preprocessing data acquired by a vibration sensor arranged on a power transmission line by using a filtering algorithm, and extracting key information of frequency and amplitude from the filtered data;
Step 352, performing Fourier transform on the acquired vibration data to obtain a spectrogram of vibration frequency, classifying high-frequency and low-frequency vibration components according to the spectrogram, and analyzing the change of amplitude;
step 353 defining a vibration compensation function Constructing a compensation model;
Vibration compensation function:
wherein:
And Representing the amplitudes of the high-frequency and low-frequency vibrations, respectively;
And The frequencies of the high-frequency and low-frequency vibrations, respectively;
And Is an influence coefficient for adjusting the influence of high-frequency and low-frequency vibration on the compensation amount;
And Is an adjustment parameter, controlling the response of the compensation function to frequency;
step 354, the acquired frequency and amplitude data is brought into a compensation function Calculating real-time compensation quantity, and adjusting characteristic points acquired by the visual sensor by using the compensation quantity to reduce positioning errors;
and 355, applying the calculated compensation quantity to the vision positioning system in real time, correcting the position of the characteristic point, and automatically adjusting the compensation model parameters by the feedback system according to the correction result to ensure that the vision positioning system is suitable for different vibration conditions.
Through the steps, the vibration compensation model can dynamically calculate and apply the compensation amount according to the frequency and amplitude information. Therefore, visual positioning deviation caused by vibration of the power transmission line can be effectively reduced, and stable positioning and operation of the robot are ensured.
In summary, the system can effectively process the disturbance caused by illumination change, instability of visual data and line vibration through the comprehensive use of the environment sensing module, the illumination compensation module, the visual inertia fusion module and the vibration compensation module, and the camera parameters are dynamically adjusted through the illumination compensation module so as to adapt to different illumination conditions, and the visual inertia fusion module and the vibration compensation module can reduce the positioning error caused by vibration and movement, so that the measures ensure the positioning precision and stability of the robot in a complex environment, and the accuracy and efficiency of the defect elimination task are improved. The self-adaptive vision algorithm module in the system can automatically adjust the parameter settings of the vision system, such as exposure time, contrast and the like, according to the change of the external environment so as to adapt to different vision environments and ensure the validity and accuracy of vision information. The self-adaptive capacity greatly enhances the adaptability of the robot to complex and changeable outdoor environments. Meanwhile, the multi-sensor fusion module integrates data from different sensors, so that the reliability and redundancy of the data are improved, the system can sense and understand the surrounding environment more comprehensively, and more accurate and rich information support is provided for subsequent path planning and navigation. The path planning and navigation module is based on the multi-source fusion data and combines an intelligent algorithm to realize accurate path planning and navigation, so that the operation of the robot on the power transmission line is more efficient and safer. The characteristics improve the intelligent level of the system together, and provide powerful technical support for intelligent inspection and maintenance of the power transmission line.
The positioning method using the intelligent defect eliminating robot outdoor visual positioning system of the power transmission line comprises the following steps:
Collecting environmental data around the power transmission line by various sensors in the environmental perception module, wherein the environmental data comprise illumination intensity, wind speed, temperature and humidity and line vibration data;
Starting a visual sensor, acquiring a visual image sequence, and synchronously starting an inertial sensor to ensure that the time stamps of visual data and inertial data are synchronous;
Triggering an illumination compensation module according to illumination data acquired by the environment sensing module, and dynamically adjusting camera parameters to adapt to current illumination conditions so as to ensure stable image quality;
extracting visual characteristic points from a current image frame, tracking the displacement of the characteristic points in adjacent frames, and recording the displacement information of the characteristic points to perform preliminary visual positioning;
integrating acceleration and angular velocity data of the inertial sensor, calculating pose variation of the robot at each moment, and estimating displacement and angle variation of the robot;
The visual inertial fusion module is used for fusing visual data with inertial sensor data, and a Kalman filter or an extended Kalman filter is used for carrying out data filtering, so that noise and errors are eliminated, and the position information of the robot is updated in real time;
Monitoring the vibration frequency and amplitude of the power transmission line through a vibration sensor, performing spectrum analysis on vibration data, and extracting high-frequency vibration components affecting visual positioning;
Calculating vibration compensation quantity according to a frequency and amplitude-based compensation model constructed by the vibration compensation module, correcting visual positioning deviation caused by line vibration, and correcting the position of a characteristic point in visual data;
the multi-sensor fusion module is used for fusing the environment data, the visual data, the inertia data and the vibration compensation data to acquire more accurate robot position information;
According to the fused positioning data, combining with the geographical position information of the power transmission line, planning a moving path of the robot on the power transmission line through a path planning and navigation module, so as to ensure that the robot can stably and accurately travel;
the positioning accuracy of the robot is monitored in real time through a feedback control module, the motion parameters of the robot are adjusted if necessary, and the compensation algorithm and the sensor parameters are dynamically adjusted according to the environmental change;
The ground operator can check the positioning information and the running state of the robot in real time through the remote monitoring module to carry out remote adjustment, and meanwhile, the fault detection module is used for monitoring system abnormality and alarming in time.
It should be noted that the above embodiments are only for illustrating the technical solution of the present invention and not for limiting the same, and although the present invention has been described in detail with reference to the preferred embodiments, it should be understood by those skilled in the art that the technical solution of the present invention may be modified or substituted without departing from the spirit and scope of the technical solution of the present invention, which is intended to be covered in the scope of the claims of the present invention.