Path planning method and device based on dual-machine mutual interference and computer equipment

文档序号:85346 发布日期:2021-10-08 浏览:47次 中文

阅读说明:本技术 基于双机互扰的路径规划方法、装置及计算机设备 (Path planning method and device based on dual-machine mutual interference and computer equipment ) 是由 舒秀兰 李骁龙 马昌运 郑旭彬 辛俊朗 于 2021-07-12 设计创作,主要内容包括:基于双机互扰的路径规划方法,包括下述步骤:根据第一机器人和第二机器人的障碍物检测信息确定第一机器人和第二机器人处于互扰状态;在所述互扰状态下,根据地标索引,确定第一机器人运行的第一路径所经历的地标节点,其中所述地标索引通过树状结构记录地图中的所有地标节点,一个父地标节点下的所有子地标节点之间能够相互通行,各个地标节点之间能够根据所述地标索引的结构通行,所述第一路径包括第一机器人从当前地标节点移动到目标地标节点所经过的所有地标节点;驱动第二机器人移动,以规避所述第一路径;驱动第一机器人沿所述第一路径运行,并跳出所述第一机器人和第二机器人的互扰状态。该方案导航效率高。(The path planning method based on double-machine mutual interference comprises the following steps: determining that the first robot and the second robot are in a mutual interference state according to the obstacle detection information of the first robot and the second robot; in the mutual interference state, determining landmark nodes passed by a first path run by the first robot according to landmark indexes, wherein the landmark indexes record all landmark nodes in a map through a tree structure, all child landmark nodes under a parent landmark node can pass through each other, all the landmark nodes can pass through according to the structure of the landmark indexes, and the first path comprises all the landmark nodes passed by the first robot moving from a current landmark node to a target landmark node; driving a second robot to move so as to avoid the first path; and driving the first robot to run along the first path and jumping out of the mutual interference state of the first robot and the second robot. The scheme has high navigation efficiency.)

1. The path planning method based on double-machine mutual interference is characterized by comprising the following steps:

determining that the first robot and the second robot are in a mutual interference state according to obstacle detection information of the first robot and the second robot, wherein the obstacle detection information comprises the position of the first robot or the second robot and the position of an obstacle, and under the mutual interference state, the first robot and the second robot are mutually judged as the obstacle;

in the mutual interference state, determining landmark nodes passed by a first path run by the first robot according to landmark indexes, wherein the landmark indexes record all landmark nodes in a map through a tree structure, all child landmark nodes under a parent landmark node can pass through each other, all the landmark nodes can pass through according to the structure of the landmark indexes, and the first path comprises all the landmark nodes passed by the first robot moving from a current landmark node to a target landmark node;

driving a second robot to move so as to avoid the first path;

and driving the first robot to run along the first path and jumping out of the mutual interference state of the first robot and the second robot.

2. The dual-machine mutual interference based path planning method according to claim 1, wherein the step of determining the landmark node experienced by the first path run by the first robot according to the landmark index specifically comprises:

circularly executing the parent landmark nodes to be traced upwards according to the current landmark node and the target landmark node respectively until the landmark nodes to be traced upwards share one parent landmark node;

the paths between the landmark nodes obtained by the backtracking constitute the first path.

3. The method for path planning based on dual-machine mutual interference according to claim 2, wherein the step of driving the second robot to move so as to avoid the first path specifically comprises:

determining a next-hop landmark node operated by the first robot according to the first path and the current landmark nodes where the first robot and the second robot are located;

and acquiring at least one adjacent landmark node of a second robot, and driving the second robot to move to the adjacent landmark node so as to avoid a path between the current landmark node and a next hop landmark node, wherein the adjacent landmark node comprises a parent landmark node, a child landmark node and a sibling landmark node of the current landmark node.

4. The dual-machine mutual interference based path planning method according to claim 3, wherein the step of driving the second robot to move to one of the adjacent landmark nodes specifically comprises:

and driving the second robot to move to a sibling landmark node of the current landmark node according to the fact that the next-hop landmark node is the parent landmark node or the child landmark node of the current landmark node.

5. The dual-machine mutual interference based path planning method according to claim 3, wherein the step of driving the second robot to move to one of the adjacent landmark nodes specifically comprises:

and driving the second robot to move to the child landmark node of the current target according to the next-hop landmark node being the brother landmark node of the current landmark node.

6. The dual-machine mutual interference based path planning method according to claim 1, wherein the step of driving the second robot to move to a position before one of the adjacent landmark nodes further comprises: marking a parent landmark node traced upwards by the current landmark node on the first path and a brother landmark node of the current landmark node as quick-path landmark nodes;

and marking a quick path landmark node in the adjacent target nodes as a second robot non-syngeneic row.

7. Path planning device based on double-machine mutual interference includes:

the mutual interference state determining module is used for determining that the first robot and the second robot are in mutual interference states according to obstacle detection information of the first robot and the second robot, wherein the obstacle detection information comprises the position of the first robot or the second robot and the position of an obstacle, and the first robot and the second robot are mutually judged as the obstacle in the mutual interference states;

a first path determining module, configured to determine, in the mutual interference state, landmark nodes that are passed by a first path where the first robot runs according to landmark indexes, where the landmark indexes record all landmark nodes in a map through a tree structure, all child landmark nodes under a parent landmark node can pass through each other, and all landmark nodes can pass through each other according to the structure of the landmark indexes, and the first path includes all landmark nodes that are passed by the first robot moving from a current landmark node to a target landmark node;

the position adjusting module is used for driving the second robot to move so as to avoid the first path;

and the state recovery module is used for driving the first robot to run along the first path and jump out of the mutual interference state of the first robot and the second robot.

8. The dual-machine mutual interference based path planning device according to claim 1, wherein the first path determining module specifically includes:

the landmark node uploading sub-module is used for circularly executing uploading father landmark nodes according to the current landmark node and the target landmark node respectively until the uploaded landmark nodes share one father landmark node;

and the splicing submodule is used for forming the first path through the paths between the landmark nodes obtained by the upward tracing.

9. A computer device comprising a memory and a processor, the memory having stored therein a computer program, characterized in that: the processor, when executing the computer program, implements the steps of the dual-machine mutual interference based path planning method according to any one of claims 1 to 6.

10. A computer-readable storage medium, on which a computer program is stored, which, when being executed by a processor, implements the steps of the dual-machine mutual interference based path planning method according to any one of claims 1 to 6.

Technical Field

The application relates to the technical field of robot navigation, in particular to a path planning method and device based on double-machine mutual interference and computer equipment.

Background

Some robots, including a tallying robot, a transferring robot, etc., need to move on a relatively fixed path of a travel route, when more than one robot is used, the robots may meet and affect each other in the travel process, in general, the robots are provided with an obstacle avoidance function, if no intervention is made to the situation, the two robots may identify each other as an obstacle and execute an obstacle avoidance strategy, the existing obstacle avoidance strategy, and the process of using the obstacle avoidance strategy to avoid the other robot at the same time by the two robots may cause confusion of actions of the two robots, the existing processing mode is to control one robot to be stationary by a far end and control the other robot to execute obstacle avoidance operation, until the two robots are no longer on the travel route of the other robot, the state is switched back to a normal travel state, and the execution of the obstacle avoidance strategy usually consumes a lot of time, the work efficiency of robot navigation is reduced.

Disclosure of Invention

The embodiment of the application aims to provide a method for avoiding the mutual interference of sweeping robots from influencing the work efficiency of robot navigation by planning the moving path of the sweeping robots under the condition of mutual interference of two machines.

In order to solve the above technical problem, an embodiment of the present application provides a path planning method based on dual-machine mutual interference, and the following technical solutions are adopted:

the path planning method based on double-machine mutual interference comprises the following steps:

determining that the first robot and the second robot are in a mutual interference state according to obstacle detection information of the first robot and the second robot, wherein the obstacle detection information comprises the position of the first robot or the second robot and the position of an obstacle, and under the mutual interference state, the first robot and the second robot are mutually judged as the obstacle;

in the mutual interference state, determining landmark nodes passed by a first path run by the first robot according to landmark indexes, wherein the landmark indexes record all landmark nodes in a map through a tree structure, all child landmark nodes under a parent landmark node can pass through each other, all the landmark nodes can pass through according to the structure of the landmark indexes, and the first path comprises all the landmark nodes passed by the first robot moving from a current landmark node to a target landmark node;

driving a second robot to move so as to avoid the first path;

and driving the first robot to run along the first path and jumping out of the mutual interference state of the first robot and the second robot.

Further, the step of determining a landmark node experienced by a first path run by the first robot according to the landmark index specifically includes:

circularly executing the parent landmark nodes to be traced upwards according to the current landmark node and the target landmark node respectively until the landmark nodes to be traced upwards share one parent landmark node;

the paths between the landmark nodes obtained by the backtracking constitute the first path.

Further, the step of driving the second robot to move to avoid the first path specifically includes:

determining a next-hop landmark node operated by the first robot according to the first path and the current landmark nodes where the first robot and the second robot are located;

and acquiring at least one adjacent landmark node of a second robot, and driving the second robot to move to the adjacent landmark node so as to avoid a path between the current landmark node and a next hop landmark node, wherein the adjacent landmark node comprises a parent landmark node, a child landmark node and a sibling landmark node of the current landmark node.

Further, the step of driving the second robot to move to one of the adjacent landmark nodes specifically includes:

and driving the second robot to move to a sibling landmark node of the current landmark node according to the fact that the next-hop landmark node is the parent landmark node or the child landmark node of the current landmark node.

Further, the step of driving the second robot to move to one of the adjacent landmark nodes specifically includes:

and driving the second robot to move to the child landmark node of the current target according to the next-hop landmark node being the brother landmark node of the current landmark node.

Further, before the step of driving the second robot to move to one of the adjacent landmark nodes, the method further comprises: marking a parent landmark node traced upwards by the current landmark node on the first path and a brother landmark node of the current landmark node as quick-path landmark nodes;

and marking a quick path landmark node in the adjacent target nodes as a second robot non-syngeneic row.

In order to solve the above technical problem, an embodiment of the present application further provides a path planning apparatus based on dual-machine mutual interference, and the following technical solutions are adopted:

path planning device based on double-machine mutual interference includes:

the mutual interference state determining module is used for determining that the first robot and the second robot are in mutual interference states according to obstacle detection information of the first robot and the second robot, wherein the obstacle detection information comprises the position of the first robot or the second robot and the position of an obstacle, and the first robot and the second robot are mutually judged as the obstacle in the mutual interference states;

a first path determining module, configured to determine, in the mutual interference state, landmark nodes that are passed by a first path where the first robot runs according to landmark indexes, where the landmark indexes record all landmark nodes in a map through a tree structure, all child landmark nodes under a parent landmark node can pass through each other, and all landmark nodes can pass through each other according to the structure of the landmark indexes, and the first path includes all landmark nodes that are passed by the first robot moving from a current landmark node to a target landmark node;

the position adjusting module is used for driving the second robot to move so as to avoid the first path;

and the state recovery module is used for driving the first robot to run along the first path and jump out of the mutual interference state of the first robot and the second robot.

Further, the first path determining module specifically includes:

the landmark node uploading sub-module is used for circularly executing uploading father landmark nodes according to the current landmark node and the target landmark node respectively until the uploaded landmark nodes share one father landmark node;

and the splicing submodule is used for forming the first path through the paths between the landmark nodes obtained by the upward tracing.

In order to solve the above technical problem, an embodiment of the present application further provides a computer device, which adopts the following technical solutions:

a computer device includes a memory and a processor, where the memory stores a computer program, and the processor implements the steps of the path planning method based on dual-machine mutual interference when executing the computer program.

In order to solve the above technical problem, an embodiment of the present application further provides a computer-readable storage medium, which adopts the following technical solutions:

a computer-readable storage medium, wherein a computer program is stored on the computer-readable storage medium, and when being executed by a processor, the computer program implements the steps of the path planning method based on dual-machine mutual interference as described above.

Compared with the prior art, the embodiment of the application mainly has the following beneficial effects:

according to the obstacle information detected by the first robot and the second robot, the first robot and the second robot are determined to be in a mutual interference state of mutually hindering the movement of the other side, in the mutual interference state, the first robot and the second robot both detect obstacles, the coordinates of the obstacles detected by the first robot are the position of the second robot, and the coordinates of the obstacles detected by the second robot are the position of the first robot.

Under the mutual interference state, a moving route of the second robot is planned to avoid a first route of the first robot, the first route is a route in which the first robot walks from a current landmark node to a target landmark node and comprises a plurality of landmark nodes, and the first robot can be ensured to smoothly move along the first route by avoiding the landmark nodes in the first route.

When the second robot avoids the first path, and particularly after the second robot leaves the landmark nodes included in the first path, the first robot can smoothly move in the same line along the first path, and then the second robot is navigated according to the target landmark nodes of the second robot, so that the obstacle avoidance strategy is not required to be executed in the mutual interference state, and the navigation efficiency of the two robots after mutual interference is greatly improved.

Drawings

In order to more clearly illustrate the solution of the present application, the drawings needed for describing the embodiments of the present application will be briefly described below, and it is obvious that the drawings in the following description are some embodiments of the present application, and that other drawings can be obtained by those skilled in the art without inventive effort.

FIG. 1 is an exemplary system architecture diagram in which the present application may be applied;

fig. 2 is a flowchart of an embodiment of a path planning method based on dual-machine mutual interference according to the present application;

FIG. 3 is a flow chart of a process involved in one embodiment of step S200 of FIG. 2;

FIG. 4 is a flow chart of a process involved in one embodiment of step S300 of FIG. 2;

fig. 5 is a schematic structural diagram of an embodiment of a path planning apparatus based on dual-machine mutual interference according to the present application;

FIG. 6 is a schematic block diagram of one embodiment of a computer device according to the present application.

Detailed Description

Unless defined otherwise, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this application belongs; the terminology used in the description of the application herein is for the purpose of describing particular embodiments only and is not intended to be limiting of the application; the terms "including" and "having," and any variations thereof, in the description and claims of this application and the description of the above figures are intended to cover non-exclusive inclusions. The terms "first," "second," and the like in the description and claims of this application or in the above-described drawings are used for distinguishing between different objects and not for describing a particular order.

Reference herein to "an embodiment" means that a particular feature, structure, or characteristic described in connection with the embodiment can be included in at least one embodiment of the application. The appearances of the phrase in various places in the specification are not necessarily all referring to the same embodiment, nor are separate or alternative embodiments mutually exclusive of other embodiments. It is explicitly and implicitly understood by one skilled in the art that the embodiments described herein can be combined with other embodiments.

In order to make the technical solutions better understood by those skilled in the art, the technical solutions in the embodiments of the present application will be clearly and completely described below with reference to the accompanying drawings.

As shown in fig. 1, the environment in which the present embodiment operates may be a system structure 10 including a robot, wherein the system structure 10 may include a terminal device 11, a terminal device 12, a terminal device 13, a network 14, and a server 15. The network 14 is a medium for providing a communication link between the terminal device 11, the terminal device 12, the terminal device 13, and the server 15, the terminal device 11, the terminal device 12, and the terminal device 13 are used as control devices of the robot, and the robot itself can receive services through the network 14 and the server 15. Network 14 may include various types of connections, such as wire, wireless communication links, or fiber optic cables, to name a few.

The user may interact with the server 15 via the network 14 using the terminal device 11, the terminal device 12, the terminal device 13 to receive or send messages or the like. Various communication client applications, such as a web browser application, a shopping application, a search application, an instant messaging tool, a mailbox client, social platform software, and the like, may be installed on the terminal devices 11, 12, and 13.

The terminal devices 11, 12, 13 may be various electronic devices having a display screen and supporting web browsing, including but not limited to smart phones, tablet computers, e-book readers, MP3 players (Moving Picture Experts Group Audio Layer III, mpeg compression standard Audio Layer 3), MP4 players (Moving Picture Experts Group Audio Layer IV, mpeg compression standard Audio Layer 4), laptop portable computers, desktop computers, and the like.

The server 15 may be a server that provides various services, such as a background server that provides support for pages displayed on the terminal device 11, the terminal device 12, and the terminal device 13.

It should be noted that the path planning method based on dual-machine mutual interference provided in the embodiment of the present application is generally executed by a server/terminal device, and accordingly, the path planning apparatus based on dual-machine mutual interference is generally disposed in the server/terminal device.

It should be understood that the number of terminal devices, networks, and servers in fig. 1 is merely illustrative. There may be any number of terminal devices, networks, and servers, as desired for implementation.

Referring to fig. 2, a flowchart of an embodiment of a method for path planning based on dual-machine mutual interference according to the present application is shown.

In this embodiment, an electronic device (for example, the server/terminal device shown in fig. 1) operating by a path planning method based on dual-machine mutual interference may request or receive data and information in a wired connection manner or a wireless connection manner. It should be noted that the wireless connection means may include, but is not limited to, a 3G/4G connection, a WiFi connection, a bluetooth connection, a WiMAX connection, a Zigbee connection, a uwb (ultra wideband) connection, and other wireless connection means now known or developed in the future.

The path planning method based on double-machine mutual interference comprises the following steps:

step S100: determining that the first robot and the second robot are in a mutual interference state according to obstacle detection information of the first robot and the second robot, wherein the obstacle detection information comprises the position of the first robot or the second robot and the position of an obstacle, and under the mutual interference state, the first robot and the second robot are mutually judged as the obstacle;

step S200: in the mutual interference state, determining landmark nodes passed by a first path run by the first robot according to landmark indexes, wherein the landmark indexes record all landmark nodes in a map through a tree structure, all child landmark nodes under a parent landmark node can pass through each other, all the landmark nodes can pass through according to the structure of the landmark indexes, and the first path comprises all the landmark nodes passed by the first robot moving from a current landmark node to a target landmark node;

step S300: driving a second robot to move so as to avoid the first path;

step S400: and driving the first robot to run along the first path and jumping out of the mutual interference state of the first robot and the second robot.

According to the obstacle information detected by the first robot and the second robot, the first robot and the second robot are determined to be in a mutual interference state of mutually hindering the movement of the other side, in the mutual interference state, the first robot and the second robot both detect obstacles, the coordinates of the obstacles detected by the first robot are the position of the second robot, and the coordinates of the obstacles detected by the second robot are the position of the first robot.

Under the mutual interference state, a moving route of the second robot is planned to avoid a first route of the first robot, the first route is a route in which the first robot walks from a current landmark node to a target landmark node and comprises a plurality of landmark nodes, and the first robot can be ensured to smoothly move along the first route by avoiding the landmark nodes in the first route.

When the second robot avoids the first path, and particularly after the second robot leaves the landmark nodes included in the first path, the first robot can smoothly move in the same line along the first path, and then the second robot is navigated according to the target landmark nodes of the second robot, so that the obstacle avoidance strategy is not required to be executed in the mutual interference state, and the navigation efficiency of the two robots after mutual interference is greatly improved.

Further, the step of determining a landmark node experienced by a first path run by the first robot according to the landmark index specifically includes:

step S201: circularly executing the parent landmark nodes to be traced upwards according to the current landmark node and the target landmark node respectively until the landmark nodes to be traced upwards share one parent landmark node;

step S202: the paths between the landmark nodes obtained by the backtracking constitute the first path.

The landmark index is of a tree structure, in one embodiment, a plurality of landmark nodes in one area are stored in the index as sibling landmark nodes, the landmark node index at the position of the area adjacent to other areas is a parent node common to the sibling landmark nodes, the landmark index is of multiple layers, and one landmark node is used as a parent landmark node of a plurality of child landmark nodes and is also used as a sibling landmark node of other landmark nodes and is also used as a child landmark node of other landmark nodes.

The landmark nodes can directly move to self brother landmark nodes, self father landmark nodes and self child landmark nodes in the process of determining the first path according to the landmark nodes. The method for determining the first path comprises the steps of tracing the current landmark node and the target landmark node, wherein the current landmark node is the current position of the robot, the target landmark node is the destination of the robot navigated through the first path, and the target landmark node and the father node of the current landmark node are traced and recorded. According to the recorded nodes, the landmark nodes which are brother landmark nodes with each other appear, and the brother landmark nodes can be directly in the same row, so that the landmark nodes included in the first path can be determined to be found completely. And starting from the current landmark node, tracing a plurality of parent nodes, then moving to a brother landmark node, and finally recursively sinking and moving to a child landmark node to achieve the target landmark node, wherein the sequence combination of the passing landmark nodes forms the whole first path in the process. According to the scheme, the shortest first path can be obtained, and the navigation efficiency of the first robot is improved.

Further, the step S300: driving a second robot to move so as to avoid the first path, specifically comprising:

step S301: determining a next-hop landmark node operated by the first robot according to the first path and the current landmark nodes where the first robot and the second robot are located;

step S304: and acquiring at least one adjacent landmark node of a second robot, and driving the second robot to move to the adjacent landmark node so as to avoid a path between the current landmark node and a next hop landmark node, wherein the adjacent landmark node comprises a parent landmark node, a child landmark node and a sibling landmark node of the current landmark node.

Specifically, according to the landmark nodes adjacent to the current landmark node where the second robot is located, the landmark nodes can be brother landmark nodes, father landmark nodes and child landmark nodes of the current landmark node, the landmark nodes included in the first path are eliminated, the second robot is moved to other adjacent landmark nodes to avoid the first path, the scheme avoids the execution of the obstacle avoidance strategy of the first robot, and the navigation efficiency, the navigation efficiency and the navigation efficiency of the first robot are improved,

Further, the step of driving the second robot to move to one of the adjacent landmark nodes specifically includes:

and driving the second robot to move to a sibling landmark node of the current landmark node according to the fact that the next-hop landmark node is the parent landmark node or the child landmark node of the current landmark node.

Further, the step of driving the second robot to move to one of the adjacent landmark nodes specifically includes:

and driving the second robot to move to the child landmark node of the current target according to the next-hop landmark node being the brother landmark node of the current landmark node.

Further, before the step of driving the second robot to move to one of the adjacent landmark nodes, the method further comprises: step S302: marking a parent landmark node traced upwards by the current landmark node on the first path and a brother landmark node of the current landmark node as quick-path landmark nodes;

step S303: and marking a quick path landmark node in the adjacent target nodes as a second robot non-syngeneic row.

Specifically, in this embodiment, the parent landmark node is located closer to the main road of the robot running path, and the child nodes are closer to the branches of the robot running path, in an embodiment, a plurality of stations are provided in the plant, the stations are spaced and connected by channels, a plurality of landmark nodes are provided in one station, the landmark nodes are brother and brother landmark nodes, and a landmark node is provided on the channel adjacent to the station, the landmark node can be used as a parent landmark node common to the landmark nodes in the station, obviously, the landmark node on the channel is used for the robot to pass through, when a moving position is selected for the second robot to avoid the first path, it is necessary to avoid the landmark node located on the channel so that other robots can run together, in this embodiment, by marking the brother node and the parent node of the current landmark node as the fast-path landmark node, and the mark is infeasible to the second robot, so that the second robot runs to the sub landmark node of the current landmark node to vacate the quick path landmark node for other robots to go together.

It will be understood by those skilled in the art that all or part of the processes of the methods of the embodiments described above can be implemented by a computer program, which can be stored in a computer-readable storage medium, and can include the processes of the embodiments of the methods described above when the computer program is executed. The storage medium may be a non-volatile storage medium such as a magnetic disk, an optical disk, a Read-Only Memory (ROM), or a Random Access Memory (RAM).

It should be understood that, although the steps in the flowcharts of the figures are shown in order as indicated by the arrows, the steps are not necessarily performed in order as indicated by the arrows. The steps are not performed in the exact order shown and may be performed in other orders unless explicitly stated herein. Moreover, at least a portion of the steps in the flow chart of the figure may include multiple sub-steps or multiple stages, which are not necessarily performed at the same time, but may be performed at different times, which are not necessarily performed in sequence, but may be performed alternately or alternately with other steps or at least a portion of the sub-steps or stages of other steps.

Further referring to fig. 5, as an implementation of the method shown in fig. 2, the present application provides an embodiment of a path planning apparatus based on dual-machine mutual interference, where the embodiment of the apparatus corresponds to the embodiment of the method shown in fig. 2, and the apparatus may be specifically applied to various electronic devices.

Path planning device based on double-machine mutual interference includes:

the mutual interference state determining module 100 is configured to determine that the first robot and the second robot are in a mutual interference state according to obstacle detection information of the first robot and the second robot, where the obstacle detection information includes a position of the first robot or the second robot and a position of an obstacle, and in the mutual interference state, the first robot and the second robot are determined as an obstacle;

a first path determining module 200, configured to determine, in the mutual interference state, landmark nodes that are passed by a first path where the first robot runs according to landmark indexes, where the landmark indexes record all landmark nodes in a map through a tree structure, all child landmark nodes under a parent landmark node can pass through each other, and all landmark nodes can pass through each other according to the structure of the landmark indexes, where the first path includes all landmark nodes that are passed by the first robot when the first robot moves from a current landmark node to a target landmark node;

a position adjusting module 300 for driving the second robot to move so as to avoid the first path;

and the state recovery module 400 is configured to drive the first robot to run along the first path and jump out of the mutual interference state of the first robot and the second robot.

According to the obstacle information detected by the first robot and the second robot, the first robot and the second robot are determined to be in a mutual interference state of mutually hindering the movement of the other side, in the mutual interference state, the first robot and the second robot both detect obstacles, the coordinates of the obstacles detected by the first robot are the position of the second robot, and the coordinates of the obstacles detected by the second robot are the position of the first robot.

Under the mutual interference state, a moving route of the second robot is planned to avoid a first route of the first robot, the first route is a route in which the first robot walks from a current landmark node to a target landmark node and comprises a plurality of landmark nodes, and the first robot can be ensured to smoothly move along the first route by avoiding the landmark nodes in the first route.

When the second robot avoids the first path, and particularly after the second robot leaves the landmark nodes included in the first path, the first robot can smoothly move in the same line along the first path, and then the second robot is navigated according to the target landmark nodes of the second robot, so that the obstacle avoidance strategy is not required to be executed in the mutual interference state, and the navigation efficiency of the two robots after mutual interference is greatly improved.

Further, the first path determining module 200 specifically includes:

the landmark node uploading sub-module 201 is used for circularly executing uploading parent landmark nodes according to the current landmark node and the target landmark node respectively until the uploading parent landmark nodes share one parent landmark node;

and the splicing sub-module 202 is configured to compose the first path by the paths between the landmark nodes obtained by the upward tracking.

In order to solve the technical problem, an embodiment of the present application further provides a computer device. Referring to fig. 6, fig. 6 is a block diagram of a basic structure of a computer device according to the present embodiment.

The computer device 6 comprises a memory 61, a processor 62, a network interface 63 communicatively connected to each other via a system bus. It is noted that only a computer device 6 having components 61-63 is shown, but it is understood that not all of the shown components are required to be implemented, and that more or fewer components may be implemented instead. As will be understood by those skilled in the art, the computer device is a device capable of automatically performing numerical calculation and/or information processing according to a preset or stored instruction, and the hardware includes, but is not limited to, a microprocessor, an Application Specific Integrated Circuit (ASIC), a Programmable Gate Array (FPGA), a Digital Signal Processor (DSP), an embedded device, and the like.

The computer device can be a desktop computer, a notebook, a palm computer, a cloud server and other computing devices. The computer equipment can carry out man-machine interaction with a user through a keyboard, a mouse, a remote controller, a touch panel or voice control equipment and the like.

The memory 61 includes at least one type of readable storage medium including a flash memory, a hard disk, a multimedia card, a card type memory (e.g., SD or DX memory, etc.), a Random Access Memory (RAM), a Static Random Access Memory (SRAM), a Read Only Memory (ROM), an Electrically Erasable Programmable Read Only Memory (EEPROM), a Programmable Read Only Memory (PROM), a magnetic memory, a magnetic disk, an optical disk, etc. In some embodiments, the memory 61 may be an internal storage unit of the computer device 6, such as a hard disk or a memory of the computer device 6. In other embodiments, the memory 61 may also be an external storage device of the computer device 6, such as a plug-in hard disk, a Smart Media Card (SMC), a Secure Digital (SD) Card, a Flash memory Card (Flash Card), and the like, which are provided on the computer device 6. Of course, the memory 61 may also comprise both an internal storage unit of the computer device 6 and an external storage device thereof. In this embodiment, the memory 61 is generally used to store an operating system and various application software installed in the computer device 6, for example, a program code of a path planning method based on dual-computer mutual interference. Further, the memory 61 may also be used to temporarily store various types of data that have been output or are to be output.

The processor 62 may be a Central Processing Unit (CPU), controller, microcontroller, microprocessor, or other data Processing chip in some embodiments. The processor 62 is typically used to control the overall operation of the computer device 6. In this embodiment, the processor 62 is configured to run a program code stored in the memory 61 or process data, for example, run a program code of the path planning method based on dual-machine mutual interference.

The network interface 63 may comprise a wireless network interface or a wired network interface, and the network interface 63 is typically used for establishing a communication connection between the computer device 6 and other electronic devices.

The present application further provides another embodiment, that is, a computer-readable storage medium is provided, where a dual-machine mutual interference based path planning program is stored in the computer-readable storage medium, and the dual-machine mutual interference based path planning program is executable by at least one processor, so that the at least one processor executes the steps of the dual-machine mutual interference based path planning method as described above.

Through the above description of the embodiments, those skilled in the art will clearly understand that the method of the above embodiments can be implemented by software plus a necessary general hardware platform, and certainly can also be implemented by hardware, but in many cases, the former is a better implementation manner. Based on such understanding, the technical solutions of the present application may be embodied in the form of a software product, which is stored in a storage medium (such as ROM/RAM, magnetic disk, optical disk) and includes instructions for enabling a terminal device (such as a mobile phone, a computer, a server, an air conditioner, or a network device) to execute the method according to the embodiments of the present application.

It is to be understood that the above-described embodiments are merely illustrative of some, but not restrictive, of the broad invention, and that the appended drawings illustrate preferred embodiments of the invention and do not limit the scope of the invention. This application is capable of embodiments in many different forms and is provided for the purpose of enabling a thorough understanding of the disclosure of the application. Although the present application has been described in detail with reference to the foregoing embodiments, it will be apparent to one skilled in the art that the present application may be practiced without modification or with equivalents of some of the features described in the foregoing embodiments. All equivalent structures made by using the contents of the specification and the drawings of the present application are directly or indirectly applied to other related technical fields and are within the protection scope of the present application.

16页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:一种用于室内行走机器人有限路径定位装置及方法

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!

技术分类