Robot, motion control method and system thereof, program product and storage medium

The dual-channel laser sensor data transmission to a host and lower computer system enables reliable cliff detection for robots, addressing the limitations of existing methods by utilizing the host's processing power for complex calculations and the lower computer's simplified detection to meet safety standards.

CN119057765APending Publication Date: 2024-12-03SPARKOZ TECH CORP +1
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202310626758.5
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2023-05-30
Publication Date
2024-12-03

AI Technical Summary

Technical Problem

Existing robot cliff detection methods using infrared, ToF, and laser sensors fail to meet safety requirements due to short detection distances, high interference, and high computing power needs, leading to unreliable cliff detection results.

Method used

A robot motion control method utilizing dual-channel transmission of laser sensor data to a host and lower computer, where the host performs complex calculations and the lower computer executes motion control based on simplified cliff detection, ensuring reliable cliff detection within the robot's computing power constraints.

Benefits of technology

Ensures reliable cliff detection that meets safety standards by leveraging the host computer's processing power for complex calculations and the lower computer's simplified cliff detection, adapting to its computing capabilities while maintaining robust motion control.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119057765A_ABST
    Figure CN119057765A_ABST
Patent Text Reader

Abstract

The invention discloses a robot motion control method and system, a robot, a computer program product and a computer readable storage medium. The motion control method comprises the following steps that original point cloud data, collected by a laser sensor, of a preset angle range in the advancing direction of the corresponding robot are obtained; the laser sensor is arranged on a robot and is connected with an upper computer and a lower computer of the robot so as to carry out double-channel transmission. Judging whether a cliff exists in the advancing direction of the robot or not based on the original point cloud data of the preset angle range to obtain a first judgment result; when it is determined that any one of the first judgment result and the obtained second judgment result comprises the existence of the cliff, the robot is controlled to execute a motion mode corresponding to the cliff; wherein the second judgment result is obtained by carrying out cliff calculation after the upper computer carries out preprocessing of coordinate conversion on the obtained original point cloud data collected by the laser sensor.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of robot technology, and in particular to a robot motion control method, a control system, a robot, a computer program product, and a computer-readable storage medium. Background Art

[0002] With the development of artificial intelligence, robots are widely used in various occasions to replace manual work. Take commercial robots as an example. They are usually deployed in public areas such as stations, airports, shopping malls, supermarkets, etc. When performing work, due to the complex environment of public areas, commercial robots are equipped with various types of sensors to perceive the surrounding environment and then determine their movement mode to ensure safe operation.

[0003] When determining whether there is a cliff in the surrounding environment, there is a method of using infrared sensors for detection in the related art, but the detection distance of infrared sensors is short and the anti-interference ability is poor, so the false detection rate is high and cannot meet the safety requirements of the mechanical safety standards. Some related technologies also use the data of ToF (Time of Flight, ToF) sensors or laser sensors for cliff detection, among which ToF sensors are expensive. In addition, the data volume of ToF sensors and laser sensors is large, and the computing power requirements are high. Therefore, ToF sensors and laser sensors are only connected to a host computer with high processing power so that the host computer can perform cliff detection. Once the host computer detects an abnormality, the detection result will be unreliable. This method also cannot meet the safety requirements of the mechanical safety standards.

[0004] In view of this, how to obtain cliff detection results that meet safety requirements to control the movement of the robot is a technical problem that needs to be urgently solved in this application. Summary of the invention

[0005] In view of the shortcomings of the above-mentioned related technologies, the purpose of the present application is to provide a robot motion control method, a control system, a robot, a computer program product, and a computer-readable storage medium, so as to overcome the technical problem existing in the above-mentioned related technologies that the robot cannot obtain reliable cliff detection results to control the robot movement.

[0006] To achieve the above-mentioned purpose and other related purposes, the first aspect disclosed in the present application provides a robot motion control method, comprising the following steps: obtaining original point cloud data of a preset angle range corresponding to the robot's travel direction collected by a laser sensor; the laser sensor is arranged on the robot, and is respectively connected to the upper computer and the lower computer of the robot for dual-channel transmission; based on the original point cloud data of the preset angle range, it is judged whether there is a cliff in the robot's travel direction to obtain a first judgment result; when it is determined that any judgment result of the first judgment result and the obtained second judgment result includes the existence of a cliff, the robot is controlled to execute a motion mode corresponding to the cliff; wherein the second judgment result is obtained by the upper computer performing a cliff calculation after pre-processing the coordinate conversion of the original point cloud data collected by the laser sensor.

[0007] In certain embodiments disclosed in the first aspect of the present application, the host computer is configured to execute a SLAM program, a path planning program, an object recognition program, or a behavior and control program.

[0008] In certain embodiments disclosed in the first aspect of the present application, the lower computer is configured to obtain the operating status of the component and control the corresponding component action.

[0009] In certain embodiments disclosed in the first aspect of the present application, the computing power of the lower computer is lower than that of the upper computer, and the lower computer is configured with a processor having a maximum main frequency of 240 MHz and a computing performance of 300 DMIPS.

[0010] In certain embodiments disclosed in the first aspect of the present application, the step of acquiring the original point cloud data collected by the laser sensor corresponding to a preset angle range in the direction of travel of the robot includes the step of intercepting the original point cloud data within a preset angle range based on the angle information of each point cloud in the original point cloud data.

[0011] In certain embodiments disclosed in the first aspect of the present application, the preset angle range includes any range within a range of ±40° with reference to the central axis of the robot.

[0012] In certain embodiments disclosed in the first aspect of the present application, the step of judging whether there is a cliff in the direction of travel of the robot based on the original point cloud data within a preset angle range includes: determining the mapping distance of each point cloud in the original point cloud data within the preset angle range at the current moment; wherein the mapping distance is the length value obtained by projecting the distance information of each point cloud onto the plane where the robot's central axis is located according to the angle information of each point cloud; determining whether there is a cliff based on the difference in the mapping distances of the point clouds at the same angle in the original point cloud data within the preset angle range at the current moment and the previous moment.

[0013] In certain embodiments disclosed in the first aspect of the present application, determining whether there is a cliff based on the difference in mapping distances of point clouds at the same angle in original point cloud data within a preset angle range at the current moment and the previous moment includes: when it is determined that the difference in mapping distances of point clouds at the same angle at the current moment and the previous moment exceeds a preset length, updating the cliff detection confidence at the current moment; when the cliff detection confidence at the current moment reaches a trigger threshold, determining that there is a cliff.

[0014] In certain embodiments disclosed in the first aspect of the present application, the trigger threshold is set to 70%.

[0015] In certain embodiments disclosed in the first aspect of the present application, the step of judging whether there is a cliff in the direction of travel of the robot based on the original point cloud data within a preset angle range also includes: dividing the original point cloud data within a preset angle range into multiple groups corresponding to multiple areas in the direction of travel of the robot based on the angle information of each point cloud in the original point cloud data, so as to judge whether there is a cliff in the direction of travel of the robot by area.

[0016] The second aspect of the present application discloses a control system of a robot, comprising: a host computer, connected to a laser sensor provided on the robot, to obtain raw point cloud data collected by the laser sensor, and to perform cliff calculation after pre-processing the raw point cloud data for coordinate conversion to obtain a second judgment result; a lower computer, connected to the laser sensor and the host computer, to obtain the raw point cloud data collected by the laser sensor corresponding to a preset angle range in the direction of travel of the robot, and to judge whether there is a cliff in the direction of travel of the robot based on the raw point cloud data in the preset angle range to obtain a first judgment result; the lower computer is also used to obtain the second judgment result, and when it is determined that any of the first judgment result and the second judgment result is that there is a cliff, control the robot to execute a motion mode corresponding to the cliff; wherein the laser sensor is respectively connected to the host computer and the lower computer for dual-channel transmission.

[0017] In certain embodiments disclosed in the second aspect of the present application, the host computer is configured to execute a SLAM program, a path planning program, an object recognition program, or a behavior and control program.

[0018] In certain embodiments disclosed in the second aspect of the present application, the lower computer is configured to obtain the operating status of each component and control the corresponding component action.

[0019] In certain embodiments disclosed in the second aspect of the present application, the computing power of the lower computer is lower than that of the upper computer, and the lower computer is configured with a processor having a maximum main frequency of 240 MHz and a computing performance of 300 DMIPS.

[0020] The third aspect of the present application discloses a computer-readable storage medium storing at least one program, which, when called and executed by a processor, implements the robot motion control method as described in any embodiment disclosed in the first aspect of the present application.

[0021] A fourth aspect of the present application discloses a computer program product. When the computer program product is run on a computer, the computer is enabled to execute the robot motion control method as described in any one of the embodiments disclosed in the first aspect of the present application.

[0022] The fifth aspect of the present application discloses a robot, comprising: a robot body, on which a laser sensor is arranged; left and right driving wheels located on the rear side of the robot body; at least one universal wheel located on the front side of the robot body; a control system as described in any embodiment disclosed in the second aspect of the present application, comprising an upper computer and a lower computer, the upper computer and the lower computer are respectively connected to the laser sensor so that the data collected by the laser sensor can be transmitted in dual channels; the control system is used to obtain the original point cloud data collected by the laser sensor to control the robot to execute a motion mode corresponding to the cliff.

[0023] In certain embodiments disclosed in the fifth aspect of the present application, the robot comprises a commercial cleaning robot.

[0024] In summary, the robot motion control method, control system, robot, computer program product, and computer-readable storage medium disclosed in the present application are to connect laser sensors to the upper computer and the lower computer respectively to perform dual-channel transmission of the collected data, and the upper computer and the lower computer respectively perform cliff detection, so that the lower computer can perform motion control according to the two judgment results, thereby ensuring the safety of the robot motion. In addition, only part of the data collected by the laser sensor is used on the lower computer, and the original data is directly used for cliff detection, which can be adapted to the computing power of the lower computer.

[0025] Those skilled in the art can easily perceive other aspects and advantages of the present application from the detailed description below. In the detailed description below, only exemplary embodiments of the present application are shown and described. As will be appreciated by those skilled in the art, the content of the present application enables those skilled in the art to modify the disclosed specific embodiments without departing from the spirit and scope of the invention to which the present application relates. Accordingly, the description in the drawings and specification of the present application is merely exemplary and not restrictive. BRIEF DESCRIPTION OF THE DRAWINGS

[0026] The specific features of the invention involved in this application are shown in the attached claims. The features and advantages of the invention involved in this application can be better understood by referring to the exemplary embodiments and drawings described in detail below. The drawings are briefly described as follows:

[0027] Figure 1 Shown is a schematic diagram of the structure of a robot in one embodiment of the present application.

[0028] Figure 2 Shown is a schematic diagram of a laser sensor scanning the surrounding environment in one embodiment of the present application.

[0029] Figure 3 Shown is a structural block diagram of a control system in one embodiment of the present application.

[0030] Figure 4 Shown is a flow chart of a robot motion control method in one embodiment of the present application.

[0031] Figure 5 Shown is a schematic diagram of obtaining original point cloud data within a preset angle range in one embodiment of the present application.

[0032] Figure 6 It is a flowchart of step S420 in one embodiment of the present application.

[0033] Figure 7 Shown is a schematic diagram of raw point cloud data of a preset angle range at the current moment and the previous moment in one embodiment of the present application.

[0034] Figure 8 Shown is a schematic diagram of a cliff point cloud in one embodiment of the present application.

[0035] Fig. 9 Shown is a schematic diagram of original point cloud data divided into regions with a preset angle range in one embodiment of the present application. DETAILED DESCRIPTION

[0036] The following is an explanation of the implementation of the present application by means of specific embodiments. People familiar with the art can easily understand other advantages and effects of the present application from the contents disclosed in this specification.

[0037] In the following description, reference is made to the accompanying drawings, which describe several embodiments of the present application. It should be understood that other embodiments may also be used, and that changes in module or unit composition, electrical and operational aspects may be made without departing from the spirit and scope of the present disclosure. The following detailed description should not be considered restrictive, and the scope of the embodiments of the present application is limited only by the claims of the published patents. The terms used herein are only for the purpose of describing specific embodiments and are not intended to limit the present application.

[0038] Although the term first, second etc. is used to describe various elements or parameters in this article in some instances, these elements or parameters should not be limited by these terms.These terms are only used to distinguish an element or parameter from another element or parameter.For example, the first judgment result can be referred to as the second judgment result, and similarly, the second judgment result can be referred to as the first judgment result, without departing from the scope of the various described embodiments.The first judgment result and the second judgment result are both describing a judgment result, but unless the context is otherwise clearly indicated, they are not the same judgment result.

[0039] Furthermore, as used in this article, the singular forms "one", "an" and "the" are intended to include plural forms as well, unless there is an indication to the contrary in the context. It should be further understood that the terms "comprise", "include" indicate the presence of the described features, steps, operations, elements, components, projects, kinds, and / or groups, but do not exclude the presence, occurrence or addition of one or more other features, steps, operations, elements, components, projects, kinds, and / or groups. The terms "or" and "and / or" used herein are interpreted as inclusive, or mean any one or any combination. Therefore, "A, B or C" or "A, B and / or C" means "any of the following: A; B; C; A and B; A and C; B and C; A, B and C". Exceptions to this definition will only occur when the combination of elements, functions, steps or operations is inherently mutually exclusive in some way.

[0040] The safety requirements for robots in the machinery safety standards are relatively high. For example, in the background technology, only the upper computer uses its powerful computing power to detect cliffs based on the data collected by the laser sensor to control the movement of the robot. Once the upper computer fails, the cliff detection results will be unavailable, making the robot unable to meet the safety requirements in the machinery safety standards. In addition, the amount of data from the laser sensor is large, and the upper computer's method of using the data collected by the laser sensor to detect cliffs is not applicable to the lower computer with poor computing power.

[0041] In view of this, the present application discloses a robot motion control method, control system, robot, and computer-readable storage medium in some embodiments, which connects laser sensors to a host computer and a slave computer respectively to perform dual-channel transmission of the collected data, and the host computer and the slave computer respectively perform cliff detection, so that the slave computer can perform motion control according to two judgment results, thereby ensuring the safety of the robot's motion. In addition, only part of the data collected by the laser sensor is used on the slave computer, and the original data is directly used for cliff detection, which can be adapted to the computing power of the slave computer.

[0042] It should be understood that the "cliff" described in the present application not only includes the concave structure below the robot's running surface, but also the convex structure located on the robot's running surface will trigger the detection of the single-point laser not meeting its preset distance. For example, when a person's feet or shoes suddenly enter the area where the wheels are about to run and are detected by the single-point laser, the "cliff" event described in the present application will be triggered.

[0043] In some possible embodiments, the present application discloses a robot, which refers to an autonomous mobile device with the ability to build a map, including but not limited to: one or more of: a medical mobile device, a commercial cleaning robot, and a patrol robot, etc. For example, it is a service robot used in a commercial scenario to perform a certain task (such as a cleaning robot, a patrol robot, or a robot for delivering food / goods) or a household robot used in a household scenario to perform cleaning or entertainment tasks (such as a sweeping robot or a companion robot, etc.).

[0044] See also Figure 1 , which is a schematic diagram of the structure of a robot in one embodiment of the present application. As shown in the figure, the robot 1 includes a robot body 10, a right drive wheel 11, a left drive wheel (not shown in the figure), at least one universal wheel 12, a laser sensor 13, and a control system (not shown in the figure).

[0045] In one embodiment, the robot body 10 includes a chassis, wherein the chassis can be integrally formed of materials such as plastic, metal or other materials used in the art, and includes a plurality of pre-formed grooves, recesses, latches or similar structures for mounting or integrating related devices, components, assemblies, or mechanisms on the chassis. When the robot is a cleaning robot, the robot body also includes a sewage tank and a clean water tank. For example, the clean water tank is integrally formed on the top of the chassis, and the sewage tank is nested on the clean water tank to be combined with the chassis.

[0046] In one embodiment, the right driving wheel 11 is disposed at the rear side of the bottom of the robot body 10 and is located on the right side of the robot body 10, and the left driving wheel (not shown) is disposed at the rear side of the bottom of the robot body 10 and is located on the left side of the robot body 10. The left driving wheel and the right driving wheel 11 are coaxially disposed, and are used to drive the robot 1 forward or backward when driven by their respective motors, or to drive the robot 1 to turn by using the differential speed of the left and right driving motors.

[0047] In one embodiment, the universal wheel 12 is disposed at the bottom of the robot body 10 and in the middle of the front side of the cleaning robot, and is used to support the weight of the front of the robot 1 and cooperate with the differential speed of the left and right driving wheels to realize steering of the robot 1. In one embodiment, the universal wheel 12 is a passive wheel, that is, the universal wheel 12 itself does not have driving capability, and it can passively roll or turn under the drive of the left and right driving wheels at the rear side of the robot 1.

[0048] In another embodiment, the number of universal wheels 12 is two, which are respectively arranged at the bottom of the robot body 10 and located at the left and right positions of the front side of the robot 1, and are used to support the weight of the front part of the robot 1 and cooperate with the differential speed of the left and right driving wheels to realize the steering of the robot 1. It should be understood that in other embodiments, the number of universal wheels can be configured accordingly according to the needs of the robot. For example, on the basis of setting a universal wheel 12 at the bottom of the robot body 10 and located at the middle position of the front side of the robot 1, another universal wheel 12 is also set at the left and right positions of the front side thereof.

[0049] In one embodiment, the laser sensor 13 is disposed on the robot body 10. Figure 1 In the example shown, the laser sensor 13 is tilted and arranged at the front side of the robot body 10. Of course, in other examples, the laser sensor 13 can also be arranged at other positions of the robot body, such as the left side, the right side, the back side, etc. The laser sensor 13 can also be arranged on the robot body 10 horizontally or in other tilted forms, and the present application does not limit the configuration posture and position of the laser sensor.

[0050] In one embodiment, the laser sensor 13 includes a single-point laser radar, a single-line laser radar, or a multi-line laser radar. Preferably, the laser sensor 13 can be configured as a 2D single-line laser radar, which emits a laser beam at a certain rotation angle, so as to obtain information about the surrounding environment. In some embodiments, more types of sensors can be further provided on the robot body 10, for example, an image sensor, a ToF sensor, an ultrasonic sensor, an infrared sensor, etc.

[0051] It should be stated here that the original point cloud data mentioned in any subsequent embodiment of the present application refers to a data set of information related to the reflection point obtained by the laser sensor 13 scanning the surrounding environment, which is data in the coordinate system of the laser sensor 13. Among them, the relevant information of a reflection point corresponds to a point cloud. In other words, the original point cloud data includes multiple point clouds. In one embodiment, each point cloud includes angle information, distance information, reflection intensity information, and time information, etc. The angle information of the point cloud is used to indicate the rotation angle of the laser beam corresponding to the point cloud, the distance information is used to indicate the length of the laser beam corresponding to the point cloud, the reflection intensity information is used to indicate the reflected light intensity of the point cloud, and the time information is used to indicate the time when the point cloud was collected.

[0052] The following combination Figure 1 and Figure 2 Describe the information included in the point cloud. Figure 2 The figure shows a schematic diagram of a laser sensor scanning the surrounding environment in one embodiment of the present application, which may correspond to Figure 1 The top view of the laser sensor 13 is used to represent the laser beam. Figure 1 and 2 Taking the laser sensor 13 shown in the figure as an example, it can rotate 360° to emit a laser beam to obtain the original point cloud data, and the laser beam corresponding to a point cloud in the original point cloud data is taken as Figure 1 and Figure 2 Taking the light beam r in the point cloud as an example, the rotation angle represented by the angle information of the point cloud corresponds to α, the distance information of the point cloud is the length l of the light beam r from the starting point of emission to the reflection point, and the reflection intensity information of the point cloud refers to the light intensity of the light beam r emitted back to the laser sensor.

[0053] In one embodiment, the control system is disposed on one or more circuit boards inside the robot body 10 and can be used to execute algorithms, control robot motion, or control the robot to perform work tasks. Figure 3 , which is a block diagram of a control system in an embodiment of the present application, as shown in the figure, the control system 14 includes a host computer 140 and a slave computer 141. The host computer 140 and the slave computer 141 can be arranged on a circuit board for connection, or they can be arranged on a circuit board separately, and the two circuit boards are electrically connected. In the embodiment, the laser sensor 13 is respectively connected to the host computer 140 and the slave computer 141 for dual-channel transmission, so that the raw laser data collected by it can be sent to the host computer 140 and the slave computer 141 at the same time.

[0054] The host computer 140 is configured to execute, for example, a SLAM (simultaneous localization and mapping) program, a path planning program, an object recognition program, or a behavior and control program. The sensors configured on the robot 1 are connected thereto, especially sensors with large data volumes, examples of which include ToF sensors, laser sensors, image sensors, etc. In one embodiment, the host computer 140 also performs cliff calculations to obtain a judgment result. In order to distinguish it from the judgment result of the subsequent lower computer, in the embodiment, the judgment result obtained by the upper computer 140 performing cliff calculations is referred to as a second judgment result.

[0055] Since the original point cloud data sent or transmitted by the laser sensor 13 is based on its own coordinate system, and the original point cloud data sent or transmitted by the host computer 140 can be used to execute a variety of programs, the host computer 140 cannot directly apply the original point cloud data and cannot arbitrarily discard part of the point cloud data. In view of this, in one embodiment, the host computer 140 needs to perform coordinate conversion (such as rotation transformation, translation transformation, etc.) and other preprocessing on the original point cloud data collected by the laser sensor 13, and then obtain the data in the robot coordinates after calculation. And further, in order to ensure the reliability and stability of the data, the host computer 140 also performs preprocessing such as filtering and noise reduction on the data in the robot coordinates, and then performs cliff calculation based on the filtered and noise-reduced data.

[0056] In one embodiment, the host computer 140 includes a network interface, an input / output interface, a memory, and a processor connected to the memory. The memory can be used to store the program executed by the host computer 140 described in the above example, and the processor calls the program on the memory to execute the corresponding algorithm / program. For example, the memory may include a random access memory (RAM), a read-only memory (ROM), a programmable read-only memory (PROM), an erasable programmable read-only memory (EPROM), an electrically erasable programmable read-only memory (EEPROM), etc. The memory is used to store a visual measurement program, an object recognition program, a SLAM application, one or more maps containing landmarks, a landmark database, a path planning program, and a behavior and control program. The memory may optionally include any one of various software applications, data structures, files, and / or databases (suitable for the requirements of a specific application).

[0057] Taking the laser sensor as a 2D single-line laser radar, the scanning frequency is 15Hz, the 360° rotation angle contains 960 point clouds, and each point cloud contains 2 bytes of data information as an example, the data volume per second reaches 28,800 bytes. Such a huge amount of data plus the above-mentioned complex data operations can only be realized by relying on the host computer 140 with strong computing power. In order to ensure the computing power of the host computer 140, in some embodiments, the processor of the host computer 140 can adopt the processor used by the industrial computer, or the host computer 140 can be configured as an industrial computer. In some embodiments, the processor of the host computer can be a single microprocessor, multiple microprocessors, a multi-core processor, a microcontroller and / or any other general computing system that can be configured by software and / or firmware. As a preferred example, the processor of the host computer 140 is configured as Intel i7.

[0058] In some embodiments, the processor of the host computer can call the SLAM application from its memory to perform the SLAM process. The robot can optionally maintain a map of landmarks and perform the SLAM process to estimate the robot's position within the map. The SLAM process can also update the map of landmarks.

[0059] In some embodiments, the processor of the host computer can call the object recognition program from its memory to perform detection and / or recognition of surrounding obstacles in the surrounding environment, so as to adjust its own moving direction and / or moving posture according to the received feedback signal. For example, for the recognition of obstacles, the types of obstacles can be divided into static obstacles or dynamic obstacles (dynamic obstacles are, for example, human bodies, animals, robots, vehicles and other movable equipment, etc.), and the types of obstacles can also be different according to different environments. For example, in indoor scenes, obstacles may be doors, walls, pillars, stairs, tables, chairs, cabinets, flower pots, electrical appliances and other various placed objects.

[0060] In some embodiments, the processor of the host computer can call the path planning program from its memory to generate a planned path by acquiring data of the robot's surrounding environment, so that the robot can read the planned path when performing a moving task. The planned path is obtained by the path planning program through real-time path learning or real-time path planning. For example, when the robot initially moves in an unfamiliar environment, the path planning program obtains the planned path through path learning; or when the robot suddenly loses the planned path during movement or encounters an unknown obstacle and needs to regenerate the planned path to avoid the obstacle, the robot can also use its own positioning and map-building capabilities to enable the path planning program to perform real-time path planning, and use the planned path as the planned path for the current moving task.

[0061] In some embodiments, the processor of the host computer can call the behavior and control program from its memory to use multiple behavior modes to perform related tasks, such as effectively planning a work area, where the behavior mode is a control system layer that can operate in parallel. Its processor is operable to execute a priority arbitration scheme to identify and implement one or more main behavior modes for any given scenario based on input from the sensor system. For example, the robot route following mode, turning mode, obstacle avoidance mode, or the robot's edge-following mode of following the edge of an obstacle, or the robot's wall-following mode of following a wall, or a travel mode of "bow"-shaped travel or "U"-shaped travel according to a preset planned path.

[0062] Please continue reading Figure 3 In one embodiment, the computing power of the lower computer 141 in the control system 14 is lower than that of the upper computer 140. The lower computer 141 includes a network interface, an input / output interface, a memory, and a processor connected to the memory. The memory can be used to store programs or data, etc., and the processor calls the program on the memory to execute the corresponding algorithm to issue control commands to each component. For example, the memory may include a random access memory (RAM), a read-only memory (ROM), a programmable read-only memory (PROM), an erasable programmable read-only memory (EPROM), an electrically erasable programmable read-only memory (EEPROM), etc.

[0063] In one embodiment, the processor of the lower computer 141 is configured as a processor with a maximum main frequency of 240MHz and a computing performance of 300DMIPS, for example, a digital signal processor (DSP), a single-chip microcomputer, etc. As a preferred example, the processor configured in the lower computer 141 is an ARM processor of the HC32F4A0 series.

[0064] In an embodiment, the lower computer 141 is configured to obtain the operating status of components and control the corresponding component actions, and the components include drive motors, fans, valves, switches, etc. In some embodiments, sensors configured on the robot that generate / collect small amounts of data are connected to the lower computer, and examples of sensors that generate / collect small amounts of data include ultrasonic sensors, infrared sensors, etc.

[0065] In one embodiment, if Figure 1 The driving motors of the left and right driving wheels of the robot 1 shown are connected to the lower computer 141, and the lower computer 141 is configured to drive the left wheel driving motor of the left driving wheel and the right wheel driving motor of the right driving wheel. For example, the lower computer 141 is used to convert the information or data / instructions provided by the upper computer 140 or itself into an electrical signal for controlling the driving motor, and control the rotation speed, steering, etc. of the driving motor according to the electrical signal to adjust the moving speed, moving direction, or movement mode of the robot 1. Specifically, when the lower computer 141 receives the instruction of the movement mode issued by the upper computer, the processor of the lower computer 141 is used to convert the instruction into an electrical signal for controlling the driving motor, and control the rotation speed, steering, etc. of the driving motor according to the electrical signal to adjust the moving speed and moving direction of the robot.

[0066] In order to ensure that the robot can comply with the safety requirements of the mechanical safety standards and match the computing power of the lower computer 141, the present application also provides a robot motion control method in a possible embodiment, and is configured on the lower computer 141 and executed by the lower computer 141.

[0067] The following combination Figures 4 to 9 The motion control method of the robot provided in the embodiment of the present application is described. Figure 4 Shown is a flow chart of a robot motion control method in an embodiment of the present application. As shown in the figure, the robot motion control method includes step S410, step S420, and step S430.

[0068] In step S410, the original point cloud data corresponding to the preset angle range in the direction of travel of the robot collected by the laser sensor is obtained. The direction of travel of the robot is the direction of travel of the robot during work. The original point cloud data of the preset angle range refers to the original point cloud data that only includes point clouds in the preset angle range. In an embodiment, the upper computer obtains the original point cloud data of the entire angle range collected by the laser sensor; at the same time, the lower computer obtains the original point cloud data corresponding to the preset angle range in the direction of travel of the robot collected by the laser sensor.

[0069] In one embodiment, step S410 includes a step of intercepting the original point cloud data within a preset angle range based on the angle information of each point cloud in the original point cloud data. Specifically, the lower computer obtains all the original point cloud data collected by the laser sensor (i.e., the original point cloud data of the point cloud within the scanning angle range of the laser sensor), and then selectively retains the point cloud within the preset angle range according to the angle information of each point cloud in all the original point cloud data, and discards the point cloud outside the preset angle range, thereby obtaining the original point cloud data within the preset angle range.

[0070] See also Figure 5 , which is a schematic diagram of obtaining raw point cloud data within a preset angle range in one embodiment of the present application. In the figure, a laser sensor is set to scan one circle (that is, the scanning angle is 360°), and one circle is composed of 960 point clouds. For example, the laser sensor sends all the collected raw point cloud data including 960 point clouds to the lower computer. When the lower computer obtains all the point cloud data, it will retain the preset angle range (such as 960) according to the angle information of each point cloud. Figure 5 The point cloud of [A1:A2] in the figure (the range is marked with a slash in the figure) is selected, and the point cloud outside the preset angle range is discarded.

[0071] In one embodiment, the preset angle range is configured to include any range within the range of ±40° of the robot's central axis. For example, the preset angle range can be configured as -40° to +40°, -38° to +38°, -36° to +36°, -34° to +34°, -32° to +32°, -30° to +30°, -28° to +28° with the robot's central axis as 0°. Preferably, the preset angle range is configured as -36° to +36° with the robot's central axis as 0°.

[0072] In step S420, based on the original point cloud data in a preset angle range, it is determined whether there is a cliff in the direction of travel of the robot to obtain a first determination result. In an embodiment, the lower computer determines whether there is a cliff in the direction of travel of the robot based on the original point cloud data in a preset angle range to obtain a first determination result.

[0073] See also Figure 6 , which is a flow chart of step S420 in one embodiment of the present application. As shown in the figure, step S420 may further include step S4201 and step S4202. In step S4201, the mapping distance of each point cloud in the original point cloud data within the preset angle range at the current moment is determined. In an embodiment, the lower computer determines the mapping distance of each point cloud in the original point cloud data within the preset angle range at the current moment.

[0074] The mapping distance is the length value obtained by projecting the distance information of each point cloud onto the plane where the robot's central axis is located according to the angle information of each point cloud. In other words, the host computer can calculate the mapping distance of each point cloud according to the angle information and distance information of each point cloud in the original point cloud data within a preset angle range.

[0075] by Figure 1 and Figure 2As shown in the figure, the angle information of the point cloud corresponding to the beam r is the rotation angle α, and the distance information is the beam length l. The mapping distance can be obtained by projecting the beam r toward the plane where the robot's central axis is located. That is, the calculation formula for the mapping distance of the point cloud is: d r =l×cosα, where the value of the rotation angle α should be the absolute angle value with the central axis as 0°. Figure 5 The preset angle configuration is based on ±36° of the robot's central axis as an example, that is, the rotation angle corresponding to A1 is -36° with the robot's central axis as 0°, and its absolute angle value is 36°. The rotation angle corresponding to A2 is +36° with the robot's central axis as 0°, and its absolute angle value is also 36°.

[0076] like Figure 6 As shown, in step S4202, whether there is a cliff is determined according to the difference in mapping distances of point clouds at the same angle in the original point cloud data within a preset angle range at the current moment and the previous moment. In an embodiment, the lower computer determines whether there is a cliff according to the difference in mapping distances of point clouds at the same angle in the original point cloud data within a preset angle range at the current moment and the previous moment.

[0077] In one embodiment, a fixed time period (e.g., 100 ms) or a fixed rotation period (e.g., a single-line laser sensor rotates once) is regarded as a moment, and the raw point cloud data obtained within the fixed time period or the fixed rotation period is regarded as the raw point cloud data at a moment. Similarly, the raw point cloud data within a preset angle range within the fixed time period or the fixed rotation period is regarded as the raw point cloud data within the preset angle range at a moment. Taking a rotation period as a moment as an example, Figure 5 The original point cloud data of the preset angle range [A1: A2] shown is the original point cloud data of the preset angle range [A1: A2] at time t1.

[0078] See also Figure 7, which is a schematic diagram of the original point cloud data of the preset angle range at the current moment and the previous moment in one embodiment of the present application, the original point cloud data of the preset angle range at the current moment t1 is a data set of point clouds corresponding to laser beams r11 to r1n, and the original point cloud data of the preset angle range at the previous moment t0 is a data set of point clouds corresponding to laser beams r01 to r0n, and the point cloud corresponding to the laser beam r11 at the current moment t1 has the same angle as the point cloud corresponding to the laser beam r01 at the previous moment t0 (it should be understood that the same angle does not mean that the angle information of the two point clouds is exactly the same, but that the angle information of the two is within the error range), the point cloud corresponding to the laser beam r12 at the current moment t1 has the same angle as the point cloud corresponding to the laser beam r02 at the previous moment t0, and so on, the point cloud corresponding to the laser beam r1n at the current moment t1 has the same angle as the point cloud corresponding to the laser beam r0n at the previous moment t0, therefore, Figure 7 Taking the example shown, the difference in mapping distance of the point cloud at the same angle in the original point cloud data of the preset angle range at the current moment and the previous moment described in step S4202 includes: the difference between the mapping distance of the point cloud corresponding to the laser beam r11 at the current moment t1 and the mapping distance of the point cloud corresponding to the laser beam r01 at the previous moment t0, the difference between the mapping distance of the point cloud corresponding to the laser beam r12 at the current moment t1 and the mapping distance of the point cloud corresponding to the laser beam r02 at the previous moment t0, ... the difference between the mapping distance of the point cloud corresponding to the laser beam r1n at the current moment t1 and the mapping distance of the point cloud corresponding to the laser beam r0n at the previous moment t0.

[0079] In one embodiment, step S4202 further includes the step of updating the cliff detection confidence at the current moment when it is determined that the difference in mapping distances of the point cloud at the same angle at the current moment and the previous moment exceeds a preset length, and the step of determining that a cliff exists when the cliff detection confidence at the current moment reaches a trigger threshold.

[0080] The cliff detection confidence is used to indicate the possibility of detecting a cliff. In an embodiment, when the difference between the point cloud at the current moment and the point cloud at the previous moment at the same angle exceeds a preset length, it is determined that the point cloud at the current moment has detected a cliff, and can be called a cliff point cloud. Figure 8, which is a schematic diagram of a cliff point cloud in an embodiment of the present application, wherein a dotted line indicates a laser beam r01 projected at the previous moment t0, and a solid line indicates a laser beam r11 projected at the current moment t1, both of which are at the same angle. When the mapping distance of the point cloud corresponding to the calculated laser beam r11 is greater than the mapping distance of the point cloud corresponding to the laser beam r01 by more than a preset length, it means that the height difference h between the surfaces detected at the current moment and the previous moment exceeds the safety height requirement, that is, the point cloud at the current moment t1 detects a cliff and is regarded as a cliff point cloud.

[0081] In some embodiments, the cliff detection confidence at the current moment can be expressed by the ratio of the number of cliff point clouds determined in the original point cloud data within the preset angle range at the current moment to the total number of point clouds in the original point cloud data within the preset angle range at the current moment. Therefore, each time it is detected that the mapping distance between a point cloud at the current moment and a point cloud at the same angle at the previous moment exceeds a preset length, the cliff detection confidence at the current moment will be updated until all point clouds within the preset angle range at the current moment are detected, or the cliff detection confidence at the current moment has reached the trigger threshold.

[0082] The trigger threshold refers to the standard for determining that a cliff is detected. In an embodiment, the trigger threshold can be set to 70%, that is, the cliff detection confidence at the current moment must reach 70% to determine that a cliff is detected at the current moment. Of course, those skilled in the art can also adjust the trigger threshold according to the actual required sensitivity, for example, it can also be set to 80%, 90%, etc.

[0083] In order to further determine the orientation of the cliff relative to the robot, in one embodiment, determining whether there is a cliff in the direction of travel of the robot in step S420 also includes: dividing the original point cloud data in the preset angle range into multiple groups corresponding to multiple areas in the direction of travel of the robot based on the angle information of each point cloud in the original point cloud data in the preset angle range, so as to determine whether there is a cliff in the direction of travel of the robot by area.

[0084] See also Fig. 9 , which is a schematic diagram of the original point cloud data of the preset angle range divided into regions in one embodiment of the present application. As shown in the figure, within the preset angle range, the laser beam projected by the laser sensor 13 corresponds to the middle area F, the left area D, and the right area E in the direction of travel of the robot. Therefore, the original point cloud data can be divided into three groups of point cloud data corresponding to the middle area F, the left area D, and the right area E according to the angle information of each point cloud in the original point cloud data of the preset angle range, as shown in FIG. Fig. 9As shown, the scannable width of the middle area F, the left area D, and the right area E must at least correspond to the width of the robot body 10. Of course, Fig. 9 What is shown is only an example. The area division may also be divided into 2 areas, 4 areas, or more areas according to actual needs. The scannable width of each area may also be adaptively adjusted, and this application does not impose any restrictions on this.

[0085] In one embodiment, the determination of whether there is a cliff in the direction of travel of the robot in different regions can be performed by respectively performing the following operations on the divided multiple groups of point cloud data: Figures 6 to 8 For detection in any of the embodiments, please refer to the above Figures 6 to 8 And the related description will not be repeated here.

[0086] Please continue reading Figure 4 In the robot motion control method described in the present application, in step S430, when it is determined that any one of the first judgment result and the obtained second judgment result includes the existence of a cliff, the robot is controlled to execute a motion mode corresponding to the cliff.

[0087] The second judgment result is obtained by the upper computer performing a preprocessing of coordinate conversion on the original point cloud data acquired by the laser sensor and then performing cliff calculation. The connection between the upper computer and the lower computer, and the process of the upper computer performing preprocessing such as coordinate conversion and cliff calculation can refer to any of the above-mentioned descriptions of the control system and the upper computer, and will not be repeated here.

[0088] In order to ensure that the robot can meet the safety requirements of the mechanical safety standards, the lower computer obtains the first judgment result including the existence of a cliff when executing step S420, or receives the second judgment result sent by the upper computer including the existence of a cliff, and controls the robot to perform the movement corresponding to the cliff. For example, the lower computer converts the movement corresponding to the cliff into an electrical signal for controlling the drive motor, so as to control the speed, direction, etc. of the left wheel drive motor and the right wheel drive motor according to the electrical signal.

[0089] In one embodiment, the movement in response to the cliff is parking, and when the lower computer determines that any judgment result includes the existence of a cliff, it controls the left wheel drive motor and the right wheel drive motor to stop rotating.

[0090] In one embodiment, the first judgment result includes the cliff's location information in addition to the cliff's existence. In this embodiment, the movement of the cliff may be, for example, to form a moving path that avoids the cliff so as to follow the moving path. For example, in step S420, the first judgment result is as follows: Fig. 9There is a cliff in the left area D, but there is no cliff in the middle area F and the right area E. The lower computer can control the robot to continue to move in a straight line to avoid the cliff in the left area D.

[0091] It should be understood that if Figures 4 to 9 The robot motion control method provided can also be configured to be executed on other robots. Figure 1 Robots shown are limited.

[0092] Furthermore, in some embodiments, Figure 1 The robot body 10 of the robot 1 is also provided with a cleaning device (not shown in the figure), which is arranged at the bottom of the robot body 10 and is used to perform cleaning operations under the control of the control system.

[0093] In one embodiment, the cleaning device includes a roller brush assembly, which is connected to a clean water tank of the robot, and the robot delivers clean water in the clean water tank to the roller brush assembly, so that the roller brush assembly cleans the floor to be cleaned. In the example where the robot is provided with a dirt collection assembly, the roller brush assembly may be located at the front side of the robot dirt collection assembly to clean the floor to be cleaned while rotating, so that the dirt collection assembly can collect the dirty water from the roller brush assembly cleaning the surface to be cleaned, and the dirty water is, for example, liquid left by the roller brush assembly when washing the surface to be cleaned.

[0094] In some examples, the roller brush assembly of the cleaning device is generally configured as a double roller brush structure, with the robot's travel direction as the front, and the double roller brush structure having a front roller brush and a rear roller brush. The front roller brush may also be referred to as a first roller brush, which can clean the floor to be cleaned while rotating. The rear roller brush may also be referred to as a second roller brush, which can be wetted to scrub the floor to be cleaned while rotating. In other words, the double roller brush structure can implement a cleaning method in which the front roller brush / first roller brush pre-cleans the garbage on the floor to be cleaned, and the rear roller brush / second roller brush scrubs the floor to be cleaned.

[0095] It should be understood that the first roller brush is used to clean the surface to be cleaned, which means that the first roller brush brings / sweeps / rolls up the garbage on the surface to be cleaned into the garbage box / dust collection chamber configured on the robot body. The second roller brush is used to scrub the surface to be cleaned, which means that the second roller brush cleans the surface to be cleaned with the help of liquid, so that the cleaning device can clean liquid (such as milk, tea, etc.), highly adherent dirt, wet garbage, etc. on the surface to be cleaned.

[0096] In another embodiment, the cleaning device may include a brush disc, a scrubber and / or the like, which is configured to contact the surface to be cleaned on which the cleaning robot travels. The cleaning device is connected to the clean water tank of the robot, and the robot delivers the clean water in the clean water tank to the cleaning device for the cleaning device to clean the ground to be cleaned. For example, in some embodiments, the cleaning device may include one or more disc-shaped brushes rotatably coupled to the robot chassis. One or more disc-shaped brushes are detachably coupled to a motor, which is configured to rotate one or more brushes relative to the robot body. In some embodiments, the cleaning device may include a brush disc or the like, which may include one or more of a cylindrical cleaning member, a disc cleaning member, a track cleaning member and / or the like. Such a brush disc and / or one or more cleaning members contained therein can be exchanged from one type (e.g., a cylindrical or disc-shaped cleaning member) to another type (e.g., a track cleaning member), thereby allowing the cleaning assembly to clean different types of surfaces.

[0097] For example, in one embodiment, the cleaning device includes a cleaning turntable / brush disc, a connecting structure and an adjusting structure. The cleaning turntable is used to clean the ground (i.e., the surface to be cleaned mentioned above), and the cleaning turntable includes a relative working surface and a mounting surface. One end of the connecting structure is rotatably connected to the mounting surface, and the rotation axis of one end of the connecting structure is parallel to the working surface, and the other end of the connecting structure is used to be installed on the chassis of the cleaning robot. The adjusting structure is arranged on the chassis, and the driving end of the adjusting structure is connected to the connecting structure. The adjusting structure is used to rotate the connecting structure to drive the cleaning turntable to make the working surface close to or away from the surface to be cleaned, and when the working surface contacts the surface to be cleaned, it is used to continue to rotate the connecting structure to provide the cleaning turntable with pressure to be close to the surface to be cleaned. At the same time, after increasing the pressure of the cleaning turntable on the ground, the speed output of the working motor is increased; after reducing the pressure of the cleaning turntable on the ground, the speed output of the working motor is reduced, so that electric energy can be further saved and the cleaning quality can be ensured. In this embodiment, the driving mechanism adjusts the rotation angle of the connecting structure within the rotating plane to control the distance between the cleaning turntable and the surface to be cleaned, and after the cleaning turntable lands, the connecting structure is continued to rotate to adjust the pressure of the cleaning turntable connected to the connecting structure on the surface to be cleaned. This solves the problem that the pressure of the cleaning turntable on the surface to be cleaned cannot be adjusted. By adjusting the pressure of the cleaning turntable on the surface to be cleaned, energy waste is avoided and the cleaning effect is guaranteed. By setting an idle travel mechanism, after the gravity of the cleaning turntable is completely released to the surface to be cleaned, the driving mechanism continues to rotate to provide the above pressure, avoiding the problem of insufficient pressure caused by the wear and shortening of the working surface of the cleaning turntable, and increasing the accuracy of the driving mechanism in adjusting the above pressure.

[0098] In one embodiment, the robot may further include an interactive device (not shown), which is connected to the control system and is used to provide an interactive interface between the user and the robot. In this embodiment, the robot can directly obtain the current command, trigger threshold, etc. input by the user through the interactive device. Specifically, the interactive device provides the user with an interactive interface with the robot based on a display visualization interface (an operation interface). The interactive device includes, for example, a display, which, when integrated with a touch sensor, can be used as a hardware device for displaying and generating input events. Among them, the operation interface can be understood as a display interface provided by the interactive device, which will not be elaborated here.

[0099] In summary, some embodiments of the present application disclose a robot, a control system of the robot, and a motion control method of the robot, by connecting laser sensors to a host computer and a slave computer respectively to perform dual-channel transmission of the collected data, and the host computer and the slave computer respectively perform cliff detection, so that the slave computer can perform motion control according to two judgment results, thereby ensuring the safety of the robot's movement. In addition, only part of the data collected by the laser sensor is used on the slave computer, and the original data is directly used for cliff detection, which can be adapted to the computing power of the slave computer.

[0100] The present application also provides a computer storage medium storing at least one program, which, when executed by a processor, controls a device where the storage medium is located to execute a robot motion control method as described in any of the above embodiments.

[0101] The embodiment of the present application also provides a computer program product. When the computer program product is run on a computer, the computer is enabled to execute the above-mentioned related steps to implement the robot motion control method described in the above-mentioned embodiment.

[0102] If the program is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present application, or the part that contributes to the prior art, or the part of the technical solution, can be embodied in the form of a software product, which is stored in a storage medium and includes several instructions for enabling a robot equipped with the storage medium to execute all or part of the steps of the method described in each embodiment of the present application.

[0103] In the embodiments provided in the present application, the computer storage medium may include a read-only memory, a random access memory, an EEPROM, a CD-ROM or other optical disk storage device, a disk storage device or other magnetic storage device, a flash memory, a USB flash drive, a mobile hard disk, or any other medium that can be used to store a desired program code in the form of an instruction or data structure and can be accessed by a computer. In addition, any connection can be appropriately referred to as a computer-readable medium. For example, if the instruction is sent from a website, a server or other remote source using a coaxial cable, an optical fiber cable, a twisted pair, a digital subscriber line (DSL), or wireless technologies such as infrared, radio, and microwaves, the coaxial cable, optical fiber cable, twisted pair, DSL, or wireless technologies such as infrared, radio, and microwaves are included in the definition of the medium. However, it should be understood that computer storage media and data storage media do not include connections, carriers, signals, or other temporary media, but are intended to be non-temporary, tangible storage media. Disk and disc, as used in this application, includes compact disc (CD), laser disc, optical disc, digital versatile disc (DVD), floppy disk and Blu-ray disc where disks usually reproduce data magnetically, while discs reproduce data optically with lasers.

[0104] In one or more exemplary aspects, the functions described in the computer program of the motion control method of the robot described in the present application can be implemented in hardware, software, firmware or any combination thereof. When implemented in software, these functions can be stored or transmitted as one or more instructions or codes to a computer-readable medium. The steps of the method or algorithm disclosed in the present application can be embodied in a processor-executable software module, wherein the processor-executable software module can be located on a tangible, non-temporary computer storage medium. A tangible, non-temporary computer storage medium can be any available medium that a computer can access.

[0105] The flowchart and block diagram in the accompanying drawings described in the present application illustrate the possible architecture, function and operation of the system, method and computer program product according to various embodiments of the present application. Based on this, each box in the flowchart or block diagram can represent a module, a program segment or a part of a code, and the module, the program segment or a part of the code contains one or more executable instructions for realizing the specified logical function. It should also be noted that in some implementations as replacements, the functions marked in the box can also occur in a different order from the order marked in the accompanying drawings. For example, two boxes represented in succession can actually be executed substantially in parallel, and they can sometimes be executed in the opposite order, depending on the functions involved. It should also be noted that each box in the block diagram and / or the flowchart, and the combination of the boxes in the block diagram and / or the flowchart can be realized by a dedicated hardware-based system that performs a specified function or operation, or can be realized by a combination of dedicated hardware and computer instructions.

[0106] The above embodiments are merely illustrative of the principles and effects of the present application and are not intended to limit the present application. Anyone familiar with the technology may modify or change the above embodiments without violating the spirit and scope of the present application. Therefore, all equivalent modifications or changes made by a person of ordinary skill in the art without departing from the spirit and technical ideas disclosed in the present application shall still be covered by the claims of the present application.

Claims

1. A robot motion control method, characterized in that: The following steps are involved: Acquire the original point cloud data of a preset angle range corresponding to the robot's moving direction collected by the laser sensor; the laser sensor is arranged on the robot and is respectively connected to the upper computer and the lower computer of the robot for dual-channel transmission; Based on the original point cloud data within a preset angle range, determining whether there is a cliff in the moving direction of the robot to obtain a first determination result; When it is determined that any one of the first judgment result and the obtained second judgment result includes the existence of a cliff, the robot is controlled to execute a movement mode corresponding to the cliff; wherein the second judgment result is obtained by the upper computer performing cliff calculation after pre-processing the coordinate conversion of the original point cloud data acquired by the laser sensor.

2. The robot motion control method according to claim 1, characterized in that: The host computer is configured to execute a SLAM program, a path planning program, an object recognition program, or a behavior and control program.

3. The robot motion control method according to claim 1, characterized in that: The lower computer is configured to obtain the running status of the component and control the corresponding component action.

4. The robot motion control method according to any one of claims 1 or 3, characterized in that: The computing capability of the lower computer is lower than that of the upper computer, and the lower computer is configured with a processor having a maximum main frequency of 240 MHz and a computing performance of 300 DMIPS.

5. The robot motion control method according to claim 1, characterized in that: The step of acquiring the original point cloud data collected by the laser sensor and corresponding to the preset angle range in the moving direction of the robot includes the step of intercepting the original point cloud data within the preset angle range based on the angle information of each point cloud in the original point cloud data.

6. The robot motion control method according to claim 1, characterized in that: The preset angle range includes any range within the range of ±40° with reference to the central axis of the robot.

7. The robot motion control method according to claim 1, characterized in that: The step of judging whether there is a cliff in the direction of movement of the robot based on the original point cloud data in a preset angle range comprises: Determine the mapping distance of each point cloud in the original point cloud data within a preset angle range at the current moment; wherein the mapping distance is a length value obtained by projecting the distance information of each point cloud onto the plane where the robot's central axis is located according to the angle information of each point cloud; Whether there is a cliff is determined according to the difference in mapping distance of the point cloud at the same angle in the original point cloud data within the preset angle range at the current moment and the previous moment.

8. The robot motion control method according to claim 7, characterized in that: Determining whether there is a cliff based on the difference in the mapping distance of the point cloud at the same angle in the original point cloud data within the preset angle range at the current moment and the previous moment includes: When it is determined that the difference between the mapping distances of the point clouds at the same angle at the current moment and the previous moment exceeds a preset length, the cliff detection confidence at the current moment is updated; When the cliff detection confidence at the current moment reaches the trigger threshold, it is determined that there is a cliff.

9. The robot motion control method according to claim 8, characterized in that: The trigger threshold is set to 70%.

10. The robot motion control method according to claim 1, characterized in that: The step of judging whether there is a cliff in the direction of travel of the robot based on the original point cloud data in a preset angle range also includes: dividing the original point cloud data in a preset angle range into multiple groups corresponding to multiple areas in the direction of travel of the robot based on the angle information of each point cloud in the original point cloud data, so as to judge whether there is a cliff in the direction of travel of the robot by area.

11. A robot control system, characterized in that: include: A host computer is connected to a laser sensor provided on the robot to obtain the original point cloud data collected by the laser sensor, and performs cliff calculation after pre-processing the coordinate conversion of the obtained original point cloud data to obtain a second judgment result; The lower computer is connected to the laser sensor and the upper computer, and is used to obtain the original point cloud data collected by the laser sensor and corresponding to the preset angle range in the direction of travel of the robot, and judge whether there is a cliff in the direction of travel of the robot based on the original point cloud data in the preset angle range to obtain a first judgment result; the lower computer is also used to obtain the second judgment result, and when it is determined that any of the first judgment result and the second judgment result is that there is a cliff, control the robot to execute a movement mode corresponding to the cliff; Wherein, the laser sensor is respectively connected to the upper computer and the lower computer for dual-channel transmission.

12. The control system according to claim 11, characterized in that: The host computer is configured to execute a SLAM program, a path planning program, an object recognition program, or a behavior and control program.

13. The control system according to claim 11, characterized in that: The lower computer is configured to obtain the operating status of each component and control the corresponding component action.

14. The control system according to claim 11 or 13, characterized in that: The computing capability of the lower computer is lower than that of the upper computer, and the lower computer is configured with a processor having a maximum main frequency of 240 MHz and a computing performance of 300 DMIPS.

15. A computer-readable storage medium, characterized in that: At least one program is stored, and when the at least one program is called and executed by a processor, the motion control method of the robot as described in any one of claims 1-10 is implemented.

16. A computer program product, characterized in that When the computer program product runs on a computer, the computer is enabled to execute the robot motion control method according to any one of claims 1 to 10.

17. A robot, characterized in that: include: A robot body, on which a laser sensor is disposed; Left and right driving wheels located at the rear side of the robot body; At least one universal wheel located on the front side of the robot body; The control system as described in any one of claims 11 to 14 comprises an upper computer and a lower computer, wherein the upper computer and the lower computer are respectively connected to the laser sensor so that the data collected by the laser sensor can be transmitted in dual channels; the control system is used to obtain the original point cloud data collected by the laser sensor to control the robot to execute a motion mode in response to the cliff.

18. The robot according to claim 17, characterized in that: The robots include commercial cleaning robots.

Citation Information

Cited By

  • Robot path planning method, device and equipment and robot

    CN120972934A

  • Robot path planning method, device, equipment and robot

    CN120972934B