Claims (5)
스스로 이동하면서 주어진 작업을 수행하는 자주식 로보트에 있어서, 상기 로보트를 이동시키는 구동수단과, 상기 구동수단에 의해 이동되는 로보트의 주행거리를 검출하는 주행거리검출수단과, 상기 구동수단에 의해 이동되는 로보트의 주행방향변화를 검출하는 방향검출수단과, 상기 주행거리검출수단에 의해 검출된 주행거리데이타 및 상기 방향각검출수단에 의해 검출된 주행방향데이타를 입력받아 현재위치를 연산하고, 상기 로보트가 목표지점까지 주행하도록 상기 구동수단을 제어하는 제어수단과, 상기 로보트가 주행하는 전방을 180°스캐닝하여 벽면까지의 최단거리를 감지하는 장애물감지수단으로 이루어진 것을 특징으로 하는 로보트의 주행제어장치.A self-propelled robot for performing a given task while moving on its own, comprising a drive means for moving the robot, a travel distance detecting means for detecting a travel distance of the robot moved by the drive means, And calculating the current position by receiving the running distance data detected by the running distance detecting means and the running direction data detected by the direction angle detecting means, Control means for controlling the driving means so as to travel to a point where the robot travels, and an obstacle sensing means for sensing the shortest distance to the wall surface by scanning the front side of the robot traveling by 180 degrees.
제1항에 있어서, 상기 제어수단은 상기 장애물감지수단에 의해 감지된 벽면까지의 최단거리에 따라 상기 로보트를 벽면에 수직정렬시키도록 상기 구동수단을 제어하는 것을 특징으로 하는 로보트의 주행제어장치.The driving control apparatus for a robot according to claim 1, wherein the control means controls the driving means so that the robot is vertically aligned with the wall surface according to the shortest distance to the wall surface detected by the obstacle sensing means.
일정한 주행영역내를 스스로 이동하면서 주어진 작업을 수행하는 로보트의 주행방법에 있어서, 장애물감지수단에 의해 상기 로보트의 전방을 소정각도로 스캐닝하여 벽면까지의 최단거리방향을 산출하는 최단거리산출스템과, 상기 최단거리산출스템에서 산출된 최단거리방향과 수직을 이루는 방향이 측정가능한가를 판별하는 수직방향측정스텝과, 상기 수직방향측정스텝에서 최단거리방향과 수직을 이루는 방향이 측정되면 최단거리방향 및 수직방향까지의 거리를 측정하는 제1거리측정스텝과, 상기 로보트를 일정거리만큼 직진주행시켜 수직을 이루는 두개의 최단거리방향의 거리를 측정하는 제2거리측정스텝과, 상기 제1 및 제2거리측정스텝에서 측정된 거리에 따라 상기 최단거리산출스텝에서 산출된 최단거리방향이 벽면에 수직한 방향이라고 인식되면 상기 로보트 벽면에 수직한 최단방향으로 회전시켜 상기 로보트를 벽면에 수직정렬시키는 수직정렬스템으로 이루어진 것을 특징으로 하는 로보트의 주행제어방법.A shortest distance calculating stem for scanning the front of the robot at a predetermined angle by an obstacle detecting means to calculate a shortest distance direction to the wall surface, A vertical direction measurement step of determining whether a direction perpendicular to the shortest distance direction calculated in the shortest distance calculation stem is measurable, and a vertical direction measurement step of determining, in the vertical direction measurement step, whether the direction perpendicular to the shortest distance direction is measured, A second distance measuring step of measuring a distance between two shortest distance directions which are perpendicular to each other by running the robot in a straight line by a predetermined distance; and a second distance measuring step of measuring a distance between the first and second distances The direction of the shortest distance calculated in the shortest distance calculating step according to the distance measured in the measuring step is a direction perpendicular to the wall surface When the drive control method of a robot, characterized in that by rotating in a direction perpendicular to the shortest robot wall consisting of a vertical alignment system for vertically aligning the robot to recognize the wall.
제3항에 있어서, 상기 수직정렬스텝은 상기 제1 및 제2거리측정스텝에서 측정된 거리(L1,L2,L3,L4)가ycosø=L1-L3의 조건을 만족하면, 상기 최단거리산출스텝에서 산출된 최단거리방향이 벽면에 수직한 방향이라고 인식하는 것을 특징으로 하는 로보트의 주행제어방법.4. The method according to claim 3, wherein in the vertical alignment step, if the distances (L1, L2, L3, L4) measured in the first and second distance measurement steps satisfy the condition of ycosø = L1-L3, The direction of the shortest distance calculated in the direction perpendicular to the wall surface is a direction perpendicular to the wall surface.
제3항에 있어서, 상기 수직정렬스텝은 상기 제1 및 제2거리측정스텝에서 측정된 거리(L1,L2,L3,L4)가 ysinø=L2-L4의 조건을 만족하면, 상기 최단거리산출스텝에서 산출된 최단거리방향이 벽면에 수직한 방향이라고 인식하는 것을 특징으로 하는 로보트의 주행제어방법.4. The method according to claim 3, wherein in the vertical alignment step, if the distances (L1, L2, L3, L4) measured in the first and second distance measurement steps satisfy the condition of ysinø = The direction of the shortest distance calculated in the direction perpendicular to the wall surface is a direction perpendicular to the wall surface.
※ 참고사항 : 최초출원 내용에 의하여 공개하는 것임.※ Note: It is disclosed by the contents of the first application.