WO2019080156A1 - Robot moving method and device and robot - Google Patents
Robot moving method and device and robotInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 44
- 238000004364 calculation method Methods 0.000 claims description 16
- 230000004807 localization Effects 0.000 claims description 16
- 230000005236 sound signal Effects 0.000 claims description 12
- 238000005516 engineering process Methods 0.000 claims description 11
- 239000000523 sample Substances 0.000 claims description 11
- 238000001514 detection method Methods 0.000 claims description 7
- 238000010586 diagram Methods 0.000 description 15
- 230000001934 delay Effects 0.000 description 5
- 230000008569 process Effects 0.000 description 5
- 238000004590 computer program Methods 0.000 description 4
- 230000000903 blocking effect Effects 0.000 description 3
- 238000005311 autocorrelation function Methods 0.000 description 2
- 238000003672 processing method Methods 0.000 description 2
- 238000002604 ultrasonography Methods 0.000 description 2
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000003203 everyday effect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000000844 transformation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- 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
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
本发明涉及机器人技术领域,特别是涉及到一种机器人的移动方法、装置和机器人。The present invention relates to the field of robot technology, and in particular to a method, device and robot for moving a robot.
随着机器人技术的发展,机器人逐渐应用到日常生活领域,例如目前出现了应用于服务行业(如餐厅)的服务型机器人。现有的服务型机器人主要提供上菜服务,机器人主要在厨房窗口与餐桌之间往返移动,其移动路线是由控制人员事先设定好的。然而,当遇到比较复杂的环境时,如当机器人的移动路线上出现障碍物时,机器人就有可能与障碍物碰撞或者停止移动直到障碍物消失为止,从而影响服务效率和服务质量。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.
图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.
应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。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轴的夹角且直角坐标系与极坐标系的原点重合,极坐标包括极径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. 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轴的夹角为从而,位置参数r、θ与则确定了声源S的位置。因此,只要计算出r、θ与就实现了对声源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 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.
具体实施时,可以通过以下方式计算出声源S的位置参数r、θ与
In the specific implementation, the position parameters r, θ of the sound source S can be calculated in the following manner.
首先,计算两个麦克风接收到声源发出的声音的时延: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(τ-(τi-τj)) (4)R ij (τ)=E[a i a j s(n-τ i )s(n-τ j -τ)]=a i a j R ss (τ-(τ i -τ j )) (4)
根据公式(4)可知,当τ=τi-τj=τij时,Rij(τ)有最大值,求出此时的τij,即计算出两个麦克风接收到声源发出的声音的时延,即声源到达两个麦克风的时延。如图4所示,分别计算出声源S到达麦克风P1和P2的时延为τ21,到达麦克风P1和P3的时延为τ31,到达麦克风P1和P4的时延为τ41。According to formula (4), when τ=τ i -τ j =τ ij , 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)
z=r sinθ (11)z=r sinθ (11)
其中,r1、r2、r3、r4为声源S分别与麦克风P1、P2、P3、P4的距离;r为声源S与极坐标系的极点O的距离,即极径;,θ为极坐标系中极轴OX到OS的夹角,即极角;为极坐标系的极轴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; 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:
其中,r为极坐标的极径,θ为极坐标的极角,为极坐标系的极轴OX与直角坐标系的x轴或y轴的夹角,τ41、τ31、τ21为两个麦克风接收到声源发出的声音的时延,L为四个麦克风依次连线构成的正方形的边长,C为声音的传播速度。从而,根据公式(15)-(16),就能计算出声源S的位置参数r、θ与实现对声源S的定位,获取服务对象的位置。Where r is the polar diameter of the polar coordinates and θ is the polar angle of the polar coordinates. 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. 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轴的夹角且直角坐标系与极坐标系的原点重合,极坐标包括极径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. 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轴的夹角为从而,位置参数r、θ与则确定了声源S的位置。因此,只要计算出r、θ与就实现了对声源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 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.
具体实施时,定位单元52可以通过以下方式计算出声源S的位置参数r、θ与
In a specific implementation, the positioning unit 52 can calculate the position parameters r, θ of the sound source S in the following manner.
首先,计算两个麦克风接收到声源发出的声音的时延: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(τ-(τi-τj)) (4)R ij (τ)=E[a i a j s(n-τ i )s(n-τ j -τ)]=a i a j R ss (τ-(τ i -τ j )) (4)
根据公式(4)可知,当τ=τi-τj=τij时,Rij(τ)有最大值,时延计算子单元521求出此时的τij,即计算出两个麦克风接收到声源发出的声音的时延,即声源到达两个麦克风的时延。如图4所示,时延计算子单元521分别计算出声源S
到达麦克风P1和P2的时延为τ21,到达麦克风P1和P3的时延为τ31,到达麦克风P1和P4的时延为τ41。According to the formula (4), when τ=τ i -τ j =τ ij , 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)
z=r sinθ (11)z=r sinθ (11)
其中,r1、r2、r3、r4为声源S分别与麦克风P1、P2、P3、P4的距离;r为声源S与极坐标系的极点O的距离,即极径;,θ为极坐标系中极轴OX到OS的夹角,即极角;为极坐标系的极轴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; 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:
其中,r为极坐标的极径,θ为极坐标的极角,为极坐标系的极轴OX与直角坐标系的x轴或y轴的夹角,τ41、τ31、τ21为两个麦克风接收到声源发出的声音的时延,L为四个麦克风依次连线构成的正方形的边长,C为声音的传播速度。从而,位置计算子单元522根据公式(15)-(16),就能计算出声源S的位置参数r、θ与实现对声源S的定位,获取服务对象的位置。
Where r is the polar diameter of the polar coordinates and θ is the polar angle of the polar coordinates. 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). 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)
- 一种机器人的移动方法,其特征在于,包括以下步骤: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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 一种机器人的移动装置,其特征在于,包括: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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 根据权利要求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.
- 一种机器人,包括存储器、处理器和至少一个被存储在所述存储器中并被配置为由所述处理器执行的应用程序,其特征在于,所述应用程序被配置为用于执行权利要求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.
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)
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)
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)
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 |
-
2017
- 2017-10-24 CN CN201711003181.3A patent/CN107796403A/en active Pending
- 2017-11-02 WO PCT/CN2017/109185 patent/WO2019080156A1/en active Application Filing
Patent Citations (5)
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 |