WO2017041225A1 - Robot following method - Google Patents

Robot following method Download PDF

Info

Publication number
WO2017041225A1
WO2017041225A1 PCT/CN2015/089127 CN2015089127W WO2017041225A1 WO 2017041225 A1 WO2017041225 A1 WO 2017041225A1 CN 2015089127 W CN2015089127 W CN 2015089127W WO 2017041225 A1 WO2017041225 A1 WO 2017041225A1
Authority
WO
WIPO (PCT)
Prior art keywords
robot
distance
sensor
tracking object
speed
Prior art date
Application number
PCT/CN2015/089127
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 深圳市赛亿科技开发有限公司
Priority to PCT/CN2015/089127 priority Critical patent/WO2017041225A1/en
Priority to CN201580028764.4A priority patent/CN107073711A/en
Publication of WO2017041225A1 publication Critical patent/WO2017041225A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls

Definitions

  • the present invention relates to the field of robot technology, and in particular, to a robot following method.
  • robots occupy more and more positions in production and life. Due to the widespread use of microprocessor controllers and sensors, the functionality and precision of modern robots are becoming more sophisticated.
  • the follow-up function of the robot plays an important role in the robot follow-up method, and it plays an important role in factory production, hospitals, and shopping malls.
  • the robot includes a Bluetooth module and a sensor module
  • the Bluetooth module includes two Bluetooth receiving modules and a Bluetooth transmitting module
  • the sensor module includes a plurality of first sensors and a plurality of second sensors
  • the plurality of The first sensor and the plurality of second sensors form at least one group
  • the method includes: identifying a tracking object, the tracking object is configured with the Bluetooth transmitting module; and monitoring two Bluetooth receiving modules on the robot with an interval of L meters to receive the Bluetooth The strength of the signal; calculate the distances L1 and L2 between the two Bluetooth receiving modules and the Bluetooth transmitting module according to the detected Bluetooth signal strength; obtain the latest two groups of L1 and L2, and calculate the tracking object according to L, L1 and L2 Speed and direction; Calculating the speed and direction of the tracking object to adjust the speed and direction of the robot; receiving the detection distances of the first sensor and the second sensor in each group; acquiring the minimum value of each group according to a predetermined rule as the detection
  • the calculating the distances L1 and L2 between the two Bluetooth receiving modules and the tracking object according to the monitored Bluetooth signal strength respectively includes: collecting a current RSSI value of the Bluetooth signal strength, and performing current RSSI values according to a preset filtering algorithm. Processing, obtaining the current RSSI base value; using the offline BP neural network algorithm to process the current RSSI base value, and obtaining the distances L1 and L2 between the Bluetooth transmitting module and the two Bluetooth receiving modules.
  • the acquiring the latest two groups L1 and L2 and calculating the speed and direction of the tracking object according to L, L1 and L2, and adjusting the speed and direction of the robot according to the calculated speed and direction of the tracking object comprises: obtaining the speed of the robot; According to the distance between the Bluetooth transmitting module and the two Bluetooth receiving modules measured twice before and after, the speed of the tracking object is obtained, and the speed of the robot is adjusted according to the speed of the obtained tracking object, which is consistent with the speed of the tracking object; The distance between the Bluetooth transmitting module and the two Bluetooth receiving modules calculates the steering angle of the tracking object, and adjusts the direction of the robot to be consistent with the direction of the tracking object according to the obtained steering angle of the tracking object.
  • the sensor module includes a plurality of first sensors and a plurality of second sensors, and the plurality of first sensors and the plurality of second sensors form at least one group: the sensor module is five preset on a semicircular arc of the robot a first sensor and four second sensors, and five first sensors and four second sensors are arranged in an arc length interval, and the adjacent two first sensors and one second sensor are set as a group Divided into three groups.
  • the first sensor is an ultrasonic sensor and the second sensor is an infrared sensor.
  • the obtaining the minimum value of each group according to a predetermined rule as the detection distance determined by the group includes: when the distance of detecting the obstacle is within the first preset range, taking the detection distance of the second sensor as the group The determined detection distance; when the distance of the obstacle is detected to be within the second preset range, The detection distance of a sensor is used as the detection distance determined by the group; when the distance of the obstacle is detected within the third preset range, the detection distance of the first sensor and the detection distance of the second sensor are merged to obtain the group. Determined detection distance.
  • the value of a In the range of 0.5 to 1, the value of a is proportional to the value of x; when y is in the range of 0.4 to 0.6, the value of y varies from 0.5 to 1, y and b is in a negative proportional relationship; when x>0.6, y ⁇ 0.6, the values of a and b are both 0.5.
  • the determining the position of the obstacle and tracking the obstacle according to the change of the time and distance of the speed of the robot and the sending of the detection distance by the two sensor modules before and after the method comprises: determining the obstacle according to the detection distance determined twice before and after The distance and direction, the movement state of the obstacle, the speed of movement and the size of the obstacle.
  • the robot following method further comprises: pre-storing a plurality of specified gestures of the tracking object, and one-to-one correspondence between the specified gestures and the distance between the robot and the tracking object; identifying a plurality of specified gestures of the tracking object, according to the identified Specify the gesture to adjust the robot to the corresponding distance.
  • the one-to-one correspondence between the plurality of specified gestures and the distance between the robot and the tracking object includes: the plurality of specified gestures include beckoning, waving, and raising a hand, and adjusting the robot to the following object when the tracking object is beckoning The specified distance is closer.
  • the adjustment robot retreats to a specified distance farther from the following object.
  • the robot stops at its original position.
  • the beneficial technical effect of the present invention is that the robot following method establishes a connection by a Bluetooth transmitting module disposed on the tracking object and two Bluetooth receiving modules disposed on the robot, thereby calculating a distance and a direction of the tracking object, thereby implementing the tracking object. Automatically follow. At the same time, the distance and direction of the obstacle are determined by the detection distance determined twice before and after, and the position of the obstacle is determined according to the speed of the robot and the time and distance of the detection distance sent by the two sensor modules before and after, thereby achieving the obstacle avoidance. .
  • the robot following method has the functions of automatically following the tracking object and automatically avoiding the obstacle, and has the advantages of simple use, convenient operation, low cost, high intelligence, and easy wide-scale promotion.
  • FIG. 1 is a structural view of a robot provided by a preferred embodiment.
  • FIG. 2 is a distribution diagram of the sensor module of FIG. 1.
  • FIG. 3 is a flow chart of a robot following method according to a preferred embodiment.
  • the robot 1 is a structural view of a robot provided by a preferred embodiment.
  • the robot 1 includes a robot body 11, a microcontroller 12, a Bluetooth module 13, a drive module 14, and a sensor module 15.
  • the Bluetooth module 13, the drive module 14, and the sensor module 15 are electrically connected to the microcontroller 12, respectively.
  • the Bluetooth module 13 includes a Bluetooth transmitting module 131 disposed on the tracking object and two Bluetooth receiving modules 132 disposed on the robot body 11 for determining the distance and direction between the robot body 11 and the tracking object.
  • the sensor module 15 is used to detect obstacles.
  • the microcontroller 12 receives the feedback information of the Bluetooth module 13 and the sensor module 15 to control the driving module 15 to drive the robot body 11 to operate, thereby implementing automatic tracking of the tracking object.
  • the robot body 11 further includes a control circuit board and a monitoring device 18 disposed on the control circuit board.
  • the microcontroller 12 and the monitoring device 18 are electrically connected to the control circuit board, respectively.
  • the monitoring device 18 is configured to monitor the power of the Bluetooth receiving device 132 to receive the signal, and thereby determine the distance between the robot body 11 and the tracking object.
  • the distribution diagram of the sensor module 15 is such that five ultrasonic sensors 151 and four infrared sensors 152 are equally spaced apart on the semicircular arc to form two adjacent ultrasonic sensors 151 and the middle.
  • the infrared sensor 152 is a group of three groups to make the sensor module 15 It can detect obstacles within 180 degrees of the front of the robot body 11, thereby increasing the detection range, avoiding obstacles as much as possible, and achieving safe and collision-free tracking.
  • the driving module 14 includes four rollers and two driving mechanisms.
  • the drive mechanism employs a servo motor.
  • the camera body 16 is further disposed on the robot body 11 , and the camera module 16 is electrically connected to the microcontroller 12 .
  • the storage module 11 and the identification module 19 are further disposed on the circuit control board.
  • the storage module 17 is configured to save a preset gesture, and the identification module 19 is configured to recognize according to the gesture captured by the camera module 16 and determine the following action of the robot body 11 accordingly.
  • the gesture image analysis program is stored in advance in the microprocessor controller 12, and the set gesture is saved to the storage module 17.
  • Such gestures as preset may include three gestures of beckoning, waving, and raising a hand.
  • the robot After beckoning, the robot will walk closer to the tracking object; instead, the robot will retreat to a farther distance from the tracking object; after raising the hand, the robot will stop at its original place.
  • the solution is not limited to these three gestures, and the user can set different types of gestures according to requirements.
  • the robot tracking method 10 includes:
  • identifying a tracking object where the tracking object is configured with a Bluetooth transmitting module, including:
  • the tracking object wears a Bluetooth transmitting module and establishes a connection with two Bluetooth receiving modules disposed on the robot.
  • Tracking objects are not limited to people, but also other movable objects.
  • the tracking object is set to be a person, that is, a user.
  • the user wears a Bluetooth transmitting module, and two Bluetooth receiving modules are arranged on the robot at intervals to realize a connection between the robot and the tracking object through a connection between the Bluetooth transmitting module and the Bluetooth receiving module.
  • the robot is provided with a control circuit board and a monitoring device disposed on the control circuit board.
  • the monitoring device is configured to monitor the power of the signal received by the Bluetooth receiving module, and thereby determine the distance between the robot and the tracking object.
  • calculating the distances L1 and L2 between the two Bluetooth receiving modules and the tracking object according to the monitored Bluetooth signal strength respectively includes:
  • the offline BP neural network algorithm is used to process the current RSSI base value, and the distances L1 and L2 between the Bluetooth transmitting module and the two Bluetooth receiving modules are obtained.
  • the monitoring device measures the distances L1 and L2 between the robot body and the user by monitoring the signal power received by the two Bluetooth receiving devices.
  • the distance is measured by a filtering method based on a RSSI (Received Signal Strength Indicator) wireless positioning method and a combination of hopping filtering and Gaussian filtering.
  • RSSI Received Signal Strength Indicator
  • the maximum value and the minimum value are removed, and then the current RSSI base value is obtained by weighted averaging to reduce the error of the RSSI value due to interference.
  • the offline BP (Back Propagation) neural network algorithm is used to calculate the distance between the Bluetooth transmitting module and the two Bluetooth receiving modules by using the obtained current RSSI base value.
  • the propagation formula of Bluetooth signal in free space is:
  • BP neural network consists of input layer, intermediate hidden layer and output layer. Under the current RSSI base value and distance value obtained by actual experiments, the hidden layer is respectively When the number of neurons is a, b, c, d..., the simulation is performed, and then the simulated model distance and the actual error curve are selected, and the number of neurons with the smallest error is selected as the input parameter to calculate the Bluetooth transmitting module and The distance between two Bluetooth receiving modules, L1 and L2.
  • the speed of the tracking object is obtained, and the speed of the robot is adjusted according to the speed of the obtained tracking object to be consistent with the speed of the tracking object;
  • the steering angle of the tracking object is calculated according to the distance between the Bluetooth transmitting module and the two Bluetooth receiving modules measured twice before and after, and the direction of the robot is adjusted according to the steering angle of the obtained tracking object.
  • the driving mechanism of the robot employs a servo motor.
  • the servo motor controls the speed of the algorithm by PID (proportion, integration, differentiation) to control the speed of the robot. Since the servo motor has a built-in Hall sensor, when the servo motor rotates, the Hall sensor emits several sets of signals every time the servo motor rotates, and one of these signals is selected as the test basis, and two adjacent ones are recorded. The time between the pulses, and then the diameter of the roller divided by the pulse time, can calculate the current speed of the roller, and can control the speed of the servo motor through the PID control algorithm, according to which the speed and position adjustment accuracy of the servo motor is very high. Accurate, so that the robot has good follow-up performance.
  • the drive mechanism includes four rollers. Four wheels It is divided into two pairs of front and rear. Each rear wheel acts as a drive wheel, which is connected to a drive mechanism. The front wheel acts as a driven wheel, which can rotate in any direction.
  • the two Bluetooth receiving modules are set at intervals of L meters. According to the RSSI measurement method, the distances between the Bluetooth transmitting modules on the user and the two Bluetooth receiving modules are respectively L1 and L2, and the distance and direction of the tracking object are calculated by L, L1 and L2. To locate the user's location.
  • the electronic differential steering mode is used for steering, the acceleration between the two rear wheels is performed by two servo motors, and then the respective speeds of the two motors are controlled according to the measured speed and the angle of the required steering, so that the two drives The speed of the wheel is different, and the purpose of steering is achieved, so that the speed and direction of the robot are adjusted according to the obtained speed and direction of the tracking object, and the automatic tracking function of the robot is realized.
  • the distance and the steering of the tracking object are measured by the Bluetooth transmitting module and the two Bluetooth receiving modules. Compared with the prior art, the cost is not only reduced, but also the product promotion and practicability are increased.
  • the sensor module includes a plurality of first sensors and a plurality of second sensors, and the plurality of first sensors and the plurality of second sensors form at least one group:
  • the sensor module is five first sensors and four second sensors preset on the semicircular arc of the robot, and five first sensors and four second sensors are arranged at an arc length interval, and the adjacent two A sensor and a second sensor are arranged in a group and are divided into three groups.
  • the first sensor is an ultrasonic sensor and the second sensor is an infrared sensor.
  • the detection distance of the second sensor is taken as the detection distance determined by the group
  • the detection distance of the first sensor is taken as the detection distance determined by the group
  • the detection distance of the super first sensor and the detection distance of the second sensor are merged to obtain the determined detection distance of the group.
  • the sensor module includes five ultrasonic sensors and four infrared sensors, and five ultrasonic sensors and four infrared sensors are arc-length on a semi-arc. Interval installation, forming two adjacent ultrasonic sensors and an intermediate infrared sensor as a group of three groups, so that the sensor module can detect within 180 degrees of the front of the robot Obstacles, thereby increasing the detection range, avoiding obstacles as much as possible, and achieving safe and collision-free tracking. Since the ultrasonic sensor has a relatively accurate detection range of 0.8 to 7 m, and the infrared sensor has a relatively accurate detection range of 0.4 m or less, the sensor module on the robot is divided into three segments.
  • the first segment is measured separately for four infrared sensors, and the measured distance ranges from 0 to 0.4 m.
  • the second segment is the distance between the five ultrasonic sensors and the four infrared sensors measured in the range of 0.4 to 0.8 m, and the third segment is five.
  • the ultrasonic sensors are measured separately and the measured distance ranges from 0.8 to 7 m.
  • x is in the range of 0.6 to 0.8
  • the value of a is 0.5 to 1.
  • the value of a is proportional to the value of x; when y is in the range of 0.4 to 0.6, the value of y varies from 0.5 to 1, and y is negatively proportional to b.
  • the ultrasonic sensor and the infrared sensor on the robot detect the surrounding obstacles in real time and send the detection results to the microcontroller.
  • the microcontroller can know which direction the obstacle is in according to the changes of the two detection data before and after. According to the distance detected by the multiple sensors, it can be known which sensors are between the detection angles of the sensors, and according to the distance detected by the sensor, this angle multiplied by twice the distance is the size of the obstacle.
  • the total speed is obtained by dividing the difference between the distances detected before and after, and dividing by the interval between transmissions. Finally, by subtracting the speed of the robot from the total speed, the moving speed of the obstacle can be obtained.
  • the sensor module can obtain the position and size of the obstacle, the static or moving, and the moving speed by transmitting the data detected in real time to the microcontroller, and then adjust the motion state according to the structure and size of the structure itself, thereby bypassing. Obstacle tracking.
  • the comprehensive and reliable detection of obstacles is realized in turn, thereby avoiding direct collision between the robot and the obstacle.
  • the sensor module is inexpensive to use, and multiple detections are formed by using multiple sensors, the reliability of detection is improved while reducing costs.
  • the robot following method 10 further includes:
  • the one-to-one correspondence between the specified gestures and the distance between the robot and the tracking object includes: the plurality of specified gestures include waving, waving, and raising the hand.
  • the robot stops at its original position.
  • a camera module is further disposed on the robot.
  • a number of specified gesture analysis programs are stored in advance in the microprocessor controller, and a number of specified gestures are in one-to-one correspondence with the distance between the robot and the tracking object.
  • Such gestures as preset may include three gestures of beckoning, waving, and raising a hand. After beckoning, the robot will walk closer to the tracking object; instead, the robot will retreat to a farther distance from the tracking object; after raising the hand, the robot will stop at its original place.
  • the solution is not limited to these three gestures, and the user can set different types of gestures according to requirements.
  • the position of the tracking object is acquired by the Bluetooth receiving module to adjust the direction of the camera module, so that the camera module always faces the tracking object.
  • a program for judging the distance between the robot and the tracking object according to different gestures is pre-stored in the microcontroller. After the camera module sends the captured gesture of the tracking object to the microcontroller, the microcontroller determines the distance that the robot should keep with the tracking object by recognizing the gesture acquired by the module, and then adjusts its own motion posture to achieve This distance is within range.
  • the tracking object is first found through the Bluetooth receiving module and the distance and direction of the tracking object are determined.
  • the Bluetooth receiving module and the sensor module send the monitored data to the micro-controller every 100 ms.
  • the distance between the robot and the tracking object ranges from 0.5 to 1 meter, and the robot calculates the tracking object based on the detected speed of itself and the distance between two adjacent detected objects. The speed, and adjust your own speed is consistent with the tracking object.
  • the robot detects the change of the direction of the tracking object, it will automatically adjust the two servo motors.
  • the speed makes the two rear wheels differential to achieve steering tracking.
  • the sensor module on the robot detects the surrounding obstacles in real time and sends the detection results to the microcontroller.
  • the microprocessor determines the position and size of the obstacle, the static or moving, and the moving speed through data analysis. Then, according to the structure and size of the structure itself, adjust the state of motion to track the obstacles.
  • the robot of the invention has the advantages of simple operation, accurate precision and relatively low cost, high intelligence degree, can be used in a complicated environment, and is easy to be widely promoted.

Abstract

A robot following method, comprising: recognizing a tracked object; monitoring the intensity of a Bluetooth signal received by two Bluetooth receiving modules (132) which are arranged on the robot at an interval of L meters; according to the monitored intensity of the Bluetooth signal, respectively calculating distances L1 and L2 between the two Bluetooth receiving modules (132) and a Bluetooth transmitting module (131); acquiring foremost two groups of L1 and L2, and according to L, L1 and L2, calculating the speed and direction of the tracked object; according to the calculated speed and direction of the tracked object, adjusting the speed and direction of the robot; receiving a detection range of a sensor in each group and according to a pre-set rule, acquiring a minimum value of each group to be used as a determined detection range of this group; according to the latest determined detection range, determining the distance and direction of an obstacle; and according to the speed of the robot and changes in time and distance of the detection range sent by a sensor module twice, determining a position of an obstacle and bypassing the obstacle. The robot following method has the advantages of being simple in use, low in cost and easy to popularize in a wide range.

Description

一种机器人跟随方法Robot following method 技术领域Technical field
本发明涉及机器人技术领域,尤其涉及一种机器人跟随方法。The present invention relates to the field of robot technology, and in particular, to a robot following method.
背景技术Background technique
随着社会的发展和科技的进步,机器人在生产与生活中占据着越来越多的位置。由于微处理控制器和传感器的广泛使用,现代机器人的功能和精确程度越来越完善。机器人的跟随功能在机器人跟随方法中占具重要比较重要的地位,其在工厂生产、医院、商场导购当中具有重要的作用。With the development of society and the advancement of technology, robots occupy more and more positions in production and life. Due to the widespread use of microprocessor controllers and sensors, the functionality and precision of modern robots are becoming more sophisticated. The follow-up function of the robot plays an important role in the robot follow-up method, and it plays an important role in factory production, hospitals, and shopping malls.
目前的跟随机器人多是由计算机通过实况视频来指定所跟随的对象,并根据传感器的数据作为依据来通过计算机实现避开障碍物。这种机器人使用复杂,成本高,不利于推广应用。Most of the current follow-up robots use a computer to specify the objects to be followed by live video, and use the computer as a basis to avoid obstacles. This kind of robot is complicated to use and high in cost, which is not conducive to popularization and application.
发明内容Summary of the invention
本发明的目的在于提供一种使用方便、成本低廉的机器人跟随方法,该机器人跟随方法具有自动跟随跟踪对象且自动避开障碍物的功能。It is an object of the present invention to provide a robot following method that is easy to use and low in cost, and has a function of automatically following a tracking object and automatically avoiding an obstacle.
为解决上述技术问题,发明采用如下所述的技术方案。一种机器人跟随方法,所述机器人包括蓝牙模块和传感器模块,所述蓝牙模块包括两个蓝牙接收模块和一个蓝牙发射模块,所述传感器模块包括若干第一传感器和若干第二传感器,所述若干第一传感器和若干第二传感器形成至少一组,其特征在于,包括:识别跟踪对象,所述跟踪对象配置有所述蓝牙发射模块;监测机器人上间隔L米设置的两个蓝牙接收模块接收蓝牙信号的强度;根据监测到的蓝牙信号强度分别计算两个蓝牙接收模块与蓝牙发射模块之间的距离L1和L2;获取最新的两组L1和L2,并根据L、L1和L2计算跟踪对象的速度和方向;根据计 算的跟踪对象的速度和方向调整机器人的速度与方向;接收每组中第一传感器和第二传感器的探测距离;按照预定的规则获取每组的最小值作为该组确定的探测距离;根据最新的两个探测距离和机器人自身的速度与方向来判断障碍物的距离和方向;根据机器人的速度与前后两次传感器模块发送探测距离的时间和距离的变化,判断障碍物的位置并绕开障碍物进行跟踪。In order to solve the above technical problems, the invention adopts the technical solution described below. A robot following method, the robot includes a Bluetooth module and a sensor module, the Bluetooth module includes two Bluetooth receiving modules and a Bluetooth transmitting module, the sensor module includes a plurality of first sensors and a plurality of second sensors, the plurality of The first sensor and the plurality of second sensors form at least one group, and the method includes: identifying a tracking object, the tracking object is configured with the Bluetooth transmitting module; and monitoring two Bluetooth receiving modules on the robot with an interval of L meters to receive the Bluetooth The strength of the signal; calculate the distances L1 and L2 between the two Bluetooth receiving modules and the Bluetooth transmitting module according to the detected Bluetooth signal strength; obtain the latest two groups of L1 and L2, and calculate the tracking object according to L, L1 and L2 Speed and direction; Calculating the speed and direction of the tracking object to adjust the speed and direction of the robot; receiving the detection distances of the first sensor and the second sensor in each group; acquiring the minimum value of each group according to a predetermined rule as the detection distance determined by the group; The two detection distances and the speed and direction of the robot itself to determine the distance and direction of the obstacle; according to the speed of the robot and the change of the time and distance of the detection distance sent by the two sensor modules before and after, determine the position of the obstacle and bypass the obstacle The object is tracked.
优选地,所述根据监测到的蓝牙信号强度分别计算两个蓝牙接收模块与跟踪对象之间的距离L1和L2包括:采集蓝牙信号强度的当前RSSI值,根据预设滤波算法对当前RSSI值进行处理,得到当前RSSI基值;采用离线BP神经网络算法对当前RSSI基值处理,得到蓝牙发射模块与两个蓝牙接收模块之间的距离L1和L2。Preferably, the calculating the distances L1 and L2 between the two Bluetooth receiving modules and the tracking object according to the monitored Bluetooth signal strength respectively includes: collecting a current RSSI value of the Bluetooth signal strength, and performing current RSSI values according to a preset filtering algorithm. Processing, obtaining the current RSSI base value; using the offline BP neural network algorithm to process the current RSSI base value, and obtaining the distances L1 and L2 between the Bluetooth transmitting module and the two Bluetooth receiving modules.
优选地,所述获取最新的两组L1和L2并根据L、L1和L2计算跟踪对象的速度和方向,根据计算的跟踪对象的速度和方向调整机器人的速度与方向包括:获得机器人的速度;根据前后两次测得的蓝牙发射模块与两个蓝牙接收模块的距离,得到跟踪对象的速度,并根据获得的跟踪对象的速度调整机器人速度与跟踪对象的速度一致;根据前后两次测得的蓝牙发射模块与两个蓝牙接收模块的距离计算跟踪对象的转向角度,并根据获得的跟踪对象的转向角度调整机器人的方向与跟踪对象的方向一致。Preferably, the acquiring the latest two groups L1 and L2 and calculating the speed and direction of the tracking object according to L, L1 and L2, and adjusting the speed and direction of the robot according to the calculated speed and direction of the tracking object comprises: obtaining the speed of the robot; According to the distance between the Bluetooth transmitting module and the two Bluetooth receiving modules measured twice before and after, the speed of the tracking object is obtained, and the speed of the robot is adjusted according to the speed of the obtained tracking object, which is consistent with the speed of the tracking object; The distance between the Bluetooth transmitting module and the two Bluetooth receiving modules calculates the steering angle of the tracking object, and adjusts the direction of the robot to be consistent with the direction of the tracking object according to the obtained steering angle of the tracking object.
优选地,所述传感器模块包括若干第一传感器和若干第二传感器,所述若干第一传感器和若干第二传感器形成至少一组为:所述传感器模块为预先设置在机器人半圆弧上的五个第一传感器和四个第二传感器,且五个第一传感器和四个第二传感器等弧长间隔设置,并将相邻的两个第一传感器和一个第二传感器设置为一组,共分为三组。Preferably, the sensor module includes a plurality of first sensors and a plurality of second sensors, and the plurality of first sensors and the plurality of second sensors form at least one group: the sensor module is five preset on a semicircular arc of the robot a first sensor and four second sensors, and five first sensors and four second sensors are arranged in an arc length interval, and the adjacent two first sensors and one second sensor are set as a group Divided into three groups.
优选地,所述第一传感器是超声波为超声波传感器,所述第二传感器是红外传感器。Preferably, the first sensor is an ultrasonic sensor and the second sensor is an infrared sensor.
优选地,所述按照预定的规则获取每组的最小值作为该组确定的探测距离包括:当探测到障碍物的距离为第一预设范围内时,取第二传感器的探测距离作为该组确定的探测距离;当探测到障碍物的距离为第二预设范围内时,取第 一传感器的探测距离作为该组确定的探测距离;当探测到障碍物的距离在第三预设范围内时,将超第一传感器的探测距离和第二传感器的探测距离进行融合,得到该组确定的探测距离。Preferably, the obtaining the minimum value of each group according to a predetermined rule as the detection distance determined by the group includes: when the distance of detecting the obstacle is within the first preset range, taking the detection distance of the second sensor as the group The determined detection distance; when the distance of the obstacle is detected to be within the second preset range, The detection distance of a sensor is used as the detection distance determined by the group; when the distance of the obstacle is detected within the third preset range, the detection distance of the first sensor and the detection distance of the second sensor are merged to obtain the group. Determined detection distance.
优选地,所述将第一传感器的探测距离和第二传感器的探测距离进行融合,得到该组确定的探测距离,所述融合方法为:d=a×x+b×y,其中,d为障碍物的距离,x为第一传感器的探测距离,y为第二传感器的探测距离,a和b的值由x和y的值决定,当x在0.6~0.8的范围内时,a的值在0.5~1的范围内变化,在这个范围内,a的值与x的值成正比关系;当y在0.4~0.6的范围内时,y的值在0.5~1的范围内变化,y与b成负比例关系;当出现x>0.6,y<0.6时,a和b的值均取0.5。Preferably, the combining the detection distance of the first sensor and the detection distance of the second sensor to obtain the determined detection distance of the group, the fusion method is: d=a×x+b×y, where d is The distance of the obstacle, x is the detection distance of the first sensor, y is the detection distance of the second sensor, and the values of a and b are determined by the values of x and y. When x is in the range of 0.6 to 0.8, the value of a In the range of 0.5 to 1, the value of a is proportional to the value of x; when y is in the range of 0.4 to 0.6, the value of y varies from 0.5 to 1, y and b is in a negative proportional relationship; when x>0.6, y<0.6, the values of a and b are both 0.5.
优选地,所述根据机器人的速度与前后两次传感器模块发送探测距离的时间和距离的变化,判断障碍物的位置并绕开障碍物进行跟踪包括:根据前后两次确定的探测距离判断障碍物的距离和方向、判断障碍物的运动状态、运动速度及障碍物大小。Preferably, the determining the position of the obstacle and tracking the obstacle according to the change of the time and distance of the speed of the robot and the sending of the detection distance by the two sensor modules before and after the method comprises: determining the obstacle according to the detection distance determined twice before and after The distance and direction, the movement state of the obstacle, the speed of movement and the size of the obstacle.
优选地,所述机器人跟随方法还包括:预存跟踪对象的若干指定手势,并将若干指定手势与机器人和跟踪对象之间的距离进行一一对应;识别跟踪对象的若干指定手势,根据识别到的指定手势调整机器人到对应的距离。Preferably, the robot following method further comprises: pre-storing a plurality of specified gestures of the tracking object, and one-to-one correspondence between the specified gestures and the distance between the robot and the tracking object; identifying a plurality of specified gestures of the tracking object, according to the identified Specify the gesture to adjust the robot to the corresponding distance.
优选地,所述若干指定手势与机器人和跟踪对象之间的距离进行一一对应包括:所述若干指定手势包括招手、摆手和举手,当跟踪对象招手时,调整机器人前行至与跟随对象更近的指定距离,当跟踪对象摆手时,调整机器人后退至与跟随对象更远的指定距离,当跟踪对象举手时,机器人自行停止在原来的位置。Preferably, the one-to-one correspondence between the plurality of specified gestures and the distance between the robot and the tracking object includes: the plurality of specified gestures include beckoning, waving, and raising a hand, and adjusting the robot to the following object when the tracking object is beckoning The specified distance is closer. When the tracking object swings, the adjustment robot retreats to a specified distance farther from the following object. When the tracking object raises the hand, the robot stops at its original position.
本发明的有益技术效果在于:该机器人跟随方法通过设置在跟踪对象上的蓝牙发射模块及两个设置在机器人上的蓝牙接收模块建立连接,来计算跟踪对象的距离和方向,从而实现对跟踪对象自动跟随。同时,通过前后两次确定的探测距离判断障碍物的距离和方向,根据机器人的速度与前后两次传感器模块发送探测距离的时间和距离的变化,判断障碍物的位置,从而实现绕开障碍物。 本发明的机器人跟随方法采用具有自动跟随跟踪对象且自动避开障碍物的功能,且其具有使用简单、操作方便、成本低廉、智能化程度高且易于大范围推广的优点。The beneficial technical effect of the present invention is that the robot following method establishes a connection by a Bluetooth transmitting module disposed on the tracking object and two Bluetooth receiving modules disposed on the robot, thereby calculating a distance and a direction of the tracking object, thereby implementing the tracking object. Automatically follow. At the same time, the distance and direction of the obstacle are determined by the detection distance determined twice before and after, and the position of the obstacle is determined according to the speed of the robot and the time and distance of the detection distance sent by the two sensor modules before and after, thereby achieving the obstacle avoidance. . The robot following method has the functions of automatically following the tracking object and automatically avoiding the obstacle, and has the advantages of simple use, convenient operation, low cost, high intelligence, and easy wide-scale promotion.
附图说明DRAWINGS
图1是较佳实施例提供的一种机器人的结构图。1 is a structural view of a robot provided by a preferred embodiment.
图2是图1传感器模块的分布图。2 is a distribution diagram of the sensor module of FIG. 1.
图3是较佳实施例提供的一种机器人跟随方法的流程图。FIG. 3 is a flow chart of a robot following method according to a preferred embodiment.
具体实施方式detailed description
为使本领域的普通技术人员更加清楚地理解发明的目的、技术方案和优点,以下结合附图和实施例对发明做进一步的阐述。The invention will be further described below in conjunction with the drawings and embodiments in order to provide a further understanding of the invention.
图1是较佳实施例提供的一种机器人的结构图。机器人1包括机器人本体11、微控制器12、蓝牙模块13、驱动模块14以及传感器模块15。蓝牙模块13、驱动模块14及传感器模块15分别与微控制器12电连接。蓝牙模块13包括设置在跟踪对象上的蓝牙发射模块131及两个设置在机器人本体11上的蓝牙接收模块132,用于确定机器人本体11相对跟踪对象之间的距离和方向。传感器模块15用于探测障碍物。微控制器12接收蓝牙模块13和传感器模块15的反馈信息以控制驱动模块15驱动机器人本体11动作,从而实现对跟踪对象的自动跟随。1 is a structural view of a robot provided by a preferred embodiment. The robot 1 includes a robot body 11, a microcontroller 12, a Bluetooth module 13, a drive module 14, and a sensor module 15. The Bluetooth module 13, the drive module 14, and the sensor module 15 are electrically connected to the microcontroller 12, respectively. The Bluetooth module 13 includes a Bluetooth transmitting module 131 disposed on the tracking object and two Bluetooth receiving modules 132 disposed on the robot body 11 for determining the distance and direction between the robot body 11 and the tracking object. The sensor module 15 is used to detect obstacles. The microcontroller 12 receives the feedback information of the Bluetooth module 13 and the sensor module 15 to control the driving module 15 to drive the robot body 11 to operate, thereby implementing automatic tracking of the tracking object.
优选地,在本实施例中,机器人本体11上还包设置有控制电路板及设置在控制电路板上的监测装置18。微控制器12与监测装置18分别与控制电路板电连接。监测装置18用于监测蓝牙接收装置132接收信号的功率,并依此确定机器人本体11与跟踪对象之间的距离。Preferably, in the embodiment, the robot body 11 further includes a control circuit board and a monitoring device 18 disposed on the control circuit board. The microcontroller 12 and the monitoring device 18 are electrically connected to the control circuit board, respectively. The monitoring device 18 is configured to monitor the power of the Bluetooth receiving device 132 to receive the signal, and thereby determine the distance between the robot body 11 and the tracking object.
参照图2所示,传感器模块15的分布示意图,将五个超声波传感器151和四个红外传感器152在半圆弧上等弧长地相间隔安装,形成两个相邻的超声波传感器151和中间的红外传感器152为一组的三个组别,以使传感器模块15 能够探测到机器人本体11前面180度以内的障碍物,从而增大检测范围,尽可能的避开障碍物,实现安全无碰撞的跟踪。Referring to FIG. 2, the distribution diagram of the sensor module 15 is such that five ultrasonic sensors 151 and four infrared sensors 152 are equally spaced apart on the semicircular arc to form two adjacent ultrasonic sensors 151 and the middle. The infrared sensor 152 is a group of three groups to make the sensor module 15 It can detect obstacles within 180 degrees of the front of the robot body 11, thereby increasing the detection range, avoiding obstacles as much as possible, and achieving safe and collision-free tracking.
本实施例中,驱动模块14包括四个滚轮与两个驱动机构。优选地,驱动机构采用伺服电机。In this embodiment, the driving module 14 includes four rollers and two driving mechanisms. Preferably, the drive mechanism employs a servo motor.
优选地,机器人本体11上还设置有摄像头模块16,且摄像头模块16与微控制器12电连接。优选地,在本实施例中,电路控制板上还设置存储模块11及识别模块19。存储模块17用于保存预先设定的手势,识别模块19用于根据摄像头模块16拍摄到的手势进行识别并依此确定机器人本体11的跟随动作。预先将手势图像分析程序储存在微处理控制器12中,并将设定的手势保存到存储模块17中。如预先设定的手势可包括招手、摆手和举手三个手势。招手后,机器人会行走到与跟踪对象更近的距离;摆手则相反,机器人会后退到离跟踪对象更远的距离;而举手后,机器人会自行停止在原来的地方。当然,本方案并不局限于这三个手势,用户可根据需求设定不同类型的手势。Preferably, the camera body 16 is further disposed on the robot body 11 , and the camera module 16 is electrically connected to the microcontroller 12 . Preferably, in this embodiment, the storage module 11 and the identification module 19 are further disposed on the circuit control board. The storage module 17 is configured to save a preset gesture, and the identification module 19 is configured to recognize according to the gesture captured by the camera module 16 and determine the following action of the robot body 11 accordingly. The gesture image analysis program is stored in advance in the microprocessor controller 12, and the set gesture is saved to the storage module 17. Such gestures as preset may include three gestures of beckoning, waving, and raising a hand. After beckoning, the robot will walk closer to the tracking object; instead, the robot will retreat to a farther distance from the tracking object; after raising the hand, the robot will stop at its original place. Of course, the solution is not limited to these three gestures, and the user can set different types of gestures according to requirements.
参照图3所示,较佳实施例提供的一种机器人跟随方法的流程图。机器人跟踪方法10包括:Referring to FIG. 3, a flow chart of a robot following method is provided by the preferred embodiment. The robot tracking method 10 includes:
101:识别跟踪对象,跟踪对象配置有蓝牙发射模块;101: Identify a tracking object, where the tracking object is configured with a Bluetooth transmitting module;
102:监测机器人上间隔L米设置的两个蓝牙接收模块接收蓝牙信号的强度;102: Monitor the strength of the Bluetooth signal received by the two Bluetooth receiving modules set by the interval L meter on the robot;
103:根据监测到的蓝牙信号强度分别计算两个蓝牙接收模块与蓝牙发射模块之间的距离L1和L2;103: Calculate distances L1 and L2 between two Bluetooth receiving modules and a Bluetooth transmitting module according to the detected Bluetooth signal strength;
104:获取最新的两组L1和L2,并根据L、L1和L2计算跟踪对象的速度和方向;104: Obtain the latest two groups of L1 and L2, and calculate the speed and direction of the tracking object according to L, L1 and L2;
105:根据计算的跟踪对象的速度和方向调整机器人的速度与方向;105: Adjusting the speed and direction of the robot according to the calculated speed and direction of the tracking object;
106:接收每组中第一传感器和第二传感器的探测距离;106: receiving a detection distance of the first sensor and the second sensor in each group;
107:按照预定的规则获取每组的最小值作为该组确定的探测距离;107: Obtain a minimum value of each group according to a predetermined rule as a detection distance determined by the group;
108:根据最新的两个探测距离和机器人自身的速度与方向来判断障碍物的距离和方向; 108: Determine the distance and direction of the obstacle according to the latest two detection distances and the speed and direction of the robot itself;
109:根据机器人的速度与前后两次传感器模块发送探测距离的时间和距离的变化,判断障碍物的位置并绕开障碍物进行跟踪。109: According to the speed of the robot and the change of the time and distance of the detection distance sent by the two sensor modules before and after, the position of the obstacle is judged and the obstacle is tracked.
具体地,101:识别跟踪对象,跟踪对象配置有蓝牙发射模块包括:Specifically, 101: identifying a tracking object, where the tracking object is configured with a Bluetooth transmitting module, including:
跟踪对象佩戴蓝牙发射模块,并与设置在机器人上的两个蓝牙接收模块建立连接。跟踪对象不局限于人,也可以其他可移动的物体。在本实施例中,跟踪对象设定为人,也就是用户。使用时,用户佩戴蓝牙发射模块,两个蓝牙接收模块间隔设置在机器人上,以通过蓝牙发射模块与蓝牙接收模块之间的连接实现机器人与跟踪对象之间的连接。The tracking object wears a Bluetooth transmitting module and establishes a connection with two Bluetooth receiving modules disposed on the robot. Tracking objects are not limited to people, but also other movable objects. In this embodiment, the tracking object is set to be a person, that is, a user. In use, the user wears a Bluetooth transmitting module, and two Bluetooth receiving modules are arranged on the robot at intervals to realize a connection between the robot and the tracking object through a connection between the Bluetooth transmitting module and the Bluetooth receiving module.
102:根据监测到的蓝牙信号强度分别计算两个蓝牙接收模块与跟踪对象之间的距离L1和L2包括:102: Calculate the distances L1 and L2 between the two Bluetooth receiving modules and the tracking object according to the detected Bluetooth signal strength respectively, including:
具体地,在本实施例中,机器人上置有控制电路板及设置在控制电路板上的监测装置。监测装置用于监测蓝牙接收模块接收信号的功率,并依此确定机器人与跟踪对象之间的距离。具体地,根据监测到的蓝牙信号强度分别计算两个蓝牙接收模块与跟踪对象之间的距离L1和L2包括:Specifically, in the embodiment, the robot is provided with a control circuit board and a monitoring device disposed on the control circuit board. The monitoring device is configured to monitor the power of the signal received by the Bluetooth receiving module, and thereby determine the distance between the robot and the tracking object. Specifically, calculating the distances L1 and L2 between the two Bluetooth receiving modules and the tracking object according to the monitored Bluetooth signal strength respectively includes:
采集蓝牙信号强度的当前RSSI值,根据预设滤波算法对当前RSSI值进行处理,得到当前RSSI基值;Collecting the current RSSI value of the Bluetooth signal strength, and processing the current RSSI value according to a preset filtering algorithm to obtain a current RSSI base value;
采用离线BP神经网络算法对当前RSSI基值处理,得到蓝牙发射模块与两个蓝牙接收模块之间的距离L1和L2。The offline BP neural network algorithm is used to process the current RSSI base value, and the distances L1 and L2 between the Bluetooth transmitting module and the two Bluetooth receiving modules are obtained.
当机器人工作时,监测装置通过监测两个蓝牙接收装置接收到的信号功率来测量出机器人本体与用户之间的距离L1和L2。在本实施例中,采用基于RSSI(Received Signal Strength Indicator接收信号的强度指示)无线定位方式及跳水滤波和高斯滤波结合的滤波方法测量距离。在接收到的当前RSSI值中,去掉最大值和最小值,然后再通过加权平均求出当前RSSI基值,以减小由于干扰带来的RSSI值的误差。采用离线BP(Back Propagation)神经网络算法通过得到的当前RSSI基值分别计算出蓝牙发射模块与两个蓝牙接收模块之间的距离。蓝牙信号在自由空间中的传播公式为: When the robot is working, the monitoring device measures the distances L1 and L2 between the robot body and the user by monitoring the signal power received by the two Bluetooth receiving devices. In this embodiment, the distance is measured by a filtering method based on a RSSI (Received Signal Strength Indicator) wireless positioning method and a combination of hopping filtering and Gaussian filtering. In the received current RSSI value, the maximum value and the minimum value are removed, and then the current RSSI base value is obtained by weighted averaging to reduce the error of the RSSI value due to interference. The offline BP (Back Propagation) neural network algorithm is used to calculate the distance between the Bluetooth transmitting module and the two Bluetooth receiving modules by using the obtained current RSSI base value. The propagation formula of Bluetooth signal in free space is:
Figure PCTCN2015089127-appb-000001
Figure PCTCN2015089127-appb-000001
其中,d为两点之间的距离,p为衰减的功率,k为随机变量因子,α为信号衰减因子。由于使用环境复杂,k和α具有很大的不确定性。采用BP神经网络算法的非线性连续映射功能来进行离线测量仿真,BP神经网络由输入层、中间隐层和输出层构成,在实际实验获取的当前RSSI基值和距离值下,分别对隐层神经元个数为a、b、c、d……时进行仿真,然后通过仿真后的模型距离与实际的误差曲线图,选出误差最小的神经元个数作为输入参数来计算蓝牙发射模块和两个蓝牙接收模块之间的距离L1和L2。Where d is the distance between two points, p is the power of attenuation, k is the random variable factor, and α is the signal attenuation factor. Due to the complex use environment, k and α have great uncertainty. The nonlinear continuous mapping function of BP neural network algorithm is used to perform offline measurement simulation. BP neural network consists of input layer, intermediate hidden layer and output layer. Under the current RSSI base value and distance value obtained by actual experiments, the hidden layer is respectively When the number of neurons is a, b, c, d..., the simulation is performed, and then the simulated model distance and the actual error curve are selected, and the number of neurons with the smallest error is selected as the input parameter to calculate the Bluetooth transmitting module and The distance between two Bluetooth receiving modules, L1 and L2.
104:获取最新的两组L1和L2,并根据L、L1和L2计算跟踪对象的速度和方向,及105:根据计算的跟踪对象的速度和方向调整机器人的速度与方向包括:104: Obtain the latest two groups of L1 and L2, and calculate the speed and direction of the tracking object according to L, L1 and L2, and 105: adjust the speed and direction of the robot according to the calculated speed and direction of the tracking object, including:
获得机器人的速度;Get the speed of the robot;
根据前后两次测得的蓝牙发射模块与两个蓝牙接收模块的距离,得到跟踪对象的速度,并根据获得的跟踪对象的速度调整机器人速度与跟踪对象的速度一致;According to the distance between the Bluetooth transmitting module and the two Bluetooth receiving modules measured twice before and after, the speed of the tracking object is obtained, and the speed of the robot is adjusted according to the speed of the obtained tracking object to be consistent with the speed of the tracking object;
根据前后两次测得的蓝牙发射模块与两个蓝牙接收模块的距离计算跟踪对象的转向角度,并根据获得的跟踪对象的转向角度调整机器人的方向与跟踪对象的方向一致。The steering angle of the tracking object is calculated according to the distance between the Bluetooth transmitting module and the two Bluetooth receiving modules measured twice before and after, and the direction of the robot is adjusted according to the steering angle of the obtained tracking object.
具体地,机器人的驱动机构采用伺服电机。伺服电机通过PID(比例(proportion)、积分(integration)、微分(differentiation))控制算法其转速,从而控制机器人的速度。由于伺服电机内部内置有霍尔传感器,当伺服电机转动时,伺服电机每转动一圈,霍尔传感器就会发出若干组信号,选取这些信号中的一个作为测试依据,并记录其两个相邻脉冲之间的时间,再用滚轮的直径除以脉冲时间,即可计算出滚轮当前的速度,并能够通过PID控制算法对伺服电机进行调速控制,依此伺服电机的速度和位置调节精度非常准确,从而使得机器人有很好的跟随性能。在本实施例中,驱动机构包括四个滚轮。四个滚轮 分为前后两对,每个后轮作为驱动轮,其连接着一个驱动机构,前轮作为从动轮,其可以在任意方向上转动。两个蓝牙接收模块间隔L米设置,根据RSSI测量方法得到用户身上的蓝牙发射模块分别到两个蓝牙接收模块的距离分别为L1和L2,通过L、L1和L2来计算跟踪对象的距离和方向,以定位用户的位置。然后采用电子差速转向方式进行转向,通过两个伺服电机对两个后轮之间的加速,然后根据测量出的速度和所需转向的角度来控制两个电机各自的速度,使两个驱动轮的速度产生差别,进而达到转向的目的,从而实现根据获得的跟踪对象的速度和方向调整机器人的速度与方向,实现机器人的自动跟踪功能。同时藉由蓝牙发射模块与两个蓝牙接收模块测量跟踪对象的距离和转向,相对现有技术,不仅降低了成本,而且增加了产品的推广性和实用性。Specifically, the driving mechanism of the robot employs a servo motor. The servo motor controls the speed of the algorithm by PID (proportion, integration, differentiation) to control the speed of the robot. Since the servo motor has a built-in Hall sensor, when the servo motor rotates, the Hall sensor emits several sets of signals every time the servo motor rotates, and one of these signals is selected as the test basis, and two adjacent ones are recorded. The time between the pulses, and then the diameter of the roller divided by the pulse time, can calculate the current speed of the roller, and can control the speed of the servo motor through the PID control algorithm, according to which the speed and position adjustment accuracy of the servo motor is very high. Accurate, so that the robot has good follow-up performance. In this embodiment, the drive mechanism includes four rollers. Four wheels It is divided into two pairs of front and rear. Each rear wheel acts as a drive wheel, which is connected to a drive mechanism. The front wheel acts as a driven wheel, which can rotate in any direction. The two Bluetooth receiving modules are set at intervals of L meters. According to the RSSI measurement method, the distances between the Bluetooth transmitting modules on the user and the two Bluetooth receiving modules are respectively L1 and L2, and the distance and direction of the tracking object are calculated by L, L1 and L2. To locate the user's location. Then, the electronic differential steering mode is used for steering, the acceleration between the two rear wheels is performed by two servo motors, and then the respective speeds of the two motors are controlled according to the measured speed and the angle of the required steering, so that the two drives The speed of the wheel is different, and the purpose of steering is achieved, so that the speed and direction of the robot are adjusted according to the obtained speed and direction of the tracking object, and the automatic tracking function of the robot is realized. At the same time, the distance and the steering of the tracking object are measured by the Bluetooth transmitting module and the two Bluetooth receiving modules. Compared with the prior art, the cost is not only reduced, but also the product promotion and practicability are increased.
具体地,传感器模块包括若干第一传感器和若干第二传感器,若干第一传感器和若干第二传感器形成至少一组为:Specifically, the sensor module includes a plurality of first sensors and a plurality of second sensors, and the plurality of first sensors and the plurality of second sensors form at least one group:
传感器模块为预先设置在机器人半圆弧上的五个第一传感器和四个第二传感器,且五个第一传感器和四个第二传感器等弧长间隔设置,并将相邻的两个第一传感器和一个第二传感器设置为一组,共分为三组。优选地,第一传感器为超声波传感器,第二传感器是红外传感器。The sensor module is five first sensors and four second sensors preset on the semicircular arc of the robot, and five first sensors and four second sensors are arranged at an arc length interval, and the adjacent two A sensor and a second sensor are arranged in a group and are divided into three groups. Preferably, the first sensor is an ultrasonic sensor and the second sensor is an infrared sensor.
107:按照预定的规则获取每组的最小值作为该组确定的探测距离包括:107: Obtain a minimum value of each group according to a predetermined rule as the detection distance determined by the group includes:
当探测到障碍物的距离为第一预设范围内时,取第二传感器的探测距离作为该组确定的探测距离;When the distance of the obstacle is detected to be within the first preset range, the detection distance of the second sensor is taken as the detection distance determined by the group;
当探测到障碍物的距离为第二预设范围内时,取第一传感器的探测距离作为该组确定的探测距离;When the distance of the obstacle is detected to be within the second preset range, the detection distance of the first sensor is taken as the detection distance determined by the group;
当探测到障碍物的距离在第三预设范围内时,将超第一传感器的探测距离和第二传感器的探测距离进行融合,得到该组确定的探测距离。When the distance of the obstacle is detected within the third preset range, the detection distance of the super first sensor and the detection distance of the second sensor are merged to obtain the determined detection distance of the group.
为了实现机器人自动避开障碍物的功能,在本实施例中,传感器模块包括五个超声波传感器和四个红外传感器,且五个超声波传感器和四个红外传感器在半圆弧上等弧长地相间隔安装,形成两个相邻的超声波传感器和中间的红外传感器为一组的三个组别,以使传感器模块能够探测到机器人前面180度以内 的障碍物,从而增大检测范围,尽可能的避开障碍物,实现安全无碰撞的跟踪。由于超声波传感器较准确的探测范围是0.8~7m之间的距离,红外传感器较准确的探测范围是0.4m以内,因此机器人上的传感器模块分为三段式检测。第一段为四个红外传感器单独测量,其测量的距离范围为0~0.4m,第二段为五个超声波传感器和四个红外传感器共同测量的距离范围0.4~0.8m,第三段为五个超声波传感器单独测量,测量的距离范围为0.8~7m。采集数据时,对每组的三个传感器测量到的距离进行融合,取其中较小的那个数据作为该组的输入数据。In order to realize the function of the robot to automatically avoid obstacles, in the embodiment, the sensor module includes five ultrasonic sensors and four infrared sensors, and five ultrasonic sensors and four infrared sensors are arc-length on a semi-arc. Interval installation, forming two adjacent ultrasonic sensors and an intermediate infrared sensor as a group of three groups, so that the sensor module can detect within 180 degrees of the front of the robot Obstacles, thereby increasing the detection range, avoiding obstacles as much as possible, and achieving safe and collision-free tracking. Since the ultrasonic sensor has a relatively accurate detection range of 0.8 to 7 m, and the infrared sensor has a relatively accurate detection range of 0.4 m or less, the sensor module on the robot is divided into three segments. The first segment is measured separately for four infrared sensors, and the measured distance ranges from 0 to 0.4 m. The second segment is the distance between the five ultrasonic sensors and the four infrared sensors measured in the range of 0.4 to 0.8 m, and the third segment is five. The ultrasonic sensors are measured separately and the measured distance ranges from 0.8 to 7 m. When collecting data, the distances measured by the three sensors of each group are fused, and the smaller one is taken as the input data of the group.
具体地,将每组的超声波传感器的探测数据和红外传感器的探测数据进行融合,得到该组的输入数据,其融合方法为:d=a×x+b×y,其中,d为障碍物的距离,x为超声波传感器的探测数据,y为红外传感器的探测数据,a和b的值由x和y的值决定,当x在0.6~0.8的范围内时,a的值在0.5~1的范围内变化,在这个范围内,a的值与x的值成正比关系;当y在0.4~0.6的范围内时,y的值在0.5~1的范围内变化,y与b成负比例关系;当出现x>0.6,y<0.6时,a和b的值均取0.5。通过这种融合方式,能够较好地弥补超声波传感器在近距离上探测不够准确和红外传感器在远距离上探测不够准确的问题。Specifically, the detection data of each group of ultrasonic sensors and the detection data of the infrared sensor are fused to obtain input data of the group, and the fusion method is: d=a×x+b×y, where d is an obstacle Distance, x is the detection data of the ultrasonic sensor, y is the detection data of the infrared sensor, and the values of a and b are determined by the values of x and y. When x is in the range of 0.6 to 0.8, the value of a is 0.5 to 1. Within the range, the value of a is proportional to the value of x; when y is in the range of 0.4 to 0.6, the value of y varies from 0.5 to 1, and y is negatively proportional to b. When x>0.6 and y<0.6, the values of a and b are both 0.5. Through this fusion method, it is possible to better compensate for the problem that the ultrasonic sensor is not accurately detected at a close distance and the infrared sensor is not accurately detected at a long distance.
在跟踪的过程中,机器人上的超声波传感器和红外传感器实时探测周围的障碍物并把探测结果发送到微控制器,微控制器根据前后两次探测数据的变化,可以知道障碍物在哪个方向,根据多个传感器所探测到的距离,可以知道障碍物处于哪些传感器的探测角度之间,再根据传感器探测出的距离,这个角度乘以距离的两倍即是障碍物的大小。根据前后探测到的距离之差,再除以发送的间隔时间,即得出总的速度。最后,用总的速度减去机器人的速度,即可得出障碍物的移动速度。因此传感器模块通过将实时探测的数据发送至微控制器可以得到障碍物的位置和大小、静止或者移动以及移动速度的大小,然后根据自己本身结构的和大小来调整自身的运动状态,从而绕开障碍物进行跟踪。依次实现对障碍物的全面可靠的检测,从而避免机器人与障碍物的直接碰撞。此外由于传感器模块使用成本低廉,且由采用多个传感器形成多重检测,在降低成本的同时,提高检测的可靠性。 During the tracking process, the ultrasonic sensor and the infrared sensor on the robot detect the surrounding obstacles in real time and send the detection results to the microcontroller. The microcontroller can know which direction the obstacle is in according to the changes of the two detection data before and after. According to the distance detected by the multiple sensors, it can be known which sensors are between the detection angles of the sensors, and according to the distance detected by the sensor, this angle multiplied by twice the distance is the size of the obstacle. The total speed is obtained by dividing the difference between the distances detected before and after, and dividing by the interval between transmissions. Finally, by subtracting the speed of the robot from the total speed, the moving speed of the obstacle can be obtained. Therefore, the sensor module can obtain the position and size of the obstacle, the static or moving, and the moving speed by transmitting the data detected in real time to the microcontroller, and then adjust the motion state according to the structure and size of the structure itself, thereby bypassing. Obstacle tracking. The comprehensive and reliable detection of obstacles is realized in turn, thereby avoiding direct collision between the robot and the obstacle. In addition, since the sensor module is inexpensive to use, and multiple detections are formed by using multiple sensors, the reliability of detection is improved while reducing costs.
优选地,该机器人跟随方法10还包括:Preferably, the robot following method 10 further includes:
预存跟踪对象的若干指定手势,并将若干指定手势与机器人和跟踪对象之间的距离进行一一对应;识别跟踪对象的若干指定手势,根据识别到的指定手势调整机器人到对应的距离。Pre-storing a number of specified gestures of the tracking object, and one-to-one correspondence between the specified gestures and the distance between the robot and the tracking object; identifying a number of specified gestures of the tracking object, and adjusting the robot to the corresponding distance according to the identified specified gesture.
具体地,若干指定手势与机器人和跟踪对象之间的距离进行一一对应包括:所述若干指定手势包括招手、摆手和举手,Specifically, the one-to-one correspondence between the specified gestures and the distance between the robot and the tracking object includes: the plurality of specified gestures include waving, waving, and raising the hand.
当跟踪对象招手时,调整机器人前行至与跟随对象更近的指定距离,When the tracking object is beckoning, adjust the robot to advance to a specified distance closer to the object to be followed.
当跟踪对象摆手时,调整机器人后退至与跟随对象更远的指定距离,When the tracking object swings, adjust the robot to retreat to a specified distance further from the object to be followed.
当跟踪对象举手时,机器人自行停止在原来的位置。When the tracking object raises the hand, the robot stops at its original position.
优选地,机器人上还设置有摄像头模块。预先将若干指定手势分析程序储存在微处理控制器中,并将若干指定手势与机器人和跟踪对象之间的距离进行一一对应。如预先设定的手势可包括招手、摆手和举手三个手势。招手后,机器人会行走到与跟踪对象更近的距离;摆手则相反,机器人会后退到离跟踪对象更远的距离;而举手后,机器人会自行停止在原来的地方。当然,本方案并不局限于这三个手势,用户可根据需求设定不同类型的手势。Preferably, a camera module is further disposed on the robot. A number of specified gesture analysis programs are stored in advance in the microprocessor controller, and a number of specified gestures are in one-to-one correspondence with the distance between the robot and the tracking object. Such gestures as preset may include three gestures of beckoning, waving, and raising a hand. After beckoning, the robot will walk closer to the tracking object; instead, the robot will retreat to a farther distance from the tracking object; after raising the hand, the robot will stop at its original place. Of course, the solution is not limited to these three gestures, and the user can set different types of gestures according to requirements.
当机器人在跟踪时,通过蓝牙接收模块获取到跟踪对象的位置来调整摄像头模块的方向,以便摄像头模块始终对着跟踪对象。微控制器中预先保存根据不同手势判断机器人与跟踪对象的距离的程序。当摄像头模块把拍摄到的跟踪对象的手势发送到为微控制器上后,微控制器通过识别模块所获取到的手势来确定机器人与跟踪对象应该保持的距离,然后调整自己的运动姿态来达到这个距离范围内。When the robot is tracking, the position of the tracking object is acquired by the Bluetooth receiving module to adjust the direction of the camera module, so that the camera module always faces the tracking object. A program for judging the distance between the robot and the tracking object according to different gestures is pre-stored in the microcontroller. After the camera module sends the captured gesture of the tracking object to the microcontroller, the microcontroller determines the distance that the robot should keep with the tracking object by recognizing the gesture acquired by the module, and then adjusts its own motion posture to achieve This distance is within range.
当该机器人工作时,首先通过蓝牙接收模块找到跟踪对象并判断跟踪对象的距离和方向。蓝牙接收模块和传感器模块每隔100ms向微处控制器发送一次所监测到的数据。在正常跟踪的情况下,机器人与跟踪对象之间的距离范围为0.5~1米,机器人根据检测到的自己的速度和通过相邻的两次探测到跟踪对象的距离的比较,计算出跟踪对象的速度,并且调整自己的速度与跟踪对象的一致。当机器人探测到跟踪对象的方向出现转变时,会自动通过调整两个伺服电机的 转速使两个后轮出现差速来实现转向跟踪。在跟踪的过程中,机器人上的传感器模块实时探测周围的障碍物并把探测结果发送到微控制器,微处理器通过数据分析判断出障碍物的位置和大小、静止或者移动以及移动速度的大小,然后根据自己本身结构的和大小来调整自身的运动状态,来绕开障碍物进行跟踪。本发明的机器人相对现有技术具备操作简单、精度满足而成本又相对低廉等优点,智能化程度高,可以在复杂的环境中使用,易于大范围推广。When the robot is working, the tracking object is first found through the Bluetooth receiving module and the distance and direction of the tracking object are determined. The Bluetooth receiving module and the sensor module send the monitored data to the micro-controller every 100 ms. In the case of normal tracking, the distance between the robot and the tracking object ranges from 0.5 to 1 meter, and the robot calculates the tracking object based on the detected speed of itself and the distance between two adjacent detected objects. The speed, and adjust your own speed is consistent with the tracking object. When the robot detects the change of the direction of the tracking object, it will automatically adjust the two servo motors. The speed makes the two rear wheels differential to achieve steering tracking. During the tracking process, the sensor module on the robot detects the surrounding obstacles in real time and sends the detection results to the microcontroller. The microprocessor determines the position and size of the obstacle, the static or moving, and the moving speed through data analysis. Then, according to the structure and size of the structure itself, adjust the state of motion to track the obstacles. Compared with the prior art, the robot of the invention has the advantages of simple operation, accurate precision and relatively low cost, high intelligence degree, can be used in a complicated environment, and is easy to be widely promoted.
以上所述仅为发明的优选实施例,而非对发明做任何形式上的限制。本领域的技术人员可在上述实施例的基础上施以各种等同的更改和改进,凡在权利要求范围内所做的等同变化或修饰,均应落入发明的保护范围之内。 The above description is only a preferred embodiment of the invention, and is not intended to limit the invention in any way. A person skilled in the art can make various equivalent modifications and improvements to the above-described embodiments, and equivalent changes or modifications made within the scope of the claims should fall within the scope of the invention.

Claims (10)

  1. 一种机器人跟随方法,所述机器人包括蓝牙模块和传感器模块,所述蓝牙模块包括两个蓝牙接收模块和一个蓝牙发射模块,所述传感器模块包括若干第一传感器和若干第二传感器,所述若干第一传感器和若干第二传感器形成至少一组,其特征在于,包括:A robot following method, the robot includes a Bluetooth module and a sensor module, the Bluetooth module includes two Bluetooth receiving modules and a Bluetooth transmitting module, the sensor module includes a plurality of first sensors and a plurality of second sensors, the plurality of The first sensor and the plurality of second sensors form at least one group, and the method includes:
    识别跟踪对象,所述跟踪对象配置有所述蓝牙发射模块;Identifying a tracking object, the tracking object being configured with the Bluetooth transmitting module;
    监测机器人上间隔L米设置的两个蓝牙接收模块接收蓝牙信号的强度;Monitoring the strength of the Bluetooth signal received by the two Bluetooth receiving modules set on the robot at intervals of L meters;
    根据监测到的蓝牙信号强度分别计算两个蓝牙接收模块与蓝牙发射模块之间的距离L1和L2;Calculating the distances L1 and L2 between the two Bluetooth receiving modules and the Bluetooth transmitting module according to the monitored Bluetooth signal strength;
    获取最新的两组L1和L2,并根据L、L1和L2计算跟踪对象的速度和方向;Obtain the latest two sets of L1 and L2, and calculate the speed and direction of the tracking object according to L, L1 and L2;
    根据计算的跟踪对象的速度和方向调整机器人的速度与方向;Adjust the speed and direction of the robot based on the calculated speed and direction of the tracked object;
    接收每组中第一传感器和第二传感器的探测距离;Receiving a detection distance of the first sensor and the second sensor in each group;
    按照预定的规则获取每组的最小值作为该组确定的探测距离;Obtaining a minimum value of each group as a detection distance determined by the group according to a predetermined rule;
    根据最新的两个探测距离和机器人自身的速度与方向来判断障碍物的距离和方向;Determine the distance and direction of the obstacle based on the latest two detection distances and the speed and direction of the robot itself;
    根据机器人的速度与前后两次传感器模块发送探测距离的时间和距离的变化,判断障碍物的位置并绕开障碍物进行跟踪。According to the speed of the robot and the change of the time and distance of the detection distance sent by the two sensor modules before and after, the position of the obstacle is judged and the obstacle is tracked.
  2. 如权利要求1所述的机器人跟随方法,其特征在于:所述根据监测到的蓝牙信号强度分别计算两个蓝牙接收模块与跟踪对象之间的距离L1和L2包括:The robot following method according to claim 1, wherein the calculating the distances L1 and L2 between the two Bluetooth receiving modules and the tracking object according to the monitored Bluetooth signal strength respectively comprises:
    采集蓝牙信号强度的当前RSSI值,根据预设滤波算法对当前RSSI值进行处理,得到当前RSSI基值;Collecting the current RSSI value of the Bluetooth signal strength, and processing the current RSSI value according to a preset filtering algorithm to obtain a current RSSI base value;
    采用离线BP神经网络算法对当前RSSI基值处理,得到蓝牙发射模块与两个蓝牙接收模块之间的距离L1和L2。The offline BP neural network algorithm is used to process the current RSSI base value, and the distances L1 and L2 between the Bluetooth transmitting module and the two Bluetooth receiving modules are obtained.
  3. 如权利要求1所述的机器人跟随方法,其特征在于:所述获取最新的两组L1和L2,并根据L、L1和L2计算跟踪对象的速度和方向,根据计算的跟踪对象的速度和方向调整机器人的速度与方向包括:The robot following method according to claim 1, wherein said acquiring the latest two groups of L1 and L2, and calculating the speed and direction of the tracking object based on L, L1 and L2, according to the calculated speed and direction of the tracking object Adjusting the speed and direction of the robot includes:
    获得机器人的速度; Get the speed of the robot;
    根据前后两次测得的蓝牙发射模块与两个蓝牙接收模块的距离,得到跟踪对象的速度,并根据获得的跟踪对象的速度调整机器人速度与跟踪对象的速度一致;According to the distance between the Bluetooth transmitting module and the two Bluetooth receiving modules measured twice before and after, the speed of the tracking object is obtained, and the speed of the robot is adjusted according to the speed of the obtained tracking object to be consistent with the speed of the tracking object;
    根据前后两次测得的蓝牙发射模块与两个蓝牙接收模块的距离计算跟踪对象的转向角度,并根据获得的跟踪对象的转向角度调整机器人的方向与跟踪对象的方向一致。The steering angle of the tracking object is calculated according to the distance between the Bluetooth transmitting module and the two Bluetooth receiving modules measured twice before and after, and the direction of the robot is adjusted according to the steering angle of the obtained tracking object.
  4. 如权利要求1所述的机器人跟随方法,其特征在于:所述传感器模块包括若干第一传感器和若干第二传感器,所述若干第一传感器和若干第二传感器形成至少一组为:The robot following method according to claim 1, wherein the sensor module comprises a plurality of first sensors and a plurality of second sensors, and the plurality of first sensors and the plurality of second sensors form at least one group:
    所述传感器模块为预先设置在机器人半圆弧上的五个第一传感器和四个第二传感器,且五个第一传感器和四个第二传感器等弧长间隔设置,并将相邻的两个第一传感器和一个第二传感器设置为一组,共分为三组。The sensor module is five first sensors and four second sensors preset on the semicircular arc of the robot, and five first sensors and four second sensors are arranged at an arc length, and the adjacent two are The first sensor and the second sensor are arranged in a group and are divided into three groups.
  5. 如权利要求4所述的机器人跟随方法,其特征在于:所述第一传感器是超声波为超声波传感器,所述第二传感器是红外传感器。The robot following method according to claim 4, wherein the first sensor is an ultrasonic wave ultrasonic sensor and the second sensor is an infrared sensor.
  6. 如权利要求1所述的机器人跟随方法,其特征在于:所述按照预定的规则获取每组的最小值作为该组确定的探测距离包括:The robot following method according to claim 1, wherein the obtaining the minimum value of each group as a predetermined detection distance according to a predetermined rule comprises:
    当探测到障碍物的距离为第一预设范围内时,取第二传感器的探测距离作为该组确定的探测距离;When the distance of the obstacle is detected to be within the first preset range, the detection distance of the second sensor is taken as the detection distance determined by the group;
    当探测到障碍物的距离为第二预设范围内时,取第一传感器的探测距离作为该组确定的探测距离;When the distance of the obstacle is detected to be within the second preset range, the detection distance of the first sensor is taken as the detection distance determined by the group;
    当探测到障碍物的距离在第三预设范围内时,将第一传感器的探测距离和第二传感器的探测距离进行融合,得到该组确定的探测距离。When the distance of the obstacle is detected within a third preset range, the detection distance of the first sensor and the detection distance of the second sensor are merged to obtain the determined detection distance of the group.
  7. 如权利要求6所述的机器人跟随方法,其特征在于:所述将第一传感器的探测距离和第二传感器的探测距离进行融合,得到该组确定的探测距离,所述融合方法为:d=a×x+b×y,其中,The robot following method according to claim 6, wherein the combining the detection distance of the first sensor and the detection distance of the second sensor to obtain the determined detection distance of the group, the fusion method is: d= a×x+b×y, where
    d为障碍物的距离,x为第一传感器的探测距离,y为第二传感器的探测距离,a和b的值由x和y的值决定,当x在0.6~0.8的范围内时,a的值在0.5~1 的范围内变化,在这个范围内,a的值与x的值成正比关系;当y在0.4~0.6的范围内时,y的值在0.5~1的范围内变化,y与b成负比例关系;当出现x>0.6,y<0.6时,a和b的值均取0.5。d is the distance of the obstacle, x is the detection distance of the first sensor, y is the detection distance of the second sensor, and the values of a and b are determined by the values of x and y, when x is in the range of 0.6 to 0.8, a The value is 0.5 to 1 Within the range, the value of a is proportional to the value of x; when y is in the range of 0.4 to 0.6, the value of y varies from 0.5 to 1, and y is negatively proportional to b. Relationship; when x>0.6, y<0.6, the values of a and b are both 0.5.
  8. 如权利要求1所述的机器人跟随方法,其特征在于:所述根据机器人的速度与前后两次传感器模块发送探测距离的时间和距离的变化,判断障碍物的位置并绕开障碍物进行跟踪包括:根据前后两次确定的探测距离判断障碍物的距离和方向、判断障碍物的运动状态、运动速度及障碍物大小。The robot following method according to claim 1, wherein the determining the position of the obstacle and tracking the obstacle is performed according to the change of the time and distance of the speed of the robot and the detection of the detection distance by the two sensor modules before and after. : Judging the distance and direction of the obstacle according to the detection distance determined twice before and after, judging the movement state of the obstacle, the speed of movement and the size of the obstacle.
  9. 如权利要求1所述的机器人跟随方法,其特征在于:所述机器人跟随方法还包括:The robot following method according to claim 1, wherein the robot following method further comprises:
    预存跟踪对象的若干指定手势,并将若干指定手势与机器人和跟踪对象之间的距离进行一一对应;Pre-storing a number of specified gestures of the tracking object, and one-to-one correspondence between the specified gestures and the distance between the robot and the tracking object;
    识别跟踪对象的若干指定手势,根据识别到的指定手势调整机器人到对应的距离。A number of specified gestures of the tracking object are identified, and the robot is adjusted to a corresponding distance according to the identified specified gesture.
  10. 如权利要求9所述的机器人跟随方法,其特征在于:所述若干指定手势与机器人和跟踪对象之间的距离进行一一对应包括:所述若干指定手势包括招手、摆手和举手,The robot following method according to claim 9, wherein the one-to-one correspondence between the plurality of specified gestures and the distance between the robot and the tracking object comprises: the plurality of specified gestures include waving, waving, and raising a hand.
    当跟踪对象招手时,调整机器人前行至与跟随对象更近的指定距离,When the tracking object is beckoning, adjust the robot to advance to a specified distance closer to the object to be followed.
    当跟踪对象摆手时,调整机器人后退至与跟随对象更远的指定距离,When the tracking object swings, adjust the robot to retreat to a specified distance further from the object to be followed.
    当跟踪对象举手时,机器人自行停止在原来的位置。 When the tracking object raises the hand, the robot stops at its original position.
PCT/CN2015/089127 2015-09-08 2015-09-08 Robot following method WO2017041225A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/CN2015/089127 WO2017041225A1 (en) 2015-09-08 2015-09-08 Robot following method
CN201580028764.4A CN107073711A (en) 2015-09-08 2015-09-08 A kind of robot follower method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2015/089127 WO2017041225A1 (en) 2015-09-08 2015-09-08 Robot following method

Publications (1)

Publication Number Publication Date
WO2017041225A1 true WO2017041225A1 (en) 2017-03-16

Family

ID=58240495

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2015/089127 WO2017041225A1 (en) 2015-09-08 2015-09-08 Robot following method

Country Status (2)

Country Link
CN (1) CN107073711A (en)
WO (1) WO2017041225A1 (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110502036A (en) * 2019-07-24 2019-11-26 苏宁智能终端有限公司 A kind of follower method and system based on Bluetooth technology
CN111240308A (en) * 2018-11-09 2020-06-05 北京奇虎科技有限公司 Method and device for detecting repeated obstacle, electronic equipment and readable storage medium
CN111966023A (en) * 2020-08-28 2020-11-20 王旭飞 Intelligent following method and device and electronic equipment
CN113865509A (en) * 2021-09-29 2021-12-31 苏州华兴源创科技股份有限公司 Automatic following detection device
CN114190821A (en) * 2020-09-16 2022-03-18 尚科宁家(中国)科技有限公司 Cleaning robot capable of walking smoothly
CN117255313A (en) * 2023-11-17 2023-12-19 双擎科技(杭州)有限公司 Service robot control method and system based on cloud platform
CN111966023B (en) * 2020-08-28 2024-04-30 王旭飞 Intelligent following method and device and electronic equipment

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108279685B (en) * 2018-03-21 2024-01-16 福建工程学院 Carrier based on visual following and working method
CN108490849A (en) * 2018-06-08 2018-09-04 武汉蛋玩科技有限公司 The robot and control method of gesture identification tracking are realized using infrared sensor
JP2020086756A (en) * 2018-11-21 2020-06-04 富士ゼロックス株式会社 Autonomous mobile device and program
CN111381587B (en) * 2018-12-11 2023-11-03 北京京东乾石科技有限公司 Following method and device for following robot
CN111025230A (en) * 2019-11-13 2020-04-17 武汉齐物科技有限公司 Bluetooth-based riding safety monitoring method and device
CN113701780B (en) * 2021-09-14 2023-08-29 成都信息工程大学 Real-time obstacle avoidance planning method based on A star algorithm
CN114536349A (en) * 2022-04-12 2022-05-27 武汉湾流科技股份有限公司 Automatic detection obstacle avoidance control method for industrial robot

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080215184A1 (en) * 2006-12-07 2008-09-04 Electronics And Telecommunications Research Institute Method for searching target object and following motion thereof through stereo vision processing and home intelligent service robot using the same
CN103802109A (en) * 2012-11-08 2014-05-21 沈阳新松机器人自动化股份有限公司 Auxiliary robot
CN105182976A (en) * 2015-09-17 2015-12-23 西北农林科技大学 Visual navigation strategy of agricultural robot

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20120316680A1 (en) * 2011-06-13 2012-12-13 Microsoft Corporation Tracking and following of moving objects by a mobile robot
CN104260092B (en) * 2014-07-08 2015-12-30 大连理工大学 One is automatically followed the tracks of robot controller and is automatically followed the tracks of robot
CN104731102B (en) * 2015-02-10 2017-12-29 刘勇 It is a kind of that robot positioning system is followed based on ultrasonic wave and bluetooth

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080215184A1 (en) * 2006-12-07 2008-09-04 Electronics And Telecommunications Research Institute Method for searching target object and following motion thereof through stereo vision processing and home intelligent service robot using the same
CN103802109A (en) * 2012-11-08 2014-05-21 沈阳新松机器人自动化股份有限公司 Auxiliary robot
CN105182976A (en) * 2015-09-17 2015-12-23 西北农林科技大学 Visual navigation strategy of agricultural robot

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111240308A (en) * 2018-11-09 2020-06-05 北京奇虎科技有限公司 Method and device for detecting repeated obstacle, electronic equipment and readable storage medium
CN110502036A (en) * 2019-07-24 2019-11-26 苏宁智能终端有限公司 A kind of follower method and system based on Bluetooth technology
CN111966023A (en) * 2020-08-28 2020-11-20 王旭飞 Intelligent following method and device and electronic equipment
CN111966023B (en) * 2020-08-28 2024-04-30 王旭飞 Intelligent following method and device and electronic equipment
CN114190821A (en) * 2020-09-16 2022-03-18 尚科宁家(中国)科技有限公司 Cleaning robot capable of walking smoothly
CN113865509A (en) * 2021-09-29 2021-12-31 苏州华兴源创科技股份有限公司 Automatic following detection device
CN117255313A (en) * 2023-11-17 2023-12-19 双擎科技(杭州)有限公司 Service robot control method and system based on cloud platform
CN117255313B (en) * 2023-11-17 2024-02-06 双擎科技(杭州)有限公司 Service robot control method and system based on cloud platform

Also Published As

Publication number Publication date
CN107073711A (en) 2017-08-18

Similar Documents

Publication Publication Date Title
WO2017041225A1 (en) Robot following method
TWI481980B (en) Electronic apparatus and navigation method thereof
CN107976999A (en) A kind of mobile robot and its avoidance and paths planning method and system
CN106323230B (en) A kind of obstacle recognition system and obstacle recognition method
EP2436001B1 (en) Position measurement systems using position sensitive detectors
CN207529226U (en) A kind of mobile robot
US20040158358A1 (en) Method of teaching traveling path to robot and robot having function of learning traveling path
KR101060988B1 (en) Apparatus and method for tracking moving objects using intelligent signal strength of Zigbee
JP2013534339A (en) Drive command based vision system control system and method for target tracking
US11636612B2 (en) Automated guided vehicle navigation device and method thereof
CN104731092A (en) Multi-directional barrier avoiding system of mobile robot
WO2018228254A1 (en) Mobile electronic device and method for use in mobile electronic device
JP2020190429A5 (en)
WO2022228019A1 (en) Moving target following method, robot, and computer-readable storage medium
Su et al. An interactive auto-recharging system for mobile robots
KR101937689B1 (en) Worker-following Control Algorithm Applied Moving Device
CN109032387B (en) Method for detecting posture of pen body through ultrasonic wave and electromagnetic positioning double sensors
CN103063209B (en) Based on the moving target localization method of dynamic dual pyroelectric sensor network
RU151795U1 (en) ANTHROPOMORPHIC MOBILE ROBOT
Seo et al. Object following method for a differential type mobile robot based on Ultra Wide Band distance sensor system
Goodhew et al. Control and experimentation of a personal robot tracking system
Yang et al. The research on intelligent mobile robot's avoiding obstacle by ultrasound
CN110873882B (en) Tracking distance measuring system capable of tracking human body and method thereof
Lian et al. Leader-follower mobile robots control based on light source detection
CN207019625U (en) Non-contact length-measuring appliance

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: 15903332

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: 15903332

Country of ref document: EP

Kind code of ref document: A1