Robot energy management method and related system, storage medium and program

By analyzing mobile and operational data, real-time obstacles and energy consumption, and using Kalman filter to calculate the status of lithium battery, the problem of insufficient battery life of the mobile robot is solved, and the continuous completion of tasks and energy management are achieved.

CN119005473AActive Publication Date: 2024-11-22广州信邦智能装备股份有限公司
View PDF 3 Cites 0 Cited by

Patent Information

Application Number
CN202411168016.3
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-05
Publication Date
2024-11-22
Estimated Expiration
2044-07-05

AI Technical Summary

Technical Problem

Mobile robots have weak battery life during production. How to effectively manage energy to avoid power outages caused by overcharging or improper power management.

Method used

By obtaining planned mobile and operation data, real-time obstacle data, analyzing actual paths and energy consumption, using Kalman filtering to calculate the charge status of lithium batteries, determine whether charging is needed, and ensure that the robot can complete the task smoothly.

Benefits of technology

Effectively manage the energy of mobile robots, avoid power outages, and ensure task continuity and productivity.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119005473A_ABST
    Figure CN119005473A_ABST
Patent Text Reader

Abstract

The invention provides a mobile robot energy management method and system and a storage medium, and the method specifically comprises the steps: obtaining planning movement data, planning operation data, movement obstacle real-time data and operation obstacle real-time data, analyzing actual movement path data and actual operation path data, calculating overall energy consumption data, and storing the overall energy consumption data. State-of-charge data of a lithium battery of the mobile robot is obtained based on Kalman filtering analysis, energy management is carried out before mobile operation and operation according to the total energy consumption of the robot and residual electric quantity before operation, and state data of the lithium battery of the mobile robot after operation are collected. Therefore, energy management and the like are carried out after the moving operation and the running operation are executed. Based on the scheme, energy management can be carried out on the mobile robot before and after use, it is ensured that the mobile robot can smoothly and coherently complete tasks, and the phenomenon that power is cut off in the task execution process due to overcharging or improper power management is avoided.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of industrial robot control, and in particular to a mobile robot energy management method applied to industrial production, and a related system, storage medium and program. Background Art

[0002] Industrial robots can replace human labor to complete simple, repetitive tasks in the industrial production process, and can serve product quality and production efficiency while ensuring operational safety.

[0003] Industrial robots can be divided into fixed robots and mobile robots based on whether their positions are fixed or not. Fixed robots are set on mobile production lines, which drive the movement of products or parts. When they reach a certain position of the fixed robots, they perform specific operations according to preset operation instructions. Mobile robots can move freely within a certain area to complete tasks such as picking up parts, assembling, and transporting. This technical solution is optimized based on mobile robots.

[0004] Mobile robots are generally required to have a long moving distance and need to be coordinated with a robotic arm for fine operations. Most of these robots have their own independent energy sources, but because they carry mobile and operating functions, they consume a lot of energy during the production process and generally have poor endurance. How to manage the energy of mobile robots and solve the "endurance anxiety" of mobile robots during the production process is an issue that the industry urgently needs to solve. Summary of the invention

[0005] The technical problem to be solved by the present invention is that, in view of the above-mentioned defects of the prior art, a mobile robot energy management method, system and storage medium are provided, which can perform energy management before and after use to ensure that the mobile robot can complete the task smoothly and continuously, and avoid overcharging or power failure during the execution of the task due to improper power management.

[0006] The technical solution adopted by the present invention to solve the technical problem is as follows:

[0007] A mobile robot energy management method, the method comprising the following steps: S1. Acquire planned movement data and planned operation data, wherein the planned movement data is used to control the mobile robot to perform movement operations in a preset movement space according to preset movement instructions, and the planned operation data is used to control the mobile robot to perform operation operations in a preset operation space according to preset operation instructions; S2. Obtaining real-time data of movement obstacles and real-time data of operation obstacles, wherein the real-time data of movement obstacles includes real-time two-dimensional data of obstacles in the movement space, and the real-time data of operation obstacles includes real-time three-dimensional data of obstacles in the operation space; S3. According to the planned movement data and the real-time movement obstacle data, the actual movement path data is analyzed and obtained, and the actual movement path data is used to control the mobile robot to move in a preset movement space according to the optimized movement instruction to perform the movement operation; S4. According to the planned operation data and the real-time data of the operation obstacle, the actual operation path data is analyzed, and the actual operation path data is used to control the mobile robot to perform the operation operation in the preset operation space according to the optimized operation instruction; S5. Calculate the mobile energy consumption data based on the actual mobile path data and the AGV operating parameters, calculate the operating energy consumption data based on the actual operating path data and the robot arm operating parameters, and obtain the overall energy consumption data by summing the mobile energy consumption data and the operating energy consumption data, wherein the overall energy consumption data is the total energy consumption of the robot required to execute the instructions contained in the actual mobile path data and the actual operating path data; S6. Based on Kalman filter analysis, the state of charge data of the lithium battery of the mobile robot is obtained, wherein the state of charge data includes the remaining power of the lithium battery before operation, and the remaining power before operation is the remaining power before the mobile robot performs the moving operation and the running operation; S7. Perform energy management before executing the moving operation and the running operation according to the total energy consumption of the robot and the remaining power before operation; when the remaining power before operation is greater than the total energy consumption of the robot, the energy management analysis result is to execute the running operation, and the mobile robot is controlled to execute the moving operation and the running operation; when the remaining power before operation is less than or equal to the total energy consumption of the robot, the energy management analysis result is to execute the charging operation, and the mobile robot is controlled to execute the charging operation; S8. Control the mobile robot to perform a mobile operation in a preset mobile space according to the optimized mobile instruction, and control the mobile robot to perform an operation operation in a preset operation space according to the optimized operation instruction until all mobile operations and operation operations are completed; S9. Collect the post-operation status data of the mobile robot's lithium battery, calculate the post-operation remaining power of the lithium battery based on the post-operation status data, compare it with the preset charging threshold, and determine whether the mobile robot needs to perform a charging operation, so as to perform energy management after performing the moving operation and the running operation; the post-operation status data includes voltage, current, and temperature, and the post-operation remaining power is the remaining power of the mobile robot after performing the moving operation and the running operation.

[0008] Further, in step S3, the actual movement path data is analyzed based on the planned movement data and the real-time movement obstacle data, specifically including: S301. Establishing a mobile space coordinate system in a preset mobile space, wherein the mobile space coordinate system is a two-dimensional Cartesian coordinate system; S302. Acquire planned movement data, analyze the planned movement data to obtain a plurality of discrete path points of the planned movement path, and further convert the coordinate values ​​of the plurality of discrete path points corresponding to the mobile space coordinate system, wherein the first discrete path point is the initial position point and the last discrete path point is the target position point; S303. Collecting real-time data of mobile obstacles, analyzing the real-time data of mobile obstacles to obtain multiple obstacle positions, and further converting the coordinate values ​​of the multiple obstacle positions corresponding to the mobile space coordinate system; S304. According to the coordinate values ​​corresponding to the discrete path points and the coordinate values ​​corresponding to the obstacle position points, the target node in the mobile space coordinate system is searched based on the A* algorithm, and the parent node is backtracked along each searched target node to form obstacle avoidance movement path data; S305. Select three path position points in the obstacle avoidance moving path data, and further obtain the coordinate values ​​corresponding to the three path position points in the moving space coordinate system; S306. Based on the coordinate values ​​corresponding to the three path position points in the mobile space coordinate system, the obstacle avoidance movement path data is smoothed according to the quadratic Bezier curve to obtain the actual movement path data, where the formula of the quadratic Bezier curve is: , specifically, , and are the coordinate values ​​of the three path position points in the mobile space coordinate system. The parameter t ranges from 0 to 1. B(t) represents the coordinate value of each position point on the actual mobile path data in the mobile space coordinate system.

[0009] Further, in step S4, the actual operation path data obtained by analysis based on the planned operation data and the real-time operation obstacle data specifically includes: S401. Acquire the planned operation data, and obtain the spatial coordinate value corresponding to the preset operation path of the robot arm in the operation space according to the planned operation data analysis; S402. Scan and obtain the spatial coordinate values ​​corresponding to the obstacles in the operating space; S403. According to the spatial coordinate values ​​of the robot arm in the operating space, obtain the spatial coordinate values ​​corresponding to at least three robot arm base points on the robot arm , and ,according to , and Construct a robotic arm space packaging box; obtain the spatial coordinate values ​​corresponding to at least two obstacle base points of the obstacle based on the spatial coordinate values ​​of the obstacle in the operating space and ,according to and Construct obstacle space packaging box; S404. By comparing whether there is overlap in the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, collision detection and matching are performed on the robot and the obstacle to determine whether there is a collision risk; when there is no overlap in the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, it is determined that there is no collision risk, and the planned operation data is used as the actual operation path data; when there is overlap in the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, it is determined that there is a collision risk, and the path optimization adjustment is performed; S405. Perform obstacle avoidance path planning based on the RRT algorithm to obtain the actual operation path of the robot arm in the operation space, and generate actual operation path data based on the actual operation path.

[0010] Further, in step S5, calculating the mobile energy consumption data based on the actual mobile path data and the AGV operation parameters specifically includes the following steps: S501. Analyze AGV power based on AGV operating parameters; S502. Analyze the AGV running track length and the AGV running speed based on the actual moving path data and the AGV running parameters, and calculate the AGV running time based on the AGV running track length and the AGV running speed; S503. According to as well as Calculate mobile energy consumption data, where: is the AGV power, L is the length of the AGV running track, is the AGV running speed, is the AGV running time, For mobile energy consumption;

[0011] In step S5, the operation energy consumption data is calculated based on the actual operation path data and the operation parameters of the robot arm, and specifically includes the following steps: S511. Analyze the average speed, friction resistance, displacement, mass, operation time and joint drive power of each joint in the robot arm based on the robot arm operation parameters; S512. Analyze the robot operation time based on the actual operation path data and the robot operation parameters; S513. Pass Calculate the inertial energy consumption of the robot arm, where: is the inertial energy consumption of the robot arm, m is the joint mass, is the average speed; S514. Pass Calculate the friction energy consumption of the robot arm, where is the friction energy consumption of the robot arm, is the friction resistance, is the displacement; S515. Pass Calculate the electrical energy consumption of the robot arm, where is the electrical energy consumption of the robot arm, is the joint driving power, is the running time of the robot arm; S516.According to Calculate the operating energy consumption data of the robot arm, where the operating energy consumption data It is the sum of motion inertia energy consumption, friction energy consumption and electrical energy consumption.

[0012] Further, in step S6, obtaining the state of charge data of the lithium battery of the mobile robot based on Kalman filter analysis specifically includes the following steps: S601. Set the initial state vector and initial error covariance of the lithium battery, where the initial state vector is , the initial error covariance is , is the initial state vector of the lithium battery at time step k=0, is the initial state of charge value, is the initial voltage state value, is the initial current state value, is the initial error covariance vector of the lithium battery at time step k = 0, is the uncertainty value of the state of charge, is the voltage state uncertainty value, is the uncertainty value of the current state; S602. Perform state prediction according to the state prediction equation and the prediction error covariance, analyze the state prediction state vector and the error covariance vector one step forward, and obtain the state prediction state vector and the error covariance vector of the lithium battery at the time step k-1, where the state prediction equation is , the prediction error covariance is , A is the state transfer matrix, B is the control matrix, is the control input value at time step k-1, is the covariance matrix of the process noise, T represents the matrix transpose, is the prediction error covariance corresponding to time step K, is the prediction error covariance corresponding to time step K-1, is the state prediction equation corresponding to time step K, is the state prediction equation corresponding to time step K-1; S603. Execute Kalman filter gain update to obtain Kalman filter gain, where the Kalman filter gain is , H is the observation matrix, R is the covariance matrix of the observation noise; S604. Perform state update and error covariance update based on Kalman filter gain to obtain an updated state vector and an updated error covariance vector of the lithium battery, wherein the updated state vector of the lithium battery is , is the voltage observation value or current observation value of the lithium battery at the current time step, and the updated error covariance vector is , is the identity matrix; S605. At each time step k, repeat the state prediction and Kalman filter gain update, and output the lithium battery state of charge data corresponding to each time step k.

[0013] Correspondingly, a mobile robot energy management system, the system comprising: A planning data acquisition module, used to acquire planned movement data and planned operation data, wherein the planned movement data is used to control the mobile robot to perform movement operations in a preset movement space according to preset movement instructions, and the planned operation data is used to control the mobile robot to perform operation operations in a preset operation space according to preset operation instructions; A real-time data acquisition module, used to acquire real-time data of movement obstacles and real-time data of operation obstacles, wherein the real-time movement obstacle data includes real-time two-dimensional data of obstacles in the movement space, and the real-time operation obstacle data includes real-time three-dimensional data of obstacles in the operation space; An actual movement path analysis module is used to analyze the planned movement data and the real-time movement obstacle data to obtain the actual movement path data, and the actual movement path data is used to control the mobile robot to move and perform movement operations in a preset movement space according to the optimized movement instructions; An actual operation path analysis module is used to analyze the actual operation path data obtained according to the planned operation data and the real-time operation obstacle data, and the actual operation path data is used to control the mobile robot to perform operation operations in a preset operation space according to the optimized operation instructions; An energy consumption analysis module is used to calculate the movement energy consumption data based on the actual movement path data and the AGV operation parameters, calculate the operation energy consumption data based on the actual operation path data and the robot arm operation parameters, and obtain the overall energy consumption data by summing the movement energy consumption data and the operation energy consumption data, wherein the overall energy consumption data is the total energy consumption of the robot required for the robot to execute the instructions contained in the actual movement path data and the actual operation path data; A state of charge analysis module, used to obtain the state of charge data of the lithium battery of the mobile robot based on Kalman filter analysis, wherein the state of charge data includes the remaining power of the lithium battery before operation, and the remaining power before operation is the remaining power before the mobile robot performs movement operation and operation operation; The first energy management module is used to perform energy management before executing the moving operation and the running operation according to the total energy consumption of the robot and the remaining power before the operation; when the remaining power before the operation is greater than the total energy consumption of the robot, the energy management analysis result is to execute the running operation, and the mobile robot is controlled to execute the moving operation and the running operation; when the remaining power before the operation is less than or equal to the total energy consumption of the robot, the energy management analysis result is to execute the charging operation, and the mobile robot is controlled to execute the charging operation; An execution module, used to control the mobile robot to perform a movement operation in a preset movement space according to the optimized movement instruction, and to control the mobile robot to perform an operation operation in a preset operation space according to the optimized operation instruction, until all movement operations and operation operations are completed; The second energy management module is used to collect the post-operation status data of the mobile robot's lithium battery, calculate the post-operation remaining power of the lithium battery based on the post-operation status data, compare it with the preset charging threshold, and determine whether the mobile robot needs to perform a charging operation, so as to perform energy management after performing the moving operation and the running operation; the post-operation status data includes voltage, current, and temperature, and the post-operation remaining power is the remaining power of the mobile robot after performing the moving operation and the running operation.

[0014] Furthermore, the actual moving path analysis module specifically includes: A mobile space coordinate establishing unit, used to establish a mobile space coordinate system in a preset mobile space, wherein the mobile space coordinate system is a two-dimensional Cartesian coordinate system; A mobile coordinate calculation unit is used to obtain the planned mobile data, obtain a plurality of discrete path points of the planned mobile path according to the planned mobile data analysis, and further convert the coordinate values ​​corresponding to the plurality of discrete path points in the mobile space coordinate system, wherein the first discrete path point is the initial position point and the last discrete path point is the target position point; A mobile obstacle coordinate acquisition unit collects real-time data of mobile obstacles, obtains multiple obstacle position points according to the real-time data of mobile obstacles, and further converts the coordinate values ​​corresponding to the multiple obstacle position points in the mobile space coordinate system; A mobile obstacle avoidance path analysis unit is used to search for target nodes in the mobile space coordinate system based on the A* algorithm according to the coordinate values ​​corresponding to the discrete path points and the coordinate values ​​corresponding to the obstacle position points, and to perform parent node backtracking along each searched target node to form obstacle avoidance mobile path data; A moving path position selection unit, used to select three path position points in the obstacle avoidance moving path data, and further obtain the coordinate values ​​corresponding to the three path position points in the moving space coordinate system; The moving path smoothing processing unit is used to smooth the obstacle avoidance moving path data according to the coordinate values ​​corresponding to the three path position points in the moving space coordinate system according to the quadratic Bezier curve to obtain the actual moving path data, wherein the formula of the quadratic Bezier curve is: , specifically, , and are the coordinate values ​​of the three path position points in the mobile space coordinate system. The parameter t ranges from 0 to 1. B(t) represents the coordinate value of each position point on the actual mobile path data in the mobile space coordinate system.

[0015] Furthermore, the actual operation path analysis module specifically includes: A planning operation data acquisition unit is used to acquire the planning operation data, and obtain the spatial coordinate value corresponding to the preset operation path of the robot arm in the operation space according to the planning operation data analysis; An operation obstacle coordinate acquisition unit is used to scan and obtain the space coordinate values ​​corresponding to the obstacles in the operation space; The packaging box construction unit is used to obtain the spatial coordinate values ​​corresponding to at least three robotic arm base points on the robotic arm according to the spatial coordinate values ​​of the robotic arm in the operating space. , and ,according to , and Construct a robotic arm space packaging box; obtain the spatial coordinate values ​​corresponding to at least two obstacle base points of the obstacle based on the spatial coordinate values ​​of the obstacle in the operating space and ,according to and Construct obstacle space packaging box; The projection analysis unit is used to perform collision detection and matching between the robot and the obstacle by comparing whether there is overlap in the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, and to determine whether there is a collision risk; when there is no overlap in the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, it is determined that there is no collision risk, and the planned operation data is used as the actual operation path data; when there is overlap in the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, it is determined that there is a collision risk, and the path optimization adjustment is performed; The operation obstacle avoidance path planning unit is used to perform obstacle avoidance path planning based on the RRT algorithm, obtain the actual operation path of the robot arm in the operation space, and generate actual operation path data according to the actual operation path.

[0016] Furthermore, the energy consumption analysis module specifically includes: AGV power analysis unit, used to analyze AGV power based on AGV operating parameters; An AGV moving time analysis unit, used for analyzing the AGV running track length and the AGV running speed based on the actual moving path data and the AGV running parameters, and calculating the AGV running time based on the AGV running track length and the AGV running speed; AGV mobile energy consumption calculation unit is used to calculate the energy consumption of as well as Calculate mobile energy consumption data, where: is the AGV power, L is the length of the AGV running track, is the AGV running speed, is the AGV running time, For mobile energy consumption; A robot arm parameter acquisition unit, used to analyze the average speed, friction resistance, displacement, mass, running time and joint driving power of each joint in the robot arm based on the robot arm operation parameters; A robot arm operation time calculation unit, used for analyzing the robot arm operation time based on actual operation path data and robot arm operation parameters; The inertial energy calculation unit of the robot arm is used to calculate the inertial energy of the robot arm. Calculate the inertial energy consumption of the robot arm, where: is the inertial energy consumption of the robot arm, m is the joint mass, is the average speed; The mechanical arm friction energy calculation unit is used to Calculate the friction energy consumption of the robot arm, where is the friction energy consumption of the robot arm, is the friction resistance, is the displacement; The electrical energy consumption calculation unit of the robot arm is used to calculate the Calculate the electrical energy consumption of the robot arm, where is the electrical energy consumption of the robot arm, is the joint driving power, is the running time of the robot arm; The robot arm operation energy consumption calculation unit is used to calculate the energy consumption of the robot arm according to the Calculate the operating energy consumption data of the robot arm, where the operating energy consumption data It is the sum of motion inertia energy consumption, friction energy consumption and electrical energy consumption.

[0017] Furthermore, the charge state analysis module specifically includes: The initial condition setting unit is used to set the initial state vector and initial error covariance of the lithium battery, where the initial state vector is , the initial error covariance is , is the initial state vector of the lithium battery at time step k=0, is the initial state of charge value, is the initial voltage state value, is the initial current state value, is the initial error covariance vector of the lithium battery at time step k = 0, is the uncertainty value of the state of charge, is the voltage state uncertainty value, is the uncertainty value of the current state; The state prediction unit is used to perform state prediction according to the state prediction equation and the prediction error covariance, analyze the state prediction state vector and the error covariance vector one step forward, and obtain the state prediction state vector and the error covariance vector of the lithium battery at the time step k-1, where the state prediction equation is , the prediction error covariance is , A is the state transfer matrix, B is the control matrix, is the control input value at time step k-1, is the covariance matrix of the process noise, T represents the matrix transpose, is the prediction error covariance corresponding to time step K, is the prediction error covariance corresponding to time step K-1, is the state prediction equation corresponding to time step K, is the state prediction equation corresponding to time step K-1; The Kalman filter gain update unit is used to perform Kalman filter gain update to obtain the Kalman filter gain, where the Kalman filter gain is , H is the observation matrix, R is the covariance matrix of the observation noise; The update execution unit is used to perform state update and error covariance update based on the Kalman filter gain to obtain the updated state vector and updated error covariance vector of the lithium battery, wherein the updated state vector of the lithium battery is , is the voltage observation value or current observation value of the lithium battery at the current time step, and the updated error covariance vector is , is the identity matrix; The state of charge acquisition unit is used to repeatedly perform state prediction and Kalman filter gain update at each time step k, and output the lithium battery state of charge data corresponding to each time step k.

[0018] Correspondingly, a storage medium stores a computer program, wherein the computer program includes program instructions. When the program instructions are executed by a processor, the processor executes the mobile robot energy management method as described above.

[0019] Compared with the prior art, the beneficial effects of the present technical solution are: after adjusting the planned mobile data and the planned operation data to obtain the actual mobile path data and the actual operation path data, the total energy consumption of the robot is analyzed and obtained, and energy management evaluation is performed before and after the task is performed to ensure that the mobile robot can complete the task smoothly and continuously, and avoid overcharging or power outages during the task due to improper power management. BRIEF DESCRIPTION OF THE DRAWINGS

[0020] Figure 1 It is a flow chart of the mobile robot energy management method of the present invention.

[0021] Figure 2 It is a structural schematic diagram of the mobile robot energy management system of the present invention.

[0022] In the figure, the components represented by the reference numerals are shown as follows: Planning data acquisition module 1, real-time data acquisition module 2, actual movement path analysis module 3, actual operation path analysis module 4, energy consumption analysis module 5, charge state analysis module 6, first energy management module 7, execution module 8, second energy management module 9. DETAILED DESCRIPTION

[0023] In order to make the purpose, technical solution and advantages of the present invention clearer and more specific, the present invention is further described in detail below with reference to the accompanying drawings and examples. It should be understood that the specific embodiments described herein are only used to explain the present invention and are not used to limit the present invention.

[0024] In the description of the present invention, it should be understood that the orientations or positional relationships indicated by the terms "center", "upper", "lower", "front", "back", "left", "right", etc. are based on the orientations or positional relationships shown in the drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or component referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the present invention. In addition, the terms "first" and "second" are used for descriptive purposes only and cannot be understood as indicating or implying relative importance.

[0025] In the description of the present invention, it should be noted that, unless otherwise clearly specified and limited, the terms "installed", "connected" and "connected" should be understood in a broad sense. For example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be an indirect connection through an intermediate medium, or it can be a connection between the two components. When a component is referred to as being "fixed to" or "disposed on" another element, it can be directly on the other component or there can also be a central component. When a component is considered to be "connected" to another element, it can be directly connected to the other element or there can be a central element at the same time. For those of ordinary skill in the art, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.

[0026] Industrial robots can replace human labor to complete simple, repetitive tasks in the industrial production process, and can serve product quality and production efficiency while ensuring operational safety.

[0027] Industrial robots can be divided into fixed robots and mobile robots based on whether their positions are fixed or not. Fixed robots are set on mobile production lines, which drive the movement of products or parts. When they reach a certain position of the fixed robots, they perform specific operations according to preset operation instructions. Mobile robots can move freely within a certain area to complete tasks such as picking up parts, assembling, and transporting. This technical solution is optimized based on mobile robots.

[0028] Mobile robots are generally required to have a long moving distance and need to be coordinated with a robotic arm for fine operations. Most of these robots have their own independent energy sources, but because they carry mobile and operating functions, they consume a lot of energy during the production process and generally have poor endurance. How to manage the energy of mobile robots and solve the "endurance anxiety" of mobile robots during the production process is an issue that the industry urgently needs to solve.

[0029] like Figure 1 As shown, in order to solve the above technical problems, this technical solution provides a mobile robot energy management method, system and storage medium. Before executing a task, the required energy consumption is obtained by analyzing the mobile energy consumption data and operating energy consumption data required by the mobile robot, and the remaining battery capacity of the lithium battery is analyzed by the state of charge data, so as to determine whether the lithium battery can support the mobile robot to complete the task in one go; after executing the task, the remaining power of the lithium battery after operation is calculated according to the post-operation state data, and it is determined whether the mobile robot needs to perform a charging operation, so as to prepare in advance for the next task. Based on the above solution, the mobile robot is energy managed to solve the "range anxiety" of the mobile robot in the production process.

[0030] like Figure 1As shown, a mobile robot energy management method comprises the following steps: S1. Obtain the planned movement data and the planned operation data, wherein the planned movement data is used to control the mobile robot to perform movement operations in a preset movement space according to preset movement instructions, and the planned operation data is used to control the mobile robot to perform operation operations in a preset operation space according to preset operation instructions. Structurally, the mobile robot includes two major functional components, AGV and mechanical arm. The AGV is responsible for completing movement in the movement space, while the mechanical arm is responsible for completing operations in the operation space. In step S1, the planned movement data is the movement path data pre-planned according to the actual situation of the movement space. The mobile robot is carried on an AGV. Ideally, the AGV can move according to the instructions in the two-dimensional movement space, from one point to another, and the AGV's arrival from one point to another is the result of executing the instructions contained in the planned movement data; similarly, the planned operation data is the operation path data pre-planned according to the actual situation of the operation space. By executing the planned operation data, the mechanical arm can be controlled to operate in a specific manner to complete the refined actions required for production.

[0031] S2. Obtain real-time data of movement obstacles and real-time data of operation obstacles, wherein the real-time data of movement obstacles includes real-time two-dimensional data of obstacles in the movement space, and the real-time data of operation obstacles includes real-time three-dimensional data of obstacles in the operation space. In step S2, the real-time data of movement obstacles reflects the real-time position of obstacles in the movement space, and the real-time data of operation obstacles reflects the real-time position of obstacles in the operation space. The real-time data of movement obstacles and the real-time data of operation obstacles can be obtained based on an industrial binocular camera.

[0032] S3. According to the planned movement data and the real-time data of movement obstacles, the actual movement path data is analyzed and obtained, and the actual movement path data is used to control the mobile robot to move in the preset movement space according to the optimized movement instructions to perform movement operations. The planned movement data can control the movement of the AVG under ideal conditions, but due to the existence of obstacles in the movement space, the planned movement data is no longer applicable. In step S3, the actual movement path data can be calculated by combining the planned movement data and the real-time data of movement obstacles. The influence of obstacles on the AVG can be overcome through the actual movement path data, so that the AVG can make slight adjustments based on the planned movement path and complete the predetermined action.

[0033] S4. According to the planned operation data and the real-time operation obstacle data, the actual operation path data is analyzed and obtained, and the actual operation path data is used to control the mobile robot to perform operation operations in the preset operation space according to the optimized operation instructions. The principle of step S4 is similar to that of step S3. The planned operation data can control the operation of the robot arm under ideal conditions, but due to the existence of obstacles in the operation space, the planned operation data is no longer applicable. In step S4, the actual operation path data can be calculated by combining the planned operation data and the real-time operation obstacle data. The actual operation path data can overcome the influence of obstacles on the robot arm, so that the robot arm can make slight adjustments based on the planned operation data to complete the predetermined action.

[0034] S5. Calculate the mobile energy consumption data based on the actual mobile path data and the AGV operating parameters, calculate the operating energy consumption data based on the actual operating path data and the robot arm operating parameters, and obtain the overall energy consumption data by summing the mobile energy consumption data and the operating energy consumption data. The overall energy consumption data is the total energy consumption of the robot required for the robot to execute the instructions contained in the actual mobile path data and the actual operating path data. The function of step S5 is to calculate the energy consumption of the AGV and the robot arm under actual working conditions based on the actual mobile path data and the AGV operating parameters, the actual operating path data and the robot arm operating parameters. The AGV corresponds to the mobile energy consumption data, and the robot arm corresponds to the operating energy consumption data. The overall energy consumption data can be calculated based on the mobile energy consumption data and the operating energy consumption data.

[0035] S6. Based on Kalman filter analysis, the state of charge data of the lithium battery of the mobile robot is obtained, and the state of charge data includes the remaining power of the lithium battery before operation, and the remaining power before operation is the remaining power before the mobile robot performs the moving operation and the running operation. The function of step S6 is to calculate the remaining power of the mobile robot before performing the task through Kalman filter analysis.

[0036] S7. Perform energy management before executing the moving operation and the running operation according to the total energy consumption of the robot and the remaining power before operation; when the remaining power before operation is greater than the total energy consumption of the robot, the energy management analysis result is to execute the running operation, and the mobile robot is controlled to execute the moving operation and the running operation; when the remaining power before operation is less than or equal to the total energy consumption of the robot, the energy management analysis result is to execute the charging operation, and the mobile robot is controlled to execute the charging operation. The function of step S7 is to judge whether the current power can support the completion of the task before the mobile robot executes the task by comparing the remaining power before operation with the total energy consumption of the robot, and to perform corresponding control: if the current power can support the completion of the task, the current task is executed; if the current power cannot support the completion of the task, the charging task is executed.

[0037] S8. Control the mobile robot to perform movement operations in the preset movement space according to the optimized movement instructions, and control the mobile robot to perform operation operations in the preset operation space according to the optimized operation instructions, until all movement operations and operation operations are completed. When the current power of the mobile robot can support the completion of the task, step S8 is executed, the AGV performs the movement operation, and the robot arm performs the operation operation until the task is completed.

[0038] S9. Collect the post-operation status data of the mobile robot's lithium battery, calculate the post-operation remaining power of the lithium battery based on the post-operation status data, compare it with the preset charging threshold, and determine whether the mobile robot needs to perform a charging operation, so as to perform energy management after performing the moving operation and the running operation; the post-operation status data includes voltage, current, and temperature, and the post-operation remaining power is the remaining power of the mobile robot after performing the moving operation and the running operation. In step S9, when the mobile robot completes the task, it determines whether it needs to be charged based on the remaining power and the charging threshold in order to perform the next task. Among them, the charging threshold can be adjusted and set according to factory parameters, experimental monitoring and actual measurement.

[0039] Based on the above technical solution, after adjusting the planned movement data and the planned operation data to obtain the actual movement path data and the actual operation path data, the total energy consumption of the robot is analyzed and obtained, and energy management evaluation is performed before and after the task is performed to ensure that the mobile robot can complete the task smoothly and continuously, and avoid overcharging or power outages during the task due to improper power management.

[0040] Preferably, in step S3, analyzing and obtaining the actual movement path data according to the planned movement data and the real-time movement obstacle data specifically includes: S301. Establish a mobile space coordinate system in a preset mobile space, wherein the mobile space coordinate system is a two-dimensional Cartesian coordinate system. In step S301, the mobile space is a two-dimensional plane, and a mobile space coordinate system is established in the mobile space according to actual conditions, and then path planning, path optimization and other operations are performed based on the mobile space coordinate system.

[0041] S302. Obtain the planned movement data, analyze the planned movement data to obtain a plurality of discrete path points of the planned movement path, and further convert the coordinate values ​​corresponding to the plurality of discrete path points in the mobile space coordinate system, wherein the first discrete path point is the initial position point and the last discrete path point is the target position point. In step S302, based on the established mobile space coordinate system, the coordinate values ​​corresponding to the plurality of discrete path points in the planned movement data are obtained.

[0042] S303. Collect real-time data of mobile obstacles, analyze the real-time data of mobile obstacles to obtain multiple obstacle position points, and further convert the coordinate values ​​corresponding to the multiple obstacle position points in the mobile space coordinate system. In step S302, the obstacle position points are collected by an industrial binocular camera, and the coordinate values ​​corresponding to the obstacle position points are obtained based on the established mobile space coordinate system.

[0043] S304. According to the coordinate values ​​corresponding to the discrete path points and the coordinate values ​​corresponding to the obstacle position points, the target node in the mobile space coordinate system is searched based on the A* algorithm, and the parent node is backtracked along each searched target node to form obstacle avoidance mobile path data. The process of obtaining obstacle avoidance mobile path data based on the A* algorithm analysis generally includes: 1. Initialization: Create an open list, namely the OPEN table, for storing the nodes to be checked; create a closed list, namely the CLOSE table, for storing the nodes that have been checked; add the starting point to the OPEN table and set its G value to 0, where the G value represents the actual cost from the starting point to the current point. 2. Define a heuristic function: The heuristic function is used to estimate the distance from the current node to the target node. Generally, in a two-dimensional grid, Euclidean distance, Manhattan distance, or Chebyshev distance can be used as a heuristic function. 3. Algorithm loop: When the OPEN table is not empty, repeat the following steps: Select a node from the OPEN table, usually the node with the smallest F value, where F= + ,in is the actual cost from the starting point to the current point, is the cost estimated by the heuristic function. Move the selected node from the OPEN table to the CLOSE table. If the node is the target node, the algorithm ends and the shortest path is found by backtracking. 4. Expand the node: Expand the selected node, that is, check all its adjacent nodes. For each adjacent node: If it is an obstacle or already in the CLOSE table, ignore it. If it is not in the OPEN table, calculate its Value and Value, where The value represents the actual cost from the starting point to the node. The value represents the cost estimated by the heuristic function and is added to the OPEN table, and its parent node is set to the current node. If it is already in the OPEN table, but can be reached through the current node If the value is smaller, update it Value, parent node, and recalculate its F value. 5. Reorder the OPEN table: Sort the nodes in the OPEN table according to the F value so that the node with the smallest F value can be selected in the next cycle. 6. Backtrack to generate a path: When the target node is added to the CLOSE table, the algorithm ends. Starting from the target node, backtracking along the parent node of each node until the starting point is reached, the shortest path is generated. In step S304, the obstacle avoidance mobile path data is obtained based on the A* algorithm analysis, which can efficiently form the shortest travel path based on the planned mobile data and the actual situation of the obstacle location point, and quickly adapt to the mobile environment during implementation.

[0044] S305. Select three path position points in the obstacle avoidance moving path data, and further obtain the coordinate values ​​corresponding to the three path position points in the moving space coordinate system. In step S305, the path position points are taken as a reference to the moving space coordinate system to obtain the corresponding coordinate axes in the moving space coordinate system.

[0045] S306. Based on the coordinate values ​​corresponding to the three path position points in the mobile space coordinate system, the obstacle avoidance movement path data is smoothed according to the quadratic Bezier curve to obtain the actual movement path data, where the formula of the quadratic Bezier curve is: , specifically, , and is the coordinate value corresponding to the three path position points in the mobile space coordinate system, the parameter t ranges from 0 to 1, and B(t) represents the coordinate value corresponding to each position point on the actual mobile path data in the mobile space coordinate system. In step 306, the obstacle avoidance mobile path data is smoothed by a quadratic Bezier curve, which can simplify the calculation and analysis process, reduce the data processing cost, and facilitate the rapid formation of actual mobile path data.

[0046] Based on the above technical solution, the obstacle avoidance movement path data is formed by backtracking the parent node based on the A* algorithm, and the actual movement path data is obtained through smoothing processing. The preset planned movement data can be optimized to ensure that the mobile robot is not affected by obstacles on the route during operation, while ensuring the operability of the movement path.

[0047] Preferably, in step S4, the actual operation path data obtained by analyzing the planned operation data and the real-time operation obstacle data specifically includes: S401. Obtain the planned operation data, and obtain the spatial coordinate values ​​corresponding to the preset operation path of the robot arm in the operation space according to the planned operation data analysis. In step S401, the operation space of the robot arm is a three-dimensional space. Correspondingly, based on the planned operation data, the planned operation data is converted into spatial coordinate values ​​in the three-dimensional space, and then the three-dimensional space coordinate system is used for path planning, path optimization and other operations.

[0048] S402. Scan and obtain the spatial coordinate values ​​corresponding to the obstacles in the operating space. In step S402, the obstacle position points are collected by an industrial binocular camera, and the spatial coordinate values ​​corresponding to the obstacle position points are obtained based on the established three-dimensional space of the robot arm operation. It should be noted that this spatial coordinate value should include three values ​​of the X-axis, Y-axis and Z-axis.

[0049] S403. According to the spatial coordinate values ​​of the robot arm in the operating space, obtain the spatial coordinate values ​​corresponding to at least three robot arm base points on the robot arm , and ,according to , and Construct a robotic arm space packaging box; obtain the spatial coordinate values ​​corresponding to at least two obstacle base points of the obstacle based on the spatial coordinate values ​​of the obstacle in the operating space and ,according to and Constructing obstacle space packaging box. In this technical solution, a collision detection model is established to analyze the planned operation data and the real-time data of the operation obstacle, so as to make a collision risk judgment. Specifically, in step S403, the collision risk judgment is made by establishing an axis-aligned bounding box.

[0050] S404. By comparing whether the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis of the three-dimensional coordinate system corresponding to the operation space overlap, the robot and the obstacle are collided and matched to determine whether there is a collision risk; when the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis of the three-dimensional coordinate system corresponding to the operation space do not overlap, it is determined that there is no collision risk, and the planned operation data is used as the actual operation path data; when the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis of the three-dimensional coordinate system corresponding to the operation space overlap, it is determined that there is a collision risk, and the path optimization adjustment is performed. In step S404, collision monitoring is performed through the axis-aligned bounding box, and there are two specific results: one is that there is a collision risk, and the other is that there is no collision risk: when there is no collision risk, no adjustment is required, and the planned operation data is directly used as the actual operation path data; when there is a collision risk, step S405 is executed to adjust the path.

[0051] S405. Perform obstacle avoidance path planning based on the RRT algorithm to obtain the actual operation path of the robot arm in the operation space, and generate actual operation path data based on the actual operation path. The following is a specific implementation example of obstacle avoidance path planning based on the RRT algorithm, which specifically includes the following steps: 1. Initialize the RRT tree: select the starting point as the root node of the tree and add it to the RRT tree; set a maximum number of iterations k to control the search process. 2. Generate random points: randomly sample a point in the environment as the target point Q_rand; if Q_rand is within the obstacle, regenerate the random point until Q_rand is in an obstacle-free area. 3. Find the nearest node: Find the node closest to Q_rand from the RRT tree, recorded as Q_near; 4. Expand the tree: Expand a distance d from Q_near in the direction of Q_rand to obtain a new node Q_new, and ensure that the line between Q_new and Q_near does not intersect with obstacles; where d is usually a fixed step size or a variable step size based on a certain strategy; 5. Add a new node: If Q_new is a new node that has not been added to the tree before, add it to the RRT tree and connect Q_new to Q_near. 6. Check the target point: If Q_new approaches or reaches the target point, stop the search and backtrack the path from the starting point to the target point; otherwise, return to step 2 and continue searching. 7. Iteration and termination: Repeat steps 2 to 6 until the path to the target point is found or the maximum number of iterations k is reached, and the actual running path data is obtained. It should be noted that this embodiment only provides an implementation idea at the program control level. When analyzing the actual operation path data, this goal can also be achieved through other means. The industry has a variety of different solutions to this technical problem, and this technical solution will not list them one by one here.

[0052] Bounding box collision detection is a fast and effective preliminary collision detection method. Based on the above technical solution, the collision risk is judged by comparing whether there is overlap between the projections of the robot space box and the obstacle space box on the X-axis, Y-axis, and Z-axis. If there is a collision risk, the RRT algorithm is used for obstacle avoidance path planning, which can quickly eliminate the situation where no collision has occurred and provide a basis for subsequent detailed collision detection, thereby preventing the robot from being affected by obstacles in the space during operation.

[0053] Preferably, in step S5, calculating the mobile energy consumption data based on the actual mobile path data and the AGV operation parameters specifically includes the following steps: S501. Analyze AGV power based on AGV operating parameters. In step S501, the AGV operating parameters can be obtained through the factory parameters of the AGV or the parameters collected in multiple actual operations, and the AGV power can be further obtained based on the AGV operating parameters.

[0054] S502. Analyze the AGV running track length and AGV running speed based on the actual moving path data and AGV running parameters, and calculate the AGV running time based on the AGV running track length and AGV running speed. In step S502, the AGV running track length can be analyzed through the actual moving path data, and the AGV running speed can be analyzed through the AGV running parameter analysis. Based on the existing data, the AGV running time can be calculated.

[0055] S503. According to as well as Calculate mobile energy consumption data, where: is the AGV power, L is the length of the AGV running track, is the AGV running speed, is the AGV running time, For mobile energy consumption.

[0056] Based on the above technical solution, the movement energy consumption data of the AGV can be estimated by collecting some basic data to determine its required energy consumption before moving.

[0057] Preferably, in step S5, calculating the operation energy consumption data based on the actual operation path data and the operation parameters of the robot arm specifically includes the following steps: S511. Analyze the average speed, friction resistance, displacement, mass, running time and joint drive power of each joint in the robotic arm based on the operation parameters of the robotic arm. In step S511, the average speed, friction resistance, displacement, mass, running time and joint drive power of each joint can be obtained based on the factory parameters of the robotic arm or the parameters collected in multiple actual operations.

[0058] S512. Analyze the robot arm operation time based on the actual operation path data and the robot arm operation parameters. In step S512, considering that the robot arm will not change direction at a large angle in normal applications, the robot arm operation model can be simplified to a plane operation model to analyze and calculate the robot arm operation time.

[0059] S513. Pass Calculate the inertial energy consumption of the robot arm, where: is the inertial energy consumption of the robot arm, m is the joint mass, is the average speed. During the movement of the robot arm, energy will be consumed due to inertia, and this energy is related to the mass, speed and acceleration of the robot arm. In step S513, the motion inertia energy consumption is calculated by the kinetic energy formula.

[0060] S514. Pass Calculate the friction energy consumption of the robot arm, where is the friction energy consumption of the robot arm, is the friction resistance, is the displacement.

[0061] S515. Pass Calculate the electrical energy consumption of the robot arm, where is the electrical energy consumption of the robot arm, is the joint driving power, The electrical energy consumption of the robotic arm depends on the efficiency of the motor, driver and other electrical components. The energy consumption of the motor of the robotic arm is usually related to its power and working time. In step S515, the electrical energy consumption is calculated by the power formula.

[0062] S516.According to Calculate the operating energy consumption data of the robot arm, where the operating energy consumption data It is the sum of motion inertia energy consumption, friction energy consumption and electrical energy consumption.

[0063] Through the above technical solution, the mobile energy consumption data of the mobile robot is calculated based on the AGV power and AGV running time. By analyzing the motion inertia energy consumption, friction energy consumption and electrical energy consumption of the robotic arm, the operating energy consumption data of the robotic arm can be calculated comprehensively and accurately, providing reliable data support for energy management.

[0064] Preferably, in step S6, obtaining the state of charge data of the lithium battery of the mobile robot based on Kalman filter analysis specifically includes the following steps: S601. Set the initial state vector and initial error covariance of the lithium battery, where the initial state vector is , the initial error covariance is , is the initial state vector of the lithium battery at time step k=0, is the initial state of charge value, is the initial voltage state value, is the initial current state value, is the initial error covariance vector of the lithium battery at time step k = 0, is the uncertainty value of the state of charge, is the voltage state uncertainty value, is the current state uncertainty value.

[0065] S602. Perform state prediction according to the state prediction equation and the prediction error covariance, analyze the state prediction state vector and the error covariance vector one step forward, and obtain the state prediction state vector and the error covariance vector of the lithium battery at the time step k-1, where the state prediction equation is , the prediction error covariance is , A is the state transfer matrix, B is the control matrix, is the control input value at time step k-1, is the covariance matrix of the process noise, T represents the matrix transpose, is the prediction error covariance corresponding to time step K, is the prediction error covariance corresponding to time step K-1, is the state prediction equation corresponding to time step K, is the state prediction equation corresponding to time step K-1.

[0066] S603. Execute Kalman filter gain update to obtain Kalman filter gain, where the Kalman filter gain is , H is the observation matrix, and R is the covariance matrix of the observation noise.

[0067] S604. Perform state update and error covariance update based on Kalman filter gain to obtain an updated state vector and an updated error covariance vector of the lithium battery, wherein the updated state vector of the lithium battery is , is the voltage observation value or current observation value of the lithium battery at the current time step, and the updated error covariance vector is , is the identity matrix.

[0068] S605. At each time step k, repeat the state prediction and Kalman filter gain update, and output the lithium battery state of charge data corresponding to each time step k.

[0069] In general, the state of charge data of the lithium battery of the mobile robot obtained based on Kalman filter analysis is roughly divided into the steps of setting initial conditions, one-step forward state prediction, Kalman filter gain update and state update, and error covariance update. Based on the above steps, the state of charge data obtained through Kalman filter analysis can be used to judge the remaining battery capacity of the lithium battery before the mobile robot performs a task. Subsequently, the mobile energy consumption data and the operating energy consumption data can be comprehensively compared with the state of charge data to judge whether the current power of the mobile robot can fully perform the task, so as to effectively manage energy.

[0070] like Figure 2As shown, a mobile robot energy management system is based on a mobile robot energy management device, and the system includes a planning data acquisition module 1, a real-time data acquisition module 2, an actual moving path analysis module 3, an actual operation path analysis module 4, an energy consumption analysis module 5, a charge state analysis module 6, a first energy management module 7, an execution module 8, and a second energy management module 9.

[0071] Specifically, the planning data acquisition module 1 is used to acquire the planned movement data and the planned operation data, wherein the planned movement data is used to control the mobile robot to perform movement operations in a preset movement space according to a preset movement instruction, and the planned operation data is used to control the mobile robot to perform operation operations in a preset operation space according to a preset operation instruction. The real-time data acquisition module 2 is used to acquire the real-time movement obstacle data and the real-time operation obstacle data, wherein the real-time movement obstacle data includes the real-time two-dimensional data of obstacles in the movement space, and the real-time operation obstacle data includes the real-time three-dimensional data of obstacles in the operation space. The actual movement path analysis module 3 is used to analyze and obtain the actual movement path data according to the planned movement data and the real-time movement obstacle data, wherein the actual movement path data is used to control the mobile robot to move and perform movement operations in a preset movement space according to the optimized movement instruction. The actual operation path analysis module 4 is used to analyze and obtain the actual operation path data according to the planned operation data and the real-time operation obstacle data, wherein the actual operation path data is used to control the mobile robot to perform operation operations in a preset operation space according to the optimized operation instruction. The energy consumption analysis module 5 is used to calculate the moving energy consumption data based on the actual moving path data and the AGV operating parameters, calculate the operating energy consumption data based on the actual operating path data and the robot arm operating parameters, and obtain the overall energy consumption data by summing the moving energy consumption data and the operating energy consumption data. The overall energy consumption data is the total energy consumption of the robot required for the robot to execute the instructions contained in the actual moving path data and the actual operating path data. The state of charge analysis module 6 is used to obtain the state of charge data of the lithium battery of the mobile robot based on Kalman filter analysis. The state of charge data includes the remaining power of the lithium battery before operation. The remaining power before operation is the remaining power before the mobile robot performs the moving operation and the operating operation. The first energy management module 7 is used to perform energy management before performing the moving operation and the operating operation according to the total energy consumption of the robot and the remaining power before operation; when the remaining power before operation is greater than the total energy consumption of the robot, the energy management analysis result is to perform the operating operation, and the mobile robot is controlled to perform the moving operation and the operating operation; when the remaining power before operation is less than the total energy consumption of the robot, the energy management analysis result is to perform the charging operation, and the mobile robot is controlled to perform the charging operation. The execution module 8 is used to control the mobile robot to perform movement operations in a preset movement space according to the optimized movement instructions, and to control the mobile robot to perform operation operations in a preset operation space according to the optimized operation instructions until all movement operations and operation operations are completed.The second energy management module 9 is used to collect the post-operation status data of the lithium battery of the mobile robot, calculate the post-operation remaining power of the lithium battery according to the post-operation status data, compare it with the preset charging threshold, and determine whether the mobile robot needs to perform a charging operation, so as to perform energy management after performing the moving operation and the running operation; the post-operation status data includes voltage, current, and temperature, and the post-operation remaining power is the remaining power of the mobile robot after performing the moving operation and the running operation.

[0072] Preferably, the actual mobile path analysis module specifically includes: a mobile space coordinate establishment unit, which is used to establish a mobile space coordinate system in a preset mobile space, and the mobile space coordinate system is a two-dimensional Cartesian coordinate system; a mobile coordinate calculation unit, which is used to obtain planned mobile data, and obtain a plurality of discrete path points of planned mobile paths according to the planned mobile data analysis, and further convert the coordinate values ​​corresponding to the plurality of discrete path points in the mobile space coordinate system, wherein the first discrete path point is the initial position point and the last discrete path point is the target position point; a mobile obstacle coordinate acquisition unit, which acquires real-time mobile obstacle data, and obtains a plurality of obstacle position points according to the real-time mobile obstacle data analysis, and further converts the coordinate values ​​corresponding to the plurality of obstacle position points in the mobile space coordinate system. The mobile obstacle avoidance path analysis unit is used to search for the target node in the mobile space coordinate system based on the A* algorithm according to the coordinate values ​​corresponding to the discrete path points and the coordinate values ​​corresponding to the obstacle position points, and to backtrack along the parent node of each searched target node to form the obstacle avoidance mobile path data; the mobile path position selection unit is used to select 3 path position points in the obstacle avoidance mobile path data, and further obtain the coordinate values ​​corresponding to the 3 path position points in the mobile space coordinate system; the mobile path smoothing unit is used to smooth the obstacle avoidance mobile path data according to the quadratic Bezier curve based on the coordinate values ​​corresponding to the 3 path position points in the mobile space coordinate system to obtain the actual mobile path data, wherein the formula of the quadratic Bezier curve is , specifically, , and are the coordinate values ​​of the three path position points in the mobile space coordinate system. The parameter t ranges from 0 to 1. B(t) represents the coordinate value of each position point on the actual mobile path data in the mobile space coordinate system.

[0073] Preferably, the actual operation path analysis module specifically includes: a planning operation data acquisition unit, which is used to acquire the planning operation data, and obtain the spatial coordinate value corresponding to the preset operation path of the robot arm in the operation space according to the planning operation data analysis; an operation obstacle coordinate acquisition unit, which is used to scan and obtain the spatial coordinate value corresponding to the obstacle in the operation space; a packaging box construction unit, which is used to obtain the spatial coordinate value corresponding to at least three robot arm base points on the robot arm according to the spatial coordinate value of the robot arm in the operation space. , and ,according to , and Construct a robotic arm space packaging box; obtain the spatial coordinate values ​​corresponding to at least two obstacle base points of the obstacle based on the spatial coordinate values ​​of the obstacle in the operating space and ,according to and Construct an obstacle space packaging box; a projection analysis unit is used to perform collision detection and matching on the robot arm and the obstacle by comparing whether there is overlap in the projections of the robot arm space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, and determine whether there is a collision risk; when the projections of the robot arm space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space do not overlap, it is determined that there is no collision risk, and the planned operation data is used as the actual operation path data; when the projections of the robot arm space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space overlap, it is determined that there is a collision risk, and the path optimization adjustment is performed; an operation obstacle avoidance path planning unit is used to perform obstacle avoidance path planning based on the RRT algorithm, obtain the actual operation path of the robot arm in the operation space, and generate actual operation path data based on the actual operation path.

[0074] Preferably, the energy consumption analysis module specifically includes: an AGV power analysis unit, which is used to analyze the AGV power based on the AGV operating parameters; an AGV movement time analysis unit, which is used to analyze the AGV operation track length and the AGV operation speed based on the actual movement path data and the AGV operation parameters, and calculate the AGV operation time based on the AGV operation track length and the AGV operation speed; an AGV movement energy consumption calculation unit, which is used to calculate the AGV operation time based on the AGV operation track length and the AGV operation speed; as well as Calculate mobile energy consumption data, where: is the AGV power, L is the length of the AGV running track, is the AGV running speed, is the AGV running time, The robot arm parameter acquisition unit is used to analyze the average speed, friction resistance, displacement, mass, running time and joint driving power of each joint in the robot arm based on the robot arm operation parameters; the robot arm operation time calculation unit is used to analyze the robot arm operation time based on the actual operation path data and the robot arm operation parameters; the robot arm motion inertia energy calculation unit is used to calculate the inertia energy of the robot arm through Calculate the inertial energy consumption of the robot arm, where: is the inertial energy consumption of the robot arm, m is the joint mass, is the average speed; the mechanical arm friction energy calculation unit is used to calculate the Calculate the friction energy consumption of the robot arm, where is the friction energy consumption of the robot arm, is the friction resistance, is the displacement; the electrical energy consumption calculation unit of the robotic arm is used to calculate Calculate the electrical energy consumption of the robot arm, where is the electrical energy consumption of the robot arm, is the joint driving power, is the running time of the robot arm; the robot arm running energy consumption calculation unit is used to calculate the energy consumption of the robot arm according to Calculate the operating energy consumption data of the robot arm, where the operating energy consumption data It is the sum of motion inertia energy consumption, friction energy consumption and electrical energy consumption.

[0075] Preferably, the state of charge analysis module specifically includes: an initial condition setting unit, which is used to set the initial state vector and initial error covariance of the lithium battery, wherein the initial state vector is , the initial error covariance is , is the initial state vector of the lithium battery at time step k=0, is the initial state of charge value, is the initial voltage state value, is the initial current state value, is the initial error covariance vector of the lithium battery at time step k = 0, is the uncertainty value of the state of charge, is the voltage state uncertainty value, is the uncertainty value of the current state; the state prediction unit is used to perform state prediction according to the state prediction equation and the prediction error covariance, analyze the state prediction state vector and the error covariance vector one step forward, and obtain the state prediction state vector and the error covariance vector of the lithium battery at the time step k-1, where the state prediction equation is , the prediction error covariance is , A is the state transfer matrix, B is the control matrix, is the control input value at time step k-1, is the covariance matrix of the process noise, T represents the matrix transpose, is the prediction error covariance corresponding to time step K, is the prediction error covariance corresponding to time step K-1, is the state prediction equation corresponding to time step K, is the state prediction equation corresponding to the time step K-1; the Kalman filter gain update unit is used to perform the Kalman filter gain update to obtain the Kalman filter gain, where the Kalman filter gain is , H is the observation matrix, R is the covariance matrix of the observation noise; the update execution unit is used to perform state update and error covariance update based on the Kalman filter gain to obtain the updated state vector and updated error covariance vector of the lithium battery, where the updated state vector of the lithium battery is , is the voltage observation value or current observation value of the lithium battery at the current time step, and the updated error covariance vector is , is a unit matrix; a state of charge acquisition unit is used to repeat state prediction and Kalman filter gain update at each time step k, and output the lithium battery state of charge data corresponding to each time step k.

[0076] Correspondingly, the technical solution also includes a storage medium, which stores a computer program. The computer program includes program instructions. When the program instructions are executed by a processor, the processor executes the mobile robot energy management method as described above.

[0077] It should be understood that the application of the present invention is not limited to the above examples. For ordinary technicians in this field, improvements or changes can be made based on the above description. All these improvements and changes should fall within the scope of protection of the claims attached to the present invention.

Claims

1. A mobile robot energy management method, characterized in that: The method comprises the following steps: S1. Obtain planned mobility data and planned operation data; S2. Obtaining real-time data of movement obstacles and real-time data of operation obstacles, wherein the real-time data of movement obstacles includes real-time two-dimensional data of obstacles in the movement space, and the real-time data of operation obstacles includes real-time three-dimensional data of obstacles in the operation space; S3. According to the planned movement data and the real-time movement obstacle data, the actual movement path data is analyzed and obtained, and the actual movement path data is used to control the mobile robot to move in a preset movement space according to the optimized movement instruction to perform the movement operation; S4. According to the planned operation data and the real-time data of the operation obstacle, the actual operation path data is analyzed, and the actual operation path data is used to control the mobile robot to perform the operation operation in the preset operation space according to the optimized operation instruction; S5. Calculate the movement energy consumption data based on the actual movement path data and the operation parameters, calculate the operation energy consumption data based on the actual operation path data and the robot operation parameters, and obtain the overall energy consumption data by summing the movement energy consumption data and the operation energy consumption data, wherein the overall energy consumption data is the total energy consumption of the robot required for the robot to execute the instructions contained in the actual movement path data and the actual operation path data; S6. Analyze and obtain the state of charge data of the battery of the mobile robot, wherein the state of charge data includes the remaining power of the battery before operation, wherein the remaining power before operation is the remaining power before the mobile robot performs the moving operation and the running operation; S7. Perform energy management before executing moving operations and running operations based on the robot's total energy consumption and the remaining power before operation; when the remaining power before operation is greater than the robot's total energy consumption, the energy management analysis result is to execute the running operation, and the mobile robot is controlled to execute the moving operation and the running operation; when the remaining power before operation is less than or equal to the robot's total energy consumption, the energy management analysis result is to execute the charging operation, and the mobile robot is controlled to execute the charging operation.

2. The method according to claim 1, characterized in that: The method further comprises: S8. Control the mobile robot to perform a mobile operation in a preset mobile space according to the optimized mobile instruction, and control the mobile robot to perform an operation operation in a preset operation space according to the optimized operation instruction until all mobile operations and operation operations are completed; S9. Collect the post-operation status data of the mobile robot's lithium battery, calculate the post-operation remaining power of the lithium battery based on the post-operation status data, compare it with the preset charging threshold, and determine whether the mobile robot needs to perform a charging operation, so as to perform energy management after performing the moving operation and the running operation; the post-operation status data includes voltage, current, and temperature, and the post-operation remaining power is the remaining power of the mobile robot after performing the moving operation and the running operation.

3. The method according to claim 2, characterized in that In step S3, the actual movement path data is analyzed based on the planned movement data and the real-time movement obstacle data, specifically including: S301. Establishing a mobile space coordinate system in a preset mobile space, wherein the mobile space coordinate system is a two-dimensional Cartesian coordinate system; S302. Acquire planned movement data, analyze the planned movement data to obtain a plurality of discrete path points of the planned movement path, and further convert the coordinate values ​​of the plurality of discrete path points corresponding to the mobile space coordinate system, wherein the first discrete path point is the initial position point and the last discrete path point is the target position point; S303. Collecting real-time data of mobile obstacles, analyzing the real-time data of mobile obstacles to obtain multiple obstacle positions, and further converting the coordinate values ​​of the multiple obstacle positions corresponding to the mobile space coordinate system; S304. According to the coordinate values ​​corresponding to the discrete path points and the coordinate values ​​corresponding to the obstacle position points, the target node in the mobile space coordinate system is searched based on the A* algorithm, and the parent node is backtracked along each searched target node to form obstacle avoidance movement path data; S305. Select three path position points in the obstacle avoidance moving path data, and further obtain the coordinate values ​​corresponding to the three path position points in the moving space coordinate system; S306. Based on the coordinate values ​​corresponding to the three path position points in the mobile space coordinate system, the obstacle avoidance movement path data is smoothed according to the quadratic Bezier curve to obtain the actual movement path data, where the formula of the quadratic Bezier curve is: , specifically, , and are the coordinate values ​​of the three path position points in the mobile space coordinate system. The parameter t ranges from 0 to 1. B(t) represents the coordinate value of each position point on the actual mobile path data in the mobile space coordinate system.

4. The method according to any one of claims 2 to 3, characterized in that: In step S4, the actual operation path data obtained by analysis based on the planned operation data and the real-time operation obstacle data specifically includes: S401. Acquire the planned operation data, and obtain the spatial coordinate value corresponding to the preset operation path of the robot arm in the operation space according to the planned operation data analysis; S402. Scan and obtain the spatial coordinate values ​​corresponding to the obstacles in the operating space; S403. According to the spatial coordinate values ​​of the robot arm in the operating space, obtain the spatial coordinate values ​​corresponding to at least three robot arm base points on the robot arm , and ,according to , and Construct a robotic arm space packaging box; obtain the spatial coordinate values ​​corresponding to at least two obstacle base points of the obstacle based on the spatial coordinate values ​​of the obstacle in the operating space and ,according to and Construct obstacle space packaging box; S404. By comparing whether there is overlap in the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, collision detection and matching are performed on the robot and the obstacle to determine whether there is a collision risk; when there is no overlap in the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, it is determined that there is no collision risk, and the planned operation data is used as the actual operation path data; when there is overlap in the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, it is determined that there is a collision risk, and the path optimization adjustment is performed; S405. Perform obstacle avoidance path planning based on the RRT algorithm to obtain the actual operation path of the robot arm in the operation space, and generate actual operation path data based on the actual operation path.

5. The method according to any one of claims 2 to 4, characterized in that: In step S5, the mobile energy consumption data is calculated based on the actual mobile path data and the AGV operation parameters, specifically including the following steps: S501. Analyze AGV power based on AGV operating parameters; S502. Analyze the AGV running track length and the AGV running speed based on the actual moving path data and the AGV running parameters, and calculate the AGV running time based on the AGV running track length and the AGV running speed; S503. According to as well as Calculate mobile energy consumption data, where: is the AGV power, L is the AGV running track length, is the AGV running speed, is the AGV running time, For mobile energy consumption; In step S5, the operation energy consumption data is calculated based on the actual operation path data and the operation parameters of the robot arm, and specifically includes the following steps: S511. Analyze the average speed, friction resistance, displacement, mass, operation time and joint drive power of each joint in the robot arm based on the robot arm operation parameters; S512. Analyze the robot operation time based on the actual operation path data and the robot operation parameters; S513. Pass Calculate the inertial energy consumption of the robot arm, where: is the inertial energy consumption of the robot arm, m is the joint mass, is the average speed; S514. Pass Calculate the friction energy consumption of the robot arm, where is the friction energy consumption of the robot arm, is the friction resistance, is the displacement; S515. By calculating the electrical energy consumption of the robot arm, wherein, is the electrical energy consumption of the robot arm, For joints Drive power, is the running time of the robot arm; S516.According to Calculate the operating energy consumption data of the robot arm, where the operating energy consumption data It is the sum of motion inertia energy consumption, friction energy consumption and electrical energy consumption.

6. The method according to any one of claims 2 to 5, characterized in that: In step S6, obtaining the state of charge data of the lithium battery of the mobile robot based on Kalman filter analysis specifically includes the following steps: S601. Set the initial state vector and initial error covariance of the lithium battery, where the initial state vector is , the initial error covariance is , is the initial state vector of the lithium battery at time step k=0, is the initial state of charge value, is the initial voltage state value, is the initial current state value, is the initial error covariance vector of the lithium battery at time step k = 0, is the uncertainty value of the state of charge, is the voltage state uncertainty value, is the uncertainty value of the current state; S602. Perform state prediction according to the state prediction equation and the prediction error covariance, analyze the state prediction state vector and the error covariance vector one step forward, and obtain the state prediction state vector and the error covariance vector of the lithium battery at the time step k-1, where the state prediction equation is , the prediction error covariance is , A is the state transfer matrix, B is the control matrix, is the control input value at time step k-1, is the covariance matrix of the process noise, T represents the matrix transpose, is the prediction error covariance corresponding to time step K, is the prediction error covariance corresponding to time step K-1, is the state prediction equation corresponding to time step K, is the state prediction equation corresponding to time step K-1; S603. Execute Kalman filter gain update to obtain Kalman filter gain, where the Kalman filter gain is , H is the observation matrix, R is the covariance matrix of the observation noise; S604. Perform state update and error covariance update based on Kalman filter gain to obtain an updated state vector and an updated error covariance vector of the lithium battery, wherein the updated state vector of the lithium battery is , is the voltage observation value or current observation value of the lithium battery at the current time step, and the updated error covariance vector is , is the identity matrix; S605. At each time step k, repeat the state prediction and Kalman filter gain update, and output the lithium battery state of charge data corresponding to each time step k.

7. A mobile robot energy management system, characterized in that: The system comprises: A planning data acquisition module is used to acquire planning movement data and planning operation data; A real-time data acquisition module, used to acquire real-time data of movement obstacles and real-time data of operation obstacles, wherein the real-time movement obstacle data includes real-time two-dimensional data of obstacles in the movement space, and the real-time operation obstacle data includes real-time three-dimensional data of obstacles in the operation space; An actual movement path analysis module is used to analyze the planned movement data and the real-time movement obstacle data to obtain the actual movement path data, and the actual movement path data is used to control the mobile robot to move and perform movement operations in a preset movement space according to the optimized movement instructions; An actual operation path analysis module is used to analyze the actual operation path data obtained according to the planned operation data and the real-time operation obstacle data, and the actual operation path data is used to control the mobile robot to perform operation operations in a preset operation space according to the optimized operation instructions; An energy consumption analysis module is used to calculate the movement energy consumption data based on the actual movement path data and the AGV operation parameters, calculate the operation energy consumption data based on the actual operation path data and the robot arm operation parameters, and obtain the overall energy consumption data by summing the movement energy consumption data and the operation energy consumption data, wherein the overall energy consumption data is the total energy consumption of the robot required for the robot to execute the instructions contained in the actual movement path data and the actual operation path data; A state of charge analysis module, used to analyze and obtain state of charge data of a battery of the mobile robot, wherein the state of charge data includes the remaining power of the battery before operation, and the remaining power before operation is the remaining power before the mobile robot performs a moving operation and an operating operation; The first energy management module is used to perform energy management before executing moving operations and running operations based on the total energy consumption of the robot and the remaining power before operation; when the remaining power before operation is greater than the total energy consumption of the robot, the energy management analysis result is to execute the running operation, and the mobile robot is controlled to execute the moving operation and the running operation; when the remaining power before operation is less than or equal to the total energy consumption of the robot, the energy management analysis result is to execute the charging operation, and the mobile robot is controlled to execute the charging operation.

8. The system according to claim 7, characterized in that The system further comprises: An execution module, used to control the mobile robot to perform a movement operation in a preset movement space according to the optimized movement instruction, and to control the mobile robot to perform an operation operation in a preset operation space according to the optimized operation instruction, until all movement operations and operation operations are completed; The second energy management module is used to collect the post-operation status data of the mobile robot's lithium battery, calculate the post-operation remaining power of the lithium battery based on the post-operation status data, compare it with the preset charging threshold, and determine whether the mobile robot needs to perform a charging operation, so as to perform energy management after performing the moving operation and the running operation; the post-operation status data includes voltage, current, and temperature, and the post-operation remaining power is the remaining power of the mobile robot after performing the moving operation and the running operation.

9. The system according to claim 8, characterized in that The actual moving path analysis module specifically includes: A mobile space coordinate establishing unit, used to establish a mobile space coordinate system in a preset mobile space, wherein the mobile space coordinate system is a two-dimensional Cartesian coordinate system; A mobile coordinate calculation unit is used to obtain the planned mobile data, obtain a plurality of discrete path points of the planned mobile path according to the planned mobile data analysis, and further convert the coordinate values ​​corresponding to the plurality of discrete path points in the mobile space coordinate system, wherein the first discrete path point is the initial position point and the last discrete path point is the target position point; A mobile obstacle coordinate acquisition unit collects real-time data of mobile obstacles, obtains multiple obstacle position points according to the real-time data of mobile obstacles, and further converts the coordinate values ​​corresponding to the multiple obstacle position points in the mobile space coordinate system; A mobile obstacle avoidance path analysis unit is used to search for target nodes in the mobile space coordinate system based on the A* algorithm according to the coordinate values ​​corresponding to the discrete path points and the coordinate values ​​corresponding to the obstacle position points, and to perform parent node backtracking along each searched target node to form obstacle avoidance mobile path data; A moving path position selection unit, used to select three path position points in the obstacle avoidance moving path data, and further obtain the coordinate values ​​corresponding to the three path position points in the moving space coordinate system; The moving path smoothing processing unit is used to smooth the obstacle avoidance moving path data according to the coordinate values ​​corresponding to the three path position points in the moving space coordinate system according to the quadratic Bezier curve to obtain the actual moving path data, wherein the formula of the quadratic Bezier curve is: , specifically, , and are the coordinate values ​​of the three path position points in the mobile space coordinate system. The parameter t ranges from 0 to 1. B(t) represents the coordinate value of each position point on the actual mobile path data in the mobile space coordinate system. The actual operation path analysis module specifically includes: A planning operation data acquisition unit is used to acquire the planning operation data, and obtain the spatial coordinate value corresponding to the preset operation path of the robot arm in the operation space according to the planning operation data analysis; An operation obstacle coordinate acquisition unit is used to scan and obtain the space coordinate values ​​corresponding to obstacles in the operation space; The packaging box construction unit is used to obtain the spatial coordinate values ​​corresponding to at least three robotic arm base points on the robotic arm according to the spatial coordinate values ​​of the robotic arm in the operating space. , and ,according to , and Construct a robotic arm space packaging box; obtain the spatial coordinate values ​​corresponding to at least two obstacle base points of the obstacle based on the spatial coordinate values ​​of the obstacle in the operating space and ,according to and Construct obstacle space packaging box; The projection analysis unit is used to perform collision detection and matching between the robot and the obstacle by comparing whether there is overlap in the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, and to determine whether there is a collision risk; when there is no overlap in the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, it is determined that there is no collision risk, and the planned operation data is used as the actual operation path data; when there is overlap in the projections of the robot space packaging box and the obstacle space packaging box on the X-axis, Y-axis, and Z-axis in the three-dimensional coordinate system corresponding to the operating space, it is determined that there is a collision risk, and the path optimization adjustment is performed; The operation obstacle avoidance path planning unit is used to perform obstacle avoidance path planning based on the RRT algorithm, obtain the actual operation path of the robot arm in the operation space, and generate actual operation path data according to the actual operation path.

10. A storage medium or a computer program, characterized in that The storage medium stores a computer program, which includes program instructions. When the program instructions are executed by a processor, the processor executes the method according to any one of claims 1 to 6.

Citation Information

Patent Citations

  • Kalman filter prediction-based robot obstacle avoidance method

    CN101943916A

  • System and method for providing local path planning for ground unmanned vehicle by unmanned aerial vehicle

    CN116540706A

  • Mobile robot energy management method and system and storage medium

    CN118418142A