KR970069252A - Robot travel control device and method thereof - Google Patents

Robot travel control device and method thereof Download PDF

Info

Publication number
KR970069252A
KR970069252A KR1019960011666A KR19960011666A KR970069252A KR 970069252 A KR970069252 A KR 970069252A KR 1019960011666 A KR1019960011666 A KR 1019960011666A KR 19960011666 A KR19960011666 A KR 19960011666A KR 970069252 A KR970069252 A KR 970069252A
Authority
KR
South Korea
Prior art keywords
robot
distance
wall surface
shortest distance
detecting
Prior art date
Application number
KR1019960011666A
Other languages
Korean (ko)
Other versions
KR100187252B1 (en
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 KR1019960011666A priority Critical patent/KR100187252B1/en
Publication of KR970069252A publication Critical patent/KR970069252A/en
Application granted granted Critical
Publication of KR100187252B1 publication Critical patent/KR100187252B1/en

Links

Classifications

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

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

본 발명은 작업초기에 로보트를 벽면에 용이하게 수직정렬시키는 로보트의 주행제어장치 및 그 방법에 관한 것으로써 로보트를 이동시키는 구동수단과, 상기 구동수단에 의해 이동되는 로보트의 주행거리를 검출하는 주행거리검출수단과, 상기 구동수단에 의해 이동되는 로부트의 주행방향변화를 검출하는 방향각검출수단과, 상기 주행거리검출수단에 의해 검출된 주행거리데이타 및 상기 방향각검출수단에 의해 검출된 주행방향데이타를 입력받아 현재위치를 연산하고, 상기 로보트가 목표지점까지 주행하도록 상기 구동수단을 제어하는 제어수단과, 상기 로보트가 주행하는 전방을 180°스캐닝하여 벽면까지의 최단거리를 감지하는 장애물감지수단으로 이루어진 것으로, 벽면과의 최단거리를 이용하여 로보트를 벽면에 수직정렬시킴으로써 로보트의 현재위치를 정확하게 파악하여 작업효율을 향상시킬 수 있다.The present invention relates to a robot travel control apparatus and method for easily aligning a robot vertically on a wall surface at the beginning of a work and includes a drive means for moving the robot and a drive means for detecting the travel distance of the robot moved by the drive means A traveling direction detecting means for detecting a traveling direction change of the road boot which is moved by the driving means; a traveling distance detecting means for detecting traveling distance data detected by the traveling distance detecting means, A control means for receiving the direction data and calculating the current position and controlling the driving means so that the robot travels to the target point; and an obstacle detection means for detecting the shortest distance to the wall by scanning the front of the robot, By using the shortest distance from the wall surface to vertically align the robot on the wall surface, The current position can improve the working efficiency by accurately identified.

Description

로보트의 주행제어장치 및 그 방법Robot travel control device and method thereof

본 내용은 요부공개 건이므로 전문내용을 수록하지 않았음Since this is a trivial issue, I did not include the contents of the text.

제1도는 본 발명의 일실시예에 의한 로보트의 주행제어장치의 제어블록도, 제2A도 및 제2B도는 본 발명에 의한 로보트의 수직정렬제어 동작순서를 도시한 플로우챠트, 제3도는 본 발명의 일실시예에 의한 로보트의 벽면과의 수직정렬 스캐닝 과정을 설명하는 설명도, 제4도는 본 발명의 일실시예에 의한 로보트의 벽면과의 수직정렬을 설명하는 설명도.FIG. 1 is a control block diagram of a robot travel control apparatus according to an embodiment of the present invention. FIG. 2A and FIG. 2B are flow charts showing a procedure for controlling the robot vertical alignment operation according to the present invention. FIG. 4 is an explanatory view illustrating a vertical alignment of a robot with a wall surface according to an embodiment of the present invention; FIG.

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.
KR1019960011666A 1996-04-17 1996-04-17 Apparatus and its method for moving control of mobile robot KR100187252B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1019960011666A KR100187252B1 (en) 1996-04-17 1996-04-17 Apparatus and its method for moving control of mobile robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1019960011666A KR100187252B1 (en) 1996-04-17 1996-04-17 Apparatus and its method for moving control of mobile robot

Publications (2)

Publication Number Publication Date
KR970069252A true KR970069252A (en) 1997-11-07
KR100187252B1 KR100187252B1 (en) 1999-05-01

Family

ID=19455978

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1019960011666A KR100187252B1 (en) 1996-04-17 1996-04-17 Apparatus and its method for moving control of mobile robot

Country Status (1)

Country Link
KR (1) KR100187252B1 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108931983B (en) * 2018-09-07 2020-04-24 深圳市银星智能科技股份有限公司 Map construction method and robot thereof
KR20220102058A (en) * 2021-01-12 2022-07-19 삼성전자주식회사 Robot and controlling method thereof

Also Published As

Publication number Publication date
KR100187252B1 (en) 1999-05-01

Similar Documents

Publication Publication Date Title
KR970010025A (en) Robot position recognition device and control method
JP5390100B2 (en) Method and apparatus for monitoring road paving machine
KR970033627A (en) Robot environmental recognition device and control method
JP5218479B2 (en) Mobile system
JP2010140247A (en) Moving object system
KR101519277B1 (en) Apparatus and Method for Recognize of Drive Way of Vehicle
JPH0895638A (en) Travel controller for mobile working robot
JP2584823B2 (en) Pavement thickness measuring device
KR970069252A (en) Robot travel control device and method thereof
JP3852076B2 (en) Rail advance measuring device and measuring method
JPH06225308A (en) Running course detector
JP2010262461A (en) Mobile object
KR970064835A (en) Robot travel control device and method thereof
JP3219204B2 (en) Road surface unevenness measurement vehicle
JP2012113765A (en) Traveling body system
JPS61139807A (en) Running controller of unattended running car
KR970010033A (en) Robot position recognition device and control method
JPH0734411A (en) Work vehicle
JP2934770B2 (en) Method and apparatus for measuring wheel diameter of mobile robot
KR950002933A (en) Robot automatic driving control device and method
JP3727429B2 (en) Method for calculating positional relationship with respect to travel route of vehicle
JP7275973B2 (en) position estimator
KR0161044B1 (en) Control system and method of mobile robot
JP2004287571A (en) Yard crane, and traveling control method therefor
JP2000222035A (en) Automatic travel device

Legal Events

Date Code Title Description
A201 Request for examination
E701 Decision to grant or registration of patent right
GRNT Written decision to grant
FPAY Annual fee payment

Payment date: 20071129

Year of fee payment: 10

LAPS Lapse due to unpaid annual fee