WO2019080156A1 - Robot moving method and device and robot - Google Patents

Robot moving method and device and robot

Info

Publication number
WO2019080156A1
WO2019080156A1 PCT/CN2017/109185 CN2017109185W WO2019080156A1 WO 2019080156 A1 WO2019080156 A1 WO 2019080156A1 CN 2017109185 W CN2017109185 W CN 2017109185W WO 2019080156 A1 WO2019080156 A1 WO 2019080156A1
Authority
WO
WIPO (PCT)
Prior art keywords
obstacle
robot
sound source
detector
location
Prior art date
Application number
PCT/CN2017/109185
Other languages
French (fr)
Chinese (zh)
Inventor
向勇阳
许仿珍
Original Assignee
深圳市沃特沃德股份有限公司
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 深圳市沃特沃德股份有限公司 filed Critical 深圳市沃特沃德股份有限公司
Publication of WO2019080156A1 publication Critical patent/WO2019080156A1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions

Definitions

  • the obstacle detector is an ultrasonic detector, an infrared detector or a laser detector.
  • the distance between the robot and the obstacle is calculated based on the interval time and the propagation speed of the ultrasonic wave.
  • the obstacle detector comprises at least two groups, each set of obstacle detectors being disposed at different longitudinal positions of the robot.
  • each set of obstacle detectors includes at least two obstacle detectors that are oriented differently.
  • the method further includes:
  • the obtaining, by the sound source localization technology based on the microphone array, the location of the service object includes:
  • the sound source is positioned by the microphone array to obtain the location of the service object.
  • the performing sound source localization of the sound signal by using the microphone array includes:
  • the positional parameter of the sound source determining a location of the service object.
  • a route adjustment module configured to adjust a movement route according to a position of the obstacle to avoid the obstacle.
  • a photographing module for photographing a position of the obstacle
  • a signal receiving unit configured to receive an ultrasonic echo signal through a receiving unit of the ultrasonic probe
  • the distance calculation unit is configured to calculate the distance between the robot and the obstacle according to the interval time and the propagation speed of the ultrasonic wave.
  • the location obtaining module includes:
  • a location calculation subunit configured to calculate a location parameter of the sound source according to the time delay and a distance between the two microphones in the microphone array, where the location parameter of the sound source determines a location of the service object.
  • the position parameter of the sound source includes a polar coordinate of the sound source, and an angle between a polar axis of the polar coordinate system and an x-axis or a y-axis of the rectangular coordinate system, the rectangular coordinate system and the pole The origin of the coordinate system coincides.
  • a method for moving a robot provided by an embodiment of the present invention, before or during the movement
  • the position of the obstacle is detected, and the moving route is adjusted according to the position of the obstacle to avoid the obstacle, thereby realizing the flexible adjustment of the moving route according to the current environment, avoiding collision with the obstacle or stopping the movement due to the obstacle blocking.
  • the flexibility and intelligence level of robot movement thereby improving service efficiency and service quality.
  • the service is automatically provided for the service object, and the control personnel are not required to manually send the control instruction, thereby further improving the intelligence level of the robot.
  • FIG. 1 is a flow chart showing a first embodiment of a method of moving a robot of the present invention
  • FIG. 4 is a schematic diagram of a coordinate system for a sound source positioning structure in an embodiment of the present invention.
  • Figure 8 is a block diagram showing a third embodiment of the mobile device of the robot of the present invention.
  • Figure 10 is a block diagram of the positioning unit of Figure 9;
  • the method includes the following steps:
  • step S11 the robot detects the position of the obstacle using an obstacle detector before or during the movement.
  • the robot can set up one or more obstacle detectors.
  • Each set of obstacle detectors has at least one obstacle detector, preferably at least two obstacle detectors oriented differently, so as to achieve a more precise positioning of the obstacle.
  • each group includes three obstacle detectors, which can be arranged along the left, center, and right lines, or in a triangular arrangement, each facing in a different direction.
  • the obstacle detector as an ultrasonic detector as an example
  • the specific process of the robot using the ultrasonic detector to detect the position of the obstacle is shown in FIG. 2, and includes the following steps:
  • the ultrasonic echo signal When the ultrasonic signal encounters an obstacle, the ultrasonic echo signal is reflected to the robot, and the robot receives the ultrasonic echo signal through the receiving unit of the ultrasonic probe.
  • the robot calculates an interval at which the transmitting unit transmits the ultrasonic signal to the receiving unit to receive the ultrasonic return signal reflected by the obstacle.
  • the timer is started, and when the receiving unit receives the ultrasonic echo signal, the timer stops counting, and when the counting time of the reading timer is obtained, the interval time is obtained. This interval is the time it takes for the ultrasound to travel back and forth between the robot and the obstacle.
  • step S12 when the position of the obstacle is detected, the robot re-plans the entire movement route, or changes part of the movement route (such as moving to an area without an obstacle next to it) to avoid the obstacle and avoid collision with the obstacle or Stop moving because the obstacle blocks the road.
  • the robot re-plans the entire movement route, or changes part of the movement route (such as moving to an area without an obstacle next to it) to avoid the obstacle and avoid collision with the obstacle or Stop moving because the obstacle blocks the road.
  • step S11 the following steps are further included:
  • the microphone array includes four microphones of P1, P2, P3, and P4, and four microphones are sequentially connected to form a square with a side length L, and the sound source is S.
  • a Cartesian coordinate system is constructed based on a square.
  • the Cartesian coordinate system includes x, y, and z axes, and the origin o is in a square.
  • the vertical line is drawn from the sound source S to the xy plane, and the origin o is used as the pole point O.
  • the ray passing through the intersection of the perpendicular line and the xy plane from the pole point O is taken as the X-axis, and the z-axis is taken as the Y-axis, and a polar coordinate system is constructed.
  • OX is the polar axis
  • the angle between OX and OS is the polar angle ⁇
  • the length of the OS is the polar diameter r, that is, the polar coordinate of the sound source S is (r, ⁇ ).
  • the angle between OX and the x-axis or y-axis is thus, the positional parameters r, ⁇ and Then the position of the sound source S is determined. Therefore, just calculate r, ⁇ and The positioning of the sound source S is achieved.
  • the position parameters r, ⁇ of the sound source S can be calculated in the following manner.
  • x(n) is the signal received by the microphone
  • s(n) is the signal from the sound source
  • w(n) is the background noise
  • is the acoustic propagation attenuation signal (generally 1)
  • is the sound source from the sound source
  • R is the autocorrelation function
  • E is the mathematical expectation.
  • r 1 , r 2 , r 3 , and r 4 are distances between the sound source S and the microphones P1, P2, P3, and P4, respectively; r is a distance between the sound source S and the pole point O of the polar coordinate system, that is, a polar diameter; ⁇ is the angle between the polar axis OX and the OS in the polar coordinate system, that is, the polar angle; It is the angle between the polar axis OX of the polar coordinate system and the x-axis or the y-axis in the Cartesian coordinate system; L is the side length of the square formed by the four microphones sequentially connected, C is the sound propagation speed, and x, y, z are The position coordinates of the sound source S in the Cartesian coordinate system. According to formulas (5)-(14), you can get:
  • step S10 when the location of the service object is acquired, the location of the service object is automatically moved to the service object direction.
  • the service object is around, there is no need to move, and only the service object is required.
  • the obstacle detector comprises at least two groups, each set of obstacle detectors being disposed at different longitudinal positions of the robot.
  • the different longitudinal positions are the upper and lower parts, the upper, middle and lower parts, or are divided into more parts in the longitudinal direction.
  • two sets of obstacle detectors can be provided at the head (upper part) and the leg (lower part) of the robot, so that both the upper and lower obstacles can be detected.
  • the ultrasonic detector includes a transmitting unit and a receiving unit.
  • the obstacle detecting module 10 includes a signal transmitting unit 11, a signal receiving unit 12, a time calculating unit 13 and a distance calculating unit 14, wherein: the signal transmitting unit 11 is configured to transmit an ultrasonic signal through a transmitting unit of the ultrasonic probe; the signal receiving unit 12 is configured to receive the ultrasonic echo signal through the receiving unit of the ultrasonic probe; the time calculating unit 13, The interval time for calculating the transmitted ultrasonic signal to the received ultrasonic echo signal; the distance calculating unit 14 is configured to calculate the distance between the robot and the obstacle according to the interval time and the propagation speed of the ultrasonic wave.
  • the location acquisition module 50 includes an acquisition unit 51 and a positioning unit 52, wherein: the acquisition unit 51 is configured to collect a sound signal sent by the service object through the microphone array, and the positioning unit 52 is configured to use the microphone array to pair the sound signal. Perform sound source localization to get the location of the service object.
  • the positioning unit 52 can locate the sound source by the time delay method.
  • the positioning unit 52 includes a delay calculation sub-unit 521 and a position calculation sub-unit 522, as shown in FIG. 10, wherein: the delay calculation sub-unit 521 uses Calculating a time delay of the sounds emitted by the two microphones in the microphone array; the position calculation sub-unit 522 is configured to calculate the position of the sound source according to the delay and the distance between the two microphones in the microphone array
  • the parameter, the position parameter of the sound source determines the location of the service object.
  • the sound source described herein specifically refers to the mouth of the service object, and the position of the sound source is the position of the head of the service object, specifically the position of the mouth.
  • the positional parameter of the sound source includes a polar coordinate of the sound source, and an angle between a projection of the polar axis of the polar coordinate system on the horizontal plane and an X-axis or a Y-axis of the Cartesian coordinate system.
  • the Cartesian coordinate system coincides with the origin of the polar coordinate system, and the polar coordinates include the polar diameter r and the polar angle ⁇ .
  • the microphone array includes four microphones of P1, P2, P3, and P4, and four microphones are sequentially connected to form a square with a side length L, and the sound source is S.
  • a Cartesian coordinate system is constructed based on a square.
  • the Cartesian coordinate system includes x, y, and z axes, and the origin o is in a square.
  • the vertical line is drawn from the sound source S to the xy plane, and the origin o is used as the pole point O.
  • the ray passing through the intersection of the perpendicular line and the xy plane from the pole point O is taken as the X-axis, and the z-axis is taken as the Y-axis, and a polar coordinate system is constructed.
  • OX is the polar axis
  • the angle between OX and OS is the polar angle ⁇
  • the length of the OS is the polar diameter r, that is, the polar coordinate of the sound source S is (r, ⁇ ).
  • the angle between OX and the x-axis or y-axis is thus, the positional parameters r, ⁇ and Then the position of the sound source S is determined. Therefore, just calculate r, ⁇ and The positioning of the sound source S is achieved.
  • the positioning unit 52 can calculate the position parameters r, ⁇ of the sound source S in the following manner.
  • x(n) is the signal received by the microphone
  • s(n) is the signal from the sound source
  • w(n) is the background noise
  • is the acoustic propagation attenuation signal (generally 1)
  • is the sound source from the sound source
  • R is the autocorrelation function
  • E is the mathematical expectation.
  • the delay calculation sub-unit 521 finds ⁇ ij at this time, that is, two microphones are calculated.
  • the delay to the sound emitted by the sound source that is, the delay of the sound source reaching the two microphones.
  • the delay calculation sub-unit 521 calculates that the delay of the sound source S reaching the microphones P1 and P2 is ⁇ 21 , the delay of reaching the microphones P1 and P3 is ⁇ 31 , and the delays of reaching the microphones P1 and P4. For ⁇ 41 .
  • the service is automatically provided for the service object, and the control personnel are not required to manually send the control instruction, thereby further improving the intelligence level of the robot.
  • the present invention also proposes a robot comprising a memory, a processor and at least one application stored in the memory and configured to be executed by the processor, the application being configured to perform a method of moving the robot.
  • the method of moving the robot includes the steps of: detecting an obstacle position by using an obstacle detector, and adjusting a movement route according to the position of the obstacle to avoid the obstacle.
  • the method for moving the robot described in this embodiment is the method for moving the robot according to the above embodiment of the present invention, and details are not described herein again.
  • steps, measures, and solutions in the various operations, methods, and processes that have been discussed in the present invention may be alternated, changed, combined, or deleted. Further, other steps, measures, and schemes of the various operations, methods, and processes that have been discussed in the present invention may be alternated, modified, rearranged, decomposed, combined, or deleted. Further, the steps, measures, and solutions in the prior art having various operations, methods, and processes disclosed in the present invention may also be alternated, changed, rearranged, decomposed, combined, or deleted.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

Disclosed in the invention are a robot moving method, a device and a robot. The method comprises the following steps: detecting a position of an obstacle by using an obstacle detector; and adjusting a moving path according to the position of the obstacle to avoid the obstacle. Provided is the embodiment of the invention is a robot moving method. By detecting the position of the obstacle before moving or during moving and adjusting the moving path according to the position of the obstacle to avoid the obstacle, flexible adjustment of the moving path according to the current environment is realized, and the phenomenon that the robot stops moving because the robot collides with the obstacle or the robot is blocked by the obstacle is avoided. Therefore, the flexibility and the intelligence level of robot movement are improved, and the service efficiency and the service quality are improved.

Description

机器人的移动方法、装置和机器人Robot moving method, device and robot 技术领域Technical field
本发明涉及机器人技术领域,特别是涉及到一种机器人的移动方法、装置和机器人。The present invention relates to the field of robot technology, and in particular to a method, device and robot for moving a robot.
背景技术Background technique
随着机器人技术的发展,机器人逐渐应用到日常生活领域,例如目前出现了应用于服务行业(如餐厅)的服务型机器人。现有的服务型机器人主要提供上菜服务,机器人主要在厨房窗口与餐桌之间往返移动,其移动路线是由控制人员事先设定好的。然而,当遇到比较复杂的环境时,如当机器人的移动路线上出现障碍物时,机器人就有可能与障碍物碰撞或者停止移动直到障碍物消失为止,从而影响服务效率和服务质量。With the development of robotics, robots are gradually being applied to everyday life. For example, service robots that are used in service industries (such as restaurants) have emerged. The existing service robot mainly provides serving service, and the robot mainly moves back and forth between the kitchen window and the dining table, and the moving route is preset by the control personnel. However, when encountering a more complicated environment, such as when an obstacle occurs on the moving route of the robot, the robot may collide with the obstacle or stop moving until the obstacle disappears, thereby affecting service efficiency and service quality.
因此,如何提高服务型机器人的智能化水平,提高移动的灵活性,是当前急需解决的技术问题。Therefore, how to improve the intelligence level of service robots and improve the flexibility of mobility is a technical problem that needs to be solved urgently.
发明内容Summary of the invention
本发明的主要目的为提供一种机器人的移动方法、装置和机器人,旨在提高机器人移动的灵活性和智能化水平,进而提高服务效率和服务质量。The main object of the present invention is to provide a method, device and robot for moving a robot, which aims to improve the flexibility and intelligence level of the robot movement, thereby improving service efficiency and service quality.
为达以上目的,本发明实施例提出一种机器人的移动方法,所述方法包括以下步骤:To achieve the above objective, an embodiment of the present invention provides a method for moving a robot, where the method includes the following steps:
利用障碍物探测器探测障碍物的位置;Using an obstacle detector to detect the location of the obstacle;
根据所述障碍物的位置调整移动路线以避开所述障碍物。The movement route is adjusted according to the position of the obstacle to avoid the obstacle.
可选地,所述利用障碍物探测器探测障碍物的位置的步骤之后还包括:Optionally, the step of detecting the location of the obstacle by using the obstacle detector further includes:
对准所述障碍物的位置拍摄照片;Taking a photo at a position that is aligned with the obstacle;
根据所述障碍物的照片识别所述障碍物和/或精确定位所述障碍物。Identifying the obstacle and/or pinpointing the obstacle based on the photo of the obstacle.
可选地,所述障碍物探测器为超声波探测器、红外探测器或激光探测器。Optionally, the obstacle detector is an ultrasonic detector, an infrared detector or a laser detector.
可选地,当所述障碍物探测器为超声波探测器时,所述利用障碍物探测器探测障碍物的位置的步骤包括: Optionally, when the obstacle detector is an ultrasonic detector, the step of detecting the position of the obstacle by using the obstacle detector comprises:
通过所述超声波探测器的发射单元发射超声波信号;Transmitting an ultrasonic signal through a transmitting unit of the ultrasonic detector;
通过所述超声波探测器的接收单元接收超声波回波信号;Receiving an ultrasonic echo signal through a receiving unit of the ultrasonic probe;
计算发射超声波信号至接收超声波回波信号的间隔时间;Calculating an interval between transmitting the ultrasonic signal to receiving the ultrasonic echo signal;
根据所述间隔时间和超声波的传播速度计算机器人与障碍物的距离。The distance between the robot and the obstacle is calculated based on the interval time and the propagation speed of the ultrasonic wave.
可选地,所述障碍物探测器至少包括两组,每组障碍物探测器设于所述机器人不同的纵向位置。Optionally, the obstacle detector comprises at least two groups, each set of obstacle detectors being disposed at different longitudinal positions of the robot.
可选地,每组障碍物探测器至少包括两个朝向不同的障碍物探测器。Optionally, each set of obstacle detectors includes at least two obstacle detectors that are oriented differently.
可选地,所述方法还包括:Optionally, the method further includes:
通过基于麦克风阵列的声源定位技术获取服务对象的位置;Obtaining a location of the service object by a sound source localization technology based on a microphone array;
根据所述服务对象的位置面向所述服务器对象或向所述服务器对象的方向移动。Moving toward the server object or in the direction of the server object according to the location of the service object.
可选地,所述通过基于麦克风阵列的声源定位技术获取服务对象的位置包括:Optionally, the obtaining, by the sound source localization technology based on the microphone array, the location of the service object includes:
通过麦克风阵列采集服务对象发出的声音信号;Acquiring a sound signal emitted by the service object through the microphone array;
通过所述麦克风阵列对所述声音信号进行声源定位,得到所述服务对象的位置。The sound source is positioned by the microphone array to obtain the location of the service object.
可选地,所述通过所述麦克风阵列对所述声音信号进行声源定位包括:Optionally, the performing sound source localization of the sound signal by using the microphone array includes:
计算出所述麦克风阵列中两个麦克风接收到所述服务对象发出的声音的时延;Calculating a delay of the two microphones in the microphone array receiving the sound emitted by the service object;
根据所述时延和所述麦克风阵列中所述两个麦克风之间的距离计算出声源的位置参数,所述声源的位置参数确定所述服务对象的位置。Calculating a positional parameter of the sound source according to the time delay and a distance between the two microphones in the microphone array, the positional parameter of the sound source determining a location of the service object.
可选地,所述声源的位置参数包括所述声源的极坐标,以及极坐标系的极轴与直角坐标系的x轴或y轴的夹角,所述直角坐标系与所述极坐标系的原点重合。Optionally, the position parameter of the sound source includes a polar coordinate of the sound source, and an angle between a polar axis of the polar coordinate system and an x-axis or a y-axis of the rectangular coordinate system, the rectangular coordinate system and the pole The origin of the coordinate system coincides.
本发明实施例同时提出一种机器人的移动装置,所述装置包括:The embodiment of the invention simultaneously provides a mobile device for a robot, the device comprising:
障碍探测模块,用于利用障碍物探测器探测障碍物的位置;An obstacle detection module for detecting an obstacle position by using an obstacle detector;
路线调整模块,用于根据所述障碍物的位置调整移动路线以避开所述障碍物。a route adjustment module, configured to adjust a movement route according to a position of the obstacle to avoid the obstacle.
可选地,所述装置还包括:Optionally, the device further includes:
拍摄模块,用于对准所述障碍物的位置拍摄照片;a photographing module for photographing a position of the obstacle;
第一处理模块,用于根据所述障碍物的照片识别所述障碍物和/或精确定位 所述障碍物。a first processing module, configured to identify the obstacle and/or accurately locate according to a photo of the obstacle The obstacle.
可选地,当所述障碍物探测器为超声波探测器时,所述障碍探测模块包括:Optionally, when the obstacle detector is an ultrasonic detector, the obstacle detection module includes:
信号发射单元,用于通过所述超声波探测器的发射单元发射超声波信号;a signal transmitting unit, configured to transmit an ultrasonic signal through a transmitting unit of the ultrasonic detector;
信号接收单元,用于通过所述超声波探测器的接收单元接收超声波回波信号;a signal receiving unit, configured to receive an ultrasonic echo signal through a receiving unit of the ultrasonic probe;
时间计算单元,用于计算发射超声波信号至接收超声波回波信号的间隔时间;a time calculation unit, configured to calculate an interval between transmitting the ultrasonic signal and receiving the ultrasonic echo signal;
距离计算单元,用于根据所述间隔时间和超声波的传播速度计算机器人与障碍物的距离。The distance calculation unit is configured to calculate the distance between the robot and the obstacle according to the interval time and the propagation speed of the ultrasonic wave.
可选地,所述装置还包括:Optionally, the device further includes:
位置获取模块,用于通过基于麦克风阵列的声源定位技术获取服务对象的位置;a location acquisition module, configured to acquire a location of the service object by using a sound source localization technology based on a microphone array;
第二处理模块,用于根据所述服务对象的位置面向所述服务器对象或向所述服务器对象的方向移动。And a second processing module, configured to move toward the server object or to the server object according to the location of the service object.
可选地,所述位置获取模块包括:Optionally, the location obtaining module includes:
采集单元,用于通过麦克风阵列采集服务对象发出的声音信号;An acquisition unit, configured to collect, by using a microphone array, a sound signal sent by a service object;
定位单元,用于通过所述麦克风阵列对所述声音信号进行声源定位,得到所述服务对象的位置。And a positioning unit, configured to perform sound source localization on the sound signal by using the microphone array to obtain a location of the service object.
可选地,所述定位单元包括:Optionally, the positioning unit includes:
时延计算子单元,用于计算出所述麦克风阵列中两个麦克风接收到所述声源发出的声音的时延;a delay calculation subunit, configured to calculate a delay of the sounds emitted by the two microphones in the microphone array received by the sound source;
位置计算子单元,用于根据所述时延和所述麦克风阵列中所述两个麦克风之间的距离计算出声源的位置参数,所述声源的位置参数确定所述服务对象的位置。a location calculation subunit, configured to calculate a location parameter of the sound source according to the time delay and a distance between the two microphones in the microphone array, where the location parameter of the sound source determines a location of the service object.
可选地,所述声源的位置参数包括所述声源的极坐标,以及极坐标系的极轴与直角坐标系的x轴或y轴的夹角,所述直角坐标系与所述极坐标系的原点重合。Optionally, the position parameter of the sound source includes a polar coordinate of the sound source, and an angle between a polar axis of the polar coordinate system and an x-axis or a y-axis of the rectangular coordinate system, the rectangular coordinate system and the pole The origin of the coordinate system coincides.
本发明实施例同时提出一种机器人,其包括存储器、处理器和至少一个被存储在所述存储器中并被配置为由所述处理器执行的应用程序,所述应用程序被配置为用于执行前述机器人的移动方法。Embodiments of the present invention also provide a robot including a memory, a processor, and at least one application stored in the memory and configured to be executed by the processor, the application being configured to execute The aforementioned method of moving the robot.
本发明实施例所提供的一种机器人的移动方法,通过在移动前或移动过程 中探测障碍物的位置,根据障碍物的位置调整移动路线以避开障碍物,从而实现了根据当前环境灵活调整移动路线,避免与障碍物碰撞或因障碍物挡路而停止移动。从而提高了机器人移动的灵活性和智能化水平,进而提高了服务效率和服务质量。进一步通过获取服务对象的位置,自动面向服务对象或向服务对象方向移动,从而实现了自动为服务对象提供服务,无需控制人员手动发送控制指令,进一步提高了机器人的智能化水平。A method for moving a robot provided by an embodiment of the present invention, before or during the movement The position of the obstacle is detected, and the moving route is adjusted according to the position of the obstacle to avoid the obstacle, thereby realizing the flexible adjustment of the moving route according to the current environment, avoiding collision with the obstacle or stopping the movement due to the obstacle blocking. Thereby improving the flexibility and intelligence level of robot movement, thereby improving service efficiency and service quality. Further, by obtaining the location of the service object, automatically moving to the service object or moving to the service object, the service is automatically provided for the service object, and the control personnel are not required to manually send the control instruction, thereby further improving the intelligence level of the robot.
附图说明DRAWINGS
图1是本发明的机器人的移动方法第一实施例的流程图;1 is a flow chart showing a first embodiment of a method of moving a robot of the present invention;
图2是本发明实施例中利用超声波探测器探测障碍物的位置的具体流程图;2 is a specific flow chart of detecting the position of an obstacle by using an ultrasonic detector in the embodiment of the present invention;
图3是本发明的机器人的移动方法第二实施例的流程图;Figure 3 is a flow chart showing a second embodiment of the moving method of the robot of the present invention;
图4是本发明实施例中对声源定位构造的坐标体系的示意图;4 is a schematic diagram of a coordinate system for a sound source positioning structure in an embodiment of the present invention;
图5是本发明的机器人的移动装置第一实施例的模块示意图;Figure 5 is a block diagram showing the first embodiment of the mobile device of the robot of the present invention;
图6图5中的障碍物探测模块的模块示意图;Figure 6 is a block diagram of the obstacle detection module of Figure 5;
图7是本发明的机器人的移动装置第二实施例的模块示意图;Figure 7 is a block diagram showing a second embodiment of the mobile device of the robot of the present invention;
图8是本发明的机器人的移动装置第三实施例的模块示意图;Figure 8 is a block diagram showing a third embodiment of the mobile device of the robot of the present invention;
图9是图8中的位置获取模块的模块示意图;9 is a block diagram of a position acquisition module of FIG. 8;
图10是图9中的定位单元的模块示意图;Figure 10 is a block diagram of the positioning unit of Figure 9;
本发明目的的实现、功能特点及优点将结合实施例,参照附图做进一步说明。The implementation, functional features, and advantages of the present invention will be further described in conjunction with the embodiments.
具体实施方式Detailed ways
应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。It is understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention.
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本发明,而不能解释为对本发明的限制。The embodiments of the present invention are described in detail below, and the examples of the embodiments are illustrated in the drawings, wherein the same or similar reference numerals are used to refer to the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the drawings are intended to be illustrative of the invention and are not to be construed as limiting.
本技术领域技术人员可以理解,除非特意声明,这里使用的单数形式“一”、“一个”、“所述”和“该”也可包括复数形式。应该进一步理解的是,本发明的说明书中使用的措辞“包括”是指存在所述特征、整数、步骤、操作、元件和/或组件, 但是并不排除存在或添加一个或多个其他特征、整数、步骤、操作、元件、组件和/或它们的组。应该理解,当我们称元件被“连接”或“耦接”到另一元件时,它可以直接连接或耦接到其他元件,或者也可以存在中间元件。此外,这里使用的“连接”或“耦接”可以包括无线连接或无线耦接。这里使用的措辞“和/或”包括一个或更多个相关联的列出项的全部或任一单元和全部组合。The singular forms "a", "the", "the" and "the" It will be further understood that the phrase "comprising", used in the <Desc/Clms Page number> However, it is not excluded that one or more other features, integers, steps, operations, components, components, and/or combinations thereof are present. It will be understood that when an element is referred to as being "connected" or "coupled" to another element, it can be directly connected or coupled to the other element. Further, "connected" or "coupled" as used herein may include either a wireless connection or a wireless coupling. The phrase "and/or" used herein includes all or any one and all combinations of one or more of the associated listed.
本技术领域技术人员可以理解,除非另外定义,这里使用的所有术语(包括技术术语和科学术语),具有与本发明所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是,诸如通用字典中定义的那些术语,应该被理解为具有与现有技术的上下文中的意义一致的意义,并且除非像这里一样被特定定义,否则不会用理想化或过于正式的含义来解释。Those skilled in the art will appreciate that all terms (including technical and scientific terms) used herein have the same meaning as commonly understood by one of ordinary skill in the art to which the invention belongs, unless otherwise defined. It should also be understood that terms such as those defined in a general dictionary should be understood to have meaning consistent with the meaning in the context of the prior art, and will not be idealized or excessive unless specifically defined as here. The formal meaning is explained.
参照图1,提出本发明机器人的移动方法第一实施例,所述方法包括以下步骤:Referring to FIG. 1, a first embodiment of a method for moving a robot according to the present invention is proposed. The method includes the following steps:
S11、利用障碍物探测器探测障碍物的位置。S11. Detecting the position of the obstacle by using an obstacle detector.
S12、根据障碍物的位置调整移动路线以避开障碍物。S12. Adjust the movement route according to the position of the obstacle to avoid the obstacle.
步骤S11中,机器人在移动之前或移动过程中,利用障碍物探测器探测障碍物的位置。机器人可以设置一个或者多个障碍物探测器。In step S11, the robot detects the position of the obstacle using an obstacle detector before or during the movement. The robot can set up one or more obstacle detectors.
可选地,障碍物探测器至少包括两组,每组障碍物探测器设于机器人不同的纵向位置。不同的纵向位置即上下两个部位,上、中、下三个部位,或者沿纵向分成更多部位。例如,可以在机器人的头部(上部)和腿部(下部)分别设置两组障碍物探测器,从而可以探测到较高和较低的两种障碍物。Optionally, the obstacle detector comprises at least two groups, each set of obstacle detectors being disposed at different longitudinal positions of the robot. The different longitudinal positions are the upper and lower parts, the upper, middle and lower parts, or are divided into more parts in the longitudinal direction. For example, two sets of obstacle detectors can be provided at the head (upper part) and the leg (lower part) of the robot, so that both the upper and lower obstacles can be detected.
每组障碍物探测器至少有一个障碍物探测器,优选至少包括两个朝向不同的障碍物探测器,从而实现对障碍物更精准的定位。例如,每组包括三个障碍物探测器,三个障碍物探测器可以沿左中右直线排布,也可以呈三角形排布,每一个面向不同的方向。Each set of obstacle detectors has at least one obstacle detector, preferably at least two obstacle detectors oriented differently, so as to achieve a more precise positioning of the obstacle. For example, each group includes three obstacle detectors, which can be arranged along the left, center, and right lines, or in a triangular arrangement, each facing in a different direction.
所述障碍物探测器如超声波探测器、红外探测器、激光探测器等。The obstacle detectors are, for example, ultrasonic detectors, infrared detectors, laser detectors, and the like.
以障碍物探测器为超声波探测器为例,机器人利用超声波探测器探测障碍物的位置的具体流程如图2所示,包括以下步骤:Taking the obstacle detector as an ultrasonic detector as an example, the specific process of the robot using the ultrasonic detector to detect the position of the obstacle is shown in FIG. 2, and includes the following steps:
S111、通过超声波探测器的发射单元发射超声波信号。S111. Send an ultrasonic signal through a transmitting unit of the ultrasonic detector.
本发明实施例中,机器人设置有超声波探测器,超声波探测器包括发射单元和接收单元。机器人通过超声波探测器的发射单元发射超声波信号。In the embodiment of the invention, the robot is provided with an ultrasonic detector, and the ultrasonic detector comprises a transmitting unit and a receiving unit. The robot transmits an ultrasonic signal through a transmitting unit of the ultrasonic probe.
S112、通过超声波探测器的接收单元接收超声波回波信号。 S112. Receive an ultrasonic echo signal through a receiving unit of the ultrasonic probe.
当超声波信号遇到障碍物时,则会向机器人反射超声波回波信号,机器人通过超声波探测器的接收单元接收超声波回波信号。When the ultrasonic signal encounters an obstacle, the ultrasonic echo signal is reflected to the robot, and the robot receives the ultrasonic echo signal through the receiving unit of the ultrasonic probe.
S113、计算发射超声波信号至接收超声波回波信号的间隔时间。S113. Calculate an interval between transmitting the ultrasonic signal and receiving the ultrasonic echo signal.
机器人计算发射单元发射超声波信号至接收单元接收到经障碍物反射回来的超声波回报信号的间隔时间。具体实施时,当发射单元发射超声波信号时启动计时器,当接收单元接收到超声波回波信号时计时器停止计时,读取计时器的计时时间则得到间隔时间。该间隔时间即超声波在机器人与障碍物之间往返所花费的时间。The robot calculates an interval at which the transmitting unit transmits the ultrasonic signal to the receiving unit to receive the ultrasonic return signal reflected by the obstacle. In a specific implementation, when the transmitting unit transmits the ultrasonic signal, the timer is started, and when the receiving unit receives the ultrasonic echo signal, the timer stops counting, and when the counting time of the reading timer is obtained, the interval time is obtained. This interval is the time it takes for the ultrasound to travel back and forth between the robot and the obstacle.
S114、根据间隔时间和超声波的传播速度计算机器人与障碍物的距离。S114. Calculate the distance between the robot and the obstacle according to the interval time and the propagation speed of the ultrasonic wave.
机器人根据公式D=ct/2计算出机器人与障碍物的距离,其中D为距离,c为超声波的传播速度,t为前述间隔时间,即超声波在机器人与障碍物之间往返所花费的时间。根据二者的相对距离,机器人就能够确定障碍物的位置。The robot calculates the distance between the robot and the obstacle according to the formula D=ct/2, where D is the distance, c is the propagation speed of the ultrasonic wave, and t is the aforementioned interval time, that is, the time it takes for the ultrasonic wave to travel back and forth between the robot and the obstacle. Based on the relative distance between the two, the robot can determine the position of the obstacle.
当超声波探测器包括不同朝向的多个时,根据每个超声波探测器检测到的距离以及各个超声波探测器的排布关系,就能实现对障碍物更精确的定位。When the ultrasonic detector includes a plurality of different orientations, a more precise positioning of the obstacle can be achieved according to the distance detected by each ultrasonic detector and the arrangement relationship of the respective ultrasonic detectors.
本领域技术人员可以理解,红外探测器、激光探测器与超声波探测器探测障碍物的位置的原理类似,本发明不再一一列举赘述。Those skilled in the art can understand that the principle of detecting the position of the obstacle by the infrared detector, the laser detector and the ultrasonic detector is similar, and the present invention will not be repeated.
进一步地,当探测到障碍物的位置后,机器人还可以对准障碍物的位置拍摄照片,并根据障碍物的照片识别障碍物和/或精确定位障碍物。从而,进一步提高障碍物的定位精度。Further, when the position of the obstacle is detected, the robot can also take a picture of the position of the obstacle and identify the obstacle and/or pinpoint the obstacle based on the photo of the obstacle. Thereby, the positioning accuracy of the obstacle is further improved.
步骤S12中,当探测到障碍物的位置时,机器人则重新规划整个移动路线,或者更改部分移动路线(如往旁边没有障碍物的区域移动),以避开障碍物,避免与障碍物碰撞或因障碍物挡路而停止移动。从而提高了机器人移动的灵活性和智能化水平,进而提高了服务效率和服务质量。In step S12, when the position of the obstacle is detected, the robot re-plans the entire movement route, or changes part of the movement route (such as moving to an area without an obstacle next to it) to avoid the obstacle and avoid collision with the obstacle or Stop moving because the obstacle blocks the road. Thereby improving the flexibility and intelligence level of robot movement, thereby improving service efficiency and service quality.
进一步地,如图3所示,在本发明的机器人的移动方法第二实施例中,步骤S11之前还包括以下步骤:Further, as shown in FIG. 3, in the second embodiment of the method for moving the robot of the present invention, before step S11, the following steps are further included:
S09、通过基于麦克风阵列的声源定位技术获取服务对象的位置。S09. Acquire a location of the service object by using a sound source localization technology based on the microphone array.
S10、根据服务对象的位置向服务器对象的方向移动。S10. Move to the server object according to the location of the service object.
本实施例中,机器人接收到服务对象的服务请求时,则通过基于麦克风阵列的声源定位技术获取服务对象的位置。如接收到“服务员”、“小沃”等关键名称的呼叫时,机器人则认定呼叫关键名称的顾客为服务对象。In this embodiment, when the robot receives the service request of the service object, the location of the service object is obtained by the sound source localization technology based on the microphone array. When receiving a call with a key name such as "waiter" or "xiaowo", the robot determines that the customer calling the key name is the service object.
步骤S09中,机器人通过麦克风阵列采集服务对象发出的声音信号,通过 麦克风阵列对声音信号进行声源定位,得到服务对象的位置。In step S09, the robot collects the sound signal sent by the service object through the microphone array, and passes The microphone array performs sound source localization on the sound signal to obtain the location of the service object.
机器人可以通过时延法对声源进行定位:首先计算出麦克风阵列中两个麦克风接收到服务对象发出的声音的时延;然后根据时延和麦克风阵列中两个麦克风之间的距离计算出声源的位置参数,声源的位置参数则确定了服务对象的位置。实际上,这里所述的声源具体指服务对象的口部,声源的位置即服务对象的头部的位置,具体为口部的位置。The robot can locate the sound source by the delay method: first calculate the delay of the two microphones in the microphone array receiving the sound from the service object; then calculate the sound according to the delay and the distance between the two microphones in the microphone array. The location parameter of the source, the location parameter of the sound source determines the location of the service object. In fact, the sound source described herein specifically refers to the mouth of the service object, and the position of the sound source is the position of the head of the service object, specifically the position of the mouth.
可选地,声源的位置参数包括声源的极坐标,以及极坐标系的极轴在水平面上的投影与直角坐标系的X轴或Y轴的夹角
Figure PCTCN2017109185-appb-000001
且直角坐标系与极坐标系的原点重合,极坐标包括极径r和极角θ。
Optionally, the positional parameter of the sound source includes a polar coordinate of the sound source, and an angle between a projection of the polar axis of the polar coordinate system on the horizontal plane and an X-axis or a Y-axis of the Cartesian coordinate system.
Figure PCTCN2017109185-appb-000001
And the Cartesian coordinate system coincides with the origin of the polar coordinate system, and the polar coordinates include the polar diameter r and the polar angle θ.
如图4所示,假设麦克风阵列包括P1、P2、P3、P4共四个麦克风,且四个麦克风依次连线构成边长为L的正方形,声源为S。以正方形为基准构造直角坐标系,直角坐标系包括x、y、z轴,原点o在正方形内。从声源S向xy平面引垂线,将原点o作为极点O,将从极点O出发经过垂线与xy平面的交点的射线作为X轴,将z轴作为Y轴,构造出一个极坐标系,其中OX为极轴,OX到OS的夹角为极角θ,OS的长度为极径r,即声源S的极坐标为(r,θ)。同时,OX与x轴或y轴的夹角为
Figure PCTCN2017109185-appb-000002
从而,位置参数r、θ与
Figure PCTCN2017109185-appb-000003
则确定了声源S的位置。因此,只要计算出r、θ与
Figure PCTCN2017109185-appb-000004
就实现了对声源S的定位。
As shown in FIG. 4, it is assumed that the microphone array includes four microphones of P1, P2, P3, and P4, and four microphones are sequentially connected to form a square with a side length L, and the sound source is S. A Cartesian coordinate system is constructed based on a square. The Cartesian coordinate system includes x, y, and z axes, and the origin o is in a square. The vertical line is drawn from the sound source S to the xy plane, and the origin o is used as the pole point O. The ray passing through the intersection of the perpendicular line and the xy plane from the pole point O is taken as the X-axis, and the z-axis is taken as the Y-axis, and a polar coordinate system is constructed. Where OX is the polar axis, the angle between OX and OS is the polar angle θ, and the length of the OS is the polar diameter r, that is, the polar coordinate of the sound source S is (r, θ). At the same time, the angle between OX and the x-axis or y-axis is
Figure PCTCN2017109185-appb-000002
Thus, the positional parameters r, θ and
Figure PCTCN2017109185-appb-000003
Then the position of the sound source S is determined. Therefore, just calculate r, θ and
Figure PCTCN2017109185-appb-000004
The positioning of the sound source S is achieved.
具体实施时,可以通过以下方式计算出声源S的位置参数r、θ与
Figure PCTCN2017109185-appb-000005
In the specific implementation, the position parameters r, θ of the sound source S can be calculated in the following manner.
Figure PCTCN2017109185-appb-000005
首先,计算两个麦克风接收到声源发出的声音的时延:First, calculate the delay between the two microphones receiving the sound from the sound source:
xi(n)=ais(n-τi)+wi(n)     (1)x i (n)=a i s(n-τ i )+w i (n) (1)
xj(n)=ajs(n-τj)+wj(n)     (2)x j (n)=a j s(n-τ j )+w j (n) (2)
Rij(τ)=E[xi(n)xj(n-τ)]     (3)R ij (τ)=E[x i (n)x j (n-τ)] (3)
其中,x(n)是麦克风接收到的信号,s(n)是声源发出的信号,w(n)是背景噪声,α是声传播衰减信号(一般取1),τ是声波从声源到麦克风的传播时间,R是自相关函数,E是数学期望。根据公式(1)-(3),得到:Where x(n) is the signal received by the microphone, s(n) is the signal from the sound source, w(n) is the background noise, α is the acoustic propagation attenuation signal (generally 1), and τ is the sound source from the sound source To the propagation time of the microphone, R is the autocorrelation function and E is the mathematical expectation. According to formulas (1)-(3), we get:
Rij(τ)=E[aiajs(n-τi)s(n-τj-τ)]=aiajRss(τ-(τij))    (4)R ij (τ)=E[a i a j s(n-τ i )s(n-τ j -τ)]=a i a j R ss (τ-(τ ij )) (4)
根据公式(4)可知,当τ=τij=τij时,Rij(τ)有最大值,求出此时的τij,即计算出两个麦克风接收到声源发出的声音的时延,即声源到达两个麦克风的时延。如图4所示,分别计算出声源S到达麦克风P1和P2的时延为τ21,到达麦克风P1和P3的时延为τ31,到达麦克风P1和P4的时延为τ41According to formula (4), when τ=τ ijij , R ij (τ) has a maximum value, and τ ij at this time is obtained, that is, the sounds of the two microphones received by the sound source are calculated. The delay, that is, the delay of the sound source reaching the two microphones. As shown in FIG. 4, the delay of the sound source S reaching the microphones P1 and P2 is calculated as τ 21 , the delays of reaching the microphones P1 and P3 are τ 31 , and the delays of reaching the microphones P1 and P4 are τ 41 .
然后,结合图4,有以下几何方程式: Then, in conjunction with Figure 4, there are the following geometric equations:
x2+y2+z2=r2         (5)x 2 +y 2 +z 2 =r 2 (5)
Figure PCTCN2017109185-appb-000006
Figure PCTCN2017109185-appb-000006
Figure PCTCN2017109185-appb-000007
Figure PCTCN2017109185-appb-000007
Figure PCTCN2017109185-appb-000008
Figure PCTCN2017109185-appb-000008
Figure PCTCN2017109185-appb-000009
Figure PCTCN2017109185-appb-000009
Figure PCTCN2017109185-appb-000010
Figure PCTCN2017109185-appb-000010
z=r sinθ          (11)z=r sinθ (11)
Figure PCTCN2017109185-appb-000011
Figure PCTCN2017109185-appb-000011
Figure PCTCN2017109185-appb-000012
Figure PCTCN2017109185-appb-000012
Figure PCTCN2017109185-appb-000013
Figure PCTCN2017109185-appb-000013
其中,r1、r2、r3、r4为声源S分别与麦克风P1、P2、P3、P4的距离;r为声源S与极坐标系的极点O的距离,即极径;,θ为极坐标系中极轴OX到OS的夹角,即极角;
Figure PCTCN2017109185-appb-000014
为极坐标系的极轴OX与直角坐标系中的x轴或y轴的夹角;L为四个麦克风依次连线构成的正方形的边长,C为声音传播速度,x、y、z是声源S在直角坐标系中的位置坐标。根据公式(5)-(14),可得:
Wherein, r 1 , r 2 , r 3 , and r 4 are distances between the sound source S and the microphones P1, P2, P3, and P4, respectively; r is a distance between the sound source S and the pole point O of the polar coordinate system, that is, a polar diameter; θ is the angle between the polar axis OX and the OS in the polar coordinate system, that is, the polar angle;
Figure PCTCN2017109185-appb-000014
It is the angle between the polar axis OX of the polar coordinate system and the x-axis or the y-axis in the Cartesian coordinate system; L is the side length of the square formed by the four microphones sequentially connected, C is the sound propagation speed, and x, y, z are The position coordinates of the sound source S in the Cartesian coordinate system. According to formulas (5)-(14), you can get:
Figure PCTCN2017109185-appb-000015
Figure PCTCN2017109185-appb-000015
Figure PCTCN2017109185-appb-000016
Figure PCTCN2017109185-appb-000016
Figure PCTCN2017109185-appb-000017
Figure PCTCN2017109185-appb-000017
其中,r为极坐标的极径,θ为极坐标的极角,
Figure PCTCN2017109185-appb-000018
为极坐标系的极轴OX与直角坐标系的x轴或y轴的夹角,τ41、τ31、τ21为两个麦克风接收到声源发出的声音的时延,L为四个麦克风依次连线构成的正方形的边长,C为声音的传播速度。从而,根据公式(15)-(16),就能计算出声源S的位置参数r、θ与
Figure PCTCN2017109185-appb-000019
实现对声源S的定位,获取服务对象的位置。
Where r is the polar diameter of the polar coordinates and θ is the polar angle of the polar coordinates.
Figure PCTCN2017109185-appb-000018
The angle between the polar axis OX of the polar coordinate system and the x-axis or the y-axis of the Cartesian coordinate system, τ 41 , τ 31 , τ 21 are the delays of the sounds of the two microphones receiving the sound source, and L is four microphones. The length of the side of the square formed by the sequential connection, and C is the propagation speed of the sound. Thus, according to the formulas (15)-(16), the positional parameters r, θ of the sound source S can be calculated.
Figure PCTCN2017109185-appb-000019
Realize the positioning of the sound source S and obtain the location of the service object.
步骤S10中,当获取了服务对象的位置后,则根据服务对象的位置自动向服务对象方向移动,当然,如果服务对象就在身边时,则无需移动,只需面向服务对象即可。从而实现了自动为服务对象提供服务,无需控制人员手动发送 控制指令,进一步提高了机器人的智能化水平。In step S10, when the location of the service object is acquired, the location of the service object is automatically moved to the service object direction. Of course, if the service object is around, there is no need to move, and only the service object is required. Thereby realizing the service for the service object automatically, without the need for the control personnel to manually send Control instructions further improve the level of intelligence of the robot.
本发明实施例的机器人的移动方法,通过在移动前或移动过程中探测障碍物的位置,根据障碍物的位置调整移动路线以避开障碍物,从而实现了根据当前环境灵活调整移动路线,避免与障碍物碰撞或因障碍物挡路而停止移动。从而提高了机器人移动的灵活性和智能化水平,进而提高了服务效率和服务质量。The method for moving a robot according to an embodiment of the present invention adjusts the position of the obstacle before or during the movement, and adjusts the movement route according to the position of the obstacle to avoid the obstacle, thereby realizing flexible adjustment of the movement route according to the current environment, thereby avoiding Stop moving with obstacles or blocking obstacles. Thereby improving the flexibility and intelligence level of robot movement, thereby improving service efficiency and service quality.
进一步通过获取服务对象的位置,自动面向服务对象或向服务对象方向移动,从而实现了自动为服务对象提供服务,无需控制人员手动发送控制指令,进一步提高了机器人的智能化水平。Further, by obtaining the location of the service object, automatically moving to the service object or moving to the service object, the service is automatically provided for the service object, and the control personnel are not required to manually send the control instruction, thereby further improving the intelligence level of the robot.
参照图5,提出本发明的机器人的移动装置第一实施例,所述装置包括障碍探测模块10和路线调整模块20,其中:障碍探测模块10,用于利用障碍物探测器探测障碍物的位置;路线调整模块20,用于根据障碍物的位置调整移动路线以避开障碍物。Referring to FIG. 5, a first embodiment of a mobile device for a robot of the present invention is proposed. The device includes an obstacle detection module 10 and a route adjustment module 20, wherein the obstacle detection module 10 is configured to detect the position of the obstacle by using an obstacle detector. The route adjustment module 20 is configured to adjust the movement route according to the position of the obstacle to avoid the obstacle.
机器人在移动之前或移动过程中,障碍探测模块10利用障碍物探测器探测障碍物的位置。机器人可以设置一个或者多个障碍物探测器。The obstacle detection module 10 uses the obstacle detector to detect the position of the obstacle before or during the movement. The robot can set up one or more obstacle detectors.
可选地,障碍物探测器至少包括两组,每组障碍物探测器设于机器人不同的纵向位置。不同的纵向位置即上下两个部位,上、中、下三个部位,或者沿纵向分成更多部位。例如,可以在机器人的头部(上部)和腿部(下部)分别设置两组障碍物探测器,从而可以探测到较高和较低的两种障碍物。Optionally, the obstacle detector comprises at least two groups, each set of obstacle detectors being disposed at different longitudinal positions of the robot. The different longitudinal positions are the upper and lower parts, the upper, middle and lower parts, or are divided into more parts in the longitudinal direction. For example, two sets of obstacle detectors can be provided at the head (upper part) and the leg (lower part) of the robot, so that both the upper and lower obstacles can be detected.
每组障碍物探测器至少有一个障碍物探测器,优选至少包括两个朝向不同的障碍物探测器,从而实现对障碍物更精准的定位。例如,每组包括三个障碍物探测器,三个障碍物探测器可以沿左中右直线排布,也可以呈三角形排布,每一个面向不同的方向。Each set of obstacle detectors has at least one obstacle detector, preferably at least two obstacle detectors oriented differently, so as to achieve a more precise positioning of the obstacle. For example, each group includes three obstacle detectors, which can be arranged along the left, center, and right lines, or in a triangular arrangement, each facing in a different direction.
所述障碍物探测器如超声波探测器、红外探测器、激光探测器等。The obstacle detectors are, for example, ultrasonic detectors, infrared detectors, laser detectors, and the like.
以障碍物探测器为超声波探测器为例,超声波探测器包括发射单元和接收单元,此时障碍探测模块10如图6所示,包括信号发射单元11、信号接收单元12、时间计算单元13和距离计算单元14,其中:信号发射单元11,用于通过超声波探测器的发射单元发射超声波信号;信号接收单元12,用于通过超声波探测器的接收单元接收超声波回波信号;时间计算单元13,用于计算发射超声波信号至接收超声波回波信号的间隔时间;距离计算单元14,用于根据间隔时间和超声波的传播速度计算机器人与障碍物的距离。Taking the obstacle detector as an example of the ultrasonic detector, the ultrasonic detector includes a transmitting unit and a receiving unit. At this time, the obstacle detecting module 10 includes a signal transmitting unit 11, a signal receiving unit 12, a time calculating unit 13 and a distance calculating unit 14, wherein: the signal transmitting unit 11 is configured to transmit an ultrasonic signal through a transmitting unit of the ultrasonic probe; the signal receiving unit 12 is configured to receive the ultrasonic echo signal through the receiving unit of the ultrasonic probe; the time calculating unit 13, The interval time for calculating the transmitted ultrasonic signal to the received ultrasonic echo signal; the distance calculating unit 14 is configured to calculate the distance between the robot and the obstacle according to the interval time and the propagation speed of the ultrasonic wave.
具体实施时,当发射单元发射超声波信号时时间计算单元13启动计时器, 当接收单元接收到超声波回波信号时时间计算单元13控制计时器停止计时,并读取计时器的计时时间则得到间隔时间。该间隔时间即超声波在机器人与障碍物之间往返所花费的时间。In a specific implementation, the time calculating unit 13 starts a timer when the transmitting unit transmits the ultrasonic signal, When the receiving unit receives the ultrasonic echo signal, the time calculating unit 13 controls the timer to stop timing, and reads the timer time of the timer to obtain an interval time. This interval is the time it takes for the ultrasound to travel back and forth between the robot and the obstacle.
距离计算单元14根据公式D=ct/2计算出机器人与障碍物的距离,其中D为距离,c为超声波的传播速度,t为前述间隔时间,即超声波在机器人与障碍物之间往返所花费的时间。根据二者的相对距离,障碍物探测器就能够确定障碍物的位置。The distance calculation unit 14 calculates the distance between the robot and the obstacle according to the formula D=ct/2, where D is the distance, c is the propagation speed of the ultrasonic wave, and t is the aforementioned interval time, that is, the ultrasonic wave travels between the robot and the obstacle. time. Based on the relative distance between the two, the obstacle detector can determine the position of the obstacle.
当超声波探测器包括不同朝向的多个时,障碍物探测器根据每个超声波探测器检测到的距离以及各个超声波探测器的排布关系,就能实现对障碍物更精确的定位。When the ultrasonic detector includes a plurality of different orientations, the obstacle detector can achieve more accurate positioning of the obstacle according to the distance detected by each ultrasonic detector and the arrangement relationship of the respective ultrasonic detectors.
本领域技术人员可以理解,红外探测器、激光探测器与超声波探测器探测障碍物的位置的原理类似,本发明不再一一列举赘述。Those skilled in the art can understand that the principle of detecting the position of the obstacle by the infrared detector, the laser detector and the ultrasonic detector is similar, and the present invention will not be repeated.
当探测到障碍物的位置时,路线调整模块20则重新规划整个移动路线,或者更改部分移动路线(如往旁边没有障碍物的区域移动),以避开障碍物,避免与障碍物碰撞或因障碍物挡路而停止移动。从而提高了机器人移动的灵活性和智能化水平,进而提高了服务效率和服务质量。When the position of the obstacle is detected, the route adjustment module 20 re-plans the entire movement route, or changes part of the movement route (such as moving to an area without an obstacle next to it) to avoid the obstacle and avoid collision with the obstacle or cause The obstacle stops and stops moving. Thereby improving the flexibility and intelligence level of robot movement, thereby improving service efficiency and service quality.
进一步地,如图7所示,在本发明机器人的移动装置第二实施例中,该装置还包括拍摄模块30和第一处理模块40,其中:拍摄模块30,用于当探测到障碍物的位置时,对准障碍物的位置拍摄照片;第一处理模块40,用于根据障碍物的照片识别障碍物和/或精确定位障碍物。从而,进一步提高障碍物的定位精度。Further, as shown in FIG. 7, in the second embodiment of the mobile device of the robot of the present invention, the device further includes a photographing module 30 and a first processing module 40, wherein: the photographing module 30 is configured to detect an obstacle In the position, the photo is taken at the position of the obstacle; the first processing module 40 is configured to identify the obstacle according to the photo of the obstacle and/or to accurately locate the obstacle. Thereby, the positioning accuracy of the obstacle is further improved.
进一步地,如图8所示,在本发明机器人的移动装置第三实施例中,该装置还包括位置获取模块50和第二处理器模块,其中:位置获取模块50,用于通过基于麦克风阵列的声源定位技术获取服务对象的位置;第二处理模块60,用于根据服务对象的位置面向服务器对象或向服务器对象的方向移动。Further, as shown in FIG. 8, in the third embodiment of the mobile device of the robot of the present invention, the device further includes a location acquisition module 50 and a second processor module, wherein: the location acquisition module 50 is configured to pass the microphone array The sound source localization technology acquires the location of the service object; the second processing module 60 is configured to move toward the server object or to the server object according to the location of the service object.
本实施例中,位置获取模块50接收到服务对象的服务请求时,则通过基于麦克风阵列的声源定位技术获取服务对象的位置。如接收到“服务员”、“小沃”等关键名称的呼叫时,位置获取模块50则认定呼叫关键名称的顾客为服务对象。In this embodiment, when the location obtaining module 50 receives the service request of the service object, the location of the service object is obtained by the sound source localization technology based on the microphone array. When receiving a call of a key name such as "waiter" or "xiaowo", the location acquisition module 50 determines that the customer calling the key name is the service object.
如图9所示,位置获取模块50包括采集单元51和定位单元52,其中:采集单元51,用于通过麦克风阵列采集服务对象发出的声音信号;定位单元52,用于通过麦克风阵列对声音信号进行声源定位,得到服务对象的位置。 As shown in FIG. 9, the location acquisition module 50 includes an acquisition unit 51 and a positioning unit 52, wherein: the acquisition unit 51 is configured to collect a sound signal sent by the service object through the microphone array, and the positioning unit 52 is configured to use the microphone array to pair the sound signal. Perform sound source localization to get the location of the service object.
定位单元52可以通过时延法对声源进行定位,此时,定位单元52如图10所示,包括时延计算子单元521和位置计算子单元522,其中:时延计算子单元521,用于计算出麦克风阵列中两个麦克风接收到声源发出的声音的时延;位置计算子单元522,用于根据时延和所述麦克风阵列中两个麦克风之间的距离计算出声源的位置参数,声源的位置参数确定服务对象的位置。实际上,这里所述的声源具体指服务对象的口部,声源的位置即服务对象的头部的位置,具体为口部的位置。The positioning unit 52 can locate the sound source by the time delay method. At this time, the positioning unit 52 includes a delay calculation sub-unit 521 and a position calculation sub-unit 522, as shown in FIG. 10, wherein: the delay calculation sub-unit 521 uses Calculating a time delay of the sounds emitted by the two microphones in the microphone array; the position calculation sub-unit 522 is configured to calculate the position of the sound source according to the delay and the distance between the two microphones in the microphone array The parameter, the position parameter of the sound source determines the location of the service object. In fact, the sound source described herein specifically refers to the mouth of the service object, and the position of the sound source is the position of the head of the service object, specifically the position of the mouth.
可选地,声源的位置参数包括声源的极坐标,以及极坐标系的极轴在水平面上的投影与直角坐标系的X轴或Y轴的夹角
Figure PCTCN2017109185-appb-000020
且直角坐标系与极坐标系的原点重合,极坐标包括极径r和极角θ。
Optionally, the positional parameter of the sound source includes a polar coordinate of the sound source, and an angle between a projection of the polar axis of the polar coordinate system on the horizontal plane and an X-axis or a Y-axis of the Cartesian coordinate system.
Figure PCTCN2017109185-appb-000020
And the Cartesian coordinate system coincides with the origin of the polar coordinate system, and the polar coordinates include the polar diameter r and the polar angle θ.
如图4所示,假设麦克风阵列包括P1、P2、P3、P4共四个麦克风,且四个麦克风依次连线构成边长为L的正方形,声源为S。以正方形为基准构造直角坐标系,直角坐标系包括x、y、z轴,原点o在正方形内。从声源S向xy平面引垂线,将原点o作为极点O,将从极点O出发经过垂线与xy平面的交点的射线作为X轴,将z轴作为Y轴,构造出一个极坐标系,其中OX为极轴,OX到OS的夹角为极角θ,OS的长度为极径r,即声源S的极坐标为(r,θ)。同时,OX与x轴或y轴的夹角为
Figure PCTCN2017109185-appb-000021
从而,位置参数r、θ与
Figure PCTCN2017109185-appb-000022
则确定了声源S的位置。因此,只要计算出r、θ与
Figure PCTCN2017109185-appb-000023
就实现了对声源S的定位。
As shown in FIG. 4, it is assumed that the microphone array includes four microphones of P1, P2, P3, and P4, and four microphones are sequentially connected to form a square with a side length L, and the sound source is S. A Cartesian coordinate system is constructed based on a square. The Cartesian coordinate system includes x, y, and z axes, and the origin o is in a square. The vertical line is drawn from the sound source S to the xy plane, and the origin o is used as the pole point O. The ray passing through the intersection of the perpendicular line and the xy plane from the pole point O is taken as the X-axis, and the z-axis is taken as the Y-axis, and a polar coordinate system is constructed. Where OX is the polar axis, the angle between OX and OS is the polar angle θ, and the length of the OS is the polar diameter r, that is, the polar coordinate of the sound source S is (r, θ). At the same time, the angle between OX and the x-axis or y-axis is
Figure PCTCN2017109185-appb-000021
Thus, the positional parameters r, θ and
Figure PCTCN2017109185-appb-000022
Then the position of the sound source S is determined. Therefore, just calculate r, θ and
Figure PCTCN2017109185-appb-000023
The positioning of the sound source S is achieved.
具体实施时,定位单元52可以通过以下方式计算出声源S的位置参数r、θ与
Figure PCTCN2017109185-appb-000024
In a specific implementation, the positioning unit 52 can calculate the position parameters r, θ of the sound source S in the following manner.
Figure PCTCN2017109185-appb-000024
首先,计算两个麦克风接收到声源发出的声音的时延:First, calculate the delay between the two microphones receiving the sound from the sound source:
xi(n)=ais(n-τi)+wi(n)    (1)x i (n)=a i s(n-τ i )+w i (n) (1)
xj(n)=ajs(n-τj)+wj(n)    (2)x j (n)=a j s(n-τ j )+w j (n) (2)
Rij(τ)=E[xi(n)xj(n-τ)]     (3)R ij (τ)=E[x i (n)x j (n-τ)] (3)
其中,x(n)是麦克风接收到的信号,s(n)是声源发出的信号,w(n)是背景噪声,α是声传播衰减信号(一般取1),τ是声波从声源到麦克风的传播时间,R是自相关函数,E是数学期望。根据公式(1)-(3),得到:Where x(n) is the signal received by the microphone, s(n) is the signal from the sound source, w(n) is the background noise, α is the acoustic propagation attenuation signal (generally 1), and τ is the sound source from the sound source To the propagation time of the microphone, R is the autocorrelation function and E is the mathematical expectation. According to formulas (1)-(3), we get:
Rij(τ)=E[aiajs(n-τi)s(n-τj-τ)]=aiajRss(τ-(τij))    (4)R ij (τ)=E[a i a j s(n-τ i )s(n-τ j -τ)]=a i a j R ss (τ-(τ ij )) (4)
根据公式(4)可知,当τ=τij=τij时,Rij(τ)有最大值,时延计算子单元521求出此时的τij,即计算出两个麦克风接收到声源发出的声音的时延,即声源到达两个麦克风的时延。如图4所示,时延计算子单元521分别计算出声源S 到达麦克风P1和P2的时延为τ21,到达麦克风P1和P3的时延为τ31,到达麦克风P1和P4的时延为τ41According to the formula (4), when τ=τ ijij , R ij (τ) has a maximum value, and the delay calculation sub-unit 521 finds τ ij at this time, that is, two microphones are calculated. The delay to the sound emitted by the sound source, that is, the delay of the sound source reaching the two microphones. As shown in FIG. 4, the delay calculation sub-unit 521 calculates that the delay of the sound source S reaching the microphones P1 and P2 is τ 21 , the delay of reaching the microphones P1 and P3 is τ 31 , and the delays of reaching the microphones P1 and P4. For τ 41 .
然后,结合图4,有以下几何方程式:Then, in conjunction with Figure 4, there are the following geometric equations:
x2+y2+z2=r2      (5)x 2 +y 2 +z 2 =r 2 (5)
Figure PCTCN2017109185-appb-000025
Figure PCTCN2017109185-appb-000025
Figure PCTCN2017109185-appb-000026
Figure PCTCN2017109185-appb-000026
Figure PCTCN2017109185-appb-000027
Figure PCTCN2017109185-appb-000027
Figure PCTCN2017109185-appb-000028
Figure PCTCN2017109185-appb-000028
Figure PCTCN2017109185-appb-000029
Figure PCTCN2017109185-appb-000029
z=r sinθ         (11)z=r sinθ (11)
Figure PCTCN2017109185-appb-000030
Figure PCTCN2017109185-appb-000030
Figure PCTCN2017109185-appb-000031
Figure PCTCN2017109185-appb-000031
Figure PCTCN2017109185-appb-000032
Figure PCTCN2017109185-appb-000032
其中,r1、r2、r3、r4为声源S分别与麦克风P1、P2、P3、P4的距离;r为声源S与极坐标系的极点O的距离,即极径;,θ为极坐标系中极轴OX到OS的夹角,即极角;
Figure PCTCN2017109185-appb-000033
为极坐标系的极轴OX与直角坐标系中的x轴或y轴的夹角;L为四个麦克风依次连线构成的正方形的边长,C为声音传播速度,x、y、z是声源S在直角坐标系中的位置坐标。根据公式(5)-(14),可得:
Wherein, r 1 , r 2 , r 3 , and r 4 are distances between the sound source S and the microphones P1, P2, P3, and P4, respectively; r is a distance between the sound source S and the pole point O of the polar coordinate system, that is, a polar diameter; θ is the angle between the polar axis OX and the OS in the polar coordinate system, that is, the polar angle;
Figure PCTCN2017109185-appb-000033
It is the angle between the polar axis OX of the polar coordinate system and the x-axis or the y-axis in the Cartesian coordinate system; L is the side length of the square formed by the four microphones sequentially connected, C is the sound propagation speed, and x, y, z are The position coordinates of the sound source S in the Cartesian coordinate system. According to formulas (5)-(14), you can get:
Figure PCTCN2017109185-appb-000034
Figure PCTCN2017109185-appb-000034
Figure PCTCN2017109185-appb-000035
Figure PCTCN2017109185-appb-000035
Figure PCTCN2017109185-appb-000036
Figure PCTCN2017109185-appb-000036
其中,r为极坐标的极径,θ为极坐标的极角,
Figure PCTCN2017109185-appb-000037
为极坐标系的极轴OX与直角坐标系的x轴或y轴的夹角,τ41、τ31、τ21为两个麦克风接收到声源发出的声音的时延,L为四个麦克风依次连线构成的正方形的边长,C为声音的传播速度。从而,位置计算子单元522根据公式(15)-(16),就能计算出声源S的位置参数r、θ与
Figure PCTCN2017109185-appb-000038
实现对声源S的定位,获取服务对象的位置。
Where r is the polar diameter of the polar coordinates and θ is the polar angle of the polar coordinates.
Figure PCTCN2017109185-appb-000037
The angle between the polar axis OX of the polar coordinate system and the x-axis or the y-axis of the Cartesian coordinate system, τ 41 , τ 31 , τ 21 are the delays of the sounds of the two microphones receiving the sound source, and L is four microphones. The length of the side of the square formed by the sequential connection, and C is the propagation speed of the sound. Thus, the position calculation sub-unit 522 can calculate the positional parameters r, θ of the sound source S according to the formulas (15) - (16).
Figure PCTCN2017109185-appb-000038
Realize the positioning of the sound source S and obtain the location of the service object.
当获取了服务对象的位置后,第二处理模块60则根据服务对象的位置控制机器人自动向服务对象方向移动,当然,如果服务对象就在身边时,则无需移动,只需转动机器人的头部或身体面向服务对象即可。从而实现了自动为服务对象提供服务,无需控制人员发送控制指令,进一步提高了机器人的智能化水平。After the location of the service object is obtained, the second processing module 60 controls the robot to automatically move to the service object according to the location of the service object. Of course, if the service object is around, there is no need to move, and only the head of the robot is rotated. Or the body can be oriented to the client. Thereby, the automatic service for the service object is realized, and the control personnel are not required to send the control instruction, thereby further improving the intelligence level of the robot.
在其它实施例中,也可以省略图8中的拍摄模块30和第一处理模块40,形成新的实施例。In other embodiments, the imaging module 30 and the first processing module 40 of FIG. 8 may also be omitted to form a new embodiment.
本发明实施例的机器人的移动装置,通过在移动前或移动过程中探测障碍物的位置,根据障碍物的位置调整移动路线以避开障碍物,从而实现了根据当前环境灵活调整移动路线,避免与障碍物碰撞或因障碍物挡路而停止移动。从而提高了机器人移动的灵活性和智能化水平,进而提高了服务效率和服务质量。The moving device of the robot according to the embodiment of the present invention adjusts the moving route according to the position of the obstacle to avoid the obstacle by detecting the position of the obstacle before or during the moving, thereby achieving flexible adjustment of the moving route according to the current environment, thereby avoiding Stop moving with obstacles or blocking obstacles. Thereby improving the flexibility and intelligence level of robot movement, thereby improving service efficiency and service quality.
进一步通过获取服务对象的位置,自动面向服务对象或向服务对象方向移动,从而实现了自动为服务对象提供服务,无需控制人员手动发送控制指令,进一步提高了机器人的智能化水平。Further, by obtaining the location of the service object, automatically moving to the service object or moving to the service object, the service is automatically provided for the service object, and the control personnel are not required to manually send the control instruction, thereby further improving the intelligence level of the robot.
本发明同时提出一种机器人,其包括存储器、处理器和至少一个被存储在存储器中并被配置为由处理器执行的应用程序,所述应用程序被配置为用于执行机器人的移动方法。所述机器人的移动方法包括以下步骤:利用障碍物探测器探测障碍物的位置,根据障碍物的位置调整移动路线以避开障碍物。本实施例中所描述的机器人的移动方法为本发明中上述实施例所涉及的机器人的移动方法,在此不再赘述。The present invention also proposes a robot comprising a memory, a processor and at least one application stored in the memory and configured to be executed by the processor, the application being configured to perform a method of moving the robot. The method of moving the robot includes the steps of: detecting an obstacle position by using an obstacle detector, and adjusting a movement route according to the position of the obstacle to avoid the obstacle. The method for moving the robot described in this embodiment is the method for moving the robot according to the above embodiment of the present invention, and details are not described herein again.
本领域技术人员可以理解,本发明包括涉及用于执行本申请中所述操作中的一项或多项的设备。这些设备可以为所需的目的而专门设计和制造,或者也可以包括通用计算机中的已知设备。这些设备具有存储在其内的计算机程序,这些计算机程序选择性地激活或重构。这样的计算机程序可以被存储在设备(例如,计算机)可读介质中或者存储在适于存储电子指令并分别耦联到总线的任何类型的介质中,所述计算机可读介质包括但不限于任何类型的盘(包括软盘、硬盘、光盘、CD-ROM、和磁光盘)、ROM(Read-Only Memory,只读存储器)、RAM(Random Access Memory,随机存储器)、EPROM(Erasable Programmable Read-Only Memory,可擦写可编程只读存储器)、EEPROM(Electrically Erasable Programmable Read-Only Memory,电可擦可编程只读存储器)、闪存、磁性卡片或光线卡片。也就是,可读介质包括由设备(例如,计算机)以能够读的形式 存储或传输信息的任何介质。Those skilled in the art will appreciate that the present invention includes apparatus that is directed to performing one or more of the operations described herein. These devices may be specially designed and manufactured for the required purposes, or may also include known devices in a general purpose computer. These devices have computer programs stored therein that are selectively activated or reconfigured. Such computer programs may be stored in a device (eg, computer) readable medium or in any type of medium suitable for storing electronic instructions and coupled to a bus, respectively, including but not limited to any Types of disks (including floppy disks, hard disks, optical disks, CD-ROMs, and magneto-optical disks), ROM (Read-Only Memory), RAM (Random Access Memory), EPROM (Erasable Programmable Read-Only Memory) , EEPROM (Electrically Erasable Programmable Read-Only Memory), flash memory, magnetic card or light card. That is, the readable medium includes a form that can be read by a device (eg, a computer) Any medium that stores or transmits information.
本技术领域技术人员可以理解,可以用计算机程序指令来实现这些结构图和/或框图和/或流图中的每个框以及这些结构图和/或框图和/或流图中的框的组合。本技术领域技术人员可以理解,可以将这些计算机程序指令提供给通用计算机、专业计算机或其他可编程数据处理方法的处理器来实现,从而通过计算机或其他可编程数据处理方法的处理器来执行本发明公开的结构图和/或框图和/或流图的框或多个框中指定的方案。Those skilled in the art will appreciate that each block of the block diagrams and/or block diagrams and/or flow diagrams and combinations of blocks in the block diagrams and/or block diagrams and/or flow diagrams can be implemented by computer program instructions. . Those skilled in the art will appreciate that these computer program instructions can be implemented by a general purpose computer, a professional computer, or a processor of other programmable data processing methods, such that the processor is executed by a computer or other programmable data processing method. The blocks of the disclosed structure and/or block diagrams and/or flow diagrams or blocks specified in the various blocks.
本技术领域技术人员可以理解,本发明中已经讨论过的各种操作、方法、流程中的步骤、措施、方案可以被交替、更改、组合或删除。进一步地,具有本发明中已经讨论过的各种操作、方法、流程中的其他步骤、措施、方案也可以被交替、更改、重排、分解、组合或删除。进一步地,现有技术中的具有与本发明中公开的各种操作、方法、流程中的步骤、措施、方案也可以被交替、更改、重排、分解、组合或删除。Those skilled in the art can understand that the steps, measures, and solutions in the various operations, methods, and processes that have been discussed in the present invention may be alternated, changed, combined, or deleted. Further, other steps, measures, and schemes of the various operations, methods, and processes that have been discussed in the present invention may be alternated, modified, rearranged, decomposed, combined, or deleted. Further, the steps, measures, and solutions in the prior art having various operations, methods, and processes disclosed in the present invention may also be alternated, changed, rearranged, decomposed, combined, or deleted.
以上所述仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。 The above is only the preferred embodiment of the present invention, and is not intended to limit the scope of the invention, and the equivalent structure or equivalent process transformations made by the description of the invention and the drawings are directly or indirectly applied to other related The technical field is equally included in the scope of patent protection of the present invention.

Claims (20)

  1. 一种机器人的移动方法,其特征在于,包括以下步骤:A method for moving a robot, comprising the steps of:
    利用障碍物探测器探测障碍物的位置;Using an obstacle detector to detect the location of the obstacle;
    根据所述障碍物的位置调整移动路线以避开所述障碍物。The movement route is adjusted according to the position of the obstacle to avoid the obstacle.
  2. 根据权利要求1所述的机器人的移动方法,其特征在于,所述利用障碍物探测器探测障碍物的位置的步骤之后还包括:The method of moving a robot according to claim 1, wherein the step of detecting the position of the obstacle by using the obstacle detector further comprises:
    对准所述障碍物的位置拍摄照片;Taking a photo at a position that is aligned with the obstacle;
    根据所述障碍物的照片识别所述障碍物和/或精确定位所述障碍物。Identifying the obstacle and/or pinpointing the obstacle based on the photo of the obstacle.
  3. 根据权利要求1所述的机器人的移动方法,其特征在于,所述障碍物探测器为超声波探测器、红外探测器或激光探测器。The method of moving a robot according to claim 1, wherein the obstacle detector is an ultrasonic detector, an infrared detector, or a laser detector.
  4. 根据权利要求3所述的机器人的移动方法,其特征在于,当所述障碍物探测器为超声波探测器时,所述利用障碍物探测器探测障碍物的位置的步骤包括:The method of moving a robot according to claim 3, wherein when the obstacle detector is an ultrasonic probe, the step of detecting the position of the obstacle by using the obstacle detector comprises:
    通过所述超声波探测器的发射单元发射超声波信号;Transmitting an ultrasonic signal through a transmitting unit of the ultrasonic detector;
    通过所述超声波探测器的接收单元接收超声波回波信号;Receiving an ultrasonic echo signal through a receiving unit of the ultrasonic probe;
    计算发射超声波信号至接收超声波回波信号的间隔时间;Calculating an interval between transmitting the ultrasonic signal to receiving the ultrasonic echo signal;
    根据所述间隔时间和超声波的传播速度计算机器人与障碍物的距离。The distance between the robot and the obstacle is calculated based on the interval time and the propagation speed of the ultrasonic wave.
  5. 根据权利要求1所述的机器人的移动方法,其特征在于,所述障碍物探测器至少包括两组,每组障碍物探测器设于所述机器人不同的纵向位置。The method of moving a robot according to claim 1, wherein the obstacle detector comprises at least two groups, each set of obstacle detectors being disposed at different longitudinal positions of the robot.
  6. 根据权利要求5所述的机器人的移动方法,其特征在于,每组障碍物探测器至少包括两个朝向不同的障碍物探测器。 The method of moving a robot according to claim 5, wherein each of the obstacle detectors comprises at least two obstacle detectors facing different directions.
  7. 根据权利要求1所述的机器人的移动方法,其特征在于,所述方法还包括:The method of moving a robot according to claim 1, wherein the method further comprises:
    通过基于麦克风阵列的声源定位技术获取服务对象的位置;Obtaining a location of the service object by a sound source localization technology based on a microphone array;
    根据所述服务对象的位置面向所述服务器对象或向所述服务器对象的方向移动。Moving toward the server object or in the direction of the server object according to the location of the service object.
  8. 根据权利要求7所述的机器人的移动方法,其特征在于,所述通过基于麦克风阵列的声源定位技术获取服务对象的位置包括:The method for moving a robot according to claim 7, wherein the obtaining the location of the service object by the sound source localization technology based on the microphone array comprises:
    通过麦克风阵列采集服务对象发出的声音信号;Acquiring a sound signal emitted by the service object through the microphone array;
    通过所述麦克风阵列对所述声音信号进行声源定位,得到所述服务对象的位置。The sound source is positioned by the microphone array to obtain the location of the service object.
  9. 根据权利要求8所述的机器人的移动方法,其特征在于,所述通过所述麦克风阵列对所述声音信号进行声源定位包括:The method for moving a sound source according to claim 8, wherein the performing sound source localization of the sound signal by the microphone array comprises:
    计算出所述麦克风阵列中两个麦克风接收到所述服务对象发出的声音的时延;Calculating a delay of the two microphones in the microphone array receiving the sound emitted by the service object;
    根据所述时延和所述麦克风阵列中所述两个麦克风之间的距离计算出声源的位置参数,所述声源的位置参数确定所述服务对象的位置。Calculating a positional parameter of the sound source according to the time delay and a distance between the two microphones in the microphone array, the positional parameter of the sound source determining a location of the service object.
  10. 根据权利要求9所述的机器人的移动方法,其特征在于,所述声源的位置参数包括所述声源的极坐标,以及极坐标系的极轴与直角坐标系的x轴或y轴的夹角,所述直角坐标系与所述极坐标系的原点重合。The method of moving a robot according to claim 9, wherein the positional parameter of the sound source comprises a polar coordinate of the sound source, and a polar axis of the polar coordinate system and an x-axis or a y-axis of the rectangular coordinate system An angle, the Cartesian coordinate system coincides with an origin of the polar coordinate system.
  11. 一种机器人的移动装置,其特征在于,包括:A mobile device for a robot, comprising:
    障碍探测模块,用于利用障碍物探测器探测障碍物的位置;An obstacle detection module for detecting an obstacle position by using an obstacle detector;
    路线调整模块,用于根据所述障碍物的位置调整移动路线以避开所述障碍物。 a route adjustment module, configured to adjust a movement route according to a position of the obstacle to avoid the obstacle.
  12. 根据权利要求11所述的机器人的移动装置,其特征在于,所述装置还包括:The mobile device of the robot according to claim 11, wherein the device further comprises:
    拍摄模块,用于对准所述障碍物的位置拍摄照片;a photographing module for photographing a position of the obstacle;
    第一处理模块,用于根据所述障碍物的照片识别所述障碍物和/或精确定位所述障碍物。And a first processing module, configured to identify the obstacle according to the photo of the obstacle and/or accurately locate the obstacle.
  13. 根据权利要求11所述的机器人的移动装置,其特征在于,所述障碍物探测器为超声波探测器、红外探测器或激光探测器。The mobile device of the robot according to claim 11, wherein the obstacle detector is an ultrasonic detector, an infrared detector or a laser detector.
  14. 根据权利要求13所述的机器人的移动装置,其特征在于,当所述障碍物探测器为超声波探测器时,所述障碍探测模块包括:The mobile device of the robot according to claim 13, wherein when the obstacle detector is an ultrasonic probe, the obstacle detecting module comprises:
    信号发射单元,用于通过所述超声波探测器的发射单元发射超声波信号;a signal transmitting unit, configured to transmit an ultrasonic signal through a transmitting unit of the ultrasonic detector;
    信号接收单元,用于通过所述超声波探测器的接收单元接收超声波回波信号;a signal receiving unit, configured to receive an ultrasonic echo signal through a receiving unit of the ultrasonic probe;
    时间计算单元,用于计算发射超声波信号至接收超声波回波信号的间隔时间;a time calculation unit, configured to calculate an interval between transmitting the ultrasonic signal and receiving the ultrasonic echo signal;
    距离计算单元,用于根据所述间隔时间和超声波的传播速度计算机器人与障碍物的距离。The distance calculation unit is configured to calculate the distance between the robot and the obstacle according to the interval time and the propagation speed of the ultrasonic wave.
  15. 根据权利要求11所述的机器人的移动装置,其特征在于,所述障碍物探测器至少包括两组,每组障碍物探测器设于所述机器人不同的纵向位置。The mobile device of claim 11, wherein the obstacle detector comprises at least two groups, each set of obstacle detectors being disposed at different longitudinal positions of the robot.
  16. 根据权利要求15所述的机器人的移动装置,其特征在于,每组障碍物探测器至少包括两个朝向不同的障碍物探测器。A mobile device for a robot according to claim 15, wherein each of the obstacle detectors comprises at least two obstacle detectors facing different directions.
  17. 根据权利要求11所述的机器人的移动装置,其特征在于,所述装置还包括: The mobile device of the robot according to claim 11, wherein the device further comprises:
    位置获取模块,用于通过基于麦克风阵列的声源定位技术获取服务对象的位置;a location acquisition module, configured to acquire a location of the service object by using a sound source localization technology based on a microphone array;
    第二处理模块,用于根据所述服务对象的位置面向所述服务器对象或向所述服务器对象的方向移动。And a second processing module, configured to move toward the server object or to the server object according to the location of the service object.
  18. 根据权利要求17所述的机器人的移动装置,其特征在于,所述位置获取模块包括:The mobile device of the robot according to claim 17, wherein the location acquisition module comprises:
    采集单元,用于通过麦克风阵列采集服务对象发出的声音信号;An acquisition unit, configured to collect, by using a microphone array, a sound signal sent by a service object;
    定位单元,用于通过所述麦克风阵列对所述声音信号进行声源定位,得到所述服务对象的位置。And a positioning unit, configured to perform sound source localization on the sound signal by using the microphone array to obtain a location of the service object.
  19. 根据权利要求18所述的机器人的移动装置,其特征在于,所述定位单元包括:The mobile device of the robot according to claim 18, wherein the positioning unit comprises:
    时延计算子单元,用于计算出所述麦克风阵列中两个麦克风接收到所述声源发出的声音的时延;a delay calculation subunit, configured to calculate a delay of the sounds emitted by the two microphones in the microphone array received by the sound source;
    位置计算子单元,用于根据所述时延和所述麦克风阵列中所述两个麦克风之间的距离计算出声源的位置参数,所述声源的位置参数确定所述服务对象的位置。a location calculation subunit, configured to calculate a location parameter of the sound source according to the time delay and a distance between the two microphones in the microphone array, where the location parameter of the sound source determines a location of the service object.
  20. 一种机器人,包括存储器、处理器和至少一个被存储在所述存储器中并被配置为由所述处理器执行的应用程序,其特征在于,所述应用程序被配置为用于执行权利要求1所述的机器人的移动方法。 A robot comprising a memory, a processor and at least one application stored in the memory and configured to be executed by the processor, wherein the application is configured to perform claim 1 The method of moving the robot.
PCT/CN2017/109185 2017-10-24 2017-11-02 Robot moving method and device and robot WO2019080156A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201711003181.3A CN107796403A (en) 2017-10-24 2017-10-24 Moving method, device and the robot of robot
CN201711003181.3 2017-10-24

Publications (1)

Publication Number Publication Date
WO2019080156A1 true WO2019080156A1 (en) 2019-05-02

Family

ID=61534341

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2017/109185 WO2019080156A1 (en) 2017-10-24 2017-11-02 Robot moving method and device and robot

Country Status (2)

Country Link
CN (1) CN107796403A (en)
WO (1) WO2019080156A1 (en)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108682064A (en) * 2018-05-14 2018-10-19 广东汇泰龙科技有限公司 A kind of method for unlocking and system based on speech recognition and recognition of face
CN108445889B (en) * 2018-05-15 2021-06-29 深圳市无限动力发展有限公司 Sweeping method and system based on intelligent sound equipment and assisted with sweeping machine
CN109343524A (en) * 2018-10-12 2019-02-15 深圳蓝胖子机器人有限公司 A kind of robot, robot cluster and its control method
CN113110481B (en) * 2021-04-26 2024-02-06 上海智蕙林医疗科技有限公司 Emergency avoidance implementation method, system, robot and storage medium
CN113190005B (en) * 2021-05-07 2022-07-08 江苏戎晟安防科技有限公司 Modular small reconnaissance robot

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104503450A (en) * 2014-11-27 2015-04-08 无锡北斗星通信息科技有限公司 Service robot achieving intelligent obstacle crossing
CN105094136A (en) * 2015-09-14 2015-11-25 桂林电子科技大学 Adaptive microphone array sound positioning rescue robot and using method thereof
CN105607042A (en) * 2014-11-19 2016-05-25 北京航天长峰科技工业集团有限公司 Method for locating sound source through microphone array time delay estimation
CN106041879A (en) * 2016-06-30 2016-10-26 广州映博智能科技有限公司 Intelligent obstacle avoidance robot
CN106681330A (en) * 2017-01-25 2017-05-17 北京航空航天大学 Robot navigation method and device based on multi-sensor data fusion

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106598046B (en) * 2016-11-29 2020-07-10 北京儒博科技有限公司 Robot avoidance control method and device
CN106863305B (en) * 2017-03-29 2019-12-17 赵博皓 Floor sweeping robot room map creating method and device
CN107045308A (en) * 2017-05-24 2017-08-15 南京华设科技股份有限公司 Intelligent interaction service robot

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105607042A (en) * 2014-11-19 2016-05-25 北京航天长峰科技工业集团有限公司 Method for locating sound source through microphone array time delay estimation
CN104503450A (en) * 2014-11-27 2015-04-08 无锡北斗星通信息科技有限公司 Service robot achieving intelligent obstacle crossing
CN105094136A (en) * 2015-09-14 2015-11-25 桂林电子科技大学 Adaptive microphone array sound positioning rescue robot and using method thereof
CN106041879A (en) * 2016-06-30 2016-10-26 广州映博智能科技有限公司 Intelligent obstacle avoidance robot
CN106681330A (en) * 2017-01-25 2017-05-17 北京航空航天大学 Robot navigation method and device based on multi-sensor data fusion

Also Published As

Publication number Publication date
CN107796403A (en) 2018-03-13

Similar Documents

Publication Publication Date Title
WO2019080156A1 (en) Robot moving method and device and robot
US7474589B2 (en) Acoustic location of gunshots using combined angle of arrival and time of arrival measurements
Schillebeeckx et al. Biomimetic sonar: Binaural 3D localization using artificial bat pinnae
JP2501010B2 (en) Mobile robot guidance device
EP2724554B1 (en) Time difference of arrival determination with direct sound
US20110317522A1 (en) Sound source localization based on reflections and room estimation
Bhatlawande et al. Ultrasonic spectacles and waist-belt for visually impaired and blind person
TWI494827B (en) Sensing device and positioning method
WO2008026463A1 (en) Localization system, robot, localization method, and sound source localization program
CN106226772B (en) A kind of moving object recognition methods based on ultrasonic sensor
US20060259213A1 (en) Tracking system and autonomous mobile unit
CN102590816A (en) Comprehensive ranging positioning signal sensor
KR20060111167A (en) Positioning deduction method
CN109709520A (en) Indoor positioning based on microphone array and build drawing method
CN110441737A (en) It is a kind of to use fish-eye sound localization method and its equipment
KR20090062594A (en) Device and method for measuring 3d position using multi-channel ultrasonic sensor
Dijk et al. 3-D indoor positioning method using a single compact base station
Guarato et al. Ultrasonic sonar system for target localization with one emitter and four receivers: Ultrasonic 3D localization
EP3182734A2 (en) Method for using a mobile device equipped with at least two microphones for determining the direction of loudspeakers in a setup of a surround sound system
JP2018096911A (en) Position estimation device, position estimation program and position estimation method
US20190331793A1 (en) Method and acoustic device for measuring surface movements
WO2021208662A1 (en) Method for estimating over-the-air propagation delay of direct wave
Rajai et al. Binaural sonar system for simultaneous sensing of distance and direction of extended barriers
Moita et al. Multi-echo technique for feature detection and identification using simple sonar configurations
CN202486309U (en) Signal transducer combining ranging and positioning

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 17930069

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 17930069

Country of ref document: EP

Kind code of ref document: A1