Track planning control method and device of inspection robot

Through multi-objective optimization model and real-time data adjustment, the problem of insufficient trajectory accuracy and obstacle avoidance capabilities in traditional trajectory planning methods is solved, and efficient and safe inspection of inspection robots in complex environments is achieved.

CN118977237AActive Publication Date: 2024-11-19GUANGDONG POWER GRID CO LTD +1

Patent Information

Application Number
CN202411052154.5
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-01
Publication Date
2024-11-19
Estimated Expiration
2044-08-01

AI Technical Summary

Technical Problem

Traditional trajectory planning methods lead to low trajectory accuracy and limited obstacle avoidance capabilities in complex environments, affecting the effectiveness of patrol tasks.

Method used

Using a multi-objective optimization model, combined with genetic algorithm or particle swarm optimization algorithm, trajectory planning is carried out based on the time information, energy consumption, smoothness and obstacle avoidance information of the robotic arm, and adjust the trajectory in real time through environmental perception and sensor data to ensure the high trajectory. Accuracy and security.

Benefits of technology

It improves the accuracy and efficiency of the inspection robot trajectory, enhances obstacle avoidance capabilities in complex environments, and ensures the safe and efficient completion of inspection tasks.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118977237A_ABST
    Figure CN118977237A_ABST
Patent Text Reader

Abstract

The invention discloses a trajectory planning control method and device for an inspection robot, and relates to the technical field of robots. The method comprises the following steps: acquiring environment sensing information and mechanical arm state information of the inspection robot, and initializing track parameters of an initial motion track to obtain processed track parameters; inputting the processed trajectory parameters into a multi-objective optimization model for iterative calculation to obtain an optimized motion trajectory; a first movement track is determined according to obstacle information in the process that the mechanical arm moves according to the optimized movement track; and according to the track deviation information of the mechanical arm in the process of moving according to the first motion track, a second motion track is determined, and according to the second motion track, the mechanical arm is controlled to move so that the inspection robot can complete the inspection task. According to the method and the device, the problem that the effect of completing the inspection task by the inspection robot is poor due to the fact that good path planning is difficult to provide for the inspection robot in related technologies is solved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of robotics technology, and in particular to a trajectory planning control method and device for an inspection robot. Background Art

[0002] Rail inspection robots are an important part of modern industrial automation and intelligence, and are widely used in inspection tasks in the power, railway, pipeline and other industries. These robots move in a specific environment along a predetermined trajectory to perform inspection, monitoring and maintenance tasks. The six-degree-of-freedom robotic arm is a key equipment widely used in industrial automation, intelligent manufacturing and service robots. Its six degrees of freedom correspond to the position (X, Y, Z) and posture (rotation around the X, Y, Z axes) of the robotic arm in three-dimensional space, enabling it to flexibly and accurately complete various complex operating tasks.

[0003] In addition, trajectory planning is the core technology of robot motion control, which aims to design a motion path for the robot from the starting point to the end point. Moreover, traditional trajectory planning methods mainly include Dijkstra algorithm (an algorithm for calculating the shortest path from a source node to all other nodes in a graph) and dynamic programming. These methods can provide good path planning effects in simple environments, but in complex and changing environments, they often show the following shortcomings:

[0004] 1. Low trajectory accuracy: The traditional control method fails to fully consider the dynamic characteristics of the robot and the real-time changes of the environment, resulting in low trajectory accuracy;

[0005] 2. Limited obstacle avoidance capability: In terms of obstacle avoidance, traditional control methods lack intelligent processing and are prone to collision with obstacles in complex environments, affecting the smooth progress of inspection tasks.

[0006] Therefore, traditional trajectory planning methods are difficult to provide better path planning for inspection robots, which in turn leads to poor results in the inspection robots completing their inspection tasks.

[0007] Currently, no effective solution has been proposed to address the problem that it is difficult to provide good path planning for inspection robots in related technologies, resulting in poor results in the inspection robots completing their inspection tasks. Summary of the invention

[0008] The main purpose of the present application is to provide a trajectory planning control method and device for a patrol robot, so as to solve the problem in the related art that it is difficult to provide a better path planning for the patrol robot, resulting in poor results of the patrol robot in completing the patrol task.

[0009] In order to achieve the above objectives, according to one aspect of the present application, a trajectory planning and control method for an inspection robot is provided. The method comprises: obtaining environmental perception information and mechanical arm state information of an inspection robot, and initializing trajectory parameters of an initial motion trajectory according to the environmental perception information and mechanical arm state information of the inspection robot to obtain processed trajectory parameters, wherein the initial motion trajectory represents the motion trajectory initially planned by the mechanical arm of the inspection robot; inputting the processed trajectory parameters into a multi-objective optimization model for iterative calculation to obtain an optimized motion trajectory, and controlling the mechanical arm to move according to the optimized motion trajectory, wherein the multi-objective optimization model is a model constructed by using a genetic algorithm or a particle swarm optimization algorithm and based on time information, energy consumption information, smoothness and obstacle avoidance information of the mechanical arm's execution trajectory; determining a first motion trajectory according to obstacle information of the mechanical arm in the process of moving according to the optimized motion trajectory, and controlling the mechanical arm to move according to the first motion trajectory; determining a second motion trajectory according to trajectory deviation information of the mechanical arm in the process of moving according to the first motion trajectory, and controlling the mechanical arm to move according to the second motion trajectory, so that the inspection robot completes the inspection task.

[0010] Furthermore, based on obstacle information when the robotic arm moves according to the optimized motion trajectory, determining the first motion trajectory includes: detecting whether there are obstacles when the robotic arm moves according to the optimized motion trajectory; if there are obstacles when the robotic arm moves according to the optimized motion trajectory, adjusting the optimized motion trajectory to obtain the first motion trajectory; if there are no obstacles when the robotic arm moves according to the optimized motion trajectory, not adjusting the optimized motion trajectory, and using the optimized motion trajectory as the first motion trajectory.

[0011] Furthermore, if there is an obstacle when the robot arm moves according to the optimized motion trajectory, the optimized motion trajectory is adjusted, and the calculation formula for obtaining the first motion trajectory is: Wherein, N is the degree of freedom of the robotic arm, η i is the weight of the obstacle avoidance path optimization for the i-th degree of freedom, Ω i is the spatial region where obstacles can exist in the i-th degree of freedom, and X is the spatial region Ω i Any position vector, d i (X) is the obstacle distance function at position X in the intelligent obstacle avoidance system, indicating the distance of the obstacle from the robotic arm, is the exponential decay function of the obstacle distance, parameter ki Determines the decay rate, For the space region Ω i The average obstacle avoidance effect within.

[0012] Furthermore, based on the trajectory deviation information of the robotic arm during the movement according to the first motion trajectory, determining the second motion trajectory includes: obtaining the current position and posture information of the robotic arm, and determining the motion trajectory currently executed by the robotic arm based on the current position and posture information of the robotic arm; judging whether there is a deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory; if there is a deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory, adjusting the current motion parameters of the robotic arm to obtain the second motion trajectory; if there is no deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory, not adjusting the current motion parameters of the robotic arm, and using the first motion trajectory as the second motion trajectory.

[0013] Furthermore, if there is a deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory, the current motion parameters of the robotic arm are adjusted to obtain the calculation formula for the second motion trajectory: Wherein, N is the degree of freedom of the robotic arm, is the weight parameter of the i-th degree of freedom, r i is the target position vector in the error compensation mechanism, s i (t) is the actual position vector, which represents the current position of the robot arm obtained by fusing the data collected by multiple sensors, ||r i (t)-s i (t)|| 2 It is the square of the Euclidean distance between the target position and the actual position, indicating the magnitude of the error.

[0014] Furthermore, the calculation formula of the multi-objective optimization model is: Wherein, N is the degree of freedom of the robot arm, α i is the weight parameter of the i-th degree of freedom, t is the time variable, t0-t f is the time range of trajectory planning, p i (t) represents the current position of the robot arm in the i-th degree of freedom, which changes with time t, and q i (t) represents the planned position of the robot arm in the i-th degree of freedom, which changes with time t. is the square root of the trajectory deviation, indicating the smoothness and optimization degree of the trajectory.

[0015] Furthermore, controlling the robotic arm to move according to the second motion trajectory so that the inspection robot completes the inspection task includes: generating a control instruction according to the second motion trajectory; and controlling the robotic arm to move according to the second motion trajectory according to the control instruction so that the inspection robot completes the inspection task.

[0016] Furthermore, after controlling the robotic arm to move along the second motion trajectory according to the control instruction, the method also includes: obtaining information when the robotic arm moves along the second motion trajectory, obtaining motion state information of the robotic arm and change information of the environment in which the robotic arm is located; adjusting the second motion trajectory according to the motion state information of the robotic arm and change information of the environment in which the robotic arm is located to obtain a target motion trajectory; controlling the robotic arm to move along the target motion trajectory so that the inspection robot completes the inspection task.

[0017] Furthermore, obtaining the environmental perception information and robotic arm status information of the inspection robot includes: obtaining data information related to the inspection robot collected by multiple sensors to obtain multiple data information, wherein the multiple sensors include: visual sensors, force sensors and acceleration sensors; fusing the multiple data information to obtain the environmental perception information and robotic arm status information of the inspection robot.

[0018] In order to achieve the above-mentioned purpose, according to another aspect of the present application, a trajectory planning control device for an inspection robot is provided. The device comprises: a first processing unit, used to obtain environmental perception information and mechanical arm state information of the inspection robot, and initialize the trajectory parameters of the initial motion trajectory according to the environmental perception information and mechanical arm state information of the inspection robot to obtain the processed trajectory parameters, wherein the initial motion trajectory represents the motion trajectory initially planned by the mechanical arm of the inspection robot; a second processing unit, used to input the processed trajectory parameters into a multi-objective optimization model for iterative calculation to obtain the optimized motion trajectory, and control the mechanical arm to move according to the optimized motion trajectory, wherein the multi-objective optimization model is a model constructed by using a genetic algorithm or a particle swarm optimization algorithm and based on the time information, energy consumption information, smoothness and obstacle avoidance information of the mechanical arm execution trajectory; a first determining unit, used to determine a first motion trajectory according to the obstacle information of the mechanical arm in the process of moving according to the optimized motion trajectory, and control the mechanical arm to move according to the first motion trajectory; a second determining unit, used to determine a second motion trajectory according to the trajectory deviation information of the mechanical arm in the process of moving according to the first motion trajectory, and control the mechanical arm to move according to the second motion trajectory, so that the inspection robot completes the inspection task.

[0019] Furthermore, the first determination unit includes: a first detection module, used to detect whether there is an obstacle when the robot arm moves according to the optimized motion trajectory; a first adjustment module, used to adjust the optimized motion trajectory to obtain the first motion trajectory if there is an obstacle when the robot arm moves according to the optimized motion trajectory; a first determination module, used to not adjust the optimized motion trajectory and use the optimized motion trajectory as the first motion trajectory if there is no obstacle when the robot arm moves according to the optimized motion trajectory.

[0020] Furthermore, the calculation formula of the first adjustment module is: Wherein, N is the degree of freedom of the robotic arm, η i is the weight of the obstacle avoidance path optimization for the i-th degree of freedom, Ω i is the spatial region where obstacles can exist in the i-th degree of freedom, and X is the spatial region Ω i Any position vector, d i (X) is the obstacle distance function at position X in the intelligent obstacle avoidance system, indicating the distance of the obstacle from the robotic arm, is the exponential decay function of the obstacle distance, parameter k i Determines the decay rate, For the space region Ω i The average obstacle avoidance effect within.

[0021] Furthermore, the second determination unit includes: a first processing module, used to obtain the current position and posture information of the robotic arm, and determine the motion trajectory currently executed by the robotic arm based on the current position and posture information of the robotic arm; a first judgment module, used to judge whether there is a deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory; a second adjustment module, used to adjust the current motion parameters of the robotic arm to obtain the second motion trajectory if there is a deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory; a second determination module, used to not adjust the current motion parameters of the robotic arm if there is no deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory, and use the first motion trajectory as the second motion trajectory.

[0022] Furthermore, the calculation formula of the second adjustment module is: Wherein, N is the degree of freedom of the robotic arm, is the weight parameter of the i-th degree of freedom, r i is the target position vector in the error compensation mechanism, s i(t) is the actual position vector, which represents the current position of the robot arm obtained by fusing the data collected by multiple sensors, ||r i (t)-s i (t)|| 2 It is the square of the Euclidean distance between the target position and the actual position, indicating the magnitude of the error.

[0023] Furthermore, the calculation formula of the multi-objective optimization model is: Wherein, N is the degree of freedom of the robot arm, α i is the weight parameter of the i-th degree of freedom, t is the time variable, t0-t f is the time range of trajectory planning, p i (t) represents the current position of the robot arm in the i-th degree of freedom, which changes with time t, and q i (t) represents the planned position of the robot arm in the i-th degree of freedom, which changes with time t. is the square root of the trajectory deviation, indicating the smoothness and optimization degree of the trajectory.

[0024] Furthermore, the second determination unit includes: a first generation module, used to generate a control instruction according to the second motion trajectory; a first control module, used to control the robotic arm to move according to the second motion trajectory according to the control instruction, so that the inspection robot completes the inspection task.

[0025] Furthermore, the device also includes: a first acquisition unit, which is used to acquire information when the robotic arm moves along the second motion trajectory after controlling the robotic arm to move along the second motion trajectory according to the control instruction, so as to obtain the motion state information of the robotic arm and the change information of the environment in which the robotic arm is located; a first adjustment unit, which is used to adjust the second motion trajectory according to the motion state information of the robotic arm and the change information of the environment in which the robotic arm is located, so as to obtain the target motion trajectory; and a first control unit, which is used to control the robotic arm to move along the target motion trajectory so that the inspection robot completes the inspection task.

[0026] Furthermore, the first processing unit includes: a first acquisition module, used to acquire data information related to the inspection robot collected by multiple sensors to obtain multiple data information, wherein the multiple sensors include: visual sensors, force sensors and acceleration sensors; a second processing module, used to fuse the multiple data information to obtain the environmental perception information and robotic arm status information of the inspection robot.

[0027] Through the present application, the following steps are adopted: obtaining environmental perception information and mechanical arm status information of the inspection robot, and initializing the trajectory parameters of the initial motion trajectory based on the environmental perception information and mechanical arm status information of the inspection robot to obtain the processed trajectory parameters, wherein the initial motion trajectory represents the motion trajectory initially planned by the mechanical arm of the inspection robot; inputting the processed trajectory parameters into a multi-objective optimization model for iterative calculation to obtain the optimized motion trajectory, and controlling the mechanical arm to move according to the optimized motion trajectory, wherein the multi-objective optimization model is a model constructed by using a genetic algorithm or a particle swarm optimization algorithm and based on the time information, energy consumption information, smoothness and obstacle avoidance information of the mechanical arm execution trajectory; determining a first motion trajectory based on the obstacle information of the mechanical arm in the process of moving according to the optimized motion trajectory, and controlling the mechanical arm to move according to the first motion trajectory; determining a second motion trajectory based on the trajectory deviation information of the mechanical arm in the process of moving according to the first motion trajectory, and controlling the mechanical arm to move according to the second motion trajectory, so that the inspection robot completes the inspection task, solving the problem that it is difficult to provide a better path planning for the inspection robot in the related art, resulting in poor effect of the inspection robot in completing the inspection task. Through the introduction of multi-objective optimization algorithms, the time, energy consumption and smoothness of the trajectory can be optimized at the same time to ensure the high accuracy and efficiency of the trajectory; sensor data fusion and dynamic adjustment can be used to achieve real-time compensation of errors to ensure the accurate execution of the trajectory; environmental modeling and real-time obstacle avoidance can be combined to optimize the obstacle avoidance path to ensure the safe and efficient operation of the inspection robot in complex environments, thereby improving the effectiveness of the inspection robot in completing inspection tasks. BRIEF DESCRIPTION OF THE DRAWINGS

[0028] The drawings constituting a part of the present application are used to provide a further understanding of the present application. The illustrative embodiments and descriptions of the present application are used to explain the present application and do not constitute an improper limitation on the present application. In the drawings:

[0029] Figure 1 is a flow chart of a trajectory planning control method for an inspection robot provided in an embodiment of the present application;

[0030] Figure 2 It is a schematic diagram of the process steps of a six-degree-of-freedom mechanical arm trajectory planning control method of a rail inspection robot in this embodiment;

[0031] Figure 3 is a schematic diagram of a system framework of a six-degree-of-freedom mechanical arm trajectory planning control method for a rail inspection robot in this embodiment;

[0032] Figure 4 Schematic diagram of the overall framework of a six-degree-of-freedom robot arm trajectory planning and control method for a rail inspection robot in this embodiment;

[0033] Figure 5 is a schematic diagram of a trajectory planning control device for an inspection robot provided in an embodiment of the present application;

[0034] Figure 6 is a schematic diagram of an electronic device provided according to an embodiment of the present application. DETAILED DESCRIPTION

[0035] It should be noted that, in the absence of conflict, the embodiments and features in the embodiments of the present application can be combined with each other. The present application will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.

[0036] In order to enable those skilled in the art to better understand the solution of the present application, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present application.

[0037] It should be noted that the terms "first", "second", etc. in the specification and claims of the present application and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequential order. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present application described here. In addition, the terms "including" and "having" and any of their variations are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device comprising a series of steps or units is not necessarily limited to those steps or units clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.

[0038] It should be noted that the relevant information (including but not limited to user device information, user personal information, etc.) and data (including but not limited to data for display, data for analysis, etc.) involved in this disclosure are all information and data authorized by the user or fully authorized by all parties. For example, an interface is set between this system and the relevant user or organization. Before obtaining relevant information, it is necessary to send an acquisition request to the aforementioned user or organization through the interface, and obtain relevant information after receiving the consent information fed back by the aforementioned user or organization.

[0039] The present invention is described below in conjunction with preferred implementation steps. Figure 1 is a flow chart of a trajectory planning control method for an inspection robot provided in an embodiment of the present application, such as Figure 1 As shown, the method comprises the following steps:

[0040] Step S101, obtain the environmental perception information and robotic arm status information of the inspection robot, and initialize the trajectory parameters of the initial motion trajectory based on the environmental perception information and robotic arm status information of the inspection robot to obtain the processed trajectory parameters, wherein the initial motion trajectory is represented by the motion trajectory initially planned by the robotic arm of the inspection robot.

[0041] For example, sensor data can be collected through the sensor module, and the environmental perception information and robotic arm status information of the inspection robot can be generated based on the collected sensor data; then, the trajectory planning parameters (corresponding to the trajectory parameters of the above-mentioned initial motion trajectory) can be initialized according to the environmental perception information and the robotic arm status information to obtain the initialized trajectory parameters (corresponding to the above-mentioned processed trajectory parameters), and the trajectory planning parameters can include parameter information such as the target position, initial position, time constraints and energy consumption constraints.

[0042] Step S102, input the processed trajectory parameters into the multi-objective optimization model for iterative calculation to obtain the optimized motion trajectory, and control the robotic arm to move according to the optimized motion trajectory, wherein the multi-objective optimization model is a model constructed using a genetic algorithm or a particle swarm optimization algorithm and based on the time information, energy consumption information, smoothness and obstacle avoidance information of the robotic arm's execution trajectory.

[0043] For example, a genetic algorithm or a particle swarm optimization algorithm can be used to establish a multi-objective optimization model, and the multi-objective optimization model can comprehensively consider time, energy consumption, smoothness and obstacle avoidance performance; then the initialized trajectory parameters (corresponding to the above-mentioned processed trajectory parameters) can be iteratively calculated through the optimization algorithm (corresponding to the above-mentioned multi-objective optimization model) to obtain the global optimal trajectory (corresponding to the above-mentioned optimized motion trajectory); and the robotic arm of the inspection robot can be controlled to move according to the global optimal trajectory (corresponding to the above-mentioned optimized motion trajectory) generated according to the multi-objective optimization model.

[0044] Step S103, determining a first motion trajectory according to obstacle information when the robot arm moves according to the optimized motion trajectory, and controlling the robot arm to move according to the first motion trajectory.

[0045] For example, a visual sensor can be used to monitor in real time whether there are obstacles in the environment when the robotic arm moves along the global optimal trajectory (corresponding to the optimized motion trajectory mentioned above); and based on the monitored situation of whether there are obstacles in the environment when the robotic arm moves along the global optimal trajectory (corresponding to the optimized motion trajectory mentioned above), the above-mentioned first motion trajectory is obtained; and then the robotic arm of the inspection robot is controlled to move according to the above-mentioned first motion trajectory.

[0046] Step S104, determining a second motion trajectory according to the trajectory deviation information of the robot arm in the process of moving according to the first motion trajectory, and controlling the robot arm to move according to the second motion trajectory, so that the inspection robot completes the inspection task.

[0047] For example, a high-precision sensor can be used to monitor in real time the current position and posture of the robotic arm when it moves along the above-mentioned first motion trajectory; then, based on the monitored current position and posture of the robotic arm, it can be determined whether there is a trajectory deviation between the current motion trajectory of the robotic arm of the inspection robot and the above-mentioned first motion trajectory; and based on whether there is a trajectory deviation between the current motion trajectory of the robotic arm and the above-mentioned first motion trajectory, the above-mentioned second motion trajectory is obtained; then the robotic arm of the inspection robot is controlled to move according to the above-mentioned second motion trajectory, and the inspection robot completes the inspection task.

[0048] Through the above steps S101 to S104, by introducing a multi-objective optimization algorithm, the time, energy consumption and smoothness of the trajectory can be optimized simultaneously to ensure the high accuracy and efficiency of the trajectory; sensor data fusion and dynamic adjustment can be used to achieve real-time compensation of errors to ensure the accurate execution of the trajectory; environmental modeling and real-time obstacle avoidance can be combined to optimize the obstacle avoidance path to ensure the safe and efficient operation of the inspection robot in a complex environment, thereby improving the effectiveness of the inspection robot in completing inspection tasks.

[0049] Optionally, in the trajectory planning and control method of the inspection robot provided in an embodiment of the present application, obtaining environmental perception information and robotic arm status information of the inspection robot includes: obtaining data information related to the inspection robot collected by multiple sensors to obtain multiple data information, wherein the multiple sensors include: visual sensors, force sensors and acceleration sensors; fusing the multiple data information to obtain the environmental perception information and robotic arm status information of the inspection robot.

[0050] For example, when performing data collection and preprocessing of an inspection robot, the following sub-steps may be included:

[0051] Step 1: Start the sensor module to collect data (corresponding to the above-mentioned multiple data information) of the inspection robot's vision, force and acceleration sensors (corresponding to the above-mentioned multiple sensors) in real time;

[0052] Step 2: A variety of sensor data (corresponding to the above-mentioned multiple data information) are integrated through a data processing module to generate the environmental perception information and robotic arm status information of the inspection robot.

[0053] In summary, by using various types of sensors to collect different data, the data information of the inspection robot can be easily obtained.

[0054] Optionally, in the trajectory planning and control method of the inspection robot provided in the embodiment of the present application, the calculation formula of the multi-objective optimization model is: Where N is the degree of freedom of the robot arm, α i is the weight parameter of the i-th degree of freedom, t is the time variable, t0-t f is the time range of trajectory planning, p i (t) represents the current position of the robot arm in the i-th degree of freedom, which changes with time t, and q i (t) represents the planned position of the robot arm in the i-th degree of freedom, which changes with time t. is the square root of the trajectory deviation, indicating the smoothness and optimization degree of the trajectory.

[0055] For example, the multi-objective optimization formula can be:

[0056]

[0057] Wherein, N is the degree of freedom of the robotic arm. The robotic arm of the inspection robot in this embodiment may be a six-degree-of-freedom robotic arm. Therefore, in this embodiment, N used to represent the degree of freedom of the robotic arm may be 6, α i is the weight parameter of the sixth degree of freedom, t is the time variable, t0-t f The time horizon of trajectory planning, p i (t) represents the current trajectory position vector of the robot arm in the i-th degree of freedom, which changes with time t, and q i (t) is the planned trajectory position vector, which changes with time. is the square root of the trajectory deviation, indicating the smoothness and optimization degree of the trajectory.

[0058] In summary, by introducing the multi-objective optimization algorithm, the time, energy consumption and smoothness of the trajectory can be optimized simultaneously to ensure high accuracy and efficiency of the trajectory.

[0059] Optionally, in the trajectory planning and control method of the inspection robot provided in the embodiment of the present application, determining the first motion trajectory based on obstacle information when the robot arm moves according to the optimized motion trajectory includes: detecting whether there are obstacles when the robot arm moves according to the optimized motion trajectory; if there are obstacles when the robot arm moves according to the optimized motion trajectory, adjusting the optimized motion trajectory to obtain the first motion trajectory; if there are no obstacles when the robot arm moves according to the optimized motion trajectory, not adjusting the optimized motion trajectory, and using the optimized motion trajectory as the first motion trajectory.

[0060] For example, when performing intelligent obstacle avoidance and path adjustment on the robotic arm of an inspection robot, the following sub-steps may be included:

[0061] Step 1: Use visual sensors to monitor obstacles in the environment in real time;

[0062] Step 2: If an obstacle is detected, the intelligent obstacle avoidance algorithm adjusts the trajectory in real time (corresponding to the optimized motion trajectory mentioned above) to obtain the first motion trajectory mentioned above, and ensures that the robotic arm of the inspection robot avoids the obstacle while maintaining path optimization; if no obstacle is detected, there is no need to adjust the current running trajectory of the robotic arm of the inspection robot (corresponding to the optimized motion trajectory mentioned above), and the robotic arm of the inspection robot can continue to move along the current running path (corresponding to the optimized motion trajectory mentioned above).

[0063] Through the above solution, it is possible to combine environmental modeling and real-time obstacle avoidance, optimize the obstacle avoidance path, and ensure the safe and efficient operation of the inspection robot in complex environments.

[0064] Optionally, in the trajectory planning and control method of the inspection robot provided in the embodiment of the present application, if there is an obstacle in the process of the robot arm moving according to the optimized motion trajectory, the optimized motion trajectory is adjusted, and the calculation formula for obtaining the first motion trajectory is: Where N is the degree of freedom of the robot arm, η i is the weight of the obstacle avoidance path optimization for the i-th degree of freedom, Ω i is the spatial region where obstacles can exist in the i-th degree of freedom, and X is the spatial region Ω i Any position vector, d i (X) is the obstacle distance function at position X in the intelligent obstacle avoidance system, which indicates the distance between the obstacle and the robotic arm. is the exponential decay function of the obstacle distance, parameter k i Determines the decay rate, For the space region Ω i The average obstacle avoidance effect within.

[0065] For example, the obstacle avoidance path optimization formula is:

[0066]

[0067] Wherein, N is the degree of freedom of the mechanical arm. The mechanical arm of the inspection robot in this embodiment may be a six-degree-of-freedom mechanical arm. Therefore, in this embodiment, N used to represent the degree of freedom of the mechanical arm may be 6, n i Optimize the weights for the obstacle avoidance path of the sixth degree of freedom, Ω i The spatial region where obstacles may exist in the i-th degree of freedom, X is the spatial region Ω i Any position vector, d i(X) is the obstacle distance function at position X in the intelligent obstacle avoidance system, which indicates the distance between the obstacle and the robotic arm. is the exponential decay function of the obstacle distance, parameter k i Determines the decay rate, For the space region Ω i The average obstacle avoidance effect within.

[0068] In summary, by using the obstacle avoidance path optimization formula, the obstacle avoidance path of the inspection robot can be optimized to ensure the safe and efficient operation of the inspection robot in complex environments.

[0069] Optionally, in the trajectory planning and control method of the inspection robot provided in the embodiment of the present application, determining the second motion trajectory based on the trajectory deviation information of the robotic arm during the movement of the first motion trajectory includes: obtaining the current position and posture information of the robotic arm, and determining the motion trajectory currently executed by the robotic arm based on the current position and posture information of the robotic arm; judging whether there is a deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory; if there is a deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory, adjusting the current motion parameters of the robotic arm to obtain the second motion trajectory; if there is no deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory, not adjusting the current motion parameters of the robotic arm, and using the first motion trajectory as the second motion trajectory.

[0070] For example, when performing real-time error detection and compensation processing on the mechanical arm of the inspection robot, the following sub-steps may be included:

[0071] Step 1: High-precision sensors monitor the current position and posture of the robotic arm in real time;

[0072] Step 2: According to the monitored current position and posture of the robotic arm, determine whether there is a deviation between the current motion trajectory of the robotic arm of the inspection robot and the planned trajectory (corresponding to the above-mentioned first motion trajectory); if there is a deviation between the current motion trajectory of the robotic arm of the inspection robot and the planned trajectory (corresponding to the above-mentioned first motion trajectory), the deviation between the current position and the planned trajectory (corresponding to the above-mentioned first motion trajectory) can be calculated by the error compensation module;

[0073] Step 3: Using the feedback control algorithm, the motion parameters of the robot arm (corresponding to the current motion parameters of the robot arm) are adjusted in real time to compensate for the trajectory deviation caused by environmental changes or the robot arm's own errors, thereby obtaining the second motion trajectory mentioned above;

[0074] Step 4: If there is no deviation between the current motion trajectory of the robotic arm of the inspection robot and the planned trajectory (corresponding to the first motion trajectory mentioned above), there is no need to adjust the motion parameters of the robotic arm (corresponding to the current motion parameters of the robotic arm mentioned above), and the robotic arm of the inspection robot can continue to move according to the current motion trajectory.

[0075] Through the above scheme, the mechanical arm of the inspection robot can be dynamically adjusted in real time to achieve real-time compensation of errors and ensure accurate execution of the trajectory.

[0076] Optionally, in the trajectory planning and control method of the inspection robot provided in the embodiment of the present application, if there is a deviation between the motion trajectory currently executed by the robot arm and the first motion trajectory, the current motion parameters of the robot arm are adjusted, and the calculation formula for obtaining the second motion trajectory is: Where N is the degree of freedom of the robot arm, is the weight parameter of the i-th degree of freedom, r i is the target position vector in the error compensation mechanism, s i (t) is the actual position vector, which represents the current position of the robot arm obtained by fusing the data collected by multiple sensors. i (t)-s i (t)|| 2 It is the square of the Euclidean distance between the target position and the actual position, indicating the magnitude of the error.

[0077] For example, the error compensation formula is:

[0078]

[0079] Wherein, N is the degree of freedom of the robot arm. The robot arm of the inspection robot in this embodiment may be a six-degree-of-freedom robot arm. Therefore, in this embodiment, N used to represent the degree of freedom of the robot arm may be 6. is the weight parameter of the sixth degree of freedom, r i is the target position vector in the error compensation mechanism, s i (t) is the actual position vector, and the current position of the robot arm is obtained by sensor data fusion, ||r i (t)-s i (t)|| 2 It is the square of the Euclidean distance between the target position and the actual position, indicating the magnitude of the error.

[0080] In summary, by using the error compensation formula, real-time compensation of the error of the running path of the mechanical arm of the inspection robot can be achieved to ensure the accurate execution of the trajectory.

[0081] Optionally, in the trajectory planning and control method of the inspection robot provided in an embodiment of the present application, controlling the robotic arm to move according to the second motion trajectory so that the inspection robot completes the inspection task includes: generating a control instruction according to the second motion trajectory; and controlling the robotic arm to move according to the second motion trajectory according to the control instruction so that the inspection robot completes the inspection task.

[0082] For example, a control instruction can be generated based on the trajectory planning and error compensation results; then the control instruction is executed by the control module to drive the robot arm to move along the optimized trajectory (corresponding to the second motion trajectory mentioned above) to ensure accurate execution of the trajectory.

[0083] Through the above solution, the control module can accurately control the movement of the mechanical arm of the inspection robot according to the generated control instructions.

[0084] Optionally, in the trajectory planning and control method of the inspection robot provided in an embodiment of the present application, after controlling the robotic arm to move along a second motion trajectory according to a control instruction, the method further includes: obtaining information when the robotic arm moves along the second motion trajectory, obtaining motion state information of the robotic arm and change information of the environment in which the robotic arm is located; adjusting the second motion trajectory according to the motion state information of the robotic arm and the change information of the environment in which the robotic arm is located to obtain a target motion trajectory; controlling the robotic arm to move along the target motion trajectory so that the inspection robot completes the inspection task.

[0085] For example, the system can continuously provide feedback and optimize the running trajectory of the robot's mechanical arm. For example, the system can continuously monitor the robot's motion state and environmental changes, adjust the trajectory planning and error compensation strategy in real time, and obtain the above-mentioned target motion trajectory; then control the robot's mechanical arm to move according to the above-mentioned target motion trajectory, and enable the robot to complete the inspection task.

[0086] Through the above scheme, the system continuously feeds back and optimizes the running trajectory of the robotic arm of the inspection robot, thereby ensuring that the robotic arm can accurately and efficiently complete the inspection task in a dynamic environment.

[0087] For example, the present embodiment relates to the field of robotics, and in particular to a six-degree-of-freedom robotic arm trajectory planning and control method for a rail inspection robot. Moreover, the six-degree-of-freedom robotic arm trajectory planning and control method for a rail inspection robot provided in the present embodiment solves the problems of low trajectory accuracy and limited obstacle avoidance capability of the robotic arm of the inspection robot in the prior art.

[0088] For example, Figure 2 is a schematic diagram of the process steps of a six-degree-of-freedom robot arm trajectory planning control method for a rail inspection robot in this embodiment, such as Figure 2As shown, a six-degree-of-freedom robot arm trajectory planning and control method for a rail inspection robot in this embodiment includes the following steps:

[0089] S1: Data collection and preprocessing;

[0090] S2: multi-objective optimization trajectory planning;

[0091] S3: Intelligent obstacle avoidance and path adjustment;

[0092] S4: Real-time error detection and compensation;

[0093] S5: control the execution of instructions;

[0094] S6: System feedback and optimization.

[0095] For example, Figure 3 is a schematic diagram of a system framework of a six-degree-of-freedom mechanical arm trajectory planning control method for a rail inspection robot in this embodiment; Figure 4 Schematic diagram of the overall framework of a six-degree-of-freedom robot arm trajectory planning control method for a rail inspection robot in this embodiment; Figure 3 and Figure 4 As shown, a six-degree-of-freedom robot arm trajectory planning and control method for a rail inspection robot in this embodiment specifically includes the following steps:

[0096] S1: Data collection and preprocessing;

[0097] In step S1, it includes the following sub-steps:

[0098] Step 1: Start the sensor module to collect data from vision, force and acceleration sensors in real time;

[0099] Step 2: Fuse multiple sensor data through the data processing module to generate environmental perception information and robotic arm status information;

[0100] S2: multi-objective optimization trajectory planning;

[0101] In step S2, it includes the following sub-steps:

[0102] Step 1: Initialize trajectory planning parameters based on environmental perception information, including target position, initial position, time constraint, and energy consumption constraint;

[0103] Step 2: Use genetic algorithm or particle swarm optimization algorithm to establish a multi-objective optimization model, taking into account time, energy consumption, smoothness and obstacle avoidance performance;

[0104] Step 3: Obtain the global optimal trajectory through iterative calculation of the optimization algorithm;

[0105] S3: Intelligent obstacle avoidance and path adjustment;

[0106] In step S3, it includes the following sub-steps:

[0107] Step 1: Use visual sensors to monitor obstacles in the environment in real time;

[0108] Step 2: If an obstacle is detected, the intelligent obstacle avoidance algorithm adjusts the trajectory in real time to ensure that the obstacle is avoided while maintaining the optimized path;

[0109] S4: Real-time error detection and compensation;

[0110] In step S4, it includes the following sub-steps:

[0111] Step 1: High-precision sensors monitor the current position and posture of the robotic arm in real time;

[0112] Step 2: Calculate the deviation between the current position and the planned trajectory through the error compensation module;

[0113] Step 3: Use feedback control algorithms to adjust the motion parameters of the robot in real time to compensate for trajectory deviations caused by environmental changes or errors in the robot itself.

[0114] S5: control the execution of instructions;

[0115] In step S5, it includes the following sub-steps:

[0116] Step 1: Generate control instructions based on trajectory planning and error compensation results;

[0117] Step 2: Execute control instructions through the control module to drive the robot arm to move along the optimized trajectory to ensure accurate execution of the trajectory;

[0118] S6: System feedback and optimization;

[0119] In step S6, it includes the following sub-steps:

[0120] Step 1: The system continuously monitors the motion state of the robot arm and environmental changes, and adjusts trajectory planning and error compensation strategies in real time;

[0121] Step 2: Ensure that the robot arm can complete inspection tasks accurately and efficiently in a dynamic environment through continuous feedback and optimization.

[0122] Moreover, the multi-objective optimization formula is:

[0123]

[0124] Wherein, N is the degree of freedom of the robot arm, which is 6 in this embodiment, α i is the weight parameter of the sixth degree of freedom, t is the time variable, t0-tf The time horizon of trajectory planning, p i (t) represents the current trajectory position vector of the robot arm in the i-th degree of freedom, which changes with time t, and q i (t) is the planned trajectory position vector, which changes with time. is the square root of the trajectory deviation, indicating the smoothness and optimization degree of the trajectory.

[0125] In addition, the error compensation formula is:

[0126]

[0127] Wherein, N is the degree of freedom of the robot arm, which is 6 in this embodiment. is the weight parameter of the sixth degree of freedom, r i is the target position vector in the error compensation mechanism, s i (t) is the actual position vector, and the current position of the robot arm is obtained by sensor data fusion, ||r i (t)-s i (t)|| 2 It is the square of the Euclidean distance between the target position and the actual position, indicating the magnitude of the error.

[0128] Moreover, the obstacle avoidance path optimization formula is:

[0129]

[0130] Wherein, N is the degree of freedom of the robot arm, which is 6 in this embodiment, n i Optimize the weights for the obstacle avoidance path of the sixth degree of freedom, Ω i The spatial region where obstacles may exist in the i-th degree of freedom, X is the spatial region Ω i Any position vector, d i (X) is the obstacle distance function at position X in the intelligent obstacle avoidance system, which indicates the distance between the obstacle and the robotic arm. is the exponential decay function of the obstacle distance, parameter k i Determines the decay rate, For the space region Ω i The average obstacle avoidance effect within.

[0131] Therefore, a six-degree-of-freedom robot arm trajectory planning control method for a rail inspection robot is provided by this embodiment, and the control method includes the following steps: S1; data acquisition and preprocessing; S2: multi-objective optimization trajectory planning; S3: intelligent obstacle avoidance and path adjustment; S4: real-time error detection and compensation; S5: execution of control instructions; S6: system feedback and optimization. Therefore, this embodiment can simultaneously optimize the time, energy consumption and smoothness of the trajectory through the introduction of a multi-objective optimization algorithm to ensure high accuracy and high efficiency of the trajectory; it can use sensor data fusion and dynamic adjustment to achieve real-time compensation of errors to ensure accurate execution of the trajectory; it can combine environmental modeling and real-time obstacle avoidance to optimize the obstacle avoidance path to ensure the safe and efficient operation of the robot in a complex environment.

[0132] For example, in order to verify the effectiveness and innovation of the six-degree-of-freedom robotic arm trajectory planning and control method of a rail inspection robot in this embodiment, a series of experiments were designed. The experiment used a rail inspection robot with a six-degree-of-freedom robotic arm. During the experiment, the robotic arm needed to execute a predetermined trajectory while responding to dynamic changes in the environment. The experiment compared the effects of using traditional trajectory planning methods and the trajectory planning method in this embodiment.

[0133] Moreover, the hardware used in the experiment includes: a robotic arm, a sensor, and a controller. The software used in the experiment includes: a traditional trajectory planning algorithm software, a multi-objective optimization trajectory planning control software in this embodiment, and a data acquisition and analysis tool. In addition, data recording includes: recording the actual motion trajectory, error conditions, obstacle avoidance success rate, and energy consumption data of the robotic arm throughout the process. Table 1 records the data obtained from the experiment.

[0134] Table 1

[0135]

[0136] By comparing the experimental data recorded in Table 1, the following conclusions can be drawn:

[0137] Average trajectory deviation: The method in this embodiment is significantly better than the traditional method in terms of trajectory planning and execution accuracy. Due to the use of multi-objective optimization and real-time error compensation mechanism, the method in this embodiment can execute the predetermined trajectory more accurately;

[0138] Obstacle avoidance success rate: The method in this embodiment has the advantage of optimizing the obstacle avoidance path. By combining intelligent obstacle avoidance and path optimization, the method in this embodiment can more efficiently avoid obstacles and ensure the safe advancement of the robot arm;

[0139] Energy consumption: The method in this embodiment optimizes energy consumption parameters so that the robot consumes less energy during trajectory execution, thereby improving energy efficiency;

[0140] Trajectory execution time: The method in this embodiment also performs well in time optimization. By comprehensively considering the time factor, the robot arm can complete the predetermined task faster.

[0141] Therefore, the method in this embodiment is superior to the traditional method in multiple key indicators of trajectory planning. Through multi-objective optimization, real-time error compensation and intelligent obstacle avoidance path optimization, the method in this embodiment achieves high precision, high efficiency and high safety of trajectory planning. The method provided in this embodiment not only improves the performance of the track inspection robot, but also provides more reliable technical guarantees for practical applications.

[0142] In summary, the trajectory planning and control method of the inspection robot provided in the embodiment of the present application obtains the environmental perception information and the state information of the robotic arm of the inspection robot, and initializes the trajectory parameters of the initial motion trajectory based on the environmental perception information and the state information of the robotic arm of the inspection robot to obtain the processed trajectory parameters, wherein the initial motion trajectory is represented by the motion trajectory initially planned by the robotic arm of the inspection robot; the processed trajectory parameters are input into the multi-objective optimization model for iterative calculation to obtain the optimized motion trajectory, and the robotic arm is controlled to move according to the optimized motion trajectory, wherein the multi-objective optimization model is a genetic algorithm or a particle swarm optimization The algorithm is based on the time information, energy consumption information, smoothness and obstacle avoidance information of the robot's execution trajectory; the first motion trajectory is determined according to the obstacle information of the robot in the process of moving according to the optimized motion trajectory, and the robot is controlled to move according to the first motion trajectory; the second motion trajectory is determined according to the trajectory deviation information of the robot in the process of moving according to the first motion trajectory, and the robot is controlled to move according to the second motion trajectory, so that the inspection robot completes the inspection task, which solves the problem that it is difficult to provide a better path planning for the inspection robot in the related technology, resulting in poor results in the inspection robot completing the inspection task. Through the introduction of the multi-objective optimization algorithm, the time, energy consumption and smoothness of the trajectory can be optimized at the same time to ensure the high accuracy and efficiency of the trajectory; the sensor data fusion and dynamic adjustment can be used to realize real-time compensation of errors to ensure the accurate execution of the trajectory; the obstacle avoidance path can be optimized by combining environmental modeling and real-time obstacle avoidance to ensure the safe and efficient operation of the inspection robot in a complex environment, thereby improving the effect of the inspection robot in completing the inspection task.

[0143] It should be noted that the steps shown in the flowcharts of the accompanying drawings can be executed in a computer system such as a set of computer executable instructions, and that, although a logical order is shown in the flowcharts, in some cases, the steps shown or described can be executed in an order different from that shown here.

[0144] The present application also provides a trajectory planning control device for an inspection robot. It should be noted that the trajectory planning control device for an inspection robot in the present application can be used to execute the trajectory planning control method for an inspection robot provided in the present application. The trajectory planning control device for an inspection robot provided in the present application is introduced below.

[0145] Figure 5 Schematic diagram of a trajectory planning control device for an inspection robot provided in an embodiment of the present application. Figure 5 As shown, the device includes: a first processing unit 501, a second processing unit 502, a first determining unit 503 and a second determining unit 504.

[0146] Specifically, the first processing unit 501 is used to obtain the environmental perception information and the state information of the robotic arm of the inspection robot, and initialize the trajectory parameters of the initial motion trajectory according to the environmental perception information and the state information of the robotic arm of the inspection robot to obtain the processed trajectory parameters, wherein the initial motion trajectory is represented by the motion trajectory initially planned by the robotic arm of the inspection robot;

[0147] The second processing unit 502 is used to input the processed trajectory parameters into the multi-objective optimization model for iterative calculation to obtain an optimized motion trajectory, and control the robot arm to move according to the optimized motion trajectory, wherein the multi-objective optimization model is a model constructed by using a genetic algorithm or a particle swarm optimization algorithm and based on time information, energy consumption information, smoothness and obstacle avoidance information of the robot arm execution trajectory;

[0148] A first determining unit 503, configured to determine a first motion trajectory according to obstacle information when the robot arm moves according to the optimized motion trajectory, and control the robot arm to move according to the first motion trajectory;

[0149] The second determination unit 504 is used to determine a second motion trajectory according to the trajectory deviation information of the robot arm in the process of moving according to the first motion trajectory, and control the robot arm to move according to the second motion trajectory so that the inspection robot completes the inspection task.

[0150] In summary, the trajectory planning control device of the inspection robot provided in the embodiment of the present application obtains the environmental perception information and the mechanical arm status information of the inspection robot through the first processing unit 501, and initializes the trajectory parameters of the initial motion trajectory according to the environmental perception information and the mechanical arm status information of the inspection robot to obtain the processed trajectory parameters, wherein the initial motion trajectory is represented as the motion trajectory initially planned by the mechanical arm of the inspection robot; the second processing unit 502 inputs the processed trajectory parameters into the multi-objective optimization model for iterative calculation to obtain the optimized motion trajectory, and controls the mechanical arm to move according to the optimized motion trajectory, wherein the multi-objective optimization model is a genetic algorithm or a particle swarm optimization. The algorithm is based on the time information, energy consumption information, smoothness and obstacle avoidance information of the robot's execution trajectory; the first determination unit 503 determines the first motion trajectory according to the obstacle information of the robot in the process of moving according to the optimized motion trajectory, and controls the robot to move according to the first motion trajectory; the second determination unit 504 determines the second motion trajectory according to the trajectory deviation information of the robot in the process of moving according to the first motion trajectory, and controls the robot to move according to the second motion trajectory, so that the inspection robot completes the inspection task, which solves the problem that it is difficult to provide a better path planning for the inspection robot in the related technology, resulting in the poor effect of the inspection robot in completing the inspection task. Through the introduction of the multi-objective optimization algorithm, the time, energy consumption and smoothness of the trajectory can be optimized at the same time to ensure the high accuracy and efficiency of the trajectory; the sensor data fusion and dynamic adjustment can be used to realize the real-time compensation of the error and ensure the accurate execution of the trajectory; the obstacle avoidance path can be optimized by combining environmental modeling and real-time obstacle avoidance to ensure the safe and efficient operation of the inspection robot in a complex environment, thereby improving the effect of the inspection robot in completing the inspection task.

[0151] Optionally, in the trajectory planning and control device of the inspection robot provided in the embodiment of the present application, the first determination unit includes: a first detection module, used to detect whether there are obstacles when the robot arm moves according to the optimized motion trajectory; a first adjustment module, used to adjust the optimized motion trajectory to obtain the first motion trajectory if there are obstacles when the robot arm moves according to the optimized motion trajectory; and a first determination module, used to not adjust the optimized motion trajectory if there are no obstacles when the robot arm moves according to the optimized motion trajectory, and use the optimized motion trajectory as the first motion trajectory.

[0152] Optionally, in the trajectory planning control device for the inspection robot provided in the embodiment of the present application, the calculation formula of the first adjustment module is: Where N is the degree of freedom of the robot arm, η i is the weight of the obstacle avoidance path optimization for the i-th degree of freedom, Ω iis the spatial region where obstacles can exist in the i-th degree of freedom, and X is the spatial region Ω i Any position vector, d i (X) is the obstacle distance function at position X in the intelligent obstacle avoidance system, which indicates the distance between the obstacle and the robotic arm. is the exponential decay function of the obstacle distance, parameter k i Determines the decay rate, For the space region Ω i The average obstacle avoidance effect within.

[0153] Optionally, in the trajectory planning control device of the inspection robot provided in the embodiment of the present application, the second determination unit includes: a first processing module, used to obtain the current position and posture information of the robotic arm, and determine the motion trajectory currently executed by the robotic arm based on the current position and posture information of the robotic arm; a first judgment module, used to judge whether there is a deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory; a second adjustment module, used to adjust the current motion parameters of the robotic arm to obtain the second motion trajectory if there is a deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory; a second determination module, used to not adjust the current motion parameters of the robotic arm if there is no deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory, and use the first motion trajectory as the second motion trajectory.

[0154] Optionally, in the trajectory planning control device for the inspection robot provided in the embodiment of the present application, the calculation formula of the second adjustment module is: Where N is the degree of freedom of the robot arm, is the weight parameter of the i-th degree of freedom, r i is the target position vector in the error compensation mechanism, s i (t) is the actual position vector, which represents the current position of the robot arm obtained by fusing the data collected by multiple sensors. i (t)-s i (t)|| 2 It is the square of the Euclidean distance between the target position and the actual position, indicating the magnitude of the error.

[0155] Optionally, in the trajectory planning control device for the inspection robot provided in the embodiment of the present application, the calculation formula of the multi-objective optimization model is: Where N is the degree of freedom of the robot arm, α i is the weight parameter of the i-th degree of freedom, t is the time variable, t0-t f is the time range of trajectory planning, p i (t) represents the current position of the robot arm in the i-th degree of freedom, which changes with time t, and q i(t) represents the planned position of the robot arm in the i-th degree of freedom, which changes with time t. is the square root of the trajectory deviation, indicating the smoothness and optimization degree of the trajectory.

[0156] Optionally, in the trajectory planning control device of the inspection robot provided in the embodiment of the present application, the second determination unit includes: a first generation module, used to generate control instructions based on the second motion trajectory; a first control module, used to control the robotic arm to move along the second motion trajectory according to the control instructions, so that the inspection robot completes the inspection task.

[0157] Optionally, in the trajectory planning control device of the inspection robot provided in the embodiment of the present application, the device also includes: a first acquisition unit, used to obtain information when the robotic arm moves along the second motion trajectory after controlling the robotic arm to move along the second motion trajectory according to a control instruction, so as to obtain the motion state information of the robotic arm and the change information of the environment in which the robotic arm is located; a first adjustment unit, used to adjust the second motion trajectory according to the motion state information of the robotic arm and the change information of the environment in which the robotic arm is located, so as to obtain the target motion trajectory; and a first control unit, used to control the robotic arm to move along the target motion trajectory, so that the inspection robot completes the inspection task.

[0158] Optionally, in the trajectory planning and control device of the inspection robot provided in the embodiment of the present application, the first processing unit includes: a first acquisition module, used to acquire data information related to the inspection robot collected by multiple sensors to obtain multiple data information, wherein the multiple sensors include: visual sensors, force sensors and acceleration sensors; a second processing module, used to fuse the multiple data information to obtain the environmental perception information and robotic arm status information of the inspection robot.

[0159] The trajectory planning control device of the inspection robot includes a processor and a memory. The above-mentioned first processing unit 501, second processing unit 502, first determination unit 503 and second determination unit 504 are all stored in the memory as program units, and the processor executes the above-mentioned program units stored in the memory to realize corresponding functions.

[0160] The processor contains a kernel, which calls the corresponding program unit from the memory. One or more kernels can be set, and the effect of the inspection robot completing the inspection task can be improved by adjusting the kernel parameters.

[0161] The memory may include non-permanent memory in a computer-readable medium, random access memory (RAM) and / or non-volatile memory, such as read-only memory (ROM) or flash RAM, and the memory includes at least one memory chip.

[0162] An embodiment of the present invention provides a computer-readable storage medium on which a program is stored. When the program is executed by a processor, the trajectory planning control method of the inspection robot is implemented.

[0163] An embodiment of the present invention provides a processor, which is used to run a program, wherein the trajectory planning control method of the inspection robot is executed when the program is running.

[0164] like Figure 6 As shown, an embodiment of the present invention provides an electronic device, the device includes a processor, a memory, and a program stored in the memory and executable on the processor, and the processor implements the following steps when executing the program: obtaining environmental perception information and mechanical arm state information of the inspection robot, and initializing the trajectory parameters of the initial motion trajectory according to the environmental perception information and mechanical arm state information of the inspection robot to obtain the processed trajectory parameters, wherein the initial motion trajectory represents the motion trajectory initially planned by the mechanical arm of the inspection robot; inputting the processed trajectory parameters into a multi-objective optimization model for iterative calculation to obtain an optimized motion trajectory, and controlling the mechanical arm to move according to the optimized motion trajectory, wherein the multi-objective optimization model is a model constructed by using a genetic algorithm or a particle swarm optimization algorithm and based on time information, energy consumption information, smoothness, and obstacle avoidance information of the mechanical arm execution trajectory; determining a first motion trajectory according to obstacle information of the mechanical arm in the process of moving according to the optimized motion trajectory, and controlling the mechanical arm to move according to the first motion trajectory; determining a second motion trajectory according to trajectory deviation information of the mechanical arm in the process of moving according to the first motion trajectory, and controlling the mechanical arm to move according to the second motion trajectory, so that the inspection robot completes the inspection task.

[0165] When the processor executes the program, the following steps are also implemented: based on the obstacle information when the robot arm moves according to the optimized motion trajectory, determining the first motion trajectory includes: detecting whether there are obstacles when the robot arm moves according to the optimized motion trajectory; if there are obstacles when the robot arm moves according to the optimized motion trajectory, adjusting the optimized motion trajectory to obtain the first motion trajectory; if there are no obstacles when the robot arm moves according to the optimized motion trajectory, not adjusting the optimized motion trajectory, and using the optimized motion trajectory as the first motion trajectory.

[0166] When the processor executes the program, the following steps are also implemented: if there is an obstacle when the robot arm moves according to the optimized motion trajectory, the optimized motion trajectory is adjusted, and the calculation formula for the first motion trajectory is obtained as follows: Where N is the degree of freedom of the robot arm, η iis the weight of the obstacle avoidance path optimization for the i-th degree of freedom, Ω i is the spatial region where obstacles can exist in the i-th degree of freedom, and X is the spatial region Ω i Any position vector, d i (X) is the obstacle distance function at position X in the intelligent obstacle avoidance system, which indicates the distance between the obstacle and the robotic arm. is the exponential decay function of the obstacle distance, parameter k i Determines the decay rate, For the space region Ω i The average obstacle avoidance effect within.

[0167] When the processor executes the program, the following steps are also implemented: determining the second motion trajectory based on the trajectory deviation information of the robotic arm during the movement according to the first motion trajectory includes: obtaining the current position and posture information of the robotic arm, and determining the motion trajectory currently executed by the robotic arm based on the current position and posture information of the robotic arm; judging whether there is a deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory; if there is a deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory, adjusting the current motion parameters of the robotic arm to obtain the second motion trajectory; if there is no deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory, not adjusting the current motion parameters of the robotic arm, and using the first motion trajectory as the second motion trajectory.

[0168] When the processor executes the program, the following steps are also implemented: if there is a deviation between the motion trajectory currently executed by the robot and the first motion trajectory, the current motion parameters of the robot are adjusted, and the calculation formula for obtaining the second motion trajectory is: Where N is the degree of freedom of the robot arm, is the weight parameter of the i-th degree of freedom, r i is the target position vector in the error compensation mechanism, s i (t) is the actual position vector, which represents the current position of the robot arm obtained by fusing the data collected by multiple sensors. i (t)-s i (t)|| 2 It is the square of the Euclidean distance between the target position and the actual position, indicating the magnitude of the error.

[0169] When the processor executes the program, the following steps are also implemented: The calculation formula of the multi-objective optimization model is: Where N is the degree of freedom of the robot arm, α i is the weight parameter of the i-th degree of freedom, t is the time variable, t0-t f is the time range of trajectory planning, p i(t) represents the current position of the robot arm in the i-th degree of freedom, which changes with time t, and q i (t) represents the planned position of the robot arm in the i-th degree of freedom, which changes with time t. is the square root of the trajectory deviation, indicating the smoothness and optimization degree of the trajectory.

[0170] When the processor executes the program, the following steps are also implemented: according to the second motion trajectory, the robotic arm is controlled to move so that the inspection robot completes the inspection task, including: according to the second motion trajectory, a control instruction is generated; according to the control instruction, the robotic arm is controlled to move according to the second motion trajectory so that the inspection robot completes the inspection task.

[0171] When the processor executes the program, the following steps are also implemented: after controlling the robotic arm to move along the second motion trajectory according to the control instruction, it also includes: obtaining information when the robotic arm moves along the second motion trajectory, obtaining the motion state information of the robotic arm and the change information of the environment in which the robotic arm is located; adjusting the second motion trajectory according to the motion state information of the robotic arm and the change information of the environment in which the robotic arm is located to obtain the target motion trajectory; controlling the robotic arm to move along the target motion trajectory so that the inspection robot completes the inspection task.

[0172] When the processor executes the program, the following steps are also implemented: obtaining the environmental perception information and robotic arm status information of the inspection robot, including: obtaining data information related to the inspection robot collected by multiple sensors to obtain multiple data information, wherein the multiple sensors include: visual sensors, force sensors and acceleration sensors; fusing multiple data information to obtain the environmental perception information and robotic arm status information of the inspection robot.

[0173] The devices in this article can be servers, PCs, PADs, mobile phones, etc.

[0174] The present application also provides a computer program product, which, when executed on a data processing device, is suitable for executing a program that is initialized with the following method steps: obtaining environmental perception information and mechanical arm status information of the inspection robot, and initializing the trajectory parameters of the initial motion trajectory based on the environmental perception information and mechanical arm status information of the inspection robot to obtain the processed trajectory parameters, wherein the initial motion trajectory is represented by the motion trajectory initially planned by the mechanical arm of the inspection robot; inputting the processed trajectory parameters into a multi-objective optimization model for iterative calculation to obtain an optimized motion trajectory, and controlling the mechanical arm to move according to the optimized motion trajectory, wherein the multi-objective optimization model is a model constructed using a genetic algorithm or a particle swarm optimization algorithm and based on the time information, energy consumption information, smoothness and obstacle avoidance information of the mechanical arm's execution trajectory; determining a first motion trajectory based on obstacle information when the mechanical arm moves according to the optimized motion trajectory, and controlling the mechanical arm to move according to the first motion trajectory; determining a second motion trajectory based on trajectory deviation information when the mechanical arm moves according to the first motion trajectory, and controlling the mechanical arm to move according to the second motion trajectory, so that the inspection robot completes the inspection task.

[0175] Those skilled in the art will appreciate that the embodiments of the present application may be provided as methods, systems, or computer program products. Therefore, the present application may adopt the form of a complete hardware embodiment, a complete software embodiment, or an embodiment in combination with software and hardware. Moreover, the present application may adopt the form of a computer program product implemented in one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) that include computer-usable program code.

[0176] The present application is described with reference to the flowcharts and / or block diagrams of the methods, devices (systems), and computer program products according to the embodiments of the present application. It should be understood that each process and / or box in the flowchart and / or block diagram, as well as the combination of the processes and / or boxes in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to generate a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.

[0177] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.

[0178] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.

[0179] In a typical configuration, a computing device includes one or more processors (CPU), input / output interfaces, network interfaces, and memory.

[0180] The memory may include non-permanent memory in a computer-readable medium, random access memory (RAM) and / or non-volatile memory in the form of read-only memory (ROM) or flash RAM. The memory is an example of a computer-readable medium.

[0181] Computer readable media include permanent and non-permanent, removable and non-removable media that can be implemented by any method or technology to store information. Information can be computer readable instructions, data structures, program modules or other data. Examples of computer storage media include, but are not limited to, phase change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM), read-only memory (ROM), electrically erasable programmable read-only memory (EEPROM), flash memory or other memory technology, compact disk read-only memory (CD-ROM), digital versatile disk (DVD) or other optical storage, magnetic cassettes, magnetic tape disk storage or other magnetic storage devices or any other non-transmission media that can be used to store information that can be accessed by a computing device. As defined herein, computer readable media does not include temporary computer readable media (transitory media), such as modulated data signals and carrier waves.

[0182] It should also be noted that the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, commodity or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, commodity or device. In the absence of more restrictions, the elements defined by the sentence "comprises a ..." do not exclude the existence of other identical elements in the process, method, commodity or device including the elements.

[0183] Those skilled in the art will appreciate that the embodiments of the present application may be provided as methods, systems or computer program products. Therefore, the present application may adopt the form of a complete hardware embodiment, a complete software embodiment or an embodiment in combination with software and hardware. Moreover, the present application may adopt the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) that contain computer-usable program code.

[0184] The above are only embodiments of the present application and are not intended to limit the present application. For those skilled in the art, the present application may have various changes and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present application should be included within the scope of the claims of the present application.

Claims

1. A trajectory planning and control method for an inspection robot, characterized in that: include: Acquire environmental perception information and mechanical arm state information of the inspection robot, and initialize trajectory parameters of the initial motion trajectory according to the environmental perception information and mechanical arm state information of the inspection robot to obtain processed trajectory parameters, wherein the initial motion trajectory represents the motion trajectory initially planned by the mechanical arm of the inspection robot; Inputting the processed trajectory parameters into a multi-objective optimization model for iterative calculation to obtain an optimized motion trajectory, and controlling the robotic arm to move according to the optimized motion trajectory, wherein the multi-objective optimization model is a model constructed using a genetic algorithm or a particle swarm optimization algorithm and based on time information, energy consumption information, smoothness, and obstacle avoidance information of the robotic arm's execution trajectory; Determining a first motion trajectory according to obstacle information when the robotic arm moves according to the optimized motion trajectory, and controlling the robotic arm to move according to the first motion trajectory; A second motion trajectory is determined based on trajectory deviation information of the robotic arm during movement along the first motion trajectory, and the robotic arm is controlled to move according to the second motion trajectory so that the inspection robot completes the inspection task.

2. The method according to claim 1, characterized in that Determining the first motion trajectory according to obstacle information when the robot arm moves according to the optimized motion trajectory includes: Detecting whether there is an obstacle when the robotic arm moves according to the optimized motion trajectory; If there is an obstacle when the robot arm moves according to the optimized motion trajectory, adjusting the optimized motion trajectory to obtain the first motion trajectory; If there is no obstacle when the robot arm moves according to the optimized motion trajectory, the optimized motion trajectory is not adjusted, and the optimized motion trajectory is used as the first motion trajectory.

3. The method according to claim 2, characterized in that If there is an obstacle when the robot arm moves according to the optimized motion trajectory, the optimized motion trajectory is adjusted, and the calculation formula for obtaining the first motion trajectory is: Wherein, N is the degree of freedom of the robotic arm, η i is the weight of the obstacle avoidance path optimization for the i-th degree of freedom, Ω i is the spatial region where obstacles can exist in the i-th degree of freedom, and X is the spatial region Ω i Any position vector, d i (X) is the obstacle distance function at position X in the intelligent obstacle avoidance system, indicating the distance of the obstacle from the robotic arm, is the exponential decay function of the obstacle distance, parameter k i Determines the decay rate, For the space region Ω i The average obstacle avoidance effect within.

4. The method according to claim 1, characterized in that: Determining the second motion trajectory according to trajectory deviation information of the robot arm in a process of moving according to the first motion trajectory includes: Acquire the current position and posture information of the robotic arm, and determine the motion trajectory currently executed by the robotic arm based on the current position and posture information of the robotic arm; Determine whether there is a deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory; If there is a deviation between the motion trajectory currently executed by the robot arm and the first motion trajectory, adjusting the current motion parameters of the robot arm to obtain the second motion trajectory; If there is no deviation between the motion trajectory currently executed by the robotic arm and the first motion trajectory, the current motion parameters of the robotic arm are not adjusted, and the first motion trajectory is used as the second motion trajectory.

5. The method according to claim 4, characterized in that If there is a deviation between the motion trajectory currently executed by the robot arm and the first motion trajectory, the current motion parameters of the robot arm are adjusted to obtain the calculation formula for the second motion trajectory: Wherein, N is the degree of freedom of the robotic arm, is the weight parameter of the i-th degree of freedom, r i is the target position vector in the error compensation mechanism, s i (t) is the actual position vector, which represents the current position of the robot arm obtained by fusing the data collected by multiple sensors, ||r i (t)-s i (t)|| 2 It is the square of the Euclidean distance between the target position and the actual position, indicating the magnitude of the error.

6. The method according to claim 1, characterized in that The calculation formula of the multi-objective optimization model is: Wherein, N is the degree of freedom of the robot arm, α i is the weight parameter of the i-th degree of freedom, t is the time variable, t0-t f is the time range of trajectory planning, p i (t) represents the current position of the robot arm in the i-th degree of freedom, which changes with time t, and q i (t) represents the planned position of the robot arm in the i-th degree of freedom, which changes with time t. is the square root of the trajectory deviation, indicating the smoothness and optimization degree of the trajectory.

7. The method according to claim 1, characterized in that According to the second motion trajectory, controlling the mechanical arm to move so that the inspection robot completes the inspection task includes: generating a control instruction according to the second motion trajectory; According to the control instruction, the mechanical arm is controlled to move according to the second motion trajectory, so that the inspection robot completes the inspection task.

8. The method according to claim 7, characterized in that After controlling the robot arm to move along the second motion trajectory according to the control instruction, the method further includes: Acquire information when the robotic arm moves along the second motion trajectory, and obtain motion state information of the robotic arm and change information of the environment in which the robotic arm is located; According to the motion state information of the robotic arm and the change information of the environment in which the robotic arm is located, adjusting the second motion trajectory to obtain a target motion trajectory; The mechanical arm is controlled to move according to the target motion trajectory so that the inspection robot completes the inspection task.

9. The method according to claim 1, characterized in that: Obtaining the inspection robot's environmental perception information and robotic arm status information includes: Acquire data information related to the inspection robot collected by multiple sensors to obtain multiple data information, wherein the multiple sensors include: a visual sensor, a force sensor, and an acceleration sensor; The multiple data information are fused and processed to obtain the environmental perception information and mechanical arm status information of the inspection robot.

10. A trajectory planning control device for an inspection robot, characterized in that: include: A first processing unit is used to obtain environmental perception information and mechanical arm state information of the inspection robot, and initialize trajectory parameters of an initial motion trajectory according to the environmental perception information and mechanical arm state information of the inspection robot to obtain processed trajectory parameters, wherein the initial motion trajectory represents an initial planned motion trajectory of the mechanical arm of the inspection robot; A second processing unit is used to input the processed trajectory parameters into a multi-objective optimization model for iterative calculation to obtain an optimized motion trajectory, and control the robot arm to move according to the optimized motion trajectory, wherein the multi-objective optimization model is a model constructed by using a genetic algorithm or a particle swarm optimization algorithm and based on time information, energy consumption information, smoothness and obstacle avoidance information of the robot arm's execution trajectory; a first determining unit, configured to determine a first motion trajectory according to obstacle information when the robot arm moves according to the optimized motion trajectory, and control the robot arm to move according to the first motion trajectory; The second determination unit is used to determine a second motion trajectory based on trajectory deviation information of the robot arm during the movement according to the first motion trajectory, and control the robot arm to move according to the second motion trajectory so that the inspection robot completes the inspection task.

Citation Information

Patent Citations

  • Multi-freedom-degree mechanical arm obstacle avoiding path planning method

    CN110125943A

  • Robotic arm control method based on man-machine fusion

    CN111152220A

  • Mechanical arm track optimization obtaining method based on improved multi-target PSO algorithm

    CN116352697A

  • Method to optimize robot motion planning using deep learning

    US20210365032A1

  • Robot planning

    US20220193907A1

Cited By

  • Multi-mechanical-arm synchronous control system based on position instruction

    CN119820560A

  • Rail-mounted robot inspection control method and system based on Internet of Things

    CN120645222A

  • Rail robot inspection control method and system based on internet of things

    CN120645222B

  • Data acquisition method and equipment for humanoid robot training ground

    CN121083647A

  • Intelligent inspection method and device for rail type inspection robot

    CN121146232A