KR100534463B1 - Disposition of range detection sensor for obstacle detection and attitude correction of mobile robot - Google Patents
Disposition of range detection sensor for obstacle detection and attitude correction of mobile robot Download PDFInfo
- Publication number
- KR100534463B1 KR100534463B1 KR10-2003-0049894A KR20030049894A KR100534463B1 KR 100534463 B1 KR100534463 B1 KR 100534463B1 KR 20030049894 A KR20030049894 A KR 20030049894A KR 100534463 B1 KR100534463 B1 KR 100534463B1
- Authority
- KR
- South Korea
- Prior art keywords
- distance
- measured
- mobile robot
- angle
- obstacle
- Prior art date
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B7/00—Measuring arrangements characterised by the use of electric or magnetic techniques
- G01B7/02—Measuring arrangements characterised by the use of electric or magnetic techniques for measuring length, width or thickness
- G01B7/023—Measuring arrangements characterised by the use of electric or magnetic techniques for measuring length, width or thickness for measuring distance between sensor and object
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
본 발명은 다수개의 거리 측정용 센서를 이용한 이동로봇의 장애물 검출 및 자세보정방법에 관한 것으로, 그 목적은 두개 이상의 거리 측정용 센서를 통해 거리데이터를 측정하고, 이들 측정값의 대비에 의해 데이터의 신뢰성을 높이며, 측정데이터를 이용하여 로봇의 위치를 파악하고, 자세를 검출할 수 있는 다수개의 거리 측정용 센서를 이용한 이동로봇의 장애물 검출 및 자세보정방법을 제공하는 것이다. The present invention relates to an obstacle detection and attitude correction method of a mobile robot using a plurality of distance measuring sensors. The object of the present invention is to measure distance data through two or more distance measuring sensors, and to compare data by comparing these measured values. The present invention provides a method for detecting obstacles and correcting a posture of a mobile robot using a plurality of distance measuring sensors capable of increasing reliability and detecting a position of a robot using measured data.
본 발명은 이동로봇의 주행방향에 다수개의 거리측정센서를 설치하는 단계; 상기 다수개의 거리측정용 센서에 의해 측정된 거리데이터의 유효값 여부를 판단하는 유효값 인식단계; 상기 유효값 판단에 의해 측정된 거리데이터로 부터 이동로봇과 장애물의 각도를 측정하는 각도측정단계; 상기 측정된 각도에 따라 로봇의 위치를 인식하여 각도에 따라 이동로봇의 위치를 보정하는 자세보정단계를 포함하는 다수개의 거리 측정용 센서를 이용한 이동로봇의 장애물 검출 및 자세보정방법을 제공함에 있다. The present invention comprises the steps of installing a plurality of distance measuring sensors in the driving direction of the mobile robot; An effective value recognizing step of determining whether or not valid values of distance data measured by the plurality of distance measuring sensors are valid; An angle measuring step of measuring angles of the moving robot and the obstacle from the distance data measured by the valid value determination; It provides an obstacle detection and attitude correction method of a mobile robot using a plurality of distance measuring sensors comprising a posture correction step of recognizing the position of the robot according to the measured angle to correct the position of the mobile robot according to the angle.
Description
본 발명은 다수개의 거리 측정용 센서를 이용한 이동로봇의 장애물 검출 및 자세보정방법에 관한 것으로, 다수개의 거리측정용 센서에 의해 이동로봇의 자율주행 경로상에 존재하는 장애물을 검출하고, 측정된 두개 이상의 거리 데이터를 서로 비교하면서 거리데이터의 신뢰성을 높이며, 별도의 복잡한 알고리즘 없이도 측정된 두개 이상의 거리 데이터를 통해 장애물과 로봇의 자세를 보정할 수 있는 다수개의 거리 측정용 센서를 이용한 이동로봇의 장애물 검출 및 자세보정방법에 관한 것이다. The present invention relates to an obstacle detection and attitude correction method of a mobile robot using a plurality of distance measuring sensors, and detects obstacles existing on an autonomous driving path of a mobile robot by a plurality of distance measuring sensors, and measures two Obstacle detection of mobile robots using multiple distance sensors to improve the reliability of the distance data by comparing the above distance data with each other and to correct the posture of the obstacle and the robot through two or more distance data measured without a separate complicated algorithm And a posture correction method.
일반적인 거리 측정용 센서의 배치는 측정하고자 하는 방향에 대해 하나의 센서만을 사용하며 측정된 거리 데이터의 신뢰성을 높이기 위해 이전에 측정된 거리 데이터들을 제어기에 저장하여 현재 측정된 거리 측정용 센서 데이터와 비교하여 갑작스런 데이터의 변화를 로봇이 인지할 수 있도록 하고, 장애물과 로봇의 자세를 보정 및 제어하기 위해서 측정된 거리 데이터를 제어기에서 인식할 수 있도록 도 6 에 도시된 바와 같은 흐름을 구비하는 별도의 복잡한 알고리즘이 적용되어 왔다. In general, the arrangement of the distance measuring sensor uses only one sensor for the direction to be measured. In order to increase the reliability of the measured distance data, the previously measured distance data is stored in the controller and compared with the currently measured distance measuring sensor data. Separate complex having a flow as shown in FIG. 6 so that the robot can recognize the sudden change of data, and the controller can recognize the measured distance data in order to correct and control the obstacle and the attitude of the robot. Algorithms have been applied.
즉, 측정하고자 하는 방향에 하나의 거리 측정 센서를 배치한 뒤 거리 측정 데이터의 신뢰성을 높이기 위한 방법으로, 현재 데이터를 위한 버퍼(N)를 지정하고, 이전 거리 데이터(N-1, N-2, N-3, N-4)를 저장하기 위한 버퍼를 지정한 뒤, 현재 데이터(N)와 이전 거리 데이터(N-1, N-2, N-3, N-4)를 순차적으로 비교하면서 현재 측정된 거리 데이터가 이전 데이터와 현저한 차이를 보이는지를 확인하도록 되어 있었다. 그러나, 이와 같은 종래의 방법은 이전에 측정된 거리 데이터를 비교하기 위한 별도의 알고리즘과 많은 메모리 공간을 필요로 하고 복잡한 알고리즘을 처리하기 위한 시간이 소요되므로 실시간으로 제어해야 하는 이동로봇에 적용하기에는 부적합함을 구비하고 있었다. 일례로 이동로봇의 진행방향이 장애물과 수평을 이루고 있다면 장애물과 충돌하는 현상은 발생하지 않을 것이므로 이동로봇이 장애물과 이루고 있는 각도를 간단하게 알아낼 수 있다면 장애물을 회피하기 위한 복잡한 알고리즘이 필요치 않게 된다. 그러나, 종래의 방법은 하나의 거리 측정용 센서를 배치하고 이로부터 얻어진 거리 데이터를 통해 이동로봇의 자세를 제어하여야 하며, 또한 이동로봇이 정지된 상태에서 거리를 측정하지 않고 로봇을 이동시키면서 얻어지는 데이터들을 계속 비교해 나가야 하므로, 이를 고려할 경우, 복잡한 알고리즘이 반드시 필요하게 되며, 이로 인해 실시간 제어 및 제어시스템의 고성능화가 곤란하고, 설계의 곤란성이 증대되는 등 여러가지 문제점이 있었다. That is, as a method for increasing the reliability of the distance measurement data after arranging one distance measurement sensor in a direction to be measured, the buffer N for the current data is designated and the previous distance data N-1 and N-2. , And specify a buffer to store N-3, N-4, and compare the current data (N) with the previous distance data (N-1, N-2, N-3, N-4) sequentially The distance data measured were to be markedly different from the previous data. However, such a conventional method is not suitable for a mobile robot that needs to be controlled in real time because it requires a separate algorithm and a large memory space for comparing previously measured distance data and takes time to process a complex algorithm. It was equipped with a ship. For example, if the moving direction of the mobile robot is parallel to the obstacle, the collision with the obstacle will not occur. Therefore, if the mobile robot can easily find the angle formed by the obstacle, a complicated algorithm for avoiding the obstacle is not necessary. However, in the conventional method, the position of the mobile robot should be controlled by arranging one distance measuring sensor and the distance data obtained therefrom, and the data obtained by moving the robot without measuring the distance while the mobile robot is stopped. Since they have to be compared continuously, when considering this, a complicated algorithm is necessary, which causes various problems such as difficulty in realizing high-performance control and control system and increasing design difficulty.
본 발명은 상기와 같은 문제점을 고려하여 이루어진 것으로, 그 목적은 두개 이상의 거리 측정용 센서를 통해 거리데이터를 측정하고, 이들 측정값의 대비에 의해 데이터의 신뢰성을 높이며, 측정데이터를 이용하여 로봇의 위치를 파악하고, 자세를 검출할 수 있는 다수개의 거리 측정용 센서를 이용한 이동로봇의 장애물 검출 및 자세보정방법을 제공하는 것이다. The present invention has been made in consideration of the above problems, and its object is to measure distance data through two or more distance measuring sensors, increase the reliability of the data by comparing these measured values, and use the measured data of the robot. An object of the present invention is to provide an obstacle detection method and a posture correction method of a mobile robot using a plurality of distance measuring sensors capable of detecting a position and detecting a posture.
본 발명은 이동로봇의 주행방향에 다수개의 거리측정센서를 설치하는 단계; 상기 다수개의 거리측정용 센서에 의해 측정된 거리데이터의 유효값 여부를 판단하는 유효값 인식단계; 상기 유효값 판단에 의해 측정된 거리데이터로 부터 이동로봇과 장애물의 각도를 측정하는 각도측정단계; 상기 측정된 각도에 따라 로봇의 위치를 인식하여 각도에 따라 이동로봇의 위치를 보정하는 자세보정단계를 포함하는 다수개의 거리 측정용 센서를 이용한 이동로봇의 장애물 검출 및 자세보정방법을 제공함에 있다. The present invention comprises the steps of installing a plurality of distance measuring sensors in the driving direction of the mobile robot; An effective value recognizing step of determining whether or not valid values of distance data measured by the plurality of distance measuring sensors are valid; An angle measuring step of measuring angles of the moving robot and the obstacle from the distance data measured by the valid value determination; It provides an obstacle detection and attitude correction method of a mobile robot using a plurality of distance measuring sensors comprising a posture correction step of recognizing the position of the robot according to the measured angle to correct the position of the mobile robot according to the angle.
도 1 은 본 발명에 따른 거리 측정용 센서의 배치상태를 보인 예시도를, 도 2 는 이동로봇에 적용하기 위한 거리 측정용 센서의 배치상태를 보인 예시도를 도시한 것으로, 본 발명은 이동로봇의 주행방향(측정하고자 하는 방향)에 대해 두개 이상의 거리 측정용 센서를 배치하고 측정된 두개 이상의 거리 데이터를 서로 비교하여 측정하고자 했던 방향에 대한 거리 측정용 데이터의 신뢰성을 높이고, 별도의 복잡한 알고리즘 없이 두개 이상의 거리 데이터와 간단한 알고리즘을 통해 로봇과 검출된 장애물이 이루고 있는 각도를 얻어 이동로봇의 자세를 보정하거나 장애물의 윤곽을 추종하며 회피 할 수 있도록 되어 있다. 이때, 상기 센서는 이동로봇의 자율주행과 관련되어 이동경로 상에 존재하는 장애물의 검출 및 로봇의 자세 보정과 거리 측정을 위한 거리 측정용 센서를 사용한다. 1 is an exemplary view showing an arrangement of the distance measuring sensor according to the present invention, Figure 2 is an illustration showing an arrangement of the distance measuring sensor for applying to a mobile robot, the present invention is a mobile robot Two or more distance measuring sensors are arranged for the driving direction (direction to be measured) of the device, and the two or more distance data are compared with each other to increase the reliability of the distance measuring data for the direction to be measured, and without any complicated algorithm. Through two or more distance data and a simple algorithm, the angle between the robot and the detected obstacle can be obtained to correct the attitude of the mobile robot or follow the outline of the obstacle and avoid it. In this case, the sensor uses a distance measuring sensor for detecting an obstacle present on the moving path, correcting the attitude of the robot, and measuring the distance in relation to autonomous driving of the mobile robot.
이와 같은 본 발명은 두개의 거리측정용 센서에 의해 측정된 거리데이터의 유효값 여부를 판단하고, 측정된 거리데이터와 일정거리 설정값의 대비에 따라 이동로봇과 장애물의 각도를 측정하며, 측정된 각도에 따라 로봇의 위치를 인식 또는 보정하도록 되어 있다. 즉, 본 발명은 측정값의 최대 편차값 Max-offset, 일정거리 설정값 Dmax, 두개의 거리측정용 센서간의 거리를 DS, 로봇과 장애물이 이루는 최대 각도 θmax 를 설정하고, 상기 설정값과 두개의 거리측정용 센서로 부터 측정된 값을 대비하여 측정값의 유효성 및 신뢰성을 향상시키고, 이동로봇의 위치를 파악하며, 자세를 보정하도록 되어 있다.The present invention as described above determines the valid value of the distance data measured by the two distance measuring sensors, and measuring the angle of the mobile robot and the obstacle in accordance with the measured distance data and the predetermined distance set value, The position of the robot is recognized or corrected according to the angle. That is, the present invention sets the maximum deviation value Max-offset of the measured value, the constant distance set value Dmax, the distance between the two distance measuring sensors D S , the maximum angle θmax between the robot and the obstacle, and the set value and the two It is to improve the validity and reliability of the measured value, to locate the mobile robot and to correct the posture by comparing the measured value from the distance measuring sensor.
이하 본 발명을 도면에 의거하여 상세히 설명하면 다음과 같다. Hereinafter, the present invention will be described in detail with reference to the drawings.
도 3 은 본 발명에 따른 이동로봇과 장애물의 각도측정 개념도를 도시한 것으로, 두개의 거리측정용 센서간의 거리를 DS , 제 1 센서와 장애물과의 거리 측정값을 S1 , 제 2 센서와 장애물과의 거리 측정값을 S2 , 장애물과 이동로봇이 이루는 각도를 θ 라 할 경우, 상기 θ 는,3 is a conceptual diagram illustrating an angle measurement of a mobile robot and an obstacle according to the present invention, and a distance between two distance measuring sensors D S , a distance measurement value between a first sensor and an obstacle S 1 , and a second sensor; When the measured distance between the obstacle is S 2 and the angle between the obstacle and the mobile robot is θ, the θ is
θ = tan-1 {{S2-S1)/DS} 가 된다.θ = tan -1 {{S 2 -S 1 ) / D S }.
이때, 상기 로봇과 장애물이 이룰 수 있는 최대 각도를 θmax 라 하면, 측정값의 최대 편차값 Max-offset 는 At this time, if the maximum angle that the robot and the obstacle can achieve is θ max, the maximum deviation value Max-offset of the measured value is
Max-offset = tan(θmax)×DS 로 표현된다.It is expressed as Max-offset = tan (θmax) × D S.
즉, 장애물과 이동로봇이 이룰 수 있는 최대각도 θmax 를 45 도로 설정하고, 센서간 거리 DS 가 10㎝ 일 경우, Max-offset = 10 ㎝ 가 된다. 또한, 장애물과 이동로봇이 이룰 수 있는 최대각도 θmax 를 60 도로 설정하고, 센서간 거리 DS 가 10㎝ 일 경우, Max-offset 는 약 17 ㎝ 가 된다That is, the maximum angle θmax that the obstacle and the mobile robot can achieve is set to 45 degrees, and when the distance D S between the sensors is 10 cm, Max-offset = 10 cm. In addition, if the maximum angle θmax that the obstacle and the mobile robot can achieve is set to 60 degrees, and the distance D S between the sensors is 10 cm, the maximum offset is about 17 cm.
상기와 같은 측정값의 최대 편차값 Max-offset는 거리 데이터의 유효성 판단의 기준범위로서, 이동로봇의 센서간 거리 및 이동로봇이 적용되는 실제 장소의 각도를 고려하여, 측정값의 최대 편차값 Max-offset 을 설정할 경우, 상기 측정값의 최대 편차값 Max-offset 과 실제 거리 측정값의 차이를 대비하여, 두 센서의 차이값(S2-S1)이 Max-offset 값보다 작거나 같을 경우, 유효한 값이 되며, 두 센서의 차이값(S2-S1)이 Max-offset 값보다 클 경우, 유효하지 않은 값이 된다. 또한, Max-offset 값보다 커서 유효하지 않은 값으로 판단되었을 경우, 제어기를 통하여 주변환경을 다시 인식하여야 한다.The maximum deviation value Max-offset of the measured value as described above is a reference range for determining the validity of the distance data. The maximum deviation value Max of the measured value is considered in consideration of the distance between the sensors of the mobile robot and the angle of the actual place to which the mobile robot is applied. When -offset is set, when the difference value (S 2 -S 1 ) of the two sensors is less than or equal to the Max-offset value in contrast to the difference between the maximum deviation value Max-offset and the actual distance measurement value of the measured value, If the difference between the two sensors (S 2 -S 1 ) is greater than the Max-offset value, the value is invalid. In addition, when it is determined that it is invalid because it is larger than the Max-offset value, the surrounding environment must be recognized again through the controller.
이와 같이 본 발명은 두 센서로 부터 측정될 수 있는 최대 편차값을 미리 설정하는 수단을 통해 측정된 거리 측정값의 유효성을 판단할 수 있도록 되어 있다. 즉, 현재 측정된 거리 측정값의 차이에 대한 크기 여부에 따라 차이의 크기가 Max-offset 보다 크다면 두개의 센서 데이터중 하나는 잘못된 값으로 인지하게 된다.As described above, the present invention is capable of determining the validity of the measured distance measurement value through means for presetting the maximum deviation value that can be measured from the two sensors. That is, if the magnitude of the difference is greater than the Max-offset depending on the magnitude of the difference of the currently measured distance measurement value, one of the two sensor data is recognized as an incorrect value.
상기 일정거리 설정값 Dmax 는 측정값 활용의 효율성을 향상시키기 위한 것으로, 로봇의 이동속도와 시스템의 제어속도 및 로봇이 사용되는 장소를 고려하여 설정된다. 거리측정용 센서는 센서 자체만으로 거리를 알 수 없고, 거리 측정을 위한 신호를 송신한 순간부터 송신된 신호가 수신될 때 까지의 시간을 측정하여 거리를 계산하도록 되어 있다. 즉, 거리 측정센서의 사용 시, 로봇의 이동속도에 따라 다르겠지만, 저속(약 20㎝/sec)으로 움직이는 로봇에서 측정된 측정값이 2 m 일 경우, 로봇이 약 10 초 동안 움직인 거리를 나타내게 된다. 따라서 로봇의 이동속도와 시스템의 제어속도 및 로봇이 사용되는 장소를 고려할 경우, 측정값이 2 m 이면, 상기 측정값내에는 장애물이 없다는 것으로 판단할 수 있다. 그러므로, 일정거리 설정값을 2 m 로 하고, 측정값이 2 m 이하 일 경우, 이동로봇의 근거리에 장애물이 있는 것으로 판단되며, 측정값이 2 m 초과할 경우, 이동로봇의 근거리에 장애물이 없는 것으로 판단할 수 있다. 또한, 측정값이 모두 일정 설정값 Dmax 이하일 경우, 측정값은 모두 유효값으로 처리되며, 이로부터 측정되는 이동로봇과 장애물과의 각도 θ 는 제어기로 전달되어 인식되게 된다. The constant distance set value Dmax is for improving the efficiency of utilizing the measured value, and is set in consideration of the moving speed of the robot, the control speed of the system, and the location where the robot is used. The distance measuring sensor cannot determine the distance only by the sensor itself, and calculates the distance by measuring the time from the moment of transmitting the signal for distance measurement until the transmitted signal is received. In other words, when using the distance sensor, it depends on the moving speed of the robot, but if the measured value is 2 m from the robot moving at low speed (about 20 cm / sec), the distance the robot has moved for about 10 seconds Will be displayed. Therefore, considering the moving speed of the robot, the control speed of the system, and the location where the robot is used, if the measured value is 2 m, it can be determined that there is no obstacle in the measured value. Therefore, if the fixed distance is set to 2 m and the measured value is 2 m or less, it is determined that there is an obstacle near the mobile robot. If the measured value exceeds 2 m, there is no obstacle near the mobile robot. It can be judged that. In addition, when all measured values are less than or equal to a predetermined set value Dmax, all measured values are treated as valid values, and the angle θ between the mobile robot and the obstacle measured therefrom is transmitted to the controller and recognized.
또한, 측정값 중, 하나라도 Dmax 보다 클 경우, 이동로봇과 장애물과의 각도 θ 를 산출하고, 상기 산출된 각도값 θ를 로봇과 장애물이 이루는 최대 각도 θmax 와 대비하여 θ＜＝θmax 일 경우, 유효 각도로 판단하여 제어기로 전달되어 인식되고, θ＞θmax 일 경우, 유효하지 않은 각도(잘못된 값으로 니식)로 판단되어 제어기에서 스톱명령을 내리게 된다. Further, if any of the measured values is larger than Dmax, the angle θ between the mobile robot and the obstacle is calculated, and when the calculated angle value θ is compared with the maximum angle θmax between the robot and the obstacle, θ <= θmax, It is judged as an effective angle and transmitted to the controller, and when θ> θmax, it is determined as an invalid angle (incorrect value) and a stop command is issued by the controller.
도 4 는 본 발명에 따른 이동로봇의 자세보정을 보인 예시도를 도시한 것으로, 이동로봇은 바닥면에 접촉되는 양측 구동수단의 동기화를 통해, 설정된 값에 따라 일직선으로 이동되도록 되어 있다. 그러나, 바닥면의 상태 및 구동수단의 상태에 따라 일측 구동수단이 미끄러지거나 헛돌게 될 경우, 이동로봇의 진행방향이 변경되는 현상이 발생된다. 본 발명은 두개의 센서로 부터 측정된 이동로봇과 벽면과의 각도측정값에 따라 이를 보정하도록 되어 있다. 즉, 벽면을 기준으로 벽면과 수평되게 이동로봇을 주행하고자 할 경우, 이동로봇의 측면에 설치된 두개의 거리측정용 센서로 부터 이동로봇과 벽면이 이루는 각도 θ를 측정한다. 이때, 벽면을 따라 이동로봇이 주행하기 위해서는 이동로봇과 벽면이 이루는 각도 θ 가 0 이 되어야 하므로, 측정각도 θ 만큼 벽면에 대하여 이동로봇이 기울어져 있음을 알 수 있게 된다. Figure 4 shows an exemplary view showing the posture correction of the mobile robot according to the present invention, the mobile robot is to be moved in a straight line according to the set value through the synchronization of the two driving means in contact with the bottom surface. However, when one driving means slips or turns in accordance with the state of the bottom surface and the driving means, the traveling direction of the mobile robot is changed. The present invention is to correct this according to the angle measurement value between the mobile robot and the wall measured from the two sensors. That is, when the mobile robot is to be driven horizontally with respect to the wall surface, the angle between the mobile robot and the wall is measured from two distance measuring sensors installed on the side of the mobile robot. At this time, in order for the mobile robot to travel along the wall, the angle θ formed by the mobile robot and the wall should be 0, so that the mobile robot is inclined with respect to the wall by the measurement angle θ.
도 5 는 본 발명에 따른 거리데이터의 처리 흐름을 보인 예시도를 도시한 것으로, 본 발명은 먼저 거리데이터 처리에 필요한 설정값인 θmax(로봇과 장애물이 이루는 최대 각도), Ds(두개의 거리측정용 센서간의 거리), Max_offset(측정값의 최대 편차값), Dmax(일정거리 설정값) 값을 설정하고, 두개의 센서를 통해 거리측정값 [S1, S2]을 측정한다. 이때, 상기 측정값을 읽어들이는 순서 및 처리하는 순서는 센서의 중요도에 따라 결정된다. 즉, 이동로봇에는 진행방향으로 각각 두개 이상의 거리측정용 센서가 설치되어 있으며, 상기 거리측정용 센서로 부터 측정되는 측정값은 이동로봇의 동작에 따라 결정된다. (이동로봇의 진행방향에 설치되어 있는 센서의 측정값이 최우선순위를 갖는다.)5 is an exemplary view showing a flow of processing of distance data according to the present invention, the present invention is the first setting value required for processing the distance data θmax (maximum angle between the robot and obstacle), Ds (two distance measurement Distance between each sensor), Max_offset (maximum deviation value of measured value), Dmax (constant distance set value), and measure the distance measured value [S 1 , S 2 ] through two sensors. At this time, the order of reading the measured value and the order of processing are determined according to the importance of the sensor. That is, two or more distance measuring sensors are installed in the moving direction in the traveling direction, and the measured values measured from the distance measuring sensors are determined according to the operation of the mobile robot. (The measured value of the sensor installed in the moving direction of the mobile robot has the highest priority.)
이와 같이, [S1, S2]이 측정되면, 상기 측정값의 차(S1- S2)와 Max_offset 을 비교하고, 측정값의 차가 Max_offset 보다 클 경우, 유효하지 않은 값으로 판단하여 제어기에서 이동로봇을 스톱하게 되며, 측정값의 차가 Max_offset 보다 작을 경우, 유효값으로 판단되어 다음 단계로 진행된다.As described above, when [S 1 , S 2 ] is measured, the difference (S 1 -S 2 ) of the measured value is compared with Max_offset. When the difference of the measured value is larger than Max_offset, it is determined as an invalid value and is determined by the controller. The robot is stopped, and if the difference between measured values is smaller than Max_offset, it is determined as a valid value and proceeds to the next step.
측정값의 차(S1- S2)가 유효값으로 판단되면, Dmax 와 측정값 [S1, S2 ]을 각각 비교하고, S1, S2 가 모두 Dmax 보다 작을 경우, 유효거리 측정값으로 판단되어 이동로봇과 장애물의 각도 θ 를 산출한 후, 이를 제어기로 입력하도록 되어 있다.If the difference (S 1 -S 2 ) of the measured values is judged to be an effective value, the Dmax and the measured values [S 1 , S 2 ] are compared respectively, and when S 1 and S 2 are both smaller than Dmax, the effective distance measured value After calculating the angle θ of the mobile robot and the obstacle, it is input to the controller.
또한, S1, S2 중, 어느 하나의 값이라도 Dmax 보다 클 경우, 이동로봇과 장애물의 각도 θ 를 산출하고 산출된 각도값 θ를 θmax 와 비교하여 θ＜＝θmax 경우, 산출된 θ이 제어기로 입력되며, θ＞θmax 일 경우, 제어기에서 스톱 명령을 전달하여 이동로봇을 정지시키도록 되어 있다.In addition, when any one of S 1 and S 2 is larger than Dmax, the angle θ of the mobile robot and the obstacle is calculated, and when the calculated angle value θ is compared with θmax, the calculated θ is a controller. When θ> θmax, the controller sends a stop command to stop the mobile robot.
본 발명은 상술한 특정의 바람직한 실시예에 한정되지 아니하며, 청구범위에서 청구하는 본 발명의 요지를 벗어남이 없이 당해 고안이 속하는 기술분야에서 통상의 지식을 가진 자라면 누구든지 다양한 변형실시가 가능한 것은 물론이고, 그와 같은 변경은 청구범위 기재의 범위 내에 있게 된다.The present invention is not limited to the above-described specific preferred embodiments, and various modifications can be made by those skilled in the art without departing from the gist of the present invention as claimed in the claims. Of course, such changes will fall within the scope of the claims.
상기와 같은 구성 및 작용에 의해 기대할 수 있는 본 발명의 효과는 하나의 거리 측정용 센서를 사용할 때 발생할 수 있는 거리 데이터를 신뢰할 수 없는 문제점과 로봇의 자세 보정을 위해 요구되는 고성능의 시스템을 구성하는 문제점을 해결하기 위해 측정하고자 하는 방향에 두개 이상의 거리 측정용 센서를 배치하고 이를 통해 측정된 두개 이상의 거리 데이터의 신뢰성을 높이고, 간단한 알고리즘의 구현으로 인한 저 사양의 시스템으로도 로봇의 자세를 보정할 수 있는 방법을 제시하는 매우 유용한 발명이다. 또한, 본 발명에 사용되는 거리측정용 센서는 실시간 처리가 가능하고 가능한 부피가 작고 가격이 저렴하므로, 경제적 부담을 해소할 수 있다. The effect of the present invention can be expected by the configuration and operation as described above is to configure the high-performance system required for the problem of unreliable distance data that can occur when using a single distance measuring sensor and the attitude correction of the robot In order to solve the problem, two or more distance measuring sensors should be placed in the direction to be measured, and the reliability of the two or more distance data measured through this will be improved. It is a very useful invention that suggests a way. In addition, since the distance measuring sensor used in the present invention is capable of real-time processing and possible volume and low price, it is possible to solve the economic burden.
또한, 본 발명은 측정값의 최대 편차값 Max-offset, 일정거리 설정값 Dmax, 두개의 거리측정용 센서간의 거리를 DS, 로봇과 장애물이 이루는 최대 각도 θmax 를 설정하고, 상기 설정값과 두개의 거리측정용 센서로 부터 측정된 값을 대비하도록 되어 있어, 측정값의 유효성 및 신뢰성을 향상시켰으며, 이동로봇의 위치를 정확히 파악하고, 이를 통해 자세를 보정을 용이하게 할 수 있는 등 많은 효과가 있다.In addition, the present invention sets the maximum deviation value Max-offset of the measured value, the constant distance set value Dmax, the distance between the two distance measuring sensors D S , the maximum angle θmax between the robot and the obstacle, and the set value and two Compared with the measured value from the distance measuring sensor, the effectiveness and reliability of the measured value are improved, and the position of the mobile robot can be accurately identified, and the posture can be easily corrected. There is.
도 1 은 본 발명에 따른 거리 측정용 센서의 배치상태를 보인 예시도1 is an exemplary view showing an arrangement of the distance measuring sensor according to the present invention
도 2 는 이동로봇에 적용하기 위한 거리 측정용 센서의 배치상태를 보인 예시도2 is an exemplary view showing an arrangement state of a distance measuring sensor for applying to a mobile robot;
도 3 은 본 발명에 따른 이동로봇과 장애물의 각도측정 개념도3 is a conceptual diagram of angle measurement of a mobile robot and an obstacle according to the present invention;
도 4 는 본 발명에 따른 이동로봇의 자세보정을 보인 예시도4 is an exemplary view showing a posture correction of the mobile robot according to the present invention.
도 5 는 본 발명에 따른 거리데이터의 처리 흐름을 보인 예시도5 is an exemplary view showing a processing flow of distance data according to the present invention.
도 6 은 종래의 방법에 의한 거리데이터의 처리 흐름을 보인 예시도6 is an exemplary view showing a processing flow of distance data by a conventional method;
* 도면의 주요부분에 대한 부호의 설명* Explanation of symbols for main parts of the drawings
(101,102,103,104,105,106,107,108) : 거리측정용 센서(101,102,103,104,105,106,107,108): Distance measuring sensor
(200) : 이동로봇(200): Mobile Robot
(300) : 장애물300: Obstacle
Claims (4)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| KR10-2003-0049894A KR100534463B1 (en) | 2003-07-21 | 2003-07-21 | Disposition of range detection sensor for obstacle detection and attitude correction of mobile robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| KR10-2003-0049894A KR100534463B1 (en) | 2003-07-21 | 2003-07-21 | Disposition of range detection sensor for obstacle detection and attitude correction of mobile robot |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| KR20050011055A KR20050011055A (en) | 2005-01-29 |
| KR100534463B1 true KR100534463B1 (en) | 2005-12-08 |
Family
ID=37223163
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| KR10-2003-0049894A KR100534463B1 (en) | 2003-07-21 | 2003-07-21 | Disposition of range detection sensor for obstacle detection and attitude correction of mobile robot |
Country Status (1)
| Country | Link |
|---|---|
| KR (1) | KR100534463B1 (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR100979629B1 (en) * | 2008-05-19 | 2010-09-01 | 성균관대학교산학협력단 | Sensor data real-time morphology processing device and method and system of drawing real-time environment map for intelligent mobile robot using the same |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR100838033B1 (en) * | 2006-07-26 | 2008-06-12 | 두산중공업 주식회사 | Method of Computing Expansion Distance Measurement Error of the Rotor in Turbine Control System |
| KR100844015B1 (en) * | 2007-05-31 | 2008-07-04 | 포항공과대학교 산학협력단 | Non-Conflict Effective Fusion Method of Distance Measuring Sensor Data |
| WO2020189818A1 (en) * | 2019-03-19 | 2020-09-24 | 엘지전자 주식회사 | Cart for stopping in parallel with installation and moving method |
| US11511425B2 (en) | 2019-03-19 | 2022-11-29 | Lg Electronics Inc. | Robot stopping parallel to installed object and method of stopping the same |
-
2003
- 2003-07-21 KR KR10-2003-0049894A patent/KR100534463B1/en not_active IP Right Cessation
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR100979629B1 (en) * | 2008-05-19 | 2010-09-01 | 성균관대학교산학협력단 | Sensor data real-time morphology processing device and method and system of drawing real-time environment map for intelligent mobile robot using the same |
Also Published As
| Publication number | Publication date |
|---|---|
| KR20050011055A (en) | 2005-01-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR100561863B1 (en) | Navigation method and navigation apparatus using virtual sensor for mobile robot | |
| EP1978432B1 (en) | Routing apparatus for autonomous mobile unit | |
| US8793069B2 (en) | Object recognition system for autonomous mobile body | |
| US5367457A (en) | Apparatus and method for improving accuracy of an automatic travelling apparatus | |
| US20060238156A1 (en) | Self-moving robot capable of correcting movement errors and method for correcting movement errors of the same | |
| KR101240181B1 (en) | Method and apparatus and for generating safe path of mobile robot | |
| JP2000056828A (en) | Automated guided vehicle system | |
| JP5085251B2 (en) | Autonomous mobile device | |
| KR100534463B1 (en) | Disposition of range detection sensor for obstacle detection and attitude correction of mobile robot | |
| KR20160068144A (en) | Vehicle Steering Apparatus and Method for Lane Keeping | |
| US11137768B2 (en) | Position estimation system, position detection method, and program | |
| JP2000180545A (en) | Method for correcting signal of at least one sensor for detecting travel path curve where vehicle moves | |
| EP3498574B1 (en) | Method and system for guiding an autonomous vehicle in a forward path in real-time | |
| KR101251776B1 (en) | A system controlling region of interest for vehicle sensor and method thereof | |
| JPH04300781A (en) | Device for controlling traveling of moving vehicle | |
| US20220073065A1 (en) | Apparatus for predicting risk of collision of vehicle and method of controlling the same | |
| JP2007233604A (en) | Road information acquisition device, and vehicle traveling control device and road traffic system using it | |
| JP4234084B2 (en) | Vehicle trajectory estimation device | |
| JP2003207570A (en) | Following distance measuring device | |
| KR0161044B1 (en) | Control system and method of mobile robot | |
| JP3727429B2 (en) | Method for calculating positional relationship with respect to travel route of vehicle | |
| KR0169647B1 (en) | Automatic guided vehicle and method of driving thereof | |
| JP2840943B2 (en) | Mobile robot guidance device | |
| EP3938226B1 (en) | Vehicle control system and method | |
| JP2805823B2 (en) | Vehicle course control device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A201 | Request for examination | ||
| E902 | Notification of reason for refusal | ||
| E701 | Decision to grant or registration of patent right | ||
| GRNT | Written decision to grant | ||
| FPAY | Annual fee payment |
Payment date: 20111103 Year of fee payment: 7 |
|
| LAPS | Lapse due to unpaid annual fee |