CN111766877A - a robot - Google Patents
a robot Download PDFInfo
- Publication number
- CN111766877A CN111766877A CN202010569310.0A CN202010569310A CN111766877A CN 111766877 A CN111766877 A CN 111766877A CN 202010569310 A CN202010569310 A CN 202010569310A CN 111766877 A CN111766877 A CN 111766877A
- Authority
- CN
- China
- Prior art keywords
- robot
- leg
- detection device
- obstacle
- motion
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
- B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
- B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0242—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Acoustics & Sound (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种机器人。所述机器人包括:机器人行走时越过障碍物系统;机器人本体,机器人行走时越过障碍物系统至少部分设置在机器人本体上,机器人本体上设置有行走装置;第一运动支腿,其安装在机器人本体上,机器人行走时越过障碍物系统中的第一探测装置以及第二探测装置安装在第一运动支腿上;第一运动驱动组件,其与第一运动支腿连接,运动驱动组件能够驱动第一运动支腿运动;第二运动支腿,其安装在机器人本体上;第二运动驱动组件,其与第二运动支腿连接,第二运动驱动组件能够驱动第二运动支腿运动;总控制器,其分别与第一运动驱动组件、第二运动驱动组件、动作命令模块以及探测装置位置变化命令模块连接。
The invention discloses a robot. The robot includes: a system for crossing obstacles when the robot walks; a robot body, the system for crossing obstacles when the robot walks is at least partially arranged on the robot body, and the robot body is provided with a walking device; a first moving leg, which is installed on the robot body The first detection device and the second detection device in the obstacle system when the robot walks are installed on the first movement leg; the first movement drive assembly is connected with the first movement leg, and the movement drive assembly can drive the first movement outrigger. A moving outrigger moves; a second moving outrigger is installed on the robot body; a second moving driving assembly is connected with the second moving outrigger, and the second moving outrigger can drive the second moving outrigger to move; the overall control The device is respectively connected with the first motion drive assembly, the second motion drive assembly, the motion command module and the detection device position change command module.
Description
技术领域technical field
本发明涉及机器人技术领域,特别是涉及一种机器人。该案为申请号:201810676646X,申请名称为一种机器人行走时越过障碍物的方法、系统及机器人的专利申请的分案申请。The present invention relates to the field of robot technology, in particular to a robot. The case is the application number: 201810676646X, and the name of the application is a divisional application of a patent application for a method, a system and a robot for a robot to walk over obstacles.
背景技术Background technique
对于勘探机器人而言,准确识别障碍种类以及避障的实现是其最关键的两个部分。机器人自动避障在某种程度上可以看作是机器人规划路线功能的一种特例,它对产品的实时性和成功率(可靠性)的要求更高。For exploration robots, the accurate identification of obstacles and the realization of obstacle avoidance are the two most critical parts. Robot automatic obstacle avoidance can be regarded as a special case of the robot's route planning function to a certain extent, and it has higher requirements on the real-time performance and success rate (reliability) of the product.
目前对于机器人周围环境障碍物的探测多利用红外传感器,实现的是对某一确定高度的二维的探测,此方法存在的明显缺陷是,机器人缺少对低于探测高度的障碍物或沟壑等信息的判断;且机器人能够判断的障碍物种类较少,遇到较为复杂的障碍信息时,机器人无法做出相应的判断。At present, infrared sensors are mostly used to detect obstacles in the surrounding environment of the robot, which realizes two-dimensional detection of a certain height. The obvious defect of this method is that the robot lacks information such as obstacles or ravines below the detection height. And the robot can judge only a few types of obstacles, when encountering more complex obstacle information, the robot cannot make corresponding judgments.
因此,希望有一种技术方案来克服或至少减轻现有技术的至少一个上述缺陷。Therefore, a technical solution is desired to overcome or at least alleviate at least one of the above-mentioned deficiencies of the prior art.
发明内容SUMMARY OF THE INVENTION
本发明的目的在于提供一种机器人来克服或至少减轻现有技术的至少一个上述缺陷。It is an object of the present invention to provide a robot that overcomes or at least alleviates at least one of the aforementioned drawbacks of the prior art.
为实现上述目的,本发明提供一种机器人,其特征在于,所述机器人包括:In order to achieve the above object, the present invention provides a robot, characterized in that, the robot includes:
机器人行走时越过障碍物系统;The robot walks over the obstacle system;
机器人本体(1),所述机器人行走时越过障碍物系统至少部分设置在所述机器人本体(1)上,所述机器人本体(1)上设置有行走装置(2),所述行走装置(2)能够使机器人以第一行走方式行走;A robot body (1), the robot body (1) is at least partially provided on the robot body (1) when the robot walks over obstacles, a walking device (2) is provided on the robot body (1), and the walking device (2) is provided on the robot body (1). ) enables the robot to walk in the first walking mode;
第一运动支腿(3),所述第一运动支腿(3)安装在所述机器人本体(1)上,所述机器人行走时越过障碍物系统中的第一探测装置(4)以及第二探测装置(5)安装在所述第一运动支腿(3)上;A first moving leg (3), the first moving leg (3) is mounted on the robot body (1), and the robot walks over the first detection device (4) and the first detection device (4) in the obstacle system. Two detection devices (5) are installed on the first moving legs (3);
第一运动驱动组件,所述第一运动驱动组件与所述第一运动支腿连接,所述运动驱动组件能够驱动所述第一运动支腿运动;a first motion drive assembly, the first motion drive assembly is connected with the first motion leg, and the motion drive assembly can drive the first motion leg to move;
第二运动支腿(6),所述第二运动支腿(6)安装在所述机器人本体(1)上;a second moving outrigger (6), the second moving outrigger (6) is mounted on the robot body (1);
第二运动驱动组件,所述第二运动驱动组件,所述第二运动驱动组件与所述第二运动支腿连接,所述第二运动驱动组件能够驱动所述第二运动支腿运动;a second motion drive assembly, the second motion drive assembly is connected with the second motion leg, and the second motion drive assembly can drive the second motion leg to move;
总控制器,所述总控制器分别与第一运动驱动组件、第二运动驱动组件、动作命令模块以及探测装置位置变化命令模块连接,其中,an overall controller, which is respectively connected with the first motion drive assembly, the second motion drive assembly, the motion command module and the detection device position change command module, wherein,
所述探测装置位置变化命令模块用于将第一探测装置位置改变信号传递给所述总控制器;The detection device position change command module is used to transmit the first detection device position change signal to the general controller;
所述动作命令模块用于将第一翻越动作的命令、第一跨越动作的命令或第二翻越动作的命令中的一个传递给所述总控制器;The action command module is configured to transmit one of the command of the first overrunning action, the command of the first overrunning action or the command of the second overrunning action to the general controller;
所述总控制器用于根据所收到的信号控制所述第一运动驱动组件和/或所述第二运动驱动组件工作,从而驱动第一运动支腿和/或第二运动支腿运动;The general controller is used to control the first motion drive assembly and/or the second motion drive assembly to work according to the received signal, thereby driving the first motion outrigger and/or the second motion outrigger to move;
所述第一运动支腿运动和/或所述第二运动支腿运动,从而使所述机器人进行第一翻越动作、第一跨越动作、第二翻越动作或改变所述第二探测装置位置中的一种。The first moving leg moves and/or the second moving leg moves, so that the robot performs a first jumping action, a first jumping action, a second jumping action or changes the position of the second detection device. a kind of.
可选地,所述第一运动驱动组件包括第一舵机、第二舵机以及第三舵机;Optionally, the first motion drive assembly includes a first steering gear, a second steering gear and a third steering gear;
所述第一运动支腿包括第一运动支腿第一段、第一运动支腿第二段、第一运动支腿第三段;The first movement outrigger includes the first segment of the first movement outrigger, the second segment of the first movement outrigger, and the third segment of the first movement outrigger;
所述第一舵机设置在机器人本体上;The first steering gear is arranged on the robot body;
所述第一运动支腿第一段与所述第一舵机的输出端连接,且能够绕所述第一舵机的输出端旋转;The first section of the first moving leg is connected to the output end of the first steering gear, and can rotate around the output end of the first steering gear;
所述第二舵机设置在所述第一运动支腿第一段上;the second steering gear is arranged on the first segment of the first moving leg;
所述第一运动支腿第二段与所述第二舵机的输出端连接,所述第一运动支腿第二段能够绕所述第二舵机的输出端旋转;The second segment of the first moving leg is connected to the output end of the second steering gear, and the second segment of the first moving leg can rotate around the output end of the second steering gear;
所述第三舵机设置在所述第一运动支腿第二段上;the third steering gear is arranged on the second segment of the first moving leg;
所述第一运动支腿第三段与所述第二舵机的输出端连接,所述第一运动支腿第三段能够绕所述第三舵机的输出端旋转;The third segment of the first moving leg is connected to the output end of the second steering gear, and the third segment of the first moving leg can rotate around the output end of the third steering gear;
所述第一探测装置安装在所述第一运动支腿第三段上;所述第二探测装置安装在所述机器人本体上;The first detection device is installed on the third section of the first moving leg; the second detection device is installed on the robot body;
所述第二运动驱动组件包括第四舵机、第五舵机;The second motion drive assembly includes a fourth steering gear and a fifth steering gear;
所述第二运动支腿包括第二运动支腿第一段、第二运动支腿第二段;The second movement outrigger includes a first segment of the second movement outrigger and a second segment of the second movement outrigger;
所述第四舵机安装在所述机器人本体上;the fourth steering gear is mounted on the robot body;
所述第二运动支腿第一段与所述第四舵机的输出端连接,所述第二运动支腿第一段能够相对所述第四舵机的输出端旋转;The first section of the second moving outrigger is connected with the output end of the fourth steering gear, and the first section of the second moving outrigger can rotate relative to the output end of the fourth steering gear;
所述第五舵机安装在所述第二运动支腿第一段上;the fifth steering gear is mounted on the first section of the second moving outrigger;
所述第二运动支腿第二段与所述第五舵机的输出端连接,所述第二运动支腿第二段能够相对所述第五舵机的输出端旋转;The second section of the second moving outrigger is connected to the output end of the fifth steering gear, and the second section of the second moving outrigger can rotate relative to the output end of the fifth steering gear;
第一滑轮组,所述第一滑轮组安装在所述第一运动支腿第三段上;a first pulley set, the first pulley set is mounted on the third segment of the first moving leg;
第二滑轮组,所述第二滑轮组安装在所述第二运动支腿第二段上;其中,A second pulley set, the second pulley set is mounted on the second segment of the second moving leg; wherein,
所述第一滑轮组以及所述第二滑轮组配合,从而能够使所述机器人以第二行走方式行走。The first pulley set and the second pulley set cooperate, so that the robot can walk in the second walking mode.
相对于现有机器人,本申请的机器人能够应对平地和复杂地形的情况,同时其能够根据需要转变为移动工作平台,具体地,两只长脚能够轻松地抬高和降低车体高度,高度抬高后车体还能够进一步进行移动,将机器人作为移动工作平台,通过两只脚的配合动作随意抬高和降低自身高度来进行勘探和作业,经过部分改造也可以横跨在河流或断崖间来搭造简易桥梁;其中移动工作平台的构建功能,能够在实际勘探中为机器人加装的各种资源采集设施以及勘探传感器的信息采集提供极大的方便,使机器人收集的信息更加精确到位。Compared with the existing robot, the robot of the present application can deal with the situation of flat ground and complex terrain, and at the same time, it can be transformed into a mobile working platform as required. The high rear car body can also move further, using the robot as a mobile work platform, through the coordinated action of the two feet to raise and lower its own height at will for exploration and operation, and after partial transformation, it can also straddle rivers or cliffs. Build a simple bridge; the construction function of the mobile work platform can provide great convenience for the collection of various resource collection facilities installed by the robot and the information collection of exploration sensors in actual exploration, so that the information collected by the robot is more accurate.
本申请的机器人具有障碍物信息探测功能,其能够根据所面临的障碍物的情况采取具体的决策,与传统的避障小车以及避障机器人相比,其更加智能。The robot of the present application has the function of detecting obstacle information, and can take specific decisions according to the situation of the obstacles it faces. Compared with the traditional obstacle avoidance car and obstacle avoidance robot, it is more intelligent.
同时,因为在控制器、传感器、驱动器选型等方面做了大量的工作,所以该发明性能稳定,成本也大大降低。实现了障碍物信息探测、翻越障碍物、跨越沟壑型障碍、自主姿态恢复、移动工作平台等多种功能。At the same time, because a lot of work has been done in the selection of controllers, sensors, and drivers, the invention has stable performance and greatly reduced costs. It realizes various functions such as obstacle information detection, overcoming obstacles, crossing ravine obstacles, autonomous attitude recovery, and mobile working platform.
附图说明Description of drawings
图1是根据本发明一实施例的机器人行走时越过障碍物的方法的流程示意图。FIG. 1 is a schematic flowchart of a method for a robot walking over obstacles according to an embodiment of the present invention.
图2是图1所示的机器人的结构示意图。FIG. 2 is a schematic structural diagram of the robot shown in FIG. 1 .
图3是图1所示的机器人的另一结构示意图。FIG. 3 is another schematic structural diagram of the robot shown in FIG. 1 .
附图标记reference number
具体实施方式Detailed ways
为使本发明实施的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行更加详细的描述。在附图中,自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。所描述的实施例是本发明一部分实施例,而不是全部的实施例。下面通过参考附图描述的实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。下面结合附图对本发明的实施例进行详细说明。In order to make the objectives, technical solutions and advantages of the present invention clearer, the technical solutions in the embodiments of the present invention will be described in more detail below with reference to the accompanying drawings in the embodiments of the present invention. Throughout the drawings, the same or similar reference numbers refer to the same or similar elements or elements having the same or similar functions. The described embodiments are some, but not all, of the embodiments of the present invention. The embodiments described below with reference to the accompanying drawings are exemplary, and are intended to explain the present invention and should not be construed as limiting the present invention. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative efforts shall fall within the protection scope of the present invention. The embodiments of the present invention will be described in detail below with reference to the accompanying drawings.
在本发明的描述中,需要理解的是,术语“中心”、“纵向”、“横向”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明保护范围的限制。In the description of the present invention, it should be understood that the terms "center", "portrait", "horizontal", "front", "rear", "left", "right", "vertical", "horizontal", The orientation or positional relationship indicated by "top", "bottom", "inner", "outer", etc. is based on the orientation or positional relationship shown in the drawings, and is only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that The device or element referred to must have a specific orientation, be constructed and operate in a specific orientation, and therefore should not be construed as limiting the scope of protection of the present invention.
图1是根据本发明一实施例的机器人行走时越过障碍物的方法的流程示意图。图2是图1所示的机器人的结构示意图。FIG. 1 is a schematic flowchart of a method for a robot walking over obstacles according to an embodiment of the present invention. FIG. 2 is a schematic structural diagram of the robot shown in FIG. 1 .
参见图2,在本实施例中,机器人在地面行走时的第一探测装置探测方向为前方向(图2中右方向)、机器人在地面行走时与前方向相反的方向为后方向(图2中左方向)、机器人在地面行走时与地面平行且与所述前方向垂直的方向为左方向(图2中纸面朝里方向)或右方向(图2中纸面朝外方向)、机器人在地面行走时的与前方向垂直且与左方向垂直的方向为上方向(图2中上方向)或下方向(图2中下方向);Referring to FIG. 2 , in this embodiment, the detection direction of the first detection device when the robot is walking on the ground is the front direction (the right direction in FIG. 2 ), and the direction opposite to the front direction when the robot is walking on the ground is the rear direction ( FIG. 2 ). center left direction), when the robot walks on the ground, the direction parallel to the ground and perpendicular to the front direction is the left direction (the paper faces inward in Figure 2) or the right direction (the paper faces outward in Figure 2). When walking on the ground, the direction perpendicular to the front direction and the left direction is the upper direction (upward direction in Figure 2) or the downward direction (the lower direction in Figure 2);
机器人的第一探测装置与疑似障碍在前方向的距离为第一探测距离;The distance between the first detection device of the robot and the suspected obstacle in the forward direction is the first detection distance;
机器人在地面行走时,第二探测装置的探测方向为朝向行走的地面设置,该方向为上述的下方向,所述第二探测装置与疑似障碍在下方向的距离为第二探测距离。When the robot is walking on the ground, the detection direction of the second detection device is set toward the walking ground, which is the above-mentioned downward direction, and the distance between the second detection device and the suspected obstacle in the downward direction is the second detection distance.
如图1所示的机器人行走时越过障碍物的方法包括:The methods of walking over obstacles as shown in Figure 1 include:
步骤1:预设第一探测距离值、第一翻越距离值、预设第一粗糙面阈值、第一跨越距离值、第二翻越距离值、第一间距值、第二探测距离值、第一预定运动轨迹;Step 1: Preset the first detection distance value, the first overrunning distance value, the preset first rough surface threshold, the first spanning distance value, the second overrunning distance value, the first distance value, the second detection distance value, the first predetermined motion trajectory;
步骤2:在机器人行走过程中,通过第一探测装置探测机器人在所述第一探测距离值内探测在前方向上是否具有第一非正常信号和/或通过第二探测装置探测在第二探测距离值内下方向是否具有第二非正常信号;Step 2: During the walking process of the robot, use the first detection device to detect whether the robot has a first abnormal signal in the forward direction within the first detection distance value and/or detect through the second detection device at the second detection distance. Whether there is a second abnormal signal in the downward direction of the value;
步骤3:当仅第一探测装置具有第一非正常信号时,机器人停止行走,机器人在前方向上遇到疑似障碍,通过第一探测装置探测疑似障碍获取第一疑似障碍信息,并将第一疑似障碍信息与第一翻越距离值和/或第一粗糙面阈值进行比对判断该疑似障碍的障碍种类,若该疑似障碍的种类为第一可翻越且需要翻越障碍,则使机器人进行第一翻越动作,从而翻越该障碍;Step 3: When only the first detection device has the first abnormal signal, the robot stops walking, and the robot encounters a suspected obstacle in the forward direction. The obstacle information is compared with the first climbing distance value and/or the first rough surface threshold to determine the obstacle type of the suspected obstacle. If the suspected obstacle type is the first surmountable obstacle and the obstacle needs to be surmounted, the robot will perform the first surmounting. action to overcome the obstacle;
当仅第二探测装置具有第二非正常信号时,机器人停止行走,机器人在下方向遇到疑似障碍,通过第一探测装置与第二探测装置配合探测获取第二疑似障碍信息,并将第二疑似障碍信息与第一跨越距离值、第二翻越距离值、第一预定运动轨迹以及第一间距值中的一个或者多个结合进行比对判断该疑似障碍种类;When only the second detection device has the second abnormal signal, the robot stops walking, and the robot encounters a suspected obstacle in the downward direction. The obstacle information is compared with one or more of the first spanning distance value, the second overrunning distance value, the first predetermined motion trajectory and the first distance value to determine the type of the suspected obstacle;
若该疑似障碍的种类为第一可跨越且需要跨越障碍,则使机器人进行第一跨越动作,从而跨越该障碍;If the type of the suspected obstacle is the first surmountable and the obstacle needs to be traversed, make the robot perform the first surmounting action to traverse the obstacle;
若该疑似障碍的种类为第二可翻越且需要翻越障碍,则使机器人进行第二翻越动作,从而翻越该障碍。If the type of the suspected obstacle is the second surmountable obstacle and the obstacle needs to be surmounted, the robot is made to perform a second tumbling action to surmount the obstacle.
在本实施例中,第一探测装置以及第二探测装置均为超声波传感器。采用超声波传感器的好处是,不会由于天气的影响而影响判断。可以理解的是,第一探测装置以及第二探测装置还可以根据需要采用不同的探测装置。In this embodiment, both the first detection device and the second detection device are ultrasonic sensors. The advantage of using ultrasonic sensors is that the judgment will not be affected by the influence of the weather. It can be understood that, the first detection device and the second detection device may also adopt different detection devices as required.
例如,在一个备选实施例中,第一探测装置采用超声波传感器、第二探测装置采用红外传感器,采用这种方式,优点在于,第一探测装置需要测量距离且希望不受到光线、温度等影响。而第二探测装置由于所探测的地面离自身较近,且朝地面检测通常不会太受光线影响。将两者结合,可以达到尽量减少成本,且使各个传感器发挥其优点的好处。For example, in an alternative embodiment, the first detection device adopts an ultrasonic sensor, and the second detection device adopts an infrared sensor. In this way, the advantage is that the first detection device needs to measure the distance and is not expected to be affected by light, temperature, etc. . On the other hand, since the ground detected by the second detection device is closer to itself, and the detection toward the ground is usually not affected by light too much. Combining the two can achieve the benefits of minimizing costs and allowing each sensor to take advantage of its strengths.
上述所指的非正常信号是指与机器人在正常行走时所获得的信号不同的信息。在本实施例中,设定第一探测装置在第一探测距离内没有障碍物时所返回的信号为第一正常信号,与第一正常信号不同的信号为第一非正常信号。The abnormal signal mentioned above refers to information different from the signal obtained by the robot during normal walking. In this embodiment, the signal returned by the first detection device when there is no obstacle within the first detection distance is set as the first normal signal, and the signal different from the first normal signal is set as the first abnormal signal.
设定第二探测装置在第二探测距离内有障碍物(例如地面)时所返回的信号为第二正常信号,与第二正常信号不同的信号为第二非正常信号。The signal returned by the second detection device when there is an obstacle (eg ground) within the second detection distance is set as the second normal signal, and the signal different from the second normal signal is the second abnormal signal.
以第一探测装置举例来说,在机器人行走过程中(以图2所示机器人为例),第一探测装置持续对前方进行探测,在前方第一探测距离值内没有障碍时,第一探测装置会探测到正常信号,将该正常信号传递给机器人,机器人可以判断前方没有疑似障碍,机器人则会继续行走。一旦前方出现障碍,则第一探测装置会探测到非正常信号(以超声波传感器为例,则该非正常信号是由于前方的障碍导致了波的返回从而形成了与正常信号不一样的信号),此时,则可以判断为非正常信号。Taking the first detection device as an example, during the walking process of the robot (taking the robot shown in FIG. 2 as an example), the first detection device continues to detect the front, and when there is no obstacle within the first detection distance in front, the first detection The device will detect a normal signal and transmit the normal signal to the robot. The robot can judge that there is no suspected obstacle ahead, and the robot will continue to walk. Once there is an obstacle ahead, the first detection device will detect an abnormal signal (taking the ultrasonic sensor as an example, the abnormal signal is caused by the return of the wave due to the obstacle ahead, thus forming a signal different from the normal signal), At this time, it can be determined as an abnormal signal.
以第二探测装置举例来说,在机器人行走过程中(以图2所示机器人为例),第二探测装置持续对下方(即机器人行走时的路面)进行探测,当探测持续有正常信号时,可以说明持续有路面供机器人行走,当探测到有非正常信号时,则可以认为下方具有疑似障碍。Taking the second detection device as an example, during the walking process of the robot (take the robot shown in FIG. 2 as an example), the second detection device continues to detect the lower part (that is, the road surface when the robot is walking), and when the detection continues to have a normal signal , it can be shown that there is continuous road for the robot to walk on. When abnormal signals are detected, it can be considered that there is a suspected obstacle below.
从上述可以看出,非正常信号是指与正常信号不同的信号,并不特指某一种或某一类信号,可以认为,只要与机器人正常行走时第一探测装置以及第二探测装置探测到的正常信号(可以是一个值、一个范围或者是机器人本身预设的能够使机器人正常走路时所收到的信号的种类)不同的信号,即为非正常信号。It can be seen from the above that an abnormal signal refers to a signal that is different from a normal signal, and does not specifically refer to a certain type or type of signal. It can be considered that as long as the first detection device and the second detection device detect when the robot is walking normally The received normal signal (which can be a value, a range, or the type of signal that is preset by the robot itself to enable the robot to walk normally) is different from the signal, that is, the abnormal signal.
在本实施例中,步骤3进一步包括:In this embodiment,
当仅第一探测装置具有第一非正常信号时,机器人停止行走(当机器人收到第一非正常信号,从而使机器人停止行走),通过第一探测装置探测疑似障碍获取第一疑似障碍信息,机器人在前方向上遇到疑似障碍,通过第一探测装置探测疑似障碍,并将第一疑似障碍信息与第一翻越距离值和/或第一粗糙面阈值进行比对判断该疑似障碍的障碍种类,若该疑似障碍的种类为斜坡障碍时,使机器人继续行走过该斜坡障碍或使机器人改变行走路径;When only the first detection device has the first abnormal signal, the robot stops walking (when the robot receives the first abnormal signal, so that the robot stops walking), the first detection device detects the suspected obstacle to obtain the first suspected obstacle information, The robot encounters a suspected obstacle in the forward direction, detects the suspected obstacle through the first detection device, and compares the first suspected obstacle information with the first overrunning distance value and/or the first rough surface threshold to determine the obstacle type of the suspected obstacle, If the type of the suspected obstacle is a slope obstacle, make the robot continue to walk through the slope obstacle or change the walking path;
当仅第一探测装置具有第一非正常信号时,机器人停止行走,机器人在前方向上遇到疑似障碍,通过第一探测装置探测疑似障碍,通过第一探测装置探测疑似障碍获取第一疑似障碍信息,并将第一疑似障碍信息与第一翻越距离值和/或第一粗糙面阈值进行比对判断该疑似障碍的障碍种类,若该疑似障碍的种类为不可越障碍时,使机器人改变行走路径。When only the first detection device has the first abnormal signal, the robot stops walking, and the robot encounters a suspected obstacle in the forward direction. The suspected obstacle is detected by the first detection device, and the first suspected obstacle information is obtained by detecting the suspected obstacle through the first detection device. , and compare the first suspected obstacle information with the first overrunning distance value and/or the first rough surface threshold to determine the obstacle type of the suspected obstacle. If the type of the suspected obstacle is an insurmountable obstacle, make the robot change the walking path .
当仅第二探测装置探测在下方向具有第二非正常信号时,机器人停止行走,机器人在下方向遇到疑似障碍,通过第一探测装置与第二探测装置配合探测从而获取第二疑似障碍信息,并将第二疑似障碍信息与第一跨越距离值、第二翻越距离值以及第一间距值中的一个或者多个结合进行比对判断该疑似障碍种类,若该疑似障碍的种类为可行走障碍时,则使机器人继续行走从而走过该可行走障碍或使机器人改变行走路径;When only the second detection device detects that there is a second abnormal signal in the downward direction, the robot stops walking, and the robot encounters a suspected obstacle in the downward direction. Compare the second suspected obstacle information with one or more of the first spanning distance value, the second overrunning distance value and the first distance value to determine the type of the suspected obstacle, if the type of the suspected obstacle is a walkable obstacle , the robot continues to walk so as to walk over the walkable obstacle or change the walking path;
当仅第二探测装置探测在下方向具有第二非正常信号时,机器人停止行走,机器人在下方向遇到疑似障碍,通过第一探测装置与第二探测装置配合探测从而获取第二疑似障碍信息,并将第二疑似障碍信息与第一跨越距离值、第二翻越距离值以及第一间距值中的一个或者多个结合进行比对判断该疑似障碍种类,若该疑似障碍的种类为不可通过障碍时,使机器人改变行走路径。When only the second detection device detects that there is a second abnormal signal in the downward direction, the robot stops walking, and the robot encounters a suspected obstacle in the downward direction. Compare the second suspected obstacle information with one or more of the first spanning distance value, the second overrunning distance value and the first distance value to determine the type of the suspected obstacle, if the type of the suspected obstacle is an impassable obstacle , to make the robot change its walking path.
在本实施例中,当仅第一探测装置具有第一非正常信号时,机器人停止行走,机器人在前方向上遇到疑似障碍,通过第一探测装置探测疑似障碍,通过第一探测装置探测疑似障碍获取第一疑似障碍信息,并将第一疑似障碍信息与第一翻越距离值和/或第一粗糙面阈值进行比对判断该疑似障碍的障碍种类具体为:In this embodiment, when only the first detection device has the first abnormal signal, the robot stops walking, and the robot encounters a suspected obstacle in the forward direction. The suspected obstacle is detected by the first detection device, and the suspected obstacle is detected by the first detection device. Obtain the first suspected obstacle information, and compare the first suspected obstacle information with the first overrunning distance value and/or the first rough surface threshold to determine the obstacle type of the suspected obstacle. Specifically:
使第一探测装置自探测到非正常信号的位置处向上方向做直线运动(以图2为例,使第一探测装置向上直线运动),并且向上方向运动过程中,以每隔预定距离探测一次的方式向前方向进行探测从而获取信号,并判断每次获得的信号是否为第一非正常信号,若是,则继续探测直至判断为否或达到第一探测装置的最大运动距离;若否,则自获取的第一次第一非正常信号至最后一次获取的第一非正常信号之间的第一探测装置所运动的距离为疑似障碍在上方向的测量尺寸以及在探测测量尺寸的同时,第一探测装置能够在每次获得信号时获取第一探测装置与疑似障碍在前方向的距离值为第一疑似障碍信息;Make the first detection device move upward in a straight line from the position where the abnormal signal is detected (take FIG. 2 as an example, make the first detection device move upward in a straight line), and during the upward movement, detect once every predetermined distance. Detect in the forward direction to obtain the signal, and judge whether the obtained signal is the first abnormal signal each time, if so, continue to detect until the judgment is no or the maximum movement distance of the first detection device is reached; if not, then The distance moved by the first detection device from the first acquired first abnormal signal to the last acquired first abnormal signal is the measured size of the suspected obstacle in the upward direction and while detecting the measured size, the first A detection device can obtain the distance between the first detection device and the suspected obstacle in the forward direction as the first suspected obstacle information each time a signal is obtained;
当探测到的疑似障碍在上方向的测量尺寸小于或等于所述第一翻越距离值且第一探测装置与疑似障碍在前方向的距离值不变或具有不连续的变化且每次变化值小于第一粗糙面阈值时,则判断该疑似障碍种类为可跨越且需要跨越障碍;When the measured size of the detected suspected obstacle in the upward direction is less than or equal to the first overrunning distance value and the distance value between the first detection device and the suspected obstacle in the forward direction does not change or has discontinuous changes, and the value of each change is less than or equal to When the first rough surface threshold is reached, it is judged that the type of the suspected obstacle can be crossed and the obstacle needs to be crossed;
当第一探测装置在运动过程中,以每隔预定距离探测一次的方式进行探测时,每次探测到的第一探测装置与疑似障碍在前方向的距离值均有变化,该变化为连续变化且每两次相邻的变化的差值小于预设第一粗糙面阈值时,则判断该疑似障碍种类为斜坡障碍;When the first detection device performs detection in a manner of detecting once every predetermined distance during the movement, the distance between the first detection device and the suspected obstacle in the forward direction detected each time changes, and the change is a continuous change And when the difference between every two adjacent changes is less than the preset first rough surface threshold, it is determined that the type of the suspected obstacle is a slope obstacle;
当探测到的疑似障碍的测量尺寸大于所述第一翻越距离值或达到第一探测装置的最大运动距离时,则判断该疑似障碍种类为不可越障碍。When the measured size of the detected suspected obstacle is greater than the first overrunning distance value or reaches the maximum movement distance of the first detection device, it is determined that the type of the suspected obstacle is an insurmountable obstacle.
举例来说,以图2所示的机器人为例,上述的以每隔预定距离探测一次的方式具体是指:事先试验测得机器人最高越障高度为Xn(即本申请所指的第一翻越距离值),那么为第一探测装置设置n(n=1,2,3…)个临界尺寸:X1,X2,X3…Xn,且X1<X2<X3<…<Xn。控制第一探测装置的位置使其在第一探测装置的最大运动距离范围内进行探测,当第一探测装置在两相邻临界尺寸点Xk-1,Xk(2<k<n)进行探测时,均返回第一非正常信号,说明障碍物尺寸大于Xk,则继续控制第一探测装置升高,在下一个临界尺寸Xk+1处进行测量;如果第一探测装置在临界尺寸Xk处测量时返回第一正常信号,则说明障碍物尺寸在Xk-1和Xk之间(即本申请所指的测量尺寸)。当k不断增大,直至增加到n时,传感器在临界尺寸Xn处测量,如果仍能返回第一非正常信号,说明障碍物尺寸高于Xn。在本实施例中,测量区间分的越小,第一探测装置采集到的数据更多,对障碍物尺寸描述更精确,越障的动作也可以更加流畅。而测量区间分的越大,则第一探测装置可以忽略一些空隙。For example, taking the robot shown in FIG. 2 as an example, the above-mentioned method of detecting once every predetermined distance specifically refers to: the highest obstacle-crossing height of the robot measured in advance is Xn (that is, the first jumping height referred to in this application). distance value), then n (n=1, 2, 3...) critical dimensions are set for the first detection device: X1, X2, X3...Xn, and X1<X2<X3<...<Xn. Control the position of the first detection device to detect within the maximum movement distance of the first detection device, when the first detection device detects at two adjacent critical dimension points Xk-1, Xk (2<k<n) , all return the first abnormal signal, indicating that the size of the obstacle is greater than Xk, then continue to control the first detection device to rise, and measure at the next critical dimension Xk+1; if the first detection device returns when measuring at the critical dimension Xk The first normal signal indicates that the size of the obstacle is between Xk-1 and Xk (that is, the measurement size referred to in this application). When k continues to increase until it increases to n, the sensor measures at the critical dimension Xn, and if it can still return the first abnormal signal, it means that the size of the obstacle is higher than Xn. In this embodiment, the smaller the measurement interval is, the more data the first detection device collects, the more accurate the description of the size of the obstacle, and the smoother the action of crossing the obstacle. And the larger the measurement interval is, the first detection device can ignore some gaps.
机器人最高越障高度为2m,将2m分为四个区间,临界尺寸分别为0,0.5m,1m,1.5m,2m。设一障碍物高度为1.2m,机器人第一探测器探测到障碍物,停止运动,进行障碍物信息探测。在0处探测,返回有效值,探测器移动到下一临界尺寸;在0.5m处探测,返回有效值,探测器移动到1m处;在1m处进行探测,返回有效值,探测器移动到1.5m处:在1.5m处探测,返回无效值,说明障碍物高度在1m-1.5m之间,进行相应的越障动作。The maximum obstacle height of the robot is 2m, and the 2m is divided into four sections. The critical dimensions are 0, 0.5m, 1m, 1.5m, and 2m. Assume that the height of an obstacle is 1.2m, the first detector of the robot detects the obstacle, stops the movement, and detects the obstacle information. Detect at 0, return the effective value, the detector moves to the next critical dimension; detect at 0.5m, return the effective value, the detector moves to 1m; detect at 1m, return the effective value, the detector moves to 1.5 At m: Detect at 1.5m and return an invalid value, indicating that the height of the obstacle is between 1m-1.5m, and perform the corresponding obstacle-crossing action.
设障碍物高度为2.2m,机器人第一探测器探测到障碍物,停止运动,进行障碍物信息探测。在0处探测,返回有效值,探测器移动到下一临界尺寸;在0.5m处探测,返回有效值,探测器移动到1m处;重复上述过程,探测器最终移动到2m处:在2m处进行探测,返回有效值,说明障碍物高度大于2m,超出机器人最大越障高度,进行相应的避障动作。The height of the obstacle is set to 2.2m, the first detector of the robot detects the obstacle, stops the movement, and detects the obstacle information. Detect at 0, return the effective value, the detector moves to the next critical dimension; detect at 0.5m, return the effective value, the detector moves to 1m; repeat the above process, the detector finally moves to 2m: at 2m Perform detection and return a valid value, indicating that the height of the obstacle is greater than 2m, exceeding the maximum obstacle height of the robot, and perform corresponding obstacle avoidance actions.
以每隔预定距离探测一次的方式种的预定距离为机器人本体的高度(图2中上下方向的尺寸)。可以理解的是,还可以是小于机器人本体的高度)(图2中上下方向的尺寸)。当小于机器人的高度时,可以防止机器人由于判断错误而进入到夹层类或者缝隙中。The predetermined distance, which is detected every predetermined distance, is the height of the robot body (the dimension in the up-down direction in FIG. 2 ). It can be understood that it can also be smaller than the height of the robot body) (the dimension in the up-down direction in FIG. 2 ). When it is smaller than the height of the robot, it can prevent the robot from entering the interlayer or the gap due to wrong judgment.
举例来说,当前方疑似障碍为可跨越且需要跨越障碍,更具体地,该可跨越且需要跨越障碍为台阶障碍时,采用本申请的以每隔预定距离探测一次的方式,不仅可以精确的判断出该台阶障碍的高度(即本申请所指的测量尺寸),还可以通过测量区间分的大小,来忽略台阶障碍的朝向机器人方向的一个面可能会有的一些小的缝隙,防止该缝隙影响机器人对该台阶障碍的判断。For example, when the suspected obstacle ahead is an obstacle that can be crossed and needs to be crossed, more specifically, when the obstacle that can be crossed and needs to be crossed is a step obstacle, the method of detecting once every predetermined distance according to the present application is adopted, which not only can accurately detect the obstacle. After judging the height of the step obstacle (that is, the measurement size referred to in this application), it is also possible to ignore some small gaps that may exist on a face of the step obstacle facing the robot direction by measuring the size of the interval to prevent the gap. Affects the robot's judgment of the step obstacle.
并且通过测量区间的划分,还可以防止当跨越该台阶障碍时,台阶障碍上方(以图2所示方向为例)还有障碍,当测量区间划分的比较大时,例如该测量区间大于本申请的机器人本体的高度(图2所示上下方向),即使台阶障碍上方还有障碍,本申请的方法还是可以使机器人跨越该台阶障碍。And through the division of the measurement interval, it can also be prevented that there are obstacles above the step obstacle (taking the direction shown in Figure 2 as an example) when the step obstacle is crossed. When the measurement interval is divided relatively large, for example, the measurement interval is larger than the application The height of the robot body (up and down direction shown in FIG. 2 ), even if there is an obstacle above the step obstacle, the method of the present application can still enable the robot to cross the step obstacle.
在本申请的一个实施例中,本申请进一步包括:In one embodiment of the present application, the present application further includes:
使第一探测装置自探测到非正常信号的位置处向上方向做直线运动,并且向上方向运动过程中,以每隔预定距离探测一次的方式向前方向进行探测从而获取信号,并判断每次获得的信号是否为第一非正常信号,若是,则继续探测直至判断为否或达到第一探测装置的最大运动距离;若否,则自获取的第一次第一非正常信号至最后一次获取的第一非正常信号之间的第一探测装置所运动的距离为疑似障碍在上方向的测量尺寸以及在探测测量尺寸的同时,第一探测装置能够在每次获得信号时获取第一探测装置与疑似障碍在前方向的距离值为第一疑似障碍信息;并且,继续使第一探测装置向上方向做直线运动,并进行一次探测,当该次探测所获得的信号为第一非正常信号时,则判断该疑似障碍为不可越障碍;当该次探测所获得的信号为第一正常信号时,则判断该疑似障碍为可跨越且需要跨越障碍。Make the first detection device move upward in a straight line from the position where the abnormal signal is detected, and during the upward movement, detect in the forward direction by detecting once every predetermined distance to obtain the signal, and judge that each time the signal is obtained. Whether the detected signal is the first abnormal signal, if so, continue to detect until the judgment is no or the maximum movement distance of the first detection device is reached; if not, from the first acquired abnormal signal to the last acquired The distance moved by the first detection device between the first abnormal signals is the measured size of the suspected obstacle in the upward direction and at the same time as the measured size is detected, the first detection device can obtain the first detection device and the first detection device each time a signal is obtained. The distance value of the suspected obstacle in the forward direction is the first suspected obstacle information; and, continue to make the first detection device move in a straight line in the upward direction, and perform a detection, when the signal obtained by this detection is the first abnormal signal, Then it is judged that the suspected obstacle is an insurmountable obstacle; when the signal obtained by the detection is the first normal signal, it is judged that the suspected obstacle can be crossed and the obstacle needs to be crossed.
采用这种方式,还可以进一步避免疑似障碍的上方还有障碍,而上方障碍与疑似障碍之间的空间不够机器人通过。In this way, it can be further avoided that there is an obstacle above the suspected obstacle, and the space between the upper obstacle and the suspected obstacle is not enough for the robot to pass.
在本申请中,通过设置第一粗糙面阈值,可以防止下列情况出现:In the present application, by setting the first rough surface threshold, the following situations can be prevented:
1、由于在现实中,所探测的表面不一定时平滑的,此时,表面上可能会有凸起,当凸起过于大时,会导致机器人无法翻越,此时,应避免该状况出现,通过设置第一粗糙面阈值可以防止该状况出现,例如,当第一探测装置在运动过程中,以每隔预定距离探测一次的方式进行探测时,每次探测到的第一探测装置与疑似障碍在前方向的距离值均有变化,该变化为连续变化且每两次相邻的变化的差值大于预设第一粗糙面阈值时,则判断该疑似障碍种类为不可越障碍。1. In reality, the detected surface is not always smooth. At this time, there may be bumps on the surface. When the bumps are too large, the robot cannot climb over. At this time, this situation should be avoided. This situation can be prevented by setting the first rough surface threshold. For example, when the first detection device performs detection in a manner of detecting once every predetermined distance during the movement, the first detection device detected each time is related to the suspected obstacle. The distance values in the forward direction all change, and the change is continuous and when the difference between every two adjacent changes is greater than the preset first rough surface threshold, it is determined that the type of the suspected obstacle is an insurmountable obstacle.
2、当疑似障碍为斜坡时,事实上不需要机器人进行第一翻越动作,此时,通过第一粗糙面阈值可以判断该疑似障碍是否斜坡,如上述的当第一探测装置在运动过程中,以每隔预定距离探测一次的方式进行探测时,每次探测到的第一探测装置与疑似障碍在前方向的距离值均有变化,该变化为连续变化且每两次相邻的变化的差值相同且均小于预设第一粗糙面阈值时,则判断该疑似障碍种类为斜坡障碍。2. When the suspected obstacle is a slope, in fact, the robot does not need to perform the first overturning action. At this time, it can be judged whether the suspected obstacle is a slope through the first rough surface threshold. As mentioned above, when the first detection device is in motion, When the detection is carried out in the manner of detecting once every predetermined distance, the distance value between the first detection device and the suspected obstacle in the forward direction detected each time changes, and the change is a continuous change and the difference between every two adjacent changes. When the values are the same and both are smaller than the preset first rough surface threshold, it is determined that the type of the suspected obstacle is a slope obstacle.
在本实施例中,当仅第二探测装置探测在下方向具有第二非正常信号时,机器人停止行走,机器人在下方向(图2中下方)遇到疑似障碍,通过第一探测装置与第二探测装置配合探测获取第二疑似障碍信息,并将第二疑似障碍信息与第一跨越距离值、第二翻越距离值、第一预定运动轨迹以及第一间距值中的一个或者多个结合进行比对判断该疑似障碍种类,若该疑似障碍的种类为可行走障碍时,则使机器人继续行走从而走过该可行走障碍或使机器人改变行走路径;In this embodiment, when only the second detection device detects that there is a second abnormal signal in the downward direction, the robot stops walking, and the robot encounters a suspected obstacle in the downward direction (bottom in FIG. 2 ), through the first detection device and the second detection device. The device cooperates with the detection to obtain the second suspected obstacle information, and compares the second suspected obstacle information with one or more combinations of the first spanning distance value, the second climbing distance value, the first predetermined motion trajectory and the first spacing value Determine the type of the suspected obstacle, and if the type of the suspected obstacle is a walkable obstacle, make the robot continue to walk so as to walk over the walkable obstacle or change the walking path of the robot;
当仅第二探测装置探测在下方向具有第二非正常信号时,机器人停止行走,机器人在下方向遇到疑似障碍,通过第一探测装置与第二探测装置配合探测从而获取第二疑似障碍信息,并将第二疑似障碍信息与第一跨越距离值、第二翻越距离值以及第一间距值中的一个或者多个结合进行比对判断该疑似障碍种类,若该疑似障碍的种类为不可通过障碍时,使机器人改变行走路径。When only the second detection device detects that there is a second abnormal signal in the downward direction, the robot stops walking, and the robot encounters a suspected obstacle in the downward direction. Compare the second suspected obstacle information with one or more of the first spanning distance value, the second overrunning distance value and the first distance value to determine the type of the suspected obstacle, if the type of the suspected obstacle is an impassable obstacle , to make the robot change its walking path.
在本实施例中,机器人在停止行走时第一探测装置所在位置为第一位置,第二疑似障碍信息包括第一探测装置在第一位置处探测在下方向是否具有第一非正常信号;使第一探测装置自第一位置向所述第二探测装置方向以第一预定运动轨迹运动,并判断是否能够行走完该第一预定运动轨迹;使第一探测装置在行走完该运动轨迹后以行走完该运动轨迹时所在位置向下方向探测,从而获取此时第一探测装置是否具有第一非正常信号;使第一探测装置自第一位置向所述第二探测装置方向以第二预定运动轨迹运动;并使第一探测装置在运动过程中以每隔预定距离探测一次的方式向下方向进行探测从而获取信号中的一个或多个;In this embodiment, when the robot stops walking, the position of the first detection device is the first position, and the second suspected obstacle information includes whether there is a first abnormal signal in the downward direction detected by the first detection device at the first position; A detection device moves from the first position to the direction of the second detection device with a first predetermined movement trajectory, and judges whether the first predetermined movement trajectory can be completed; When the movement trajectory is completed, the position is detected in the downward direction, so as to obtain whether the first detection device has a first abnormal signal at this time; the first detection device is moved from the first position to the direction of the second detection device in a second predetermined direction. Track movement; make the first detection device detect in the downward direction in a manner of detecting once every predetermined distance during the movement, so as to acquire one or more of the signals;
当仅第二探测装置探测在下方向具有第二非正常信号时,机器人停止行走,机器人在下方向遇到疑似障碍,通过第一探测装置与第二探测装置配合探测获取第二疑似障碍信息,并将第二疑似障碍信息与第一跨越距离值、第二翻越距离值以及第一间距值中的一个或者多个结合进行比对判断该疑似障碍种类具体为:When only the second detection device detects that there is a second abnormal signal in the downward direction, the robot stops walking, and the robot encounters a suspected obstacle in the downward direction. The second suspected obstacle information is compared with one or more of the first spanning distance value, the second spanning distance value and the first distance value to determine the type of the suspected obstacle specifically:
使第一探测装置在所述第一位置处探测在下方向是否具有第一非正常信号,若无,使第一探测装置自第一位置向所述第二探测装置方向以第一预定运动轨迹运动,并判断是否能够行走完该第一预定运动轨迹,若否,则判断该障碍为不可通过障碍;参见图2,在本实施例中,第一预定运动轨迹指图2所示的第一运动支腿第二段向机器人本体方向运动,该运动包括第一探测装置在后方向(图2中左方运动)运动,且包括向后方向运动的同时第一探测装置在下方向(图2中下方运动)位置的改变。Make the first detection device detect whether there is a first abnormal signal in the downward direction at the first position, if not, make the first detection device move from the first position to the direction of the second detection device with a first predetermined movement track , and determine whether the first predetermined movement trajectory can be walked, if not, then the obstacle is judged to be an impassable obstacle; referring to FIG. 2 , in this embodiment, the first predetermined movement trajectory refers to the first movement shown in FIG. 2 . The second segment of the outrigger moves toward the robot body. This movement includes the movement of the first detection device in the backward direction (movement to the left in Figure 2), and the movement in the backward direction while the first detection device is in the downward direction (lower in Figure 2). movement) changes in position.
通过设定第一预定运动轨迹,可以判断该疑似障碍是否是一个不规则形状的向下方向倾斜的形状。若是不规则的形状,由于机器人本体本身具有一定的规则体积,因此不适宜越过该斜坡,因此,则认为该障碍为不可通过障碍。By setting the first predetermined motion trajectory, it can be determined whether the suspected obstacle is an irregular shape inclined downward. If it is an irregular shape, since the robot body itself has a certain regular volume, it is not suitable to cross the slope, therefore, the obstacle is considered as an impassable obstacle.
机器人在停止行走时第一探测装置所在位置为第一位置,使第一探测装置在所述第一位置处探测在下方向是否具有第一非正常信号,若无,则使第一探测装置自第一位置向所述第二探测装置以第一预定运动轨迹运动,并判断是否能够行走完该运动轨迹,若能够行走完该第一预定运动轨迹(则证明在运动轨迹上均没有障碍),则使第一探测装置在行走完该运动轨迹后以行走完该运动轨迹时所在位置向下方向探测,从而获取此时第一探测装置是否具有第一非正常信号,若有,则判断该障碍为不可通过障碍。当具有第一非正常信号,则认为这个疑似障碍在上至下(图2中所述上至下方向)的尺寸较大,在这种情况下,可能是个对于机器人来说是悬崖般的存在,机器人再往前走可能会掉落从而造成机器人的损坏,因此,设置为不可通过障碍。When the robot stops walking, the position of the first detection device is the first position, so that the first detection device detects whether there is a first abnormal signal in the downward direction at the first position. A position moves toward the second detection device with a first predetermined motion trajectory, and judges whether the motion trajectory can be completed. Make the first detection device detect in the downward direction of the position when the movement trajectory is completed after walking the movement trajectory, so as to obtain whether the first detection device has the first abnormal signal at this time, and if so, determine that the obstacle is Impossible to pass obstacles. When there is a first abnormal signal, it is considered that the size of the suspected obstacle is larger from the top to the bottom (the top-to-bottom direction described in Figure 2). In this case, it may be a cliff-like existence for the robot. , the robot may fall and cause damage to the robot if it goes further. Therefore, it is set as an impassable obstacle.
若否,则判断该障碍为可翻越且需要翻越障碍。当不具有第一非正常信号,即该信号为第一正常信号,则说明这个疑似障碍在上至下(图2中所述上至下方向)的尺寸不会超过机器人所能跨越的尺寸,因此,这个时候机器人可以跨越。If not, it is judged that the obstacle is surmountable and the obstacle needs to be surmounted. When there is no first abnormal signal, that is, the signal is the first normal signal, it means that the size of the suspected obstacle in the top-to-bottom (the top-to-bottom direction described in Figure 2) will not exceed the size that the robot can span, Therefore, this time the robot can cross.
在一个备选实施例中,机器人在停止行走时第一探测装置所在位置为第一位置,使第一探测装置在所述第一位置处探测在下方向是否具有第一非正常信号,若有,则使第一探测装置自第一位置向所述第二探测装置方向以第二预定运动轨迹运动,并使第一探测装置在运动过程中以每隔预定距离探测一次的方式向下方向进行探测从而获取信号,并判断每次获得的信号是否为第一正常信号,若获得的信号均为第一正常信号,则判断该疑似障碍为可行走障碍;若获得的信号中仅有一个第一不正常信号,则判断该疑似障碍为可行走障碍;若获得的信号中有两个以上第一不正常信号,则判断该疑似障碍为可跨越且需要跨越障碍。In an alternative embodiment, when the robot stops walking, the position of the first detection device is the first position, so that the first detection device detects whether there is a first abnormal signal in the downward direction at the first position, and if so, Then make the first detection device move from the first position to the direction of the second detection device with a second predetermined motion trajectory, and make the first detection device detect in the downward direction by detecting once every predetermined distance during the movement process. Thereby, a signal is obtained, and it is judged whether the obtained signal is the first normal signal each time. If the obtained signal is the first normal signal, it is judged that the suspected obstacle is a walkable obstacle; if there is only one first abnormal signal in the obtained signal. If the signal is normal, the suspected obstacle is judged to be a walkable obstacle; if there are two or more first abnormal signals in the obtained signal, it is judged that the suspected obstacle can be crossed and the obstacle needs to be crossed.
在该备选实施例中,当机器人在停止行走时第一探测装置所在位置为第一位置,使第一探测装置在所述第一位置处探测在下方向具有第一非正常信号时,说明第一探测装置在探测时能够探测到地面,此时,则使第一探测装置自第一位置向第二探测装置方向以第二预定运动轨迹运动,并使第一探测装置在运动过程中以每隔预定距离探测一次的方式向下方向进行探测从而获取信号。In this alternative embodiment, when the robot stops walking, the position of the first detection device is the first position, and when the first detection device detects a first abnormal signal in the downward direction at the first position, it indicates that the first detection device has a first abnormal signal in the downward direction. A detection device can detect the ground during detection. At this time, the first detection device is moved from the first position to the direction of the second detection device in a second predetermined motion trajectory, and the first detection device is moved every time during the movement process. The signal is acquired by detecting the downward direction by detecting once at a predetermined distance.
本实施例中的第二预定运动轨迹为:第一探测装置向机器人本体方向(同时也是第二探测装置方向)直线靠近,即除了向后方向运动外,在上方向、下方向、左方向以及右方向上的位置均不改变。The second predetermined movement trajectory in this embodiment is: the first detection device approaches the robot body direction (and also the direction of the second detection device) in a straight line, that is, in addition to moving in the backward direction, in the upward direction, downward direction, left direction and The position in the right direction does not change.
采用这种方式,由于在运动的同时使第一探测装置在运动过程中以每隔预定距离探测一次的方式(与上述的每隔预定距离探测一次的方式方法相同)向下方向进行探测从而获取信号,因此,可以探测在这段运动距离过程中地面的情况。例如,若获得的信号均为第一正常信号,则判断该疑似障碍为可行走障碍。此时,可以认为,在整个运动过程中可能均为地面或者即使有裂缝或者凸起(可能裂缝或者凸起正好在两个预定探测距离之间,没有探测到),也不会影响机器人的行走,因此,该疑似障碍为可行走障碍。In this way, since the first detection device detects the downward direction in the manner of detecting once every predetermined distance (same as the above-mentioned method of detecting once every predetermined distance) during the movement, the acquisition of The signal, therefore, can detect what is happening on the ground during this moving distance. For example, if the obtained signals are all the first normal signals, it is determined that the suspected obstacle is a walkable obstacle. At this time, it can be considered that the whole movement process may be the ground or even if there are cracks or bulges (maybe the cracks or bulges are just between the two predetermined detection distances and are not detected), the walking of the robot will not be affected. , therefore, the suspected obstacle is a walkable obstacle.
又例如,若获得的信号中仅有一个第一不正常信号,则判断该疑似障碍为可行走障碍;此时,可以认为,在整个运动过程中除了地面外可能具有一个裂缝或者凸起,且该裂缝或者凸起的在运动方向的距离不大(没有使得第一探测装置连续探测到),因此,也不会影响机器人的行走,因此,该疑似障碍为可行走障碍。For another example, if there is only one first abnormal signal in the obtained signal, it is determined that the suspected obstacle is a walkable obstacle; at this time, it can be considered that there may be a crack or bulge in addition to the ground during the whole movement process, and The distance of the crack or bulge in the moving direction is not large (the first detection device does not continuously detect it), therefore, it does not affect the walking of the robot. Therefore, the suspected obstacle is a walkable obstacle.
又例如,若获得的信号中有两个以上第一不正常信号,则判断该疑似障碍为可跨越且需要跨越障碍。此时,可能具有的裂缝或凸起已经大到了影响机器人行走,或者可能影响到机器人行走,因此,由于在第一探测装置在第一位置处探测在下方向具有第一非正常信号(即能够探测到地面或者其他可供机器人支撑的东西),因此,认为机器人可以跨越该障碍,此时,判断该疑似障碍为可跨越且需要跨越障碍。For another example, if there are more than two first abnormal signals in the obtained signals, it is determined that the suspected obstacle can be crossed and the obstacle needs to be crossed. At this time, the possible cracks or protrusions have been large enough to affect the walking of the robot, or may affect the walking of the robot. Therefore, since the first detection device detects the first abnormal signal in the downward direction at the first position (that is, it can detect to the ground or other things that can be supported by the robot), therefore, it is considered that the robot can cross the obstacle. At this time, it is judged that the suspected obstacle can be crossed and the obstacle needs to be crossed.
在一个优选实施例中,可以在上述的获得的信号中有两个以上第一不正常信号,则判断该疑似障碍为可跨越且需要跨越障碍中,在判断该疑似障碍为可跨越且需要跨越障碍之前进一步包括如下步骤:In a preferred embodiment, there may be two or more first abnormal signals in the obtained signal, then the suspected obstacle is judged to be surmountable and needs to be surmounted, and the suspected obstacle is judged to be surmountable and needs to be surmounted. Further steps prior to the barrier include the following:
使第一探测装置行走完第二运动轨迹后向远离机器人本体的方向运动预定距离(该预定距离能够使第一探测装置至少超过第一位置),此时,可以确保该疑似障碍的尺寸足够本申请的机器人站立,可以使判断更为准确。After the first detection device walks the second motion trajectory, it moves a predetermined distance away from the robot body (the predetermined distance can make the first detection device at least exceed the first position). At this time, it can be ensured that the size of the suspected obstacle is sufficient for this The applied robot stands, which can make the judgment more accurate.
在本实施例中,第一探测装置在下方向与地面之间距离设定有一个原始值,该原始值为机器人在正常行走时第一探测装置与下方向之间的距离。该距离设置为小于机器人本体在上方向至下方向之间的尺寸(即高度尺寸),采用这种设置,可以忽略机器人可以直接行走过的障碍,例如,细小的突起或者小石子之类的障碍。In this embodiment, an original value is set for the distance between the first detection device and the ground in the downward direction, and the original value is the distance between the first detection device and the downward direction when the robot is walking normally. The distance is set to be smaller than the size of the robot body from the upper direction to the lower direction (that is, the height size). With this setting, obstacles that the robot can walk directly through, such as small protrusions or small stones, can be ignored. .
在本实施例中,机器人行走时越过障碍物的方法进一步包括当第一探测装置具有第一非正常信号且第二探测装置具有第二非正常信号时,使机器人改变行走路径。当第一探测装置以及第二探测装置同时有第一非正常信号以及第二非正常信号时,机器人前方情况比较复杂,直接使机器人改变行走路径即可。In this embodiment, the method for the robot to walk over obstacles further includes changing the walking path of the robot when the first detection device has a first abnormal signal and the second detection device has a second abnormal signal. When the first detection device and the second detection device have the first abnormal signal and the second abnormal signal at the same time, the situation in front of the robot is more complicated, and the robot can directly change the walking path.
本申请还提供了一种机器人行走时越过障碍物系统,该机器人行走时越过障碍物系统能够为机器人提供上述的机器人行走时越过障碍物的方法,该机器人行走时越过障碍物系统包括:The present application also provides a system for crossing obstacles when the robot walks, the system for crossing obstacles when the robot walks can provide the above-mentioned method for the robot to cross obstacles when walking, and the system for crossing obstacles when the robot walks includes:
预设模块,预设模块用于预设第一探测距离值、第一翻越距离值、预设第一粗糙面阈值、第一跨越距离值、第二翻越距离值、第一间距值、第二探测距离值、第一运动轨迹;Preset module, the preset module is used to preset the first detection distance value, the first overrunning distance value, the preset first rough surface threshold value, the first spanning distance value, the second overrunning distance value, the first distance value, the second Detection distance value, first motion trajectory;
第一探测装置,第一探测装置用于探测疑似障碍并生成第一信号,所述第一信号包括第一正常信号以及第一非正常信号;a first detection device, the first detection device is used to detect a suspected obstacle and generate a first signal, the first signal includes a first normal signal and a first abnormal signal;
第二探测装置,第二探测装置用于探测第二信号,所述第二信号包括第二正常信号以及第二非正常信号;a second detection device, the second detection device is configured to detect a second signal, the second signal includes a second normal signal and a second abnormal signal;
第一疑似障碍信息生成模块,所述第一疑似障碍信息生成模块用于生成第一疑似障碍信息;a first suspected obstacle information generation module, the first suspected obstacle information generation module is used to generate the first suspected obstacle information;
第二疑似障碍信息生成模块,所述第二疑似障碍信息生成模块用于生成第二疑似障碍信息;a second suspected obstacle information generation module, the second suspected obstacle information generation module is used to generate second suspected obstacle information;
信号接收模块,信号接收模块用于获取第一疑似障碍信息以及第二疑似障碍信息;a signal receiving module, the signal receiving module is used to obtain the first suspected obstacle information and the second suspected obstacle information;
判断模块,判断模块用于接收所述信号接收模块传递的第一疑似障碍信息以及第二疑似障碍信息,并将第一疑似障碍信息与第一翻越距离值和/或第一粗糙面阈值进行比对判断该疑似障碍的障碍种类;以及并将第二疑似障碍信息与第一跨越距离值、第二翻越距离值、第一预定运动轨迹以及第一间距值中的一个或者多个结合进行比对判断该疑似障碍种类;Judging module, the judging module is used to receive the first suspected obstacle information and the second suspected obstacle information transmitted by the signal receiving module, and compare the first suspected obstacle information with the first overrunning distance value and/or the first rough surface threshold value Judging the obstacle type of the suspected obstacle; and comparing the second suspected obstacle information with one or more of the first spanning distance value, the second climbing distance value, the first predetermined motion trajectory and the first distance value. Determine the type of the suspected disorder;
动作命令模块,动作命令模块用于根据所述判断模块所传递的疑似障碍种类向机器人发送执行命令,执行命令包括第一翻越动作的命令、第一跨越动作的命令或第二翻越动作的命令;Action command module, the action command module is used to send an execution command to the robot according to the suspected obstacle type transmitted by the judging module, and the execution command includes the command of the first jumping action, the command of the first jumping action or the command of the second jumping action;
探测装置位置变化命令模块,传感器位置变化命令模块用于向机器人发送第一探测装置位置改变信号。The detection device position change command module, the sensor position change command module is used to send a first detection device position change signal to the robot.
可以理解的是,本申请的判断模块判断的疑似障碍种类包括上述的第一可跨越且需要跨越障碍、第一可翻越且需要翻越障碍、第二可翻越且需要翻越障碍、斜坡障碍、不可越障碍、可行走障碍、不可通过障碍等。It can be understood that the types of suspected obstacles judged by the judgment module of the present application include the above-mentioned first surmountable and required obstacle, first surmountable and surmountable obstacle, second surmountable and surmountable obstacle, slope obstacle, impossibility to surmount. Obstacles, walkable obstacles, impassable obstacles, etc.
采用本申请的机器人行走时越过障碍物系统能够将障碍物分成第一可翻越且需要翻越障碍、第一可跨越且需要跨越障碍以及第二可翻越且需要翻越障碍,并根据障碍物的种类行进相应的动作,相对于现有技术,能够识别更多的障碍物种类,并根据种类进行更多的应对。When the robot walks over the obstacle system of the present application, the obstacles can be divided into the first surmountable and the obstacle to be surmounted, the first surmountable and the obstacle to be surmounted, and the second surmountable and the obstacle to be surmounted, and travel according to the type of the obstacle Corresponding actions, compared with the prior art, can identify more types of obstacles, and perform more responses according to the types.
在本实施例中,第一探测装置以及第二探测装置均为超声波传感器。采用超声波传感器的好处是,不会由于天气的影响而影响判断。可以理解的是,第一探测装置以及第二探测装置还可以根据需要采用不同的探测装置。In this embodiment, both the first detection device and the second detection device are ultrasonic sensors. The advantage of using ultrasonic sensors is that the judgment will not be affected by the influence of the weather. It can be understood that, the first detection device and the second detection device may also adopt different detection devices as required.
例如,在一个备选实施例中,第一探测装置采用超声波传感器、第二探测装置采用红外传感器,采用这种方式,优点在于,第一探测装置需要测量距离且希望不受到光线、温度等影响。而第二探测装置由于所探测的地面离自身较近,且朝地面检测通常不会太受光线影响。将两者结合,可以达到尽量减少成本,且使各个传感器发挥其优点的好处。For example, in an alternative embodiment, the first detection device adopts an ultrasonic sensor, and the second detection device adopts an infrared sensor. In this way, the advantage is that the first detection device needs to measure the distance and is not expected to be affected by light, temperature, etc. . On the other hand, since the ground detected by the second detection device is closer to itself, and the detection toward the ground is usually not affected by light too much. Combining the two can achieve the benefits of minimizing costs and allowing each sensor to take advantage of its strengths.
参见图2,本申请还提供了一种机器人,用于进行上述的机器人行走时越过障碍物的方法,该机器人包括:Referring to FIG. 2, the present application also provides a robot for performing the above-mentioned method for walking over obstacles when the robot walks, the robot comprising:
机器人行走时越过障碍物系统,机器人行走时越过障碍物系统为如上所述的机器人行走时越过障碍物系统;The robot walks over the obstacle system, and the robot walks over the obstacle system is the above-mentioned robot walk over the obstacle system;
机器人本体1,机器人行走时越过障碍物系统至少部分设置在机器人本体1上,机器人本体1上设置有行走装置2,行走装置2能够使机器人以第一行走方式行走;The
第一运动支腿3,第一运动支腿3安装在机器人本体1上,机器人行走时越过障碍物系统中的第一探测装置4以及第二探测装置5安装在第一运动支腿3上;The first moving
第一运动驱动组件,第一运动驱动组件与第一运动支腿3连接,运动驱动组件能够驱动第一运动支腿3运动;The first motion drive assembly, the first motion drive assembly is connected with the
第二运动支腿6,第二运动支腿6安装在机器人本体1上;The second moving
第二运动驱动组件,第二运动驱动组件,第二运动驱动组件与第二运动支腿6连接,第二运动驱动组件能够驱动第二运动支腿6运动;The second motion drive assembly, the second motion drive assembly, the second motion drive assembly is connected with the
总控制器,总控制器分别与第一运动驱动组件、第二运动驱动组件、动作命令模块以及探测装置位置变化命令模块连接,其中,an overall controller, which is respectively connected with the first motion drive assembly, the second motion drive assembly, the motion command module and the detection device position change command module, wherein,
探测装置位置变化命令模块用于将第一探测装置位置改变信号传递给总控制器;The detection device position change command module is used to transmit the first detection device position change signal to the general controller;
动作命令模块用于将第一翻越动作的命令、第一跨越动作的命令或第二翻越动作的命令中的一个传递给总控制器;The action command module is used to transmit one of the command of the first overrunning action, the command of the first overrunning action or the command of the second overrunning action to the general controller;
总控制器用于根据所收到的信号控制第一运动驱动组件和/或第二运动驱动组件工作,从而驱动第一运动支腿和/或第二运动支腿运动;The overall controller is used to control the first motion drive assembly and/or the second motion drive assembly to work according to the received signal, thereby driving the first motion outrigger and/or the second motion outrigger to move;
第一运动支腿运动和/或所述第二运动支腿运动,从而使机器人进行第一翻越动作、第一跨越动作、第二翻越动作或改变第二探测装置位置中的一种。The movement of the first moving leg and/or the movement of the second moving leg causes the robot to perform one of a first jumping action, a first jumping action, a second jumping action or changing the position of the second detection device.
采用本申请的机器人,能够执行多种运动,包括第一翻越动作、第一跨越动作、第二翻越动作或改变第二探测装置位置中的一种。且能够执行多种障碍检测,如上述的第一可翻越且需要翻越障碍、第一可跨越且需要跨越障碍以及第二可翻越且需要翻越障碍,并根据障碍物的种类行进相应的动作,相对于现有技术,能够识别更多的障碍物种类,并根据种类进行更多的应对。Using the robot of the present application, it is possible to perform a variety of motions, including one of a first jumping action, a first jumping action, a second jumping action, or changing the position of the second detection device. And can perform a variety of obstacle detection, such as the above-mentioned first surmountable and need to surmount obstacles, first surmountable and surmountable obstacles, and second surmountable and surmountable obstacles, and take corresponding actions according to the type of obstacles, relatively Compared with the existing technology, more types of obstacles can be identified, and more responses can be made according to the types.
在本实施例中,参见图2及图3,第一运动支腿5位于所述机器人本体的一端,第二运动支腿6位于所述机器人本体的设置有第一运动支腿5的一端相对的另一端,机器人的行走方向为第一运动支腿5至第二运动支腿6的方向(图2中左至右的方向)或第二运动支腿6至第一运动支腿5的方向(图2中右至左的方向)。In this embodiment, referring to FIG. 2 and FIG. 3 , the
参见图2,在本实施例中,第一运动驱动组件包括第一舵机7、第二舵机8以及第三舵机9;Referring to FIG. 2 , in this embodiment, the first motion drive assembly includes a
第一运动支腿3包括第一运动支腿第一段31、第一运动支腿第二段32、第一运动支腿第三段33;The
第一舵机7设置在机器人本体1上;The
第一运动支腿第一段31与所述第一舵机7的输出端连接,且能够绕第一舵机7的输出端旋转;The first section 31 of the first moving leg is connected to the output end of the
第二舵机9设置在第一运动支腿第一段31上;The
第一运动支腿第二段32与所述第二舵机8的输出端连接,第一运动支腿第二段32能够绕所述第二舵机8的输出端旋转;The
第三舵机9设置在所述第一运动支腿第二段32上;The
第一运动支腿第三段33与所述第二舵机9的输出端连接,所述第一运动支腿第三段33能够绕所述第三舵机9的输出端旋转;The
第一探测装置4安装在所述第一运动支腿第三段33上;所述第二探测装置5安装在所述机器人本体1上;The
第二运动驱动组件包括第四舵机10、第五舵机11;The second motion drive assembly includes a
第二运动支腿6包括第二运动支腿第一段61、第二运动支腿第二段62;The
第四舵机10安装在所述机器人本体1上;The
第二运动支腿第一段61与所述第四舵机10的输出端连接,所述第二运动支腿第一段61能够相对所述第四舵机10的输出端旋转;The
第五舵机11安装在所述第二运动支腿第一段61上;The
第二运动支腿第二段62与所述第五舵机11的输出端连接,所述第二运动支腿第二段62能够相对所述第四舵机10的输出端旋转;The
第一滑轮组12,第一滑轮组12安装在所述第一运动支腿第三段33上;The
第二滑轮组13,第二滑轮组13安装在所述第二运动支腿第二段62上;其中,The
第一滑轮组以及所述第二滑轮组配合,从而能够使所述机器人以第二行走方式行走。The cooperation of the first pulley set and the second pulley set enables the robot to walk in a second walking manner.
在本实施例中,第一行走方式为履带式行走方式,具体地,在本实施例中,机器人本体包括底盘系统,底盘系统包括履带、同步带轮、底盘支撑架和履带式底盘驱动电机,同步带轮包括主动轮和从动轮,履带式底盘驱动电机安装在底盘支撑架上,同步带轮的主动轮与履带式底盘驱动电机的输出轴相连,履带与所述同步带轮啮合,带动履带运动。In this embodiment, the first walking mode is a crawler-type walking mode. Specifically, in this embodiment, the robot body includes a chassis system, and the chassis system includes a crawler belt, a synchronous pulley, a chassis support frame, and a crawler-type chassis drive motor, The synchronous pulley includes a driving wheel and a driven wheel. The crawler chassis drive motor is installed on the chassis support frame. The driving wheel of the synchronous pulley is connected with the output shaft of the crawler chassis drive motor. The crawler meshes with the synchronous pulley to drive the crawler. sports.
第二行走方式为轮式行走方式。采用两种不同的方式,可以使机器人在两种不同的方式之间切换,以根据路面选择最为合适的行走方式。另外,在执行跨越、翻越等任务时,需要两种行走方式的共同配合从而形成完善的跨越动作或者翻越动作。The second walking mode is a wheeled walking mode. Using two different ways, the robot can switch between the two different ways to choose the most suitable walking way according to the road surface. In addition, when performing tasks such as spanning and jumping, the cooperation of the two walking modes is required to form a perfect spanning action or jumping action.
相对于现有机器人,本申请的机器人能够应对平地和复杂地形的情况,同时其能够根据需要转变为移动工作平台,具体地,两只长脚能够轻松地抬高和降低车体高度,高度抬高后车体还能够进一步进行移动,将机器人作为移动工作平台,通过两只脚的配合动作随意抬高和降低自身高度来进行勘探和作业,经过部分改造也可以横跨在河流或断崖间来搭造简易桥梁;其中移动工作平台的构建功能,能够在实际勘探中为机器人加装的各种资源采集设施以及勘探传感器的信息采集提供极大的方便,使机器人收集的信息更加精确到位。Compared with the existing robot, the robot of the present application can deal with the situation of flat ground and complex terrain, and at the same time, it can be transformed into a mobile working platform as required. The high rear car body can also move further, using the robot as a mobile work platform, through the coordinated action of the two feet to raise and lower its own height at will for exploration and operation, and after partial transformation, it can also straddle rivers or cliffs. Build a simple bridge; the construction function of the mobile work platform can provide great convenience for the collection of various resource collection facilities installed by the robot and the information collection of exploration sensors in actual exploration, so that the information collected by the robot is more accurate.
本申请的机器人具有障碍物信息探测功能,其能够根据所面临的障碍物的情况采取具体的决策,与传统的避障小车以及避障机器人相比,其更加智能。The robot of the present application has the function of detecting obstacle information, and can take specific decisions according to the situation of the obstacles it faces. Compared with the traditional obstacle avoidance car and obstacle avoidance robot, it is more intelligent.
同时,因为在控制器、传感器、驱动器选型等方面做了大量的工作,所以该发明性能稳定,成本也大大降低。实现了障碍物信息探测、翻越障碍物、跨越沟壑型障碍、自主姿态恢复、移动工作平台等多种功能。At the same time, because a lot of work has been done in the selection of controllers, sensors, and drivers, the invention has stable performance and greatly reduced costs. It realizes various functions such as obstacle information detection, overcoming obstacles, crossing ravine obstacles, autonomous attitude recovery, and mobile working platform.
在本实施例中,本申请的机器人进一步包括角度传感器,该角度传感器设置在机器人本体上,并与总控制器连接,角度传感器可以随时探测机器人的状态,并将所探测的状态信号传递给总控制器,总控制器可以根据角度传感器所传递的信号向各个舵机(第一舵机、第二舵机、第三舵机、第四舵机以及第五舵机)发送工作命令,从而根据需要调整机器人的形态与位置。In this embodiment, the robot of the present application further includes an angle sensor, which is arranged on the robot body and connected to the general controller. The angle sensor can detect the state of the robot at any time, and transmit the detected state signal to the general controller. The controller, the general controller can send work commands to each steering gear (the first steering gear, the second steering gear, the third steering gear, the fourth steering gear and the fifth steering gear) according to the signal transmitted by the angle sensor, so as to The shape and position of the robot need to be adjusted.
参见图2,举例来说,通过角度传感器的探测,发现机器人本体处于翻车状态,则可以通过第一舵机和/或第四舵机工作,从而使第一运动支腿第一段翻转和/或第二运动支腿第一段翻转,以实现机器人翻身从而恢复机器人的正常姿态(以机器人正常行走时的姿态为正常姿态)。Referring to Fig. 2, for example, through the detection of the angle sensor, it is found that the robot body is in a rollover state, then the first steering gear and/or the fourth steering gear can be operated, so that the first segment of the first moving leg is turned over and/or Or the first segment of the second moving leg is turned over, so that the robot can turn over to restore the normal posture of the robot (the posture of the robot when it is walking normally is the normal posture).
在本实施例中,第一舵机、第二舵机、第三舵机、第四舵机以及第五舵机为伺服电机,可以实现更为精确的控制。In this embodiment, the first steering gear, the second steering gear, the third steering gear, the fourth steering gear and the fifth steering gear are servo motors, which can achieve more precise control.
下面以举例的方式对本申请的原理进行详细阐述,可以理解的是,该举例并不构成对本申请的任何限制。The principles of the present application will be described in detail below by way of examples, and it should be understood that the examples do not constitute any limitation to the present application.
参见图2,机器人行走方法包括:Referring to Figure 2, the robot walking method includes:
当障碍物为第一可跨越且需要跨越障碍时,获取第一跨越动作命令;When the obstacle is the first to be crossed and the obstacle needs to be crossed, obtain the first cross action command;
当障碍物为第一可翻越且需要翻越障碍时,获取第一翻越动作命令;以及,When the obstacle is the first surmountable and the obstacle needs to be surmounted, acquiring the first surmounting action command; and,
当障碍物为第二可翻越且需要翻越障碍时,获取第二翻越动作命令;When the obstacle is the second surmountable and the obstacle needs to be surmounted, obtain the second surmounting action command;
根据所获取的第一跨越动作命令进行第一跨越动作;Perform a first spanning action according to the obtained first spanning action command;
根据所获取的第一翻越动作命令进行第一翻越动作;Perform the first overrunning action according to the obtained first overrunning action command;
根据所获取的第二翻越动作命令进行第二翻越动作。The second jumping action is performed according to the acquired second jumping action command.
具体地,第一翻越动作具体包括如下步骤:Specifically, the first overturning action specifically includes the following steps:
步骤101:使第二舵机工作,从而带动第一运动支腿第二段在上方向运动第一预定距离;Step 101: make the second steering gear work, thereby driving the second segment of the first moving leg to move the first predetermined distance in the upward direction;
步骤102:使机器人向前方向运动第二预设距离;Step 102: make the robot move a second preset distance in the forward direction;
步骤103:使第二舵机工作,从而带动第一运动支腿第三段在下方向运动,直至第一运动支腿第三段接触地面;Step 103: make the second steering gear work, thereby driving the third section of the first moving leg to move in the downward direction until the third section of the first moving leg contacts the ground;
步骤104:同时使第二舵机以及第五舵机工作,通过第二运动支腿第二段以及第一运动支腿第二段配合使机器人本体在上方向上运动至第三预设距离;Step 104: make the second steering gear and the fifth steering gear work at the same time, and make the robot body move to the third preset distance in the upward direction through the cooperation of the second segment of the second moving outrigger and the second segment of the first moving outrigger;
步骤105:使机器人向前方向运动至第四预定距离;Step 105: move the robot forward to a fourth predetermined distance;
步骤106:同时使第二舵机以及第五舵机工作,通过第二运动支腿第二段以及第一运动支腿第一段配合使机器人本体在下方向上运动至接触地面。Step 106: Make the second steering gear and the fifth steering gear work at the same time, and make the robot body move in the downward direction until it contacts the ground through the cooperation of the second segment of the second moving leg and the first segment of the first moving leg.
第一跨越动作具体为:The first spanning action is as follows:
步骤201:使第二舵机工作,从而带动第一运动支腿第二段在下方向运动直至第一运动支腿第三段接触地面;Step 201: make the second steering gear work, thereby driving the second segment of the first moving leg to move in the downward direction until the third segment of the first moving leg contacts the ground;
步骤202:同时使第二舵机以及第五舵机工作,通过第二运动支腿第二段以及第一运动支腿第三段配合使机器人本体向上方向运动至第五预设距离;Step 202: make the second steering gear and the fifth steering gear work at the same time, and move the robot body upward to the fifth preset distance through the cooperation of the second segment of the second moving leg and the third segment of the first moving leg;
步骤203:使机器人向前方向运动至第六预定距离;Step 203: move the robot forward to a sixth predetermined distance;
步骤204:同时使第二舵机以及使第五舵机工作,从而使第二运动支腿第二段以及第一运动支腿第一段配合运动,从而使机器人本体向下方向运动至接触地面。Step 204: Make the second steering gear and the fifth steering gear work at the same time, so that the second segment of the second moving leg and the first segment of the first moving leg cooperate to move, so that the robot body moves downward until it touches the ground .
第二翻越动作具体包括如下步骤:The second jumping action specifically includes the following steps:
步骤301:使第二舵机工作,从而带动所述第一运动支腿第二段在下方向运动直至第一运动支腿第三段接触地面;Step 301: make the second steering gear work, thereby driving the second segment of the first moving leg to move in the downward direction until the third segment of the first moving leg contacts the ground;
步骤302:使第五舵机工作,从而带动所述第二运动支腿第二段在下方向运动直至第二运动支腿第二段接触地面;Step 302 : make the fifth steering gear work, thereby driving the second segment of the second moving outrigger to move in the downward direction until the second segment of the second moving outrigger contacts the ground;
步骤303:同时使第二舵机以及第五舵机工作,使第一运动支腿第二段与第二运动支腿第二段配合,使所述机器人本体向上方向运动第七预设距离;Step 303: make the second steering gear and the fifth steering gear work at the same time, make the second segment of the first moving leg cooperate with the second segment of the second moving leg, and make the robot body move upwards by a seventh preset distance;
步骤304:使机器人行走向前方向行走预定距离;Step 304: make the robot walk a predetermined distance in the forward direction;
步骤305:同时使第二舵机以及第五舵机工作,使第一运动支腿第二段与第二运动支腿第二段配合,使所述机器人本体向下方向运动至接触地面。Step 305: Make the second steering gear and the fifth steering gear work at the same time, make the second segment of the first moving leg cooperate with the second segment of the second moving leg, and make the robot body move downward until it touches the ground.
本申请还提供了一种机器人行走时检测障碍物的方法,机器人在地面行走时的第一探测装置探测方向为前方向、机器人在地面行走时与前方向相反的方向为后方向、机器人在地面行走时与地面平行且与所述前方向垂直的方向为左方向或右方向、机器人在地面行走时的与前方向垂直且与左方向垂直的方向为上方向或下方向;The present application also provides a method for detecting obstacles when a robot is walking. The direction parallel to the ground and perpendicular to the front direction when walking is the left direction or the right direction, and the direction perpendicular to the front direction and the left direction when the robot walks on the ground is the up or down direction;
机器人的第一探测装置与疑似障碍在前方向的距离为第一探测距离;The distance between the first detection device of the robot and the suspected obstacle in the forward direction is the first detection distance;
预设第一探测距离值、第一翻越距离值、预设第一粗糙面阈值;Presetting a first detection distance value, a first overrunning distance value, and a preset first rough surface threshold;
在机器人行走过程中,通过第一探测装置探测机器人在所述第一探测距离值内探测在前方向上是否具有第一非正常信号;During the walking process of the robot, the first detection device detects whether the robot has a first abnormal signal in the forward direction within the first detection distance value;
当第一探测装置具有非正常信号时,机器人停止行走,使第一探测装置自探测到第一非正常信号的位置处向上方向做直线运动,并且向上方向运动过程中,以每隔预定距离探测一次的方式向前方向进行探测从而获取信号,并判断每次获得的信号是否为第一非正常信号,若是,则继续探测直至判断为否或达到第一探测装置的最大运动距离;若否,则自获取的第一次第一非正常信号至最后一次获取的第一非正常信号之间的第一探测装置所运动的距离为疑似障碍在上方向的测量尺寸,且在探测测量尺寸的同时,第一探测装置能够在每次获得信号时获取第一探测装置与疑似障碍在前方向的距离值;When the first detection device has an abnormal signal, the robot stops walking, so that the first detection device moves in a straight line upward from the position where the first abnormal signal is detected, and during the upward movement, the robot detects at every predetermined distance. One-time detection is carried out in the forward direction to obtain the signal, and it is judged whether the obtained signal is the first abnormal signal each time. Then, the distance moved by the first detection device from the acquired first abnormal signal to the last acquired first abnormal signal is the measured size of the suspected obstacle in the upward direction, and while detecting the measured size , the first detection device can obtain the distance value between the first detection device and the suspected obstacle in the forward direction each time a signal is obtained;
当探测到的疑似障碍在上方向的测量尺寸小于或等于所述第一翻越距离值且第一探测装置与疑似障碍在前方向的距离值不变或具有不连续的变化且每次变化值小于第一粗糙面阈值时,则判断该疑似障碍种类为可跨越且需要跨越障碍;When the measured size of the detected suspected obstacle in the upward direction is less than or equal to the first overrunning distance value and the distance value between the first detection device and the suspected obstacle in the forward direction does not change or has discontinuous changes, and the value of each change is less than or equal to When the first rough surface threshold is reached, it is judged that the type of the suspected obstacle can be crossed and the obstacle needs to be crossed;
当第一探测装置在运动过程中,以每隔预定距离探测一次的方式进行探测时,每次探测到的第一探测装置与疑似障碍在前方向的距离值均有变化,该变化为连续变化且每两次相邻的变化的差值小于预设第一粗糙面阈值时,则判断该疑似障碍种类为斜坡障碍;When the first detection device performs detection in a manner of detecting once every predetermined distance during the movement, the distance between the first detection device and the suspected obstacle in the forward direction detected each time changes, and the change is a continuous change And when the difference between every two adjacent changes is less than the preset first rough surface threshold, it is determined that the type of the suspected obstacle is a slope obstacle;
当探测到的疑似障碍的测量尺寸大于所述第一翻越距离值时,则判断该疑似障碍种类为不可越障碍。When the measured size of the detected suspected obstacle is greater than the first overrunning distance value, it is determined that the type of the suspected obstacle is an insurmountable obstacle.
本申请还提供了一种机器人行走时检测障碍物的系统,用于上述的机器人行走时检测障碍物的方法,所述机器人行走时检测障碍物的系统包括:The present application also provides a system for detecting obstacles when a robot walks, which is used for the above-mentioned method for detecting obstacles when a robot walks. The system for detecting obstacles when the robot walks includes:
预设模块,所述预设模块用于预设第一探测距离值、第一翻越距离值、预设第一粗糙面阈值;a preset module, the preset module is used to preset a first detection distance value, a first climbing distance value, and a preset first rough surface threshold;
第一探测装置,所述第一探测装置用于探测信号;a first detection device, the first detection device is used to detect a signal;
逻辑控制模块,所述逻辑控制模块用于控制第一探测装置工作逻辑,所述第一探测装置工作逻辑至少包括:在所述第一探测距离值内探测在前方向上是否具有非正常信号;以及,以每隔预定距离探测一次的方式向前方向进行探测从而获取信号;以及第一探测装置能够在每次获得信号时获取第一探测装置与疑似障碍在前方向的距离值;a logic control module, the logic control module is used to control the working logic of the first detection device, the working logic of the first detection device at least includes: detecting whether there is an abnormal signal in the forward direction within the first detection distance value; and , to detect the forward direction in a manner of detecting once every predetermined distance to obtain a signal; and the first detection device can obtain the distance value of the first detection device and the suspected obstacle in the forward direction each time a signal is obtained;
动作逻辑控制模块,所述动作逻辑控制模块用于向机器人传递第一探测装置的运动逻辑,所述运动逻辑至少包括:使第一探测装置自探测到非正常信号的位置处向上方向做直线运动;an action logic control module, the action logic control module is used to transmit the motion logic of the first detection device to the robot, and the motion logic at least includes: making the first detection device perform a straight upward motion from the position where the abnormal signal is detected ;
信号获取模块,所述信号获取模块用于获取第二探测装置所传递的第一正常信号或第一非正常信号,并生成判断信号;a signal acquisition module, which is used to acquire the first normal signal or the first abnormal signal transmitted by the second detection device, and generate a judgment signal;
判断模块,所述判断模块用于接收所述信号获取模块传递的判断信号,并通过判断信号与第一翻越距离值和/或第一粗糙面阈值比对判断该疑似障碍的障碍种类为可跨越且需要跨越障碍、斜坡障碍或不可越障碍中的一种。Judging module, the judging module is used to receive the judgment signal transmitted by the signal acquisition module, and judge that the obstacle type of the suspected obstacle is crossable by comparing the judgment signal with the first overrunning distance value and/or the first rough surface threshold value And it needs to cross one of the obstacles, slope obstacles or insurmountable obstacles.
本申请还提供了一种机器人行走时检测障碍物的方法,机器人在地面行走时的第一探测装置探测方向为前方向、机器人在地面行走时与前方向相反的方向为后方向、机器人在地面行走时与地面平行且与所述前方向垂直的方向为左方向或右方向、机器人在地面行走时的与前方向垂直且与左方向垂直的方向为上方向或下方向;所述机器人行走时越过障碍物的方法包括:The present application also provides a method for detecting obstacles when a robot is walking. When walking, the direction parallel to the ground and perpendicular to the front direction is the left direction or the right direction, and the direction perpendicular to the front direction and the left direction when the robot walks on the ground is the upward direction or the downward direction; when the robot walks Ways to get over obstacles include:
预设第二探测距离、第一跨越距离值、第二翻越距离值、第一间距值、第二探测距离值;Presetting the second detection distance, the first spanning distance value, the second overrunning distance value, the first distance value, and the second detection distance value;
在机器人行走过程中,通过第二探测装置探测在第二探测距离值内下方向是否具有第二非正常信号;During the walking process of the robot, whether there is a second abnormal signal in the downward direction within the second detection distance value is detected by the second detection device;
当仅第二探测装置具有第二非正常信号时,机器人停止行走,机器人在下方向遇到疑似障碍,机器人在停止行走时第一探测装置所在位置为第一位置,使第一探测装置在所述第一位置处探测在下方向是否具有第一非正常信号,若无,使第一探测装置自第一位置向所述第二探测装置方向以第一预定运动轨迹运动,并判断是否能够行走完该运动轨迹,若否,则判断该障碍为不可通过障碍;When only the second detection device has a second abnormal signal, the robot stops walking, the robot encounters a suspected obstacle in the downward direction, and the position of the first detection device when the robot stops walking is the first position, so that the first detection device is in the Detect whether there is a first abnormal signal in the downward direction at the first position, if not, make the first detection device move from the first position to the direction of the second detection device with a first predetermined motion trajectory, and determine whether it can complete the walking. Movement trajectory, if not, judge the obstacle as an impassable obstacle;
机器人在停止行走时第一探测装置所在位置为第一位置,使第一探测装置在所述第一位置处探测在下方向是否具有第一非正常信号,若无,则使第一探测装置自第一位置向所述第二探测装置以第一预定运动轨迹运动,并判断是否能够行走完该运动轨迹,若是,则使第一探测装置在行走完该运动轨迹后以行走完该运动轨迹时所在位置向下方向探测,从而获取此时第一探测装置是否具有第一非正常信号,若是,则判断该障碍为不可通过障碍;若否,则判断该障碍为可翻越且需要翻越障碍;When the robot stops walking, the position of the first detection device is the first position, so that the first detection device detects whether there is a first abnormal signal in the downward direction at the first position. A position moves toward the second detection device with a first predetermined movement trajectory, and judges whether the movement trajectory can be completed. The position is detected in the downward direction, so as to obtain whether the first detection device has a first abnormal signal at this time, and if so, it is determined that the obstacle is an impassable obstacle;
机器人在停止行走时第一探测装置所在位置为第一位置,使第一探测装置在所述第一位置处探测在下方向是否具有第一非正常信号,若有,则使第一探测装置自第一位置向所述第二探测装置方向以第二预定运动轨迹运动,并使第二探测装置在运动过程中以每隔预定距离探测一次的方式向下方向进行探测从而获取信号,并判断每次获得的信号是否为第一正常信号,若获得的信号均为第一正常信号,则判断该疑似障碍为可行走障碍;若获得的信号中仅有一个第一非正常信号,则判断该疑似障碍为可行走障碍;若获得的信号中有两个以上第一非正常信号,则判断该疑似障碍为可跨越且需要跨越障碍。When the robot stops walking, the position of the first detection device is the first position, so that the first detection device detects whether there is a first abnormal signal in the downward direction at the first position. A position moves in the direction of the second detection device with a second predetermined movement track, and the second detection device detects the downward direction in a manner of detecting once every predetermined distance during the movement process to obtain a signal, and judges that each time Whether the obtained signal is the first normal signal, if all the obtained signals are the first normal signal, the suspected obstacle is judged to be a walkable obstacle; if there is only one first abnormal signal in the obtained signal, the suspected obstacle is judged It is a walkable obstacle; if there are more than two first abnormal signals in the obtained signals, it is determined that the suspected obstacle can be crossed and the obstacle needs to be crossed.
本申请还提供了一种机器人行走时检测障碍物的系统,用于上述的其特征在于,所述机器人行走时检测障碍物的系统包括:The application also provides a system for detecting obstacles when a robot is walking, which is used for the above-mentioned features. The system for detecting obstacles when the robot is walking includes:
预设模块,所述预设模块用于预设第二探测距离、第一跨越距离值、第二翻越距离值、第一间距值、第二探测距离值;a preset module, the preset module is used to preset a second detection distance, a first spanning distance value, a second overrunning distance value, a first spacing value, and a second detection distance value;
第二探测装置,所述第二探测装置用于探测信号;a second detection device, the second detection device is used to detect a signal;
第一探测装置,第一探测装置用于探测信号;a first detection device, the first detection device is used to detect the signal;
第一探测装置逻辑控制模块,第一探测装置逻辑控制模块用于为第一探测装置提供第一工作逻辑,第一工作逻辑至少包括使第二探测装置在运动过程中以每隔预定距离探测一次的方式向下方向进行探测从而获取信号;The first detection device logic control module, the first detection device logic control module is used to provide the first detection device with a first working logic, and the first working logic at least includes making the second detection device detect at every predetermined distance during the movement process. The way to detect in the downward direction to obtain the signal;
信号获取模块,信号获取模块用于获取第一探测装置所传递的第一信号和第二探测装置所传递第二信号;所述第一信号包括第一正常信号以及第二非正常信号;所述第二信号包括第二正常信号以及第二非正常信号;a signal acquisition module, which is used for acquiring the first signal transmitted by the first detection device and the second signal transmitted by the second detection device; the first signal includes a first normal signal and a second abnormal signal; the The second signal includes a second normal signal and a second abnormal signal;
判断模块,判断模块用于接收信号获取模块传递的第一信号以及第二信号,并根据第一信号与第一翻越距离值和/或第一粗糙面阈值判断该疑似障碍的障碍种类为可跨越且需要跨越障碍、斜坡障碍或不可越障碍中的一种。Judging module, the judging module is used to receive the first signal and the second signal transmitted by the signal acquisition module, and according to the first signal and the first overrunning distance value and/or the first rough surface threshold value, judge that the obstacle type of the suspected obstacle is crossable And it needs to cross one of the obstacles, slope obstacles or insurmountable obstacles.
最后需要指出的是:以上实施例仅用以说明本发明的技术方案,而非对其限制。尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。Finally, it should be pointed out that the above embodiments are only used to illustrate the technical solutions of the present invention, but not to limit them. Although the present invention has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that: it is still possible to modify the technical solutions described in the foregoing embodiments, or perform equivalent replacements to some of the technical features; and these Modifications or substitutions do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the embodiments of the present invention.
Claims (2)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010569310.0A CN111766877B (en) | 2018-06-27 | 2018-06-27 | a robot |
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010569310.0A CN111766877B (en) | 2018-06-27 | 2018-06-27 | a robot |
| CN201810676646.XA CN108873900B (en) | 2018-06-27 | 2018-06-27 | A method for walking over obstacles when a robot walks |
Related Parent Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201810676646.XA Division CN108873900B (en) | 2018-06-27 | 2018-06-27 | A method for walking over obstacles when a robot walks |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111766877A true CN111766877A (en) | 2020-10-13 |
| CN111766877B CN111766877B (en) | 2021-08-31 |
Family
ID=64295200
Family Applications (2)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010569310.0A Active CN111766877B (en) | 2018-06-27 | 2018-06-27 | a robot |
| CN201810676646.XA Active CN108873900B (en) | 2018-06-27 | 2018-06-27 | A method for walking over obstacles when a robot walks |
Family Applications After (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201810676646.XA Active CN108873900B (en) | 2018-06-27 | 2018-06-27 | A method for walking over obstacles when a robot walks |
Country Status (1)
| Country | Link |
|---|---|
| CN (2) | CN111766877B (en) |
Families Citing this family (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109674404B (en) * | 2019-01-26 | 2021-08-10 | 深圳市云鼠科技开发有限公司 | Obstacle avoidance processing mode of sweeping robot based on free move technology |
| CN112400448B (en) * | 2019-08-20 | 2024-03-08 | 苏州科瓴精密机械科技有限公司 | Automatic walking robot and control method thereof |
| CN111174758B (en) * | 2020-01-18 | 2021-07-16 | 湖南工学院 | A method for robot terrain detection without signal |
| CN113552589A (en) * | 2020-04-01 | 2021-10-26 | 杭州萤石软件有限公司 | Obstacle detection method, robot, and storage medium |
| CN111813103B (en) * | 2020-06-08 | 2021-07-16 | 珊口(深圳)智能科技有限公司 | Control method, control system and storage medium for mobile robot |
| CN111688843A (en) * | 2020-06-29 | 2020-09-22 | 北京云迹科技有限公司 | Wheel type robot presser foot prevention device |
| CN112050813B (en) * | 2020-08-08 | 2022-08-02 | 浙江科聪控制技术有限公司 | Laser navigation system for anti-riot one-zone mobile robot |
| CN114763129B (en) * | 2021-01-11 | 2025-01-28 | 宁波方太厨具有限公司 | Cleaning robot wheel set trapped state identification method and walking system |
| CN113050655A (en) * | 2021-03-29 | 2021-06-29 | 中国南方电网有限责任公司超高压输电公司柳州局 | Method for completing obstacle avoidance of transformer substation robot through laser range finder |
| CN116295388B (en) * | 2023-05-11 | 2023-08-29 | 国网浙江宁波市鄞州区供电有限公司 | Method, device and detector for electric pipeline detection |
Citations (33)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1759992A (en) * | 2005-09-12 | 2006-04-19 | 中国科学技术大学 | Fully autonomous highly mobile robot with composite locomotion mechanism |
| CN101143604A (en) * | 2007-10-31 | 2008-03-19 | 东华大学 | Joint track type walking mechanism |
| CN201140734Y (en) * | 2007-11-19 | 2008-10-29 | 北京交通大学 | A walking wheel-track compound mobile robot |
| CN101758866A (en) * | 2010-02-12 | 2010-06-30 | 李剑川 | Composite wheel-tracked-bended leg obstacle crossing travelling system |
| US20110266076A1 (en) * | 2008-12-09 | 2011-11-03 | Christopher Lynn Morey | Mobile robot systems and methods |
| CN102541068A (en) * | 2011-12-27 | 2012-07-04 | 广东工业大学 | Lower limb motion planning system for biped robot in obstacle crossing |
| CN102642578A (en) * | 2012-04-24 | 2012-08-22 | 北京航空航天大学 | Wheel-legged detector for planet surface detection |
| CN103309351A (en) * | 2013-06-08 | 2013-09-18 | 哈尔滨工程大学 | Maintenance robot obstacle avoidance planning method |
| CN103481964A (en) * | 2013-09-13 | 2014-01-01 | 北京航空航天大学 | Six-leg walking robot capable of crossing obstacles |
| CN103481963A (en) * | 2013-09-13 | 2014-01-01 | 北京航空航天大学 | Two-stage buffer foot device applicable to obstacle crossing robot |
| CN104044658A (en) * | 2014-06-26 | 2014-09-17 | 北京林业大学 | Novel walking mechanism of novel wheel and leg combined type mobile robot |
| US20140326521A1 (en) * | 2011-11-28 | 2014-11-06 | Matia Robotics Mekatronik Sistemler Ar-Ge Mühendi- Slik Yazilim Sanayi Ve Ticaret | Transport device |
| US20150112538A1 (en) * | 2012-06-07 | 2015-04-23 | Samsung Electronics Co., Ltd. | Obstacle sensing module and cleaning robot including the same |
| CN104608838A (en) * | 2014-12-08 | 2015-05-13 | 中国科学院合肥物质科学研究院 | Six foot wheel leg type climbing biomimetic robot |
| CN104875811A (en) * | 2015-06-12 | 2015-09-02 | 洛阳理工学院 | Wheel leg assisted composite obstacle crossing device |
| CN104881027A (en) * | 2015-05-04 | 2015-09-02 | 国家电网公司 | Autonomic barrier-crossing system for wheel-track transformer station inspection robot and control method thereof |
| CN105074600A (en) * | 2013-02-27 | 2015-11-18 | 夏普株式会社 | Surrounding environment recognition device, autonomous mobile system using same, and surrounding environment recognition method |
| CN105151153A (en) * | 2015-09-28 | 2015-12-16 | 哈尔滨工业大学深圳研究生院 | Wheel-foot hybrid mode hexapod robot moving platform |
| CN105480320A (en) * | 2014-10-09 | 2016-04-13 | 无锡津天阳激光电子有限公司 | STM32 control-based exploration robot with six feet and eighteen degrees of freedom |
| CN105843222A (en) * | 2016-03-18 | 2016-08-10 | 北京航空航天大学 | Six-wheel/leg robot compound movement path programming method |
| CN106314577A (en) * | 2016-08-23 | 2017-01-11 | 西安科技大学 | Autonomous obstacle surmounting and avoiding walking control method for six-track and four-swing-arm rescue robot |
| CN106379436A (en) * | 2016-11-24 | 2017-02-08 | 国网山东省电力公司电力科学研究院 | Wheel type obstacle crossing mechanism of transformer substation, robot and method of obstacle crossing mechanism |
| US20170131718A1 (en) * | 2014-07-16 | 2017-05-11 | Ricoh Company, Ltd. | System, machine, and control method |
| US20170270579A1 (en) * | 2016-03-15 | 2017-09-21 | Tier1 Technology, S.L. | Robotic equipment for the location of items in a shop and operating process thereof |
| CN107284551A (en) * | 2017-06-23 | 2017-10-24 | 江苏工程职业技术学院 | A kind of sniffing robot for being applicable complicated landform |
| CN107608362A (en) * | 2017-10-30 | 2018-01-19 | 北京奇虎科技有限公司 | A kind of robot |
| CN107732772A (en) * | 2017-10-31 | 2018-02-23 | 成都意町工业产品设计有限公司 | A kind of power transmission line crusing robot obstacle detouring control system and method |
| CN107765693A (en) * | 2017-10-31 | 2018-03-06 | 成都意町工业产品设计有限公司 | A kind of power transmission line crusing robot traveling control system and method |
| CN207139783U (en) * | 2017-08-09 | 2018-03-27 | 科沃斯机器人股份有限公司 | Self-movement robot |
| CN107894773A (en) * | 2017-12-15 | 2018-04-10 | 广东工业大学 | A kind of air navigation aid of mobile robot, system and relevant apparatus |
| CN107943021A (en) * | 2017-10-19 | 2018-04-20 | 布法罗机器人科技(成都)有限公司 | A kind of adaptive stair activity control system and method |
| CN107985443A (en) * | 2017-12-23 | 2018-05-04 | 长安大学 | A kind of wheeled more ground adaptability vehicles and its obstacle-detouring method |
| CN207326967U (en) * | 2017-10-24 | 2018-05-08 | 西安捷盟信息科技有限公司 | A kind of rescue robot of adaptive landform |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR101245832B1 (en) * | 2006-05-23 | 2013-03-21 | 삼성전자주식회사 | Apparatus and method for detecting obstacle |
| CN104765366B (en) * | 2014-11-27 | 2017-03-01 | 浙江传媒学院 | Realize the service robot of intelligent obstacle detouring |
| CN104808664B (en) * | 2014-11-27 | 2015-11-18 | 无锡美联动线智能科技有限公司 | A kind of method realizing intelligent obstacle detouring |
| CN205721364U (en) * | 2016-04-27 | 2016-11-23 | 河北德普电器有限公司 | Control system is dodged in robot barrier path |
| CN107092260B (en) * | 2017-06-09 | 2020-11-20 | 北京小米移动软件有限公司 | Mobile robot and method for crossing obstacles |
-
2018
- 2018-06-27 CN CN202010569310.0A patent/CN111766877B/en active Active
- 2018-06-27 CN CN201810676646.XA patent/CN108873900B/en active Active
Patent Citations (33)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1759992A (en) * | 2005-09-12 | 2006-04-19 | 中国科学技术大学 | Fully autonomous highly mobile robot with composite locomotion mechanism |
| CN101143604A (en) * | 2007-10-31 | 2008-03-19 | 东华大学 | Joint track type walking mechanism |
| CN201140734Y (en) * | 2007-11-19 | 2008-10-29 | 北京交通大学 | A walking wheel-track compound mobile robot |
| US20110266076A1 (en) * | 2008-12-09 | 2011-11-03 | Christopher Lynn Morey | Mobile robot systems and methods |
| CN101758866A (en) * | 2010-02-12 | 2010-06-30 | 李剑川 | Composite wheel-tracked-bended leg obstacle crossing travelling system |
| US20140326521A1 (en) * | 2011-11-28 | 2014-11-06 | Matia Robotics Mekatronik Sistemler Ar-Ge Mühendi- Slik Yazilim Sanayi Ve Ticaret | Transport device |
| CN102541068A (en) * | 2011-12-27 | 2012-07-04 | 广东工业大学 | Lower limb motion planning system for biped robot in obstacle crossing |
| CN102642578A (en) * | 2012-04-24 | 2012-08-22 | 北京航空航天大学 | Wheel-legged detector for planet surface detection |
| US20150112538A1 (en) * | 2012-06-07 | 2015-04-23 | Samsung Electronics Co., Ltd. | Obstacle sensing module and cleaning robot including the same |
| CN105074600A (en) * | 2013-02-27 | 2015-11-18 | 夏普株式会社 | Surrounding environment recognition device, autonomous mobile system using same, and surrounding environment recognition method |
| CN103309351A (en) * | 2013-06-08 | 2013-09-18 | 哈尔滨工程大学 | Maintenance robot obstacle avoidance planning method |
| CN103481964A (en) * | 2013-09-13 | 2014-01-01 | 北京航空航天大学 | Six-leg walking robot capable of crossing obstacles |
| CN103481963A (en) * | 2013-09-13 | 2014-01-01 | 北京航空航天大学 | Two-stage buffer foot device applicable to obstacle crossing robot |
| CN104044658A (en) * | 2014-06-26 | 2014-09-17 | 北京林业大学 | Novel walking mechanism of novel wheel and leg combined type mobile robot |
| US20170131718A1 (en) * | 2014-07-16 | 2017-05-11 | Ricoh Company, Ltd. | System, machine, and control method |
| CN105480320A (en) * | 2014-10-09 | 2016-04-13 | 无锡津天阳激光电子有限公司 | STM32 control-based exploration robot with six feet and eighteen degrees of freedom |
| CN104608838A (en) * | 2014-12-08 | 2015-05-13 | 中国科学院合肥物质科学研究院 | Six foot wheel leg type climbing biomimetic robot |
| CN104881027A (en) * | 2015-05-04 | 2015-09-02 | 国家电网公司 | Autonomic barrier-crossing system for wheel-track transformer station inspection robot and control method thereof |
| CN104875811A (en) * | 2015-06-12 | 2015-09-02 | 洛阳理工学院 | Wheel leg assisted composite obstacle crossing device |
| CN105151153A (en) * | 2015-09-28 | 2015-12-16 | 哈尔滨工业大学深圳研究生院 | Wheel-foot hybrid mode hexapod robot moving platform |
| US20170270579A1 (en) * | 2016-03-15 | 2017-09-21 | Tier1 Technology, S.L. | Robotic equipment for the location of items in a shop and operating process thereof |
| CN105843222A (en) * | 2016-03-18 | 2016-08-10 | 北京航空航天大学 | Six-wheel/leg robot compound movement path programming method |
| CN106314577A (en) * | 2016-08-23 | 2017-01-11 | 西安科技大学 | Autonomous obstacle surmounting and avoiding walking control method for six-track and four-swing-arm rescue robot |
| CN106379436A (en) * | 2016-11-24 | 2017-02-08 | 国网山东省电力公司电力科学研究院 | Wheel type obstacle crossing mechanism of transformer substation, robot and method of obstacle crossing mechanism |
| CN107284551A (en) * | 2017-06-23 | 2017-10-24 | 江苏工程职业技术学院 | A kind of sniffing robot for being applicable complicated landform |
| CN207139783U (en) * | 2017-08-09 | 2018-03-27 | 科沃斯机器人股份有限公司 | Self-movement robot |
| CN107943021A (en) * | 2017-10-19 | 2018-04-20 | 布法罗机器人科技(成都)有限公司 | A kind of adaptive stair activity control system and method |
| CN207326967U (en) * | 2017-10-24 | 2018-05-08 | 西安捷盟信息科技有限公司 | A kind of rescue robot of adaptive landform |
| CN107608362A (en) * | 2017-10-30 | 2018-01-19 | 北京奇虎科技有限公司 | A kind of robot |
| CN107732772A (en) * | 2017-10-31 | 2018-02-23 | 成都意町工业产品设计有限公司 | A kind of power transmission line crusing robot obstacle detouring control system and method |
| CN107765693A (en) * | 2017-10-31 | 2018-03-06 | 成都意町工业产品设计有限公司 | A kind of power transmission line crusing robot traveling control system and method |
| CN107894773A (en) * | 2017-12-15 | 2018-04-10 | 广东工业大学 | A kind of air navigation aid of mobile robot, system and relevant apparatus |
| CN107985443A (en) * | 2017-12-23 | 2018-05-04 | 长安大学 | A kind of wheeled more ground adaptability vehicles and its obstacle-detouring method |
Non-Patent Citations (12)
| Title |
|---|
| S.KALAIVANAN,等: "Coverage path planning for an autonomous robot specific to agricultural operations", 《2017 INTERNATIONAL CONFERENCE ON INTELLIGENT COMPUTING AND CONTROL (I2C2)》 * |
| WENKAI CHANG,等: "Development of a Power Line Inspection Robot with Hybrid Operation Modes", 《2017 IEEE/RSJ INTERNATIONAL CONFERENCE ON INTELLIGENT ROBOTS AND SYSTEMS (IROS)》 * |
| 丁希仑,等: "一种新型变结构轮腿式机器人的设计与分析", 《中南大学学报(自然科学版)》 * |
| 尤波,等: "六边形六足机器人障碍自识别步态规划", 《哈尔滨理工大学学报》 * |
| 朴春日: "关节履带式机器人设计及运动性能研究", 《中国优秀硕士学位论文全文数据库信息科技辑2013年第07期》 * |
| 杨国田,等: "室内移动服务机器人的避障与运动规划", 《华中科技大学学报(自然科学版)》 * |
| 王云倩,等: "基于CPG控制的六足爬壁机器人自主越障研究", 《哈尔滨工程大学学报》 * |
| 王德新,等: "自主越障机器人在非结构化环境下的越障控制研究", 《制造业自动化》 * |
| 王文格,等: "未知环境下机器人障碍物检测技术", 《中国图象图形学报》 * |
| 赵文才,等: "轮腿交互变换式行走机器人运动学分析", 《机械工程与自动化》 * |
| 陈殿生,等: "轮式腿型机器人的越障分析与仿真", 《北京航空航天大学学报》 * |
| 鲁京立,等: "轮一腿复合移动机器人构型控制及越障策略", 《仪器仪表学报》 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN108873900B (en) | 2020-11-20 |
| CN108873900A (en) | 2018-11-23 |
| CN111766877B (en) | 2021-08-31 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111766877B (en) | a robot | |
| US11660752B2 (en) | Perception and fitting for a stair tracker | |
| US12077229B2 (en) | Stair tracking for modeled and perceived terrain | |
| US11073842B1 (en) | Perception and fitting for a stair tracker | |
| US12094195B2 (en) | Identifying stairs from footfalls | |
| CN110456797B (en) | AGV repositioning system and method based on 2D laser sensor | |
| JP3521860B2 (en) | Vehicle travel path recognition device | |
| CN104881027B (en) | Wheel-track combined Intelligent Mobile Robot active obstacle system and control method | |
| CN101948011B (en) | A Multifunctional Lunar Exploration Robot with Hexapods and Universal Walking | |
| Simmons et al. | Obstacle avoidance and safeguarding for a lunar rover | |
| US20230415343A1 (en) | Automatically trasitioning a robot to an operational mode optimized for particular terrain | |
| CN111077890A (en) | A realization method of agricultural robot based on GPS positioning and automatic obstacle avoidance | |
| CN204557216U (en) | Wheel-track combined Intelligent Mobile Robot active obstacle system | |
| CN114954525A (en) | An unmanned transport vehicle system and operation method suitable for phosphate mining roadway | |
| CN112224300B (en) | A Stable Walking Method for Biped Robots Going Down Steps | |
| CN108873914A (en) | A kind of robot autonomous navigation system and method based on depth image data | |
| WO2020129120A1 (en) | Information processing device and mobile robot | |
| CN114815804B (en) | A bionic robot | |
| CN111267990A (en) | A wheel-leg compound robot motion control equipment, method, device and system | |
| CN104369769A (en) | Steering wheel control method and system thereof | |
| CN103373407B (en) | The intelligent switch method of wheel robot leg and wheel leg | |
| TWI426241B (en) | Self - propelled device for the tracking system | |
| CN116954205A (en) | Robot walking environment detection method, walking control method, robot and chip | |
| CN106950949B (en) | A seven photoelectric switch arc array and method for vehicle edge navigation | |
| CN119217357A (en) | Threshold obstacle and its orientation recognition method, robot control method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| OL01 | Intention to license declared | ||
| OL01 | Intention to license declared |