Robot control method and apparatus, and electronic device and storage medium

By obtaining obstacle information and basic robot control information, simulating rotation to judge collision risks and planning arc paths, the collision problem of mowing robots during the transition of bow characters is solved, and work efficiency and safety are improved.

WO2024244302A1PCT designated stage expired Publication Date: 2024-12-05ZHEJIANG SUNSEEKER IND CO LTD

Patent Information

Application Number
PCT/CN2023/130028
Authority / Receiving Office
WO · WO
Patent Type
Applications
Current Assignee / Owner
Priority Date
2023-06-02
Filing Date
2023-11-06
Publication Date
2024-12-05

AI Technical Summary

Technical Problem

When the mowing robot is planning a transition, it is prone to collision with obstacles due to shape reasons, resulting in damage and reduced work efficiency.

Method used

By obtaining obstacle information, target point position information and robot control basic information, simulate rotation and judge collision risk. If there is any collision, plan the arc path to avoid collision and improve work efficiency.

Benefits of technology

It effectively avoids collision between robots and obstacles, and improves work efficiency and safety.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN2023130028_05122024_PF_FP_ABST
    Figure CN2023130028_05122024_PF_FP_ABST
Patent Text Reader

Abstract

Disclosed in the embodiments of the present application are a robot control method and apparatus, and a system and a storage medium. The method comprises: acquiring obstacle information, position information of a target point and basic control information of a robot; performing simulated rotation according to the obstacle information and a rotation size of the robot, and determining whether the robot will collide with an obstacle during a rotation process; if the robot will collide with the obstacle, planning an arc path according to the position information of the target point and the basic control information, so as to obtain a target path and a transition point on the target path; and according to the target path, controlling the robot to travel to the transition point, and to travel in a direction from the transition point to the target point. On this basis, the present application maximally avoids the occurrence of a robot colliding with an obstacle by means of combining simulated rotation with arc-path planning, such that obstacle avoidance is more accurate, and collision damage is avoided, thereby improving the operation efficiency of the robot.
Need to check novelty before this filing date? Find Prior Art

Description

Robot control method, device, electronic device and storage medium

[0001] This application claims priority to the following patent applications, the entire contents of which are incorporated herein by reference: Chinese Patent Application No. 2023106515053, filed on June 2, 2023 with the State Intellectual Property Office of China, entitled “Robot Control Method, Device, Electronic Device and Storage Medium” Technical Field

[0002] The embodiments of the present application relate to the field of robot control technology, and in particular to a robot control method, device, electronic device, and storage medium. Background Art

[0003] With the development of technology, more and more tasks can be completed by robots, such as the most common sweeping robots and lawn mowing robots. Usually, sweeping robots are circular in shape. When they detect that they are trapped during a bow-shaped transition, they are controlled to rotate to the left or right. When their rotation angle exceeds the preset angle, the sweeping robot is controlled to move backward and rotate one circle in the opposite direction of the successful rotation to determine whether the sweeping robot has successfully escaped. Alternatively, they can directly rotate the robot to a corresponding angle to re-plan the path to escape. Lawn mowing robots are usually square in shape. When they are close to obstacles during a bow-shaped transition, if they are used as circular robots to escape, they are likely to collide with the obstacles due to their shape. This may cause damage to objects or the robot, and also reduce the robot's work efficiency.

[0004] Summary of the Invention

[0005] The purpose of the present disclosure is to provide an improved robot control method, device, electronic device, and storage medium that solve at least one of the above problems.

[0006] According to one aspect of the present disclosure, the object is achieved at least in part by a method for controlling a robot. The method comprises:

[0007] Obtaining obstacle information, target point location information, and basic control information of the robot;

[0008] Performing simulated rotation according to the obstacle information and the rotation size of the robot to determine whether the robot will collide with the obstacle during the rotation;

[0009] If the obstacle is encountered, a circular path is planned based on the position information of the target point and the basic control information to obtain a target path and a transition point on the target path;

[0010] The robot is controlled to move to the transition point according to the target path, and then moves from the transition point toward the target point.

[0011] Therefore, the control method of a robot with the above characteristics obtains obstacle information, target point position information, and basic control information of the robot; simulates rotation based on the obstacle information and the robot's rotation size to determine whether the robot will collide with the obstacle during the rotation process; if it will collide with the obstacle, plans an arc path based on the target point position information and the basic control information to obtain the target path and the transition point on the target path; controls the robot to move to the transition point according to the target path, and then moves from the transition point toward the target point. Based on this, by combining simulated rotation with arc path planning, the robot is prevented from colliding with obstacles to the greatest extent possible, obstacle avoidance is more accurate, collision damage is avoided, and the robot's work efficiency is improved.

[0012] According to a second aspect of the present disclosure, the object is at least partially achieved by a control device for a robot. The device comprises:

[0013] An acquisition module is used to obtain obstacle information, target point location information, and basic control information of the robot;

[0014] a collision prediction module, configured to simulate rotation according to the obstacle information and the rotation size of the robot, and determine whether the robot will collide with the obstacle during the rotation;

[0015] An arc planning module is used to plan an arc path according to the position information of the target point and the basic control information if the obstacle is likely to be collided with, and obtain a target path and a transition point on the target path;

[0016] The travel control module is used to control the robot to travel to the transition point according to the target path, and to travel from the transition point to the target point.

[0017] According to a second aspect of the present disclosure, the object is at least partially achieved by an electronic device. The electronic device comprises:

[0018] one or more processors;

[0019] a storage device for storing one or more programs,

[0020] When the one or more programs are executed by the one or more processors, the one or more processors implement the robot control method provided in any embodiment of the present application.

[0021] According to a second aspect of the present disclosure, the object is achieved at least in part by a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the robot control method provided in any embodiment of the present application.

[0022] The details of at least one embodiment are set forth in the accompanying drawings and the description below. Other features, objects, and advantages will be apparent from the description, drawings, and claims. BRIEF DESCRIPTION OF THE DRAWINGS

[0023] FIG1 is a schematic flow chart of a robot control method according to a first embodiment of the present application;

[0024] FIG2 is a schematic diagram of the process of arc path planning provided in Example 1 of the present application;

[0025] FIG3 is a schematic structural diagram of a robot control device provided in Example 2 of the present application;

[0026] FIG4 is a schematic structural diagram of an electronic device provided in Example 3 of the present application. DETAILED DESCRIPTION

[0027] The present application will be further described in detail below with reference to the accompanying drawings and examples. It should be understood that the specific embodiments described herein are intended only to illustrate the present application and are not intended to limit the present application. It should also be noted that, for ease of description, the accompanying drawings only illustrate portions of the present application, not all of the structures.

[0028] Example 1

[0029] Figure 1 is a flow chart of a robot control method provided in Example 1 of the present application. The method of this embodiment is applicable to robot control scenarios. The method can be executed by a robot control device, which can be implemented in hardware and / or software and can generally be integrated into a system such as a computer with data computing capabilities. Specifically, the method includes the following steps:

[0030] Step 101: Obtain obstacle information, target point location information, and basic control information of the robot.

[0031] In this step, the obstacle information may be the point cloud information of the obstacle. The point cloud information can usually be obtained using equipment such as a laser radar. The laser radar scans the environment within the corresponding range to obtain the point cloud information of the environment. By analyzing the point cloud information of the environment, the point cloud information corresponding to any obstacle in the environment can be obtained, that is, the obstacle information in this step.

[0032] It should be noted that the corresponding range of the LiDAR refers to the range that the LiDAR device can scan. In addition, the number of obstacles in the aforementioned environment can be one or two or more. Therefore, the obstacle information obtained in this step can include point cloud information of one or more obstacles.

[0033] In addition, the target point refers to the next point that the robot needs to reach. In a more common example, during the control process of the robot's movement, the position information of the next required point will be continuously generated. Each time it is generated, the position information of the required point can be determined as the position information of the target point in this step.

[0034] Of course, in other examples, the robot will first plan multiple points and the order in which the robot passes through each point after scanning the map of the entire environment during its movement. According to this order, after the robot reaches any point, the next point will be the target point in this step.

[0035] Therefore, the position information of the target point obtained in this step can be obtained according to different control logics of the robot. In general, the target point is the next position point that the robot needs to reach.

[0036] Furthermore, the basic control information of the robot mainly refers to the information of the robot itself required to control the movement of the robot, such as the robot's speed range, minimum turning radius, preset minimum arc distance, preset maximum arc distance, rotation angle range, etc.

[0037] It should be noted that, in different examples, the content included in the basic control information may be different, which will be shown in detail in the subsequent description.

[0038] The speed range of the robot can be, but is not limited to, [0.1, 0.2], and the speed unit is m / s. Of course, the speed range can be adjusted according to actual needs.

[0039] The minimum turning radius is the sum of the distance from the robot's central axis to its tail and a preset safety distance, where the preset safety distance can be, but is not limited to, 0.1 meters.

[0040] The preset minimum arc distance refers to the minimum arc distance that the robot can escape from. It is usually set by the designer. This value is an assumed value, that is, the minimum arc distance that the robot can escape from. In a specific example, it can be set to twice the length of the robot body. In addition, the arc distance refers to the length of the arc.

[0041] The preset maximum arc distance is also an assumed value and can be preset by the designer according to needs.

[0042] The rotation angle range refers to the maximum angle range that the robot can rotate without colliding with obstacles.

[0043] It should be noted that when the basic control information includes the rotation angle range, when acquiring the basic control information, the rotation angle range of the robot without colliding with the obstacle can be determined based on the obstacle information.

[0044] The range of the robot's rotation angle without colliding with an obstacle can be determined by performing a simulated rotation based on the obstacle information and the robot's rotation size. The range of the rotation angle can be used to limit the range of the planned arc path during subsequent path planning.

[0045] In addition, the robot referred to in this embodiment can be but is not limited to a square robot.

[0046] Step 102: Perform simulated rotation based on the obstacle information and the robot's rotation size to determine whether the robot will collide with the obstacle during the rotation.

[0047] In this step, the rotation size of the robot can also be the distance between the rotation center of the robot and the point where the robot body is farthest from the rotation center. For greater safety, a safety distance can be added to the distance.

[0048] Alternatively, the point cloud information of the obstacle can be the 3D coordinates of the obstacle's edge points, with the robot's LiDAR as the coordinate origin. Specifically, the simulated rotation process can include first calculating the distance between each target edge point of the obstacle and the robot's rotation center, where the target edge point is an edge point on the obstacle that is at the same height as the robot's rotation center or at a preset height difference, and then comparing the obtained distance with the previous rotation dimension.

[0049] If there is a distance smaller than the rotation size, it means that the robot will collide with an obstacle during the simulated rotation. If there is no distance smaller than the rotation size, it means that the robot will not collide with an obstacle during the simulated rotation.

[0050] It should be noted that the above-mentioned simulated rotation process mainly involves the calculation of the distance between two coordinate points. The specific calculation formula can be referred to related technologies and will not be repeated here.

[0051] Step 103: If the robot does not collide with an obstacle during the rotation process, the robot is rotated to a target direction corresponding to the position information of the target point; and the robot is controlled to move to the target point in the target direction.

[0052] In this step, if it is determined in the aforementioned step 102 that the robot does not collide with an obstacle during the rotation process, the robot can be controlled to rotate to the target direction, where the target direction can be a straight line direction from the current position of the robot to the target point.

[0053] It should be noted that before controlling the robot to move in the target direction, it is possible to first determine whether there are any obstacles in the target direction that can block the robot's movement.

[0054] Specifically, the vertical distance between the obstacles around the travel path and the travel path can be calculated to determine whether there is a vertical distance less than a preset distance, where the preset distance here can be the vertical distance from the center point of the robot to the side of the robot.

[0055] If it does not exist, it means that there is no obstacle that can block the robot's movement. At this time, the robot can be controlled to move to the target point in the target direction; if it exists, it means that there is an obstacle that can block the robot's movement, and the path planning needs to be re-performed.

[0056] It should be noted that, if the path rule needs to be re-formulated at this time, steps 104 and 105 can be executed to plan an obstacle avoidance path.

[0057] Step 104: If an obstacle is encountered, a circular path is planned based on the position information of the target point and the basic control information to obtain the circular path and the transition points on the circular path.

[0058] In this step, the process of arc path planning can refer to Figure 2, which is a flowchart of arc path planning provided in Example 1 of the present application.

[0059] As shown in FIG2 , the arc path planning process may include:

[0060] Step 201: Plan a forward arc path based on the position information of the target point and the basic control information. Each time a forward arc path is planned, determine whether the forward arc path meets the preset requirements.

[0061] In this step, when planning the forward circular arc path according to the position information of the target point and the basic control information, multiple forward circular arc paths can be planned in sequence.

[0062] Specifically, the basic control information here may include the speed range and the minimum turning radius of the robot. First, a first preset number of speed values ​​are extracted from the speed range, and the angular velocity corresponding to each speed value is determined according to the minimum turning radius.

[0063] In a specific example, the speed interval may be [0.1, 0.2], the first preset number may be i, illustratively, i=5, then 5 speed values ​​may be evenly extracted from the speed interval, for example, 0.11, 0.13, 0.15, 0.17, 0.19.

[0064] Then, the angular velocity corresponding to each speed value is calculated according to a preset formula, wherein the preset formula may be ω=v / R0, wherein ω is the angular velocity, v is the speed value, and R0 is the minimum turning radius.

[0065] Then the obtained velocity values ​​are combined with the angular velocities in pairs. Specifically, the velocity value set v = (v0, v1, v2, ..., v i ), the angular velocity set ω=(ω0,ω1,ω2,...,ω j ), taking one element from each of the velocity value set and the angular velocity set to form a combination (v i ,ω j ), i∈N, j∈N, for any combination, determine the arc radius of the forward arc path corresponding to the combination, and if the arc radius meets the preset radius requirement, determine the arc radius as the arc radius to be used;

[0066] For any of the arc radii to be taken, if there are other arc radii to be taken with the same value, the combination corresponding to any of the arc radii to be taken with the same value is determined as the target combination; if there are no other arc radii to be taken with the same value, the combination corresponding to the arc radii to be taken is determined as the target combination.

[0067] For any target combination, a forward arc path is fitted according to the velocity value and angular velocity value in the target combination.

[0068] In a specific example, assuming the minimum turning radius is 0.5 meters, taking the speed values ​​as 0.1m / s, 0.15m / s, and 0.2m / s, we get the angular velocities as 0.2r / s, 0.3r / s, and 0.4r / s, and then the following combinations (v, ω):

[0069] (0.1,0.2), (0.1,0.3), (0.1,0.4), (0.15,0.2), (0.15,0.3), (0.15,0.4), (0.2,0.2), (0.2,0.3), (0.2,0.4).

[0070] For any combination, the arc radius is determined according to the formula R = v / ω, which is: 0.5, 0.33, 0.25, 0.75, 0.5, 0.375, 1, 0.67, 0.5. The preset radius requirement is that the arc radius is greater than or equal to the minimum turning radius. The obtained arc radius and corresponding target combination are shown in Table 1 below:

[0071] Table 1

[0072] Each time a forward arc path is planned, a second preset number of simulation points are extracted from the forward arc path, and simulated rotation is performed on the simulation points in sequence. In a specific example, the second preset number may be 100.

[0073] It should be noted that when extracting simulation points, points can be taken according to a fixed step size. At this time, the second preset number needs to be calculated based on the length of the forward arc path and the fixed step size. Specifically, it can be the quotient of the length of the forward arc path and the fixed step size rounded down.

[0074] Of course, the second preset number may also be fixed directly, and then the quotient of the length of the forward arc path and the second preset number is calculated, and the quotient is determined as the distance between the simulation points to select the points.

[0075] In addition, the process of performing simulated rotation on the simulated point can refer to the simulated rotation process in the aforementioned step 102, which will not be described in detail here.

[0076] If the robot does not collide with obstacles when performing simulated rotation at a simulation point, the simulation point currently performing simulated rotation meets the preset requirements, and the forward arc path meets the preset requirements; if the robot will collide with obstacles when performing simulated rotation at all simulation points, the forward arc path is determined not to meet the preset requirements.

[0077] It should be noted that whether the vehicle will collide with an obstacle can also be determined by referring to the judgment process in the aforementioned step 102, which will not be repeated here.

[0078] In addition, the above process can illustrate that the preset requirement that the forward arc path referred to in this step needs to meet is that there are simulation points that will not collide with obstacles.

[0079] Step 202: If the conditions are met, the currently planned forward arc path is determined as the target path, and the point on the target path that meets the preset requirements is determined as the transition point. If the conditions are not met, the next forward arc path is planned.

[0080] In this step, if a forward arc path that meets the preset requirements is found in the previous step, it can be determined as the target path, and the simulated points on the target path that meet the preset requirements are determined as transition points. The simulated points that meet the preset requirements are the simulated points where the simulated rotation will not collide with obstacles.

[0081] If not, the next set of speed values, the corresponding angular velocity, and the position information of the target point are used to plan the next forward arc path.

[0082] Step 203: If all planned forward arc paths do not meet the preset requirements, determine whether the historical path to the current position point meets the preset requirements based on the control basic information.

[0083] Of course, there may be a situation where all planned forward arc paths do not meet the preset requirements. In this case, a transition point can be found from the historical path. In other words, a point is selected from the historical path leading to the current position, and then a simulated rotation is performed. The preset requirement here is still to find a simulated point that does not collide with obstacles.

[0084] Step 204: If the conditions are met, the historical path is determined as the target path, and the points on the target path that meet the preset requirements are determined as transition points.

[0085] Similarly, the points that meet the preset requirements in this step are the simulation points in the historical path where the simulated rotation will not collide with obstacles.

[0086] It should be noted that if the historical path does not meet the preset requirements, an alarm can be issued and manual intervention can be made in path planning.

[0087] In order to further simplify the point-taking process in this application, the basic control information may also include a preset minimum arc distance, wherein the preset minimum arc distance is the minimum arc distance that the robot is assumed to be able to escape from.

[0088] Then, before extracting the simulation point, determine whether the distance of the planned forward arc path is less than the preset minimum arc distance. If the distance of the forward arc path is less than the preset minimum arc distance, filter the forward arc path and plan the next forward arc path.

[0089] Based on this feature, some forward arc paths that may not meet the preset conditions can be filtered out, reducing the amount of calculation required for planning.

[0090] Of course, the actual length of the point selection in the forward arc path can also be shortened, thereby further reducing the amount of calculation.

[0091] For example, the control basic information includes a preset farthest arc distance. Then, when extracting the simulation points, if the distance of the forward arc path is greater than the preset farthest arc distance, a second preset number of simulation points are extracted from the forward arc path, wherein the distance from each simulation point to the starting point is less than or equal to the preset farthest arc distance.

[0092] If the distance of the forward arc path is less than or equal to the preset farthest arc distance, a second preset number of simulation points are extracted from the forward arc path.

[0093] That is to say, if the distance of the forward arc path is greater than the preset farthest arc distance, then the simulation point can be extracted from the portion of the forward arc path that is less than the preset farthest arc distance.

[0094] For another example, the control basic information includes a preset minimum arc distance and a preset maximum arc distance. When extracting the simulation points, if the distance of the forward arc path is greater than the preset maximum arc distance, a second preset number of simulation points are extracted from the forward arc path, wherein the distance from each simulation point to the starting point is less than or equal to the preset maximum arc distance, and the distance from each simulation point to the starting point is greater than or equal to the preset minimum arc distance.

[0095] If the distance of the forward arc path is less than or equal to the preset maximum arc distance, a second preset number of simulation points are extracted from the forward arc path, and the distance from each simulation point to the starting point is greater than or equal to the preset minimum arc distance.

[0096] That is to say, if the distance of the forward arc path is greater than the preset maximum arc distance, the range of the point is the portion of the forward arc path that is greater than the preset minimum arc distance and less than the preset maximum arc distance.

[0097] If the distance of the forward arc path is less than or equal to the preset maximum arc distance, the range of the point is the portion of the forward arc path that is greater than the preset minimum arc distance.

[0098] Step 105: Control the robot to move to the transition point according to the arc path, and move from the transition point to the target point.

[0099] In this step, the robot can be controlled to move to the transition point according to the arc path obtained above, and rotate to the direction of the target point at the transition point, and then continue to move to the target point.

[0100] In this embodiment, obstacle information, target point location information, and basic control information for the robot are obtained; a simulated rotation is performed based on the obstacle information and the robot's rotation size to determine whether the robot will collide with the obstacle during the rotation process; if the robot will collide with the obstacle, an arc path is planned based on the target point location information and basic control information to obtain the arc path and the transition point on the arc path; the robot is controlled to move to the transition point according to the arc path, and then moves from the transition point toward the target point. Based on this, the present application combines simulated rotation with arc path planning to avoid the robot colliding with obstacles to the greatest extent possible, making obstacle avoidance more accurate, avoiding collision damage, and improving the robot's work efficiency.

[0101] Example 2

[0102] Figure 3 is a schematic diagram of the structure of a robot control device provided in Example 2 of the present application. The robot control device provided in this embodiment of the present application can execute the robot control method provided in any embodiment of the present application, and has the corresponding functional modules and beneficial effects of the execution method. The device can be implemented in software and / or hardware. As shown in Figure 3, the robot control device specifically includes: an acquisition module 301, a collision prediction module 302, an arc planning module 303, and a travel control module 304.

[0103] Among them, the acquisition module is used to obtain obstacle information, target point location information and robot control basic information;

[0104] The collision prediction module is used to simulate the rotation of the robot based on the obstacle information and the robot's rotation size to determine whether the robot will collide with the obstacle during the rotation process;

[0105] The arc planning module is used to plan the arc path based on the position information of the target point and the basic control information if there is a collision with an obstacle, and obtain the arc path and the transition points on the arc path;

[0106] The travel control module is used to control the robot to travel to the transition point according to the arc path, and then travel from the transition point to the target point.

[0107] Furthermore, the travel control module includes:

[0108] A rotation control module is used to rotate the robot to a target direction corresponding to the position information of the target point if the robot does not collide with an obstacle during the rotation process;

[0109] The travel module is used to control the robot to travel to the target point in the target direction.

[0110] Furthermore, the arc planning module includes:

[0111] A path planning unit is used to plan a forward arc path based on the location information of the target point and the basic control information, and to determine whether the forward arc path meets the preset requirements for each planned forward arc path;

[0112] A first transition point determination unit is configured to determine the currently planned forward arc path as the target path if the requirements are met, and determine a point on the target path that meets the preset requirements as a transition point; if the requirements are not met, plan the next forward arc path;

[0113] A historical path judgment unit is used to judge whether the historical path to the current position meets the preset requirements based on the control basic information if all planned forward arc paths do not meet the preset requirements;

[0114] The second transition point determination unit is configured to determine the historical path as the target path if the requirements are met, and determine the point on the target path that meets the preset requirements as the transition point.

[0115] Furthermore, the basic control information includes the robot’s speed range and minimum turning radius;

[0116] The path planning unit includes:

[0117] an angular velocity determination subunit, configured to extract a first preset number of speed values ​​from the speed interval, and determine an angular velocity corresponding to each speed value according to the minimum turning radius;

[0118] A path generation subunit, configured to generate, for any speed value, a forward arc path to a target point according to the speed value, the corresponding angular velocity, and the position information of the target point;

[0119] a simulated rotation subunit, configured to extract a second preset number of simulated points from the forward arc path and perform simulated rotation on the simulated points in sequence;

[0120] The first judgment subunit is configured to determine whether the robot will not collide with obstacles when performing simulated rotation at a simulated point, the forward arc path meets preset requirements, and the simulated point currently performing simulated rotation meets preset requirements;

[0121] The second judgment subunit is used to determine if, at all simulation points, the robot collides with an obstacle during simulated rotation, and the forward arc path determination does not meet preset requirements.

[0122] Furthermore, the basic control information also includes a preset minimum arc distance;

[0123] The Arc Planning module also includes:

[0124] The arc path filtering module is used to filter the forward arc path if the distance of the forward arc path is less than a preset minimum arc distance, and plan the next forward arc path.

[0125] Furthermore, the basic control information also includes a preset maximum arc distance;

[0126] The simulated rotating subunit includes:

[0127] a first extraction subunit, configured to extract a second preset number of simulation points from the forward circular arc path if the distance of the forward circular arc path is greater than a preset farthest circular arc distance, wherein the distance from each simulation point to the starting point is less than or equal to the preset farthest circular arc distance;

[0128] The second extraction subunit is configured to extract a second preset number of simulation points from the forward circular arc path if the distance of the forward circular arc path is less than or equal to the preset farthest circular arc distance.

[0129] Furthermore, the basic control information also includes a preset maximum arc distance;

[0130] The simulated rotating subunit includes:

[0131] a third extraction subunit, configured to extract a second preset number of simulation points from the forward circular arc path if the distance of the forward circular arc path is greater than the preset farthest circular arc distance, wherein the distance from each simulation point to the starting point is less than or equal to the preset farthest circular arc distance, and the distance from each simulation point to the starting point is greater than or equal to the preset minimum circular arc distance;

[0132] The fourth extraction subunit is used to extract a second preset number of simulation points from the forward arc path if the distance of the forward arc path is less than or equal to the preset maximum arc distance, and the distance from each simulation point to the starting point is greater than or equal to the preset minimum arc distance.

[0133] Furthermore, the basic control information includes a rotation angle range;

[0134] The acquisition module includes:

[0135] The rotation angle range determining unit is used to determine the rotation angle range of the robot without colliding with the obstacle based on the obstacle information.

[0136] Example 3

[0137] Figure 4 is a structural diagram of an electronic device provided in Example 3 of the present application. As shown in Figure 4, the electronic device includes a processor 410, a memory 420, an input device 430 and an output device 440; the number of processors 410 in the electronic device can be one or more, and Figure 4 takes one processor 410 as an example; the processor 410, memory 420, input device 430 and output device 440 in the electronic device can be connected via a bus or other means, and Figure 4 takes connection via a bus as an example.

[0138] The memory 420 is a computer-readable storage medium that can be used to store software programs, computer-executable programs, and modules, such as the program instructions / modules corresponding to the robot control method in the embodiment of the present invention. The processor 410 executes the software programs, instructions, and modules stored in the memory 420 to execute various functional applications and data processing of the electronic device, that is, to implement the above-mentioned robot control method:

[0139] Obtain obstacle information, target point location information, and basic robot control information;

[0140] Perform simulated rotation based on obstacle information and the robot's rotation size to determine whether the robot will collide with the obstacle during the rotation;

[0141] If an obstacle is encountered, the arc path is planned based on the target point location information and basic control information to obtain the arc path and the transition point on the arc path;

[0142] The robot is controlled to move to the transition point according to the arc path, and then moves from the transition point to the target point.

[0143] The memory 420 may mainly include a program storage area and a data storage area, wherein the program storage area may store applications required to operate the electronic device and at least one function; the data storage area may store data created based on the use of the terminal, etc. In addition, the memory 420 may include a high-speed random access memory and may also include a non-volatile memory, such as at least one disk storage device, a flash memory device, or other non-volatile solid-state storage device. In some instances, the memory 420 may further include a memory remotely located relative to the processor 410, and these remote memories may be connected to the electronic device via a network. Examples of the above-mentioned network include, but are not limited to, the Internet, an intranet, a local area network, a mobile communication network, and combinations thereof.

[0144] Example 4

[0145] The fourth embodiment of the present application further provides a storage medium containing computer-executable instructions. When the computer-executable instructions are executed by a computer processor, they are used to perform a robot control method. The method includes:

[0146] Obtain obstacle information, target point location information, and basic robot control information;

[0147] Perform simulated rotation based on obstacle information and the robot's rotation size to determine whether the robot will collide with the obstacle during the rotation;

[0148] If an obstacle is encountered, the arc path is planned based on the target point location information and basic control information to obtain the arc path and the transition point on the arc path;

[0149] The robot is controlled to move to the transition point according to the arc path, and then moves from the transition point to the target point.

[0150] Of course, the storage medium containing computer-executable instructions provided in an embodiment of the present application, whose computer-executable instructions are not limited to the above method operations, can also execute related operations in the robot control method provided in any embodiment of the present application.

[0151] Through the above description of the implementation methods, those skilled in the art can clearly understand that the present application can be implemented with the help of software and necessary general-purpose hardware, and of course it can also be implemented by hardware, but in many cases the former is a better implementation method. Based on this understanding, the technical solution of the present application is essentially or the part that contributes to the prior art can be embodied in the form of a software product, which can be stored in a computer-readable storage medium, such as a computer's floppy disk, read-only memory (ROM), random access memory (RAM), flash memory (FLASH), hard disk or optical disk, etc., including a number of instructions for enabling a computer device (which can be a personal computer, server, or network device, etc.) to execute the methods of each embodiment of the present application.

[0152] It is worth noting that in the embodiment of the above-mentioned search device, the various units and modules included are only divided according to functional logic, but are not limited to the above-mentioned division, as long as the corresponding functions can be achieved; in addition, the specific names of the functional units are only for the convenience of distinguishing each other, and are not used to limit the scope of protection of this application.

[0153] Note that the above are only preferred embodiments of the present application and the technical principles employed. Those skilled in the art will understand that the present application is not limited to the specific embodiments herein, and that various obvious changes, readjustments, and substitutions can be made by those skilled in the art without departing from the scope of protection of the present application. Therefore, although the present application has been described in more detail through the above embodiments, the present application is not limited to the above embodiments and may include many other equivalent embodiments without departing from the scope of the present application. The scope of the present application is determined by the scope of the appended claims.

Claims

1. A robot control method, characterized in that: The method comprises: Obtaining obstacle information, target point location information, and basic control information of the robot; Performing simulated rotation according to the obstacle information and the rotation size of the robot to determine whether the robot will collide with the obstacle during the rotation; If the obstacle is collided with, a circular arc path is planned according to the position information of the target point and the control basic information to obtain the target path and the transition point on the target path; The robot is controlled to move to the transition point according to the target path, and then moves from the transition point to the target point.

2. The method according to claim 1, characterized in that The method also includes: If the robot does not collide with the obstacle during the rotation, rotating the robot to a target direction corresponding to the position information of the target point; Control the robot to move to the target point in the target direction.

3. The method according to claim 1, characterized in that The planning of the arc path according to the position information of the target point and the control basic information to obtain the target path and the transition points on the target path includes: Planning a forward circular arc path according to the position information of the target point and the control basic information, and determining whether the forward circular arc path meets preset requirements each time a forward circular arc path is planned; If the requirements are met, the currently planned forward arc path is determined as the target path, and the point on the target path that meets the preset requirements is determined as the transition point. If the requirements are not met, the next forward arc path is planned; If all planned forward arc paths do not meet the preset requirements, determine whether the historical path to the current position point meets the preset requirements based on the control basic information; If so, the historical path is determined as the target path, and the point on the target path that meets the preset requirements is determined as the transition point.

4. The method according to claim 3, characterized in that The basic control information includes the speed range and minimum turning radius of the robot; The planning of the forward arc path according to the position information of the target point and the control basic information, and each planning of a forward arc path, determining whether the forward arc path meets the preset requirements, comprises: Extracting a first preset number of speed values ​​from the speed interval, and determining an angular velocity corresponding to each of the speed values ​​according to the minimum turning radius; The obtained speed values ​​and angular velocities are combined in pairs, and for any combination, the arc radius of the forward arc path corresponding to the combination is determined, and if the arc radius meets the preset radius requirement, the arc radius is determined as the arc radius to be used; For any of the to-be-used circular arc radii, if there are other to-be-used circular arc radii with the same value, a combination corresponding to any to-be-used circular arc radii among the to-be-used circular arc radii with the same value is determined as a target combination; If there are no other arc radii with the same value, the combination corresponding to the arc radii to be taken is determined as the target combination; For any target combination, a forward arc path is fitted according to the velocity value and angular velocity value in the target combination; Extracting a second preset number of simulation points from the forward arc path, and performing simulated rotation on the simulation points in sequence; If the robot does not collide with the obstacle when performing simulated rotation at a simulated point, the forward arc path meets the preset requirements, and the simulated point currently performing simulated rotation meets the preset requirements; If at all simulation points, the robot collides with the obstacle during the simulated rotation, the The forward arc path determination does not meet the preset requirements.

5. The method according to claim 4, characterized in that The control basic information also includes a preset minimum arc distance; Before extracting the second preset number of simulation points from the forward circular arc path, planning the forward circular arc path according to the position information of the target point and the control basic information, and determining whether the forward circular arc path meets the preset requirements for each planned forward circular arc path, further comprising: If the distance of the forward circular arc path is less than the preset minimum circular arc distance, the forward circular arc path is filtered and the next forward circular arc path is planned.

6. The method according to claim 4 or 5, characterized in that: The control basic information also includes a preset farthest arc distance; The step of extracting a second preset number of simulation points from the forward arc path comprises: If the distance of the forward circular arc path is greater than the preset farthest circular arc distance, extract a second preset number of simulation points from the forward circular arc path, wherein the distance from each simulation point to the starting point is less than or equal to the preset farthest circular arc distance; If the distance of the forward circular arc path is less than or equal to the preset farthest circular arc distance, a second preset number of simulation points are extracted from the forward circular arc path.

7. The method according to claim 5, characterized in that The control basic information also includes a preset farthest arc distance; The step of extracting a second preset number of simulation points from the forward arc path comprises: If the distance of the forward circular arc path is greater than the preset farthest circular arc distance, extract a second preset number of simulation points from the forward circular arc path, wherein the distance from each simulation point to the starting point is less than or equal to the preset farthest circular arc distance, and the distance from each simulation point to the starting point is greater than or equal to the preset minimum circular arc distance; If the distance of the forward arc path is less than or equal to the preset farthest arc distance, a second preset number of simulation points are extracted from the forward arc path, and the distance from each simulation point to the starting point is greater than or equal to the preset minimum arc distance.

8. The method according to claim 1, characterized in that The control basic information includes a rotation angle range; Obtaining basic control information of the robot includes: Based on the obstacle information, a rotation angle range of the robot without colliding with the obstacle is determined.

9. A robot control device, characterized in that: include: An acquisition module, used to acquire obstacle information, target point location information and basic control information of the robot; A collision prediction module, used to simulate the rotation according to the obstacle information and the rotation size of the robot, and determine whether the robot will collide with the obstacle during the rotation process; An arc planning module, used to plan an arc path according to the position information of the target point and the control basic information if the obstacle is likely to be collided with, and obtain a target path and a transition point on the target path; The travel control module is used to control the robot to travel to the transition point according to the target path, and to travel from the transition point to the target point.

10. An electronic device, characterized in that: include: one or more processors; a storage device for storing one or more programs, When the one or more programs are executed by the one or more processors, the one or more processors implement the robot control method as described in any one of claims 1 to 8.

11. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the program is executed by a processor, the robot control method as claimed in any one of claims 1 to 8 is implemented.

Citation Information

Patent Citations

  • Robot control method and device, electronic equipment and storage medium

    CN116661454A

  • Method and device for adjusting robot path

    CN106598054A

  • Obstacle avoidance method of mobile equipment and mobile equipment

    CN111513626A

  • Marking method, marking device, intelligent robot and readable storage medium

    CN112161624A

  • Rectangular sweeping robot control method and device and rectangular sweeping robot

    CN114489076A

Cited By

  • AGV intelligent obstacle avoidance and path optimization method and system

    CN119717828A

  • Working dog and robot collaborative operation system

    CN120215513A