Robot control method and device, processor and readable storage medium
By obtaining basic robot data and adjusting driving strategies to optimize paths and speeds, the problem of low driving safety of construction robots in the existing technology is solved, and safety improvement in complex scenarios is achieved.
Patent Information
- Application Number
- CN202411187997.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-28
- Publication Date
- 2024-12-03
AI Technical Summary
Existing indoor construction robots have low safety during driving in complex construction scenarios, single perception strategy, and cannot effectively deal with complex working conditions and obstacle interference, resulting in potential safety risks.
By obtaining the basic data of the robot, determining the initial driving strategy and predicting the safe driving results, adjusting the driving strategy according to the safety threshold, and achieving the target driving strategy to optimize the robot's driving path and speed and improve safety.
It improves the safety of the robot in complex construction scenarios, reduces the safety risks during driving, and ensures that the robot can perform intelligent and automated control based on the real-time environment and status.
Smart Images

Figure CN119065374A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of construction robot motion control, and in particular to a robot control method, device, processor and readable storage medium. Background Art
[0002] At present, indoor construction robots have been effectively and widely used in construction scenes in various buildings, helping to achieve efficient and precise construction. When executing the construction procedure, the robot needs various instruments and equipment on the robot to realize linkage operation and control feedback, so as to achieve safe and accurate movement and operation in the construction scene. Among them, the motion chassis of the indoor construction robot bears the equipment weight of the construction robot load, provides the robot with motion power and realizes spatial movement in the construction scene according to user instructions. In complex construction scenes, especially the high-height construction scenes of special buildings represented by substations, there are obstacles such as construction materials in the spatial environment, and the robot is loaded with large-mass and high-precision operating equipment due to indoor construction needs. When the robot chassis in the loaded state faces complex terrain features or obstacles, it may need to change the motion state at any time to meet the safety requirements and construction process requirements. There are certain safety risks in the frequent motion state switching.
[0003] In related technologies, the robot chassis is equipped with a series of sensors to detect its own motion state and to judge and feedback risks. However, the current perception strategies of existing robot chassis are relatively simple, and the perception capabilities of intelligent robots represented by indoor sweeping robots may not be sufficient to meet the needs in complex construction sites. Robots for construction scenes usually rely on magnetic strip guidance and other methods for fixed-point and directional driving. Faced with complex working conditions that may change, fixed-program movement methods may have inevitable safety risks. At the same time, large-load chassis often face more complex working environments and more stringent safety conditions due to the load mass and existing motion inertia. They will face more complex road resistance and potential risks in construction scenes. There is a technical problem that existing robots have low safety during driving.
[0004] With respect to the above-mentioned technical problem of low safety of existing robots during driving, no effective solution has been proposed so far. Summary of the invention
[0005] The embodiments of the present invention provide a control method, device, processor and readable storage medium for a robot, so as to at least solve the technical problem that the existing robot has low safety during driving.
[0006] According to one aspect of an embodiment of the present invention, a control method for a robot is provided. The method may include: obtaining basic data of the robot, wherein the basic data is used to indicate the motion performance of the robot; determining the initial driving strategy of the robot based on the basic data, wherein the initial driving strategy is used to indicate the rules for the robot to drive in the initial driving stage; determining the safe driving result of the robot based on the initial driving strategy, wherein the safe driving result is used to indicate the safe result of the robot driving under the initial driving strategy; determining the target driving strategy of the robot based on the safe driving result, wherein the target driving strategy is used to indicate the rules for the robot to drive in the target driving stage, and the target driving stage is the driving stage after the initial driving stage; and controlling the robot to drive according to the target driving strategy.
[0007] Optionally, based on the basic data, the initial driving strategy of the robot is determined, including: determining the resultant force data and initial safety data of the robot, wherein the resultant force data is used to indicate the total resultant force acting on the robot, and the initial safety data is used to indicate the safety level of the robot's driving under the basic data; based on the resultant force data and the initial safety data, the initial driving strategy of the robot is determined.
[0008] Optionally, based on the initial driving strategy, determining the safe driving result of the robot includes: extracting a preset motion path of the robot from the initial driving strategy; and predicting the safe driving result of the robot based on the initial driving strategy and the preset motion path.
[0009] Optionally, based on the safe driving results, a target driving strategy of the robot is determined, including: extracting a safety value from the safe driving results, wherein the safety value is used to indicate the safety level of the robot's driving under the initial driving strategy; in response to the safety value being greater than a safety threshold, determining the initial driving strategy as the target driving strategy.
[0010] Optionally, the control method of the robot also includes: in response to the safety value being less than a safety threshold, adjusting the initial driving strategy to obtain a target driving strategy, wherein the safety value of the robot under the target driving strategy is greater than the safety value of the robot under the initial driving strategy.
[0011] Optionally, in response to the safety value being less than a safety threshold, the initial driving strategy is adjusted to obtain a target driving strategy, including: in response to the safety value being less than the safety threshold, determining an initial driving factor based on the initial driving strategy, wherein the initial driving factor is used to indicate the driving direction of the robot in the initial driving parameters; based on the initial driving factor and the driving safety result, adjusting the initial driving strategy to obtain the target driving strategy.
[0012] According to another aspect of an embodiment of the present invention, a control device for a robot is also provided. The device may include: an acquisition unit, used to acquire basic data of the robot, wherein the basic data is used to indicate the motion performance of the robot; a first determination unit, used to determine the initial driving strategy of the robot based on the basic data, wherein the initial driving strategy is used to indicate the rules for the robot to drive in the initial driving stage; a second determination unit, used to determine the safe driving result of the robot based on the initial driving strategy, wherein the safe driving result is used to indicate the safe result of the robot driving under the initial driving strategy; a third determination unit, used to determine the target driving strategy of the robot based on the safe driving result, wherein the target driving strategy is used to indicate the rules for the robot to drive in the target driving stage, and the target driving stage is the driving stage after the initial driving stage; a control unit, used to control the robot to drive according to the target driving strategy.
[0013] According to another aspect of an embodiment of the present invention, a computer-readable storage medium is also provided, the computer-readable storage medium including a stored program, wherein when the program is executed by a processor, the device where the storage medium is located is controlled to execute the robot control method in the embodiment of the present invention.
[0014] According to another aspect of the embodiment of the present invention, a processor is further provided. The processor is used to run a program, wherein the robot control method in the embodiment of the present invention is executed when the program is run.
[0015] According to another aspect of the embodiments of the present invention, a computer program product is provided, which includes computer instructions, and when the computer instructions are executed by a processor, the robot control method in the embodiments of the present invention is implemented.
[0016] In an embodiment of the present invention, basic data of the robot is obtained, wherein the basic data is used to indicate the robot's motion performance; based on the basic data, the initial driving strategy of the robot is determined, wherein the initial driving strategy is used to indicate the rules for the robot to drive in the initial driving stage; based on the initial driving strategy, the safe driving result of the robot is determined; based on the safe driving result, the target driving strategy of the robot is determined. That is to say, the present invention obtains the basic data of the robot, determines the initial driving strategy according to the basic data, predicts the initial driving strategy, determines the safe driving result, and optimizes the initial driving strategy according to the safe driving result to obtain the target driving strategy, and then controls the robot to drive according to the target driving strategy. Since the present invention predicts the initial driving strategy in advance and determines the safe driving result, it avoids the situation that the robot can only drive according to the preset driving strategy, which leads to low driving safety of the robot, thereby solving the technical problem of low safety of the existing robot during driving, and achieving the technical effect of improving the safety of the existing robot during driving. BRIEF DESCRIPTION OF THE DRAWINGS
[0017] The drawings described herein are used to provide a further understanding of the present invention and constitute a part of this application. The exemplary embodiments of the present invention and their descriptions are used to explain the present invention and do not constitute an improper limitation of the present invention. In the drawings:
[0018] Figure 1 is a flow chart of a robot control method according to an embodiment of the present invention;
[0019] Figure 2 is a flow chart of a fusion perception control and monitoring method for a motion chassis of an indoor construction robot according to an embodiment of the present invention;
[0020] Figure 3 is a schematic diagram of a fusion perception control and monitoring strategy module of a motion chassis of an indoor construction robot according to an embodiment of the present invention;
[0021] Figure 4 is a schematic diagram of a sensing state according to an embodiment of the present invention;
[0022] Figure 5 is a schematic diagram of a sensing scenario according to an embodiment of the present invention;
[0023] Figure 6 is a schematic diagram of a robot control device according to an embodiment of the present invention. DETAILED DESCRIPTION
[0024] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.
[0025] It should be noted that the terms "first", "second", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, functional component or device that includes a series of steps or units is not necessarily limited to those steps or units clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, functional components or devices.
[0026] According to an embodiment of the present invention, an embodiment of a robot control method is provided. It should be noted that the steps shown in the flowchart of the accompanying drawings can be executed in a computer system such as a set of computer executable instructions, and although a logical order is shown in the flowchart, in some cases, the steps shown or described can be executed in an order different from that shown here.
[0027] Figure 1 is a flow chart of a robot control method according to an embodiment of the present invention. Figure 1 As shown, the method may include the following steps:
[0028] Step S101, obtaining basic data of the robot.
[0029] In the technical solution provided in the above step S101 of the present invention, the basic data is used to indicate the motion performance of the robot.
[0030] In this embodiment, the basic data of the robot is obtained. For example, the basic data collected by various sensors are obtained through the sensor module of the holiday man's motion chassis. This is only an illustrative example and does not limit the specific method of obtaining the basic data of the robot.
[0031] Optionally, the basic data of the robot may be acceleration data, the total mass of the robot, the distance data between the robot and a certain range in front, and the like.
[0032] Step S102, determining the initial driving strategy of the robot based on the basic data.
[0033] In the technical solution provided in the above step S102 of the present invention, the initial driving strategy is used to represent the driving rules of the robot in the initial driving stage.
[0034] In this embodiment, after the basic data of the robot is acquired in step S101, the initial driving strategy of the robot is determined according to the basic data.
[0035] Optionally, the resultant force data and initial safety data of the robot are determined, wherein the resultant force data is used to indicate the total resultant force acting on the robot, and the initial safety data is used to indicate the safety level of the robot when traveling under basic data.
[0036] Alternatively, the resultant force data can be expressed as Initial safety data can also be called decision strength value, denoted as S t (θ n ).
[0037] For example, the net force acting on the moving chassis at time t is It can be obtained by the following formula (1):
[0038]
[0039] in, It can represent the acceleration vector measured at time t, including a tx ,a ty and a tz The three orthogonal components correspond to the acceleration values of the moving chassis in the three coordinate directions; m can represent the total mass of the robot moving chassis and other equipment mounted on the chassis, and the resultant force Include and The three components correspond to the forces in different directions and satisfy the following formulas (2) and (3):
[0040]
[0041] in, and is a unit vector along the three coordinate directions.
[0042] For another example, based on the speed of light c and the measured transmission time T t , satisfying the following formula (4):
[0043]
[0044] The measured distance in each direction constitutes an overall distance array for the area in front of the moving chassis, where each element in the array corresponds to a distance value within a specific angle range in front of the moving chassis, satisfying the following formula (5):
[0045] D t ={d t (θ1),d t (θ2),…,d t (θ n )} (5)
[0046] Among them, θ1, θ2, …, θ n represents a series of angles arranged in order in front of the moving chassis, n represents the number of angles, which is determined by the performance of the ToF sensor and actual needs; assuming that the distance threshold is d threshold , by calculating the detected distance value and the distance threshold, the decision strength value S at the corresponding angle is obtained t (θ n ), can be calculated by the following formula (6):
[0047]
[0048] Wherein, k1 and k2 are positive constants used to adjust the sensitivity of the decision strength value when the distance is greater than the threshold and less than the threshold, respectively.
[0049] Step S103, determining the safe driving result of the robot based on the initial driving strategy.
[0050] In the technical solution provided in the above step S103 of the present invention, the safe driving result is used to indicate the safety result of the robot driving under the initial driving strategy.
[0051] In this embodiment, after the combined force data and initial safety data of the robot are determined in step S102, the safe driving result of the robot is determined according to the initial driving strategy.
[0052] Optionally, a preset motion path of the robot is extracted from the initial driving strategy, so as to predict the safe driving result of the robot according to the initial driving strategy and the preset motion path. The safe driving result can be calculated using the comprehensive motion parameter A t (θ n ) is expressed numerically, and the safe driving result can also be called a motion decision recommendation.
[0053] For example, according to the combined force and decision strength value S t (θ n ), calculate the comprehensive motion parameter A t (θ n ):
[0054]
[0055] in, Can represent combined force At angle θ n Components in the corresponding direction; combined with the sensor data obtained by other sensors on the motion chassis, optimize the comprehensive motion parameters A in each direction t (θ n ), the optimized parameter A ′ t (θ n )satisfy:
[0056]
[0057] Where M can represent the number of additional sensors involved in decision making, ω m It can represent the weight value corresponding to each additional sensor, B m (θ n ) The parameter values obtained by the additional mth sensor will calculate the comprehensive motion parameter A ′ t (θn ) and the set robot motion path are transmitted to the closed-loop control system of the robot system to calculate the motion decision suggestions.
[0058] Step S104: Determine the target driving strategy of the robot based on the safe driving result.
[0059] In the technical solution provided in the above step S104 of the present invention, the target driving strategy is used to represent the rules for the robot to drive in the target driving phase, and the target driving phase is the driving phase after the initial driving phase.
[0060] In this embodiment, after the safe driving result of the robot is determined in step S103, the target driving strategy of the robot is determined according to the safe driving result.
[0061] Optionally, a safety value is extracted from the safe driving result, wherein the safety value is used to indicate the degree of safety of the robot's driving under the initial driving strategy; when the safety value is greater than the safety threshold, it means that the robot is driving safely under the initial driving strategy, based on which the initial driving strategy can be determined as the target driving strategy.
[0062] Optionally, when the safety value is less than the safety threshold, it means that the robot is not safe to drive under the initial driving strategy. Based on this, the initial driving strategy can be adjusted to obtain the target driving strategy.
[0063] For example, according to the initial driving strategy, an initial driving factor is determined, wherein the initial driving factor is used to indicate the driving direction of the robot in the initial driving parameters; according to the initial driving factor and the driving safety result, the initial driving strategy is adjusted to obtain the target driving strategy.
[0064] For another example, when the safety value is less than the safety threshold, that is, when the motion decision suggestion is to prevent motion suggestion, the motion suggestion direction is calculated according to the acquired parameters, and the motion suggestion factor D (θ n )satisfy:
[0065] D(θ n )=A ′ t (θ n )W(θ n ) (9)
[0066] Among them, W(θ n ) can represent the weighted coefficient of each angle, which is determined by the current environmental perception and motion state of the robot chassis and the expected motion direction. It is a comprehensive calculation result based on obstacle distribution, expected path and current motion state.
[0067] Step S105, controlling the robot to travel according to the target driving strategy.
[0068] In the technical solution provided in the above step S105 of the present invention, after the target driving strategy of the robot is determined in step S104, the robot is controlled to drive according to the target driving strategy.
[0069] In this embodiment, the robot is controlled to travel according to the target travel strategy. For example, the robot control system is used in combination with the target travel strategy to control the robot to travel. This is only an example and does not limit the specific method of controlling the robot to travel.
[0070] Optionally, through the target driving strategy, intelligent and automatic motion control can be achieved in the robot control system according to the scene environment conditions and the robot state.
[0071] It should be noted that the above embodiments can be executed by a control device of a robot.
[0072] In the above steps S101 to S105 of the present invention, the basic data of the robot is obtained, wherein the basic data is used to indicate the robot's motion performance; based on the basic data, the initial driving strategy of the robot is determined, wherein the initial driving strategy is used to indicate the rules for the robot to drive in the initial driving stage; based on the initial driving strategy, the safe driving result of the robot is determined; based on the safe driving result, the target driving strategy of the robot is determined. In other words, the present invention obtains the basic data of the robot, determines the initial driving strategy according to the basic data, predicts the initial driving strategy, determines the safe driving result, and optimizes the initial driving strategy according to the safe driving result to obtain the target driving strategy, and then controls the robot to drive according to the target driving strategy. Since the present invention predicts the initial driving strategy in advance and determines the safe driving result, it avoids the situation that the robot can only drive according to the preset driving strategy, which leads to low driving safety of the robot, thereby solving the technical problem of low safety of the existing robot during driving, and achieving the technical effect of improving the safety of the existing robot during driving.
[0073] The above method of this embodiment is further introduced below.
[0074] As an optional implementation method, based on basic data, the initial driving strategy of the robot is determined, including: determining the robot's resultant force data and initial safety data, wherein the resultant force data is used to indicate the total resultant force acting on the robot, and the initial safety data is used to indicate the safety level of the robot's driving under the basic data; based on the resultant force data and the initial safety data, the initial driving strategy of the robot is determined.
[0075] In this embodiment, the resultant force data and initial safety data of the robot are determined based on the basic data, and then the initial driving strategy of the robot is determined based on the resultant force data and the initial safety data. The initial safety data can also be called the decision strength value S t (θ n ).
[0076] Optionally, the resultant force data can be calculated according to the aforementioned formula (1), and the initial safety data can be calculated according to the aforementioned formula (6), which will not be described in detail here.
[0077] As an optional implementation method, based on the initial driving strategy, determining the safe driving result of the robot includes: extracting a preset motion path of the robot from the initial driving strategy; and predicting the safe driving result of the robot based on the initial driving strategy and the preset motion path.
[0078] In this embodiment, a preset motion path of the robot is extracted from the initial driving strategy, and a safe driving result of the robot is predicted based on the initial driving strategy and the preset motion path. The safe driving result may also be referred to as a motion decision suggestion.
[0079] Optionally, by extracting a preset motion path and predicting a safe driving result based on an initial driving strategy, the robot can be helped to select a more appropriate driving path and speed, thereby improving driving efficiency.
[0080] As an optional implementation method, based on the safe driving results, the target driving strategy of the robot is determined, including: extracting a safety value from the safe driving results, wherein the safety value is used to indicate the safety level of the robot's driving under the initial driving strategy; in response to the safety value being greater than a safety threshold, determining the initial driving strategy as the target driving strategy.
[0081] In this embodiment, a safety value is extracted from the safety driving result, and when the safety value is greater than a safety threshold, the initial driving strategy is determined as the target driving strategy.
[0082] For example, assuming that the safety threshold is 0.3 and the safety value is 1, since 1>0.3, that is, the safety value is greater than the safety threshold, based on this, the initial driving strategy can be determined as the target driving strategy.
[0083] As an optional implementation method, the control of the robot also includes: in response to the safety value being less than a safety threshold, adjusting the initial driving strategy to obtain a target driving strategy, wherein the safety value of the robot under the target driving strategy is greater than the safety value of the robot under the initial driving strategy.
[0084] In this embodiment, when the safety value is less than the safety threshold, it means that the robot is not safe to drive under the initial driving strategy. Based on this, the initial driving strategy can be adjusted to obtain the target driving strategy.
[0085] Optionally, by adjusting the initial driving strategy, the safety of the robot can be improved, the occurrence of accidents can be reduced, and the safety of the robot and the surrounding environment can be guaranteed.
[0086] As an optional implementation method, in response to the safety value being less than a safety threshold, the initial driving strategy is adjusted to obtain a target driving strategy, including: in response to the safety value being less than the safety threshold, based on the initial driving strategy, an initial driving factor is determined, wherein the initial driving factor is used to indicate the driving direction of the robot in the initial driving parameters; based on the initial driving factor and the driving safety result, the initial driving strategy is adjusted to obtain the target driving strategy.
[0087] In this embodiment, when the safety value is less than the safety threshold, the initial driving factor is determined according to the initial driving strategy; thus, the initial driving strategy is adjusted according to the initial driving factor and the driving safety result to obtain the target driving strategy.
[0088] Optionally, the initial driving factor can be determined according to the aforementioned formula (9), which will not be described in detail here.
[0089] It should be noted that the above embodiments can be executed by a control device of a robot.
[0090] In this embodiment, the basic data of the robot is obtained, wherein the basic data is used to indicate the robot's motion performance; based on the basic data, the initial driving strategy of the robot is determined, wherein the initial driving strategy is used to indicate the rules for the robot to drive in the initial driving stage; based on the initial driving strategy, the safe driving result of the robot is determined; based on the safe driving result, the target driving strategy of the robot is determined. That is to say, the present invention obtains the basic data of the robot, determines the initial driving strategy according to the basic data, predicts the initial driving strategy, and determines the safe driving result, thereby optimizing the initial driving strategy according to the safe driving result to obtain the target driving strategy, and then controls the robot to drive according to the target driving strategy. Since the present invention predicts the initial driving strategy in advance and determines the safe driving result, it avoids the situation that the robot can only drive according to the preset driving strategy, which leads to low driving safety of the robot, thereby solving the technical problem of low safety of the existing robot during driving, and achieving the technical effect of improving the safety of the existing robot during driving.
[0091] The technical solution of the embodiment of the present invention is illustrated below in conjunction with preferred implementation modes.
[0092] Indoor construction robots are effectively and widely used in construction scenes in various buildings, helping to achieve efficient and precise construction. When executing the construction procedure, the robot needs various instruments and equipment on the robot to realize linkage operation and control feedback, so as to achieve safe and accurate movement and operation in the construction scene. Among them, the motion chassis of the indoor construction robot bears the equipment weight of the construction robot load, provides the robot with motion power and realizes spatial movement in the construction scene according to user instructions. In complex construction scenes, especially the high-height construction scenes of special buildings represented by substations, there are obstacles in the spatial environment such as construction materials, and the robot is loaded with large-mass and high-precision operating equipment due to indoor construction needs. When the robot chassis in the loaded state faces complex terrain features or obstacles, it may need to change the motion state at any time to meet the safety requirements and construction process requirements. There are certain safety risks in the frequent switching of motion states.
[0093] Normally, the robot chassis is equipped with a series of sensors to detect its own motion state and to judge and feedback risks. However, the existing robot chassis perception strategies are relatively simple, and the perception capabilities of intelligent robots represented by indoor sweeping robots may not be sufficient to meet the needs in complex construction sites. Robots for construction scenes usually rely on magnetic strip guidance and other methods for fixed-point and directional driving. Faced with complex working conditions that may change, fixed-program movement methods may have inevitable safety risks. At the same time, large-load chassis often face more complex working environments and more stringent safety conditions due to load mass and existing motion inertia. In construction scenes, they will face more complex road resistance and potential risks. Therefore, there is a technical problem of low safety of existing robots during driving. No effective solution has been proposed for the above-mentioned technical problem of low safety of existing robots during driving.
[0094] However, an embodiment of the present invention proposes a fusion perception control and monitoring method for an indoor construction robot motion chassis, which obtains various sensors according to the sensor module of the robot motion chassis to form a fusion decision on the robot motion state and the expected motion state; based on the obtained fusion decision, combined with the set robot motion route, the robot closed-loop control system is used to drive the robot motion chassis to execute the expected motion behavior; based on the updated motion behavior, the robot's motion behavior is repeatedly adjusted to achieve adaptive regulation of the robot's real-time state perception and environmental perception; thereby solving the technical problem of low safety of existing robots during driving and achieving the technical effect of improving the safety of existing robots during driving.
[0095] The embodiments of the present invention are further described below.
[0096] Figure 2 is a flow chart of a fusion perception control and monitoring method for a motion chassis of an indoor construction robot according to an embodiment of the present invention. The analysis method comprises the following steps:
[0097] Step S201, obtaining information such as the motion state and direction of the robot motion chassis to form a fusion decision on the robot motion state and the expected motion state.
[0098] In this embodiment, various sensors are acquired according to the sensor module of the robot motion chassis to form a fusion decision on the robot motion state and the expected motion state.
[0099] Optionally, the acceleration data of the robot motion chassis is obtained through an inertial measurement unit IMU sensor; specifically, is the acceleration vector measured at time t, m is the total mass of the robot chassis and other equipment mounted on the chassis; the resultant force acting on the chassis at time t is It can be obtained from the above formula (1) that the resultant force Include and The three components can be obtained from the above formula (2) and formula (3), which will not be described in detail here.
[0100] Optionally, a time-of-flight ToF sensor mounted on the moving chassis is used to obtain distance data within a certain range in front of the moving chassis; the distance detection method is to calculate the time required for the light pulse to be reflected by the target in front and then received by the sensor based on the ToF sensor, which is based on the speed of light c and the measured transmission time T t , which can be obtained by the above formula (4) and will not be elaborated here.
[0101] Optionally, the measured distance in each direction constitutes an overall distance array for the area in front of the moving chassis, wherein each element in the array corresponds to a distance value within a specific angle range in front of the moving chassis, satisfying the aforementioned formula (5), which will not be repeated here.
[0102] Optionally, a distance threshold d is preset threshold , by calculating the detected distance value and the distance threshold, the decision strength value S at the corresponding angle is obtained t (θ n ), can be calculated by the above formula (6), which will not be described in detail here.
[0103] Optionally, when the distance exceeds a distance threshold d threshold When the detected distance is less than the distance threshold d, the decision strength value is positive and increases with the detected distance, indicating the suitability in the direction of movement.threshold When , the decision strength value is negative. When there is an obstacle in front of the moving chassis and the distance is closer, the decision strength is smaller, providing a stronger decision value to prevent movement.
[0104] Optionally, for the obtained resultant force And the obtained decision strength value S t (θ n ), calculate the comprehensive motion parameter A t (θ n ), satisfying the above formula (7), combined with the sensor data obtained by other sensors on the motion chassis, optimize the comprehensive motion parameters A in each direction t (θ n ), the optimized parameter A ′ t (θ n ) satisfies the aforementioned formula (8), which will not be elaborated here.
[0105] Step S202: updating the robot's operating behavior according to the obtained fusion decision and the set robot motion route.
[0106] In this embodiment, according to the fusion decision obtained in step S201, combined with the set robot motion route, the robot closed-loop control system is used to drive the robot motion chassis to perform the desired motion behavior.
[0107] Optionally, the obtained comprehensive motion parameter A ′ t (θ n ) is transmitted to the closed-loop control system of the robot system; according to the set robot motion path, the next moment t is obtained ′ The target speed and direction of the robot chassis planned at the time interval t ′ -t is determined based on the robot system performance and scenario requirements.
[0108] Optionally, according to the comprehensive motion parameter A ′ t (θ n ) and the planned target speed and target direction, and calculate the motion decision suggestion; a positive result represents the basic safety of the operation, and a higher value indicates a stronger driving motion suggestion; a negative result represents the potential danger of the operation, and a higher absolute value indicates a stronger blocking motion suggestion;
[0109] Optionally, when the motion decision suggestion is to prevent motion suggestion, the suggested motion direction is calculated according to the acquired parameters, and the motion suggestion factor D (θ n ) satisfies the aforementioned formula (9), which will not be elaborated here.
[0110] Step S203, controlling the robot to travel according to the updated movement behavior.
[0111] In this embodiment, the robot control system is used according to the updated operation behavior, combined with the motion decision suggestion and the motion suggestion factor, to control the power output of the robot motion chassis to achieve the maintenance or change of the motion state.
[0112] Figure 3 It is a schematic diagram of a fusion perception control and monitoring strategy module of an indoor construction robot motion chassis according to an embodiment of the present invention. The fusion perception control and monitoring strategy module structure 300 includes: a self-monitoring module 301, an external perception module 302, an inertial measurement unit 303, other sensors 304 and a time-of-flight ToF distance sensor 305.
[0113] In this embodiment, the self-monitoring module 301 includes an inertial measurement unit (IMU). Through the sensing data of other sensors 304, the self-monitoring module 301 realizes comprehensive monitoring of the state of the robot motion chassis body and provides information about the motion state and direction of the chassis.
[0114] Optionally, the IMU integrates accelerometer, gyroscope, and magnetometer sensors, which can provide information about the object's motion state and direction.
[0115] Optionally, the external perception module 302 includes a time-of-flight (ToF) depth sensor 305 facing the forward motion direction of the robot chassis. The time-of-flight (ToF) depth sensor 305 can obtain the environmental status on the path that the chassis is about to pass, and detect existing objects in the construction environment and obstacles that may interfere with the operation of the robot.
[0116] Figure 4 is a schematic diagram of a sensing state according to an embodiment of the present invention, such as Figure 4 As shown in the figure, the acceleration data of the robot's motion chassis is obtained through the inertial measurement unit IMU sensor to obtain the resultant force Join forces Include and The three components correspond to the forces in each direction. The measured distance in each direction constitutes an overall distance array for the area in front of the moving chassis, where each element in the array corresponds to the distance value D in a specific angle range in front of the moving chassis. t .
[0117] Figure 5 is a schematic diagram of a sensing scenario according to an embodiment of the present invention, such as Figure 5As shown, for angles θ1 and θ2, there is an obstacle 3 in front of θ1, so that the distance d t (θ1) is less than the set threshold distance threshold d threshold , so the decision strength value S t (θ1) is negative; there is no obstacle in the θ2 direction, and the distance d is obtained t (θ2) is greater than the set threshold distance threshold d threshold , so the decision strength value S t (θ1) is positive.
[0118] In this embodiment, the corresponding electricity usage address is matched by the asset number of the electricity meter, and a map positioning point is generated based on the existing operating electricity meter positioning. Based on the positioning point and the departure point, the optimal time-saving meter reading route and meter reading sequence are intelligently planned; the technical problem of low safety of existing robots during driving is solved, and the technical effect of improving meter reading efficiency is achieved.
[0119] According to an embodiment of the present invention, a robot control device is also provided. It should be noted that the robot control device can be used to execute the robot control method in embodiment 1.
[0120] Figure 6 Schematic diagram of a robot control device according to an embodiment of the present invention. Figure 6 As shown, the control device 600 of the robot may include: an acquisition unit 601 , a first determination unit 602 , a second determination unit 603 , a third determination unit 604 and a control unit 605 .
[0121] The acquisition unit 601 is used to acquire basic data of the robot, wherein the basic data is used to indicate the motion performance of the robot.
[0122] The first determining unit 602 is used to determine the initial driving strategy of the robot based on the basic data, wherein the initial driving strategy is used to represent the driving rules of the robot in the initial driving stage.
[0123] The second determining unit 603 is used to determine the safe driving result of the robot based on the initial driving strategy, wherein the safe driving result is used to indicate the safe driving result of the robot under the initial driving strategy.
[0124] The third determination unit 604 is used to determine the target driving strategy of the robot based on the safe driving result, wherein the target driving strategy is used to represent the driving rules of the robot in the target driving stage, and the target driving stage is the driving stage after the initial driving stage.
[0125] The control unit 605 is used to control the robot to travel according to the target driving strategy.
[0126] Optionally, the first determination unit 602 may include: a first determination module, used to determine the resultant force data and initial safety data of the robot, wherein the resultant force data is used to indicate the total resultant force acting on the robot, and the initial safety data is used to indicate the safety level of the robot when driving under basic data; and a second determination module, used to determine the initial driving strategy of the robot based on the resultant force data and the initial safety data.
[0127] Optionally, the second determination unit 603 may include: a first extraction module, used to extract a preset motion path of the robot from the initial driving strategy; and a prediction module, used to predict the safe driving result of the robot based on the initial driving strategy and the preset motion path.
[0128] Optionally, the third determination unit 604 may include: a second extraction module, used to extract a safety value from the safe driving results, wherein the safety value is used to indicate the degree of safety of the robot driving under the initial driving strategy; and a third determination module, used to determine that the initial driving strategy is the target driving strategy in response to the safety value being greater than a safety threshold.
[0129] Optionally, the robot's control device 600 may include: an adjustment module, used to adjust the initial driving strategy in response to the safety value being less than a safety threshold, to obtain a target driving strategy, wherein the safety value of the robot under the target driving strategy is greater than the safety value of the robot under the initial driving strategy.
[0130] Optionally, the adjustment module may include: a determination submodule, for determining an initial driving factor based on the initial driving strategy in response to a safety value being less than a safety threshold, wherein the initial driving factor is used to indicate the driving direction of the robot in the initial driving parameters; and an adjustment submodule, for adjusting the initial driving strategy based on the initial driving factor and the driving safety result to obtain a target driving strategy.
[0131] In this embodiment, the basic data of the robot is obtained, wherein the basic data is used to indicate the robot's motion performance; based on the basic data, the initial driving strategy of the robot is determined, wherein the initial driving strategy is used to indicate the rules for the robot to drive in the initial driving stage; based on the initial driving strategy, the safe driving result of the robot is determined; based on the safe driving result, the target driving strategy of the robot is determined. That is to say, the present invention obtains the basic data of the robot, determines the initial driving strategy according to the basic data, predicts the initial driving strategy, and determines the safe driving result, thereby optimizing the initial driving strategy according to the safe driving result to obtain the target driving strategy, and then controls the robot to drive according to the target driving strategy. Since the present invention predicts the initial driving strategy in advance and determines the safe driving result, it avoids the situation that the robot can only drive according to the preset driving strategy, which leads to low driving safety of the robot, thereby solving the technical problem of low safety of the existing robot during driving, and achieving the technical effect of improving the safety of the existing robot during driving.
[0132] According to an embodiment of the present invention, there is further provided a computer-readable storage medium, the storage medium including a stored program, wherein the program executes the robot control method in Embodiment 1.
[0133] According to an embodiment of the present invention, a processor is further provided, which is used to run a program, wherein the robot control method in Example 1 is executed when the program is run.
[0134] According to an embodiment of the present invention, a computer program product is further provided. The computer program product includes computer instructions. When the computer instructions are executed by a processor, the robot control method in Embodiment 1 is implemented.
[0135] The serial numbers of the above embodiments of the present invention are only for description and do not represent the advantages or disadvantages of the embodiments.
[0136] In the above embodiments of the present invention, the description of each embodiment has its own emphasis. For parts that are not described in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.
[0137] In the several embodiments provided in this application, it should be understood that the disclosed technical content can be implemented in other ways. Among them, the device embodiments described above are only schematic. For example, the division of units can be a logical function division. There may be other division methods in actual implementation. For example, multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of units or modules, which can be electrical or other forms.
[0138] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed over multiple units. Some or all of the units may be selected according to actual needs to achieve the purpose of the present embodiment.
[0139] In addition, each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit. The above-mentioned integrated unit may be implemented in the form of hardware or in the form of software functional units.
[0140] If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent functional component, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, in essence, or the part that contributes to the prior art, or all or part of the technical solution can be embodied in the form of a software functional component, which is stored in a storage medium and includes several instructions for a computer device (which can be a personal computer, server or network device, etc.) to perform all or part of the steps of the methods of each embodiment of the present invention. The aforementioned storage medium includes: U disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), mobile hard disk, disk or optical disk, etc., which can store program codes.
[0141] The above are only preferred embodiments of the present invention. It should be pointed out that, for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principles of the present invention. These improvements and modifications should also be regarded as the scope of protection of the present invention.
Claims
1. A robot control method, characterized in that: include: Acquiring basic data of the robot, wherein the basic data is used to indicate the motion performance of the robot; Based on the basic data, determining an initial driving strategy of the robot, wherein the initial driving strategy is used to represent a driving rule of the robot in an initial driving stage; Based on the initial driving strategy, determining a safe driving result of the robot, wherein the safe driving result is used to indicate a safe driving result of the robot under the initial driving strategy; Based on the safe driving result, determining a target driving strategy of the robot, wherein the target driving strategy is used to represent a rule for the robot to drive in a target driving phase, and the target driving phase is a driving phase after the initial driving phase; The robot is controlled to travel according to the target driving strategy.
2. The method according to claim 1, characterized in that Based on the basic data, determining an initial driving strategy of the robot includes: Determining resultant force data and initial safety data of the robot, wherein the resultant force data is used to indicate the total resultant force acting on the robot, and the initial safety data is used to indicate the safety level of the robot traveling under the basic data; Based on the resultant force data and the initial safety data, the initial driving strategy of the robot is determined.
3. The method according to claim 1, characterized in that Determining a safe driving result of the robot based on the initial driving strategy includes: Extracting a preset motion path of the robot from the initial driving strategy; Based on the initial driving strategy and the preset motion path, the safe driving result of the robot is predicted.
4. The method according to claim 1, characterized in that Based on the safe driving result, determining a target driving strategy of the robot includes: Extracting a safety value from the safe driving result, wherein the safety value is used to indicate the safety degree of the robot driving under the initial driving strategy; In response to the safety value being greater than a safety threshold, the initial driving strategy is determined as the target driving strategy.
5. The method according to claim 4, characterized in that The method further comprises: In response to the safety value being less than the safety threshold, the initial driving strategy is adjusted to obtain the target driving strategy, wherein the safety value of the robot under the target driving strategy is greater than the safety value of the robot under the initial driving strategy.
6. The method according to claim 5, characterized in that In response to the safety value being less than a safety threshold, adjusting the initial driving strategy to obtain the target driving strategy includes: In response to the safety value being less than the safety threshold, determining an initial driving factor based on the initial driving strategy, wherein the initial driving factor is used to indicate a driving direction of the robot in the initial driving parameters; Based on the initial driving factor and the driving safety result, the initial driving strategy is adjusted to obtain the target driving strategy.
7. A robot control device, characterized in that: include: An acquisition unit, used for acquiring basic data of the robot, wherein the basic data is used for indicating the motion performance of the robot; A first determining unit, configured to determine an initial driving strategy of the robot based on the basic data, wherein the initial driving strategy is used to represent a driving rule of the robot in an initial driving stage; A second determining unit is used to determine a safe driving result of the robot based on the initial driving strategy, wherein the safe driving result is used to indicate a safe driving result of the robot under the initial driving strategy; a third determining unit, configured to determine a target driving strategy of the robot based on the safe driving result, wherein the target driving strategy is used to represent a rule for the robot to drive in a target driving phase, and the target driving phase is a driving phase after the initial driving phase; A control unit is used to control the robot to travel according to the target travel strategy.
8. A computer-readable storage medium, characterized in that: The computer-readable storage medium includes a stored program, wherein when the program is executed by a processor, the device where the storage medium is located is controlled to execute the method according to any one of claims 1 to 6.
9. A processor, characterized in that: The processor is used to run a program, wherein the program executes the method according to any one of claims 1 to 6 when running.
10. A computer program product, characterized in that The computer program product comprises computer instructions, which implement the method according to any one of claims 1 to 6 when executed by a processor.
Citation Information
Patent Citations
Robot, robot driving strategy determination method and device and storage medium
CN114326710A
Driving strategy determination method and device, electronic equipment and automatic driving vehicle
CN114590248A
Method and device for determining driving strategy of autonomous vehicle, equipment and medium
CN115675531A
Vehicle driving strategy determination method and device based on passenger risk cognition
CN115771506A
