KR102515061B1 - Method for preventing collision of automated guided vehicle for automated guided vehicle system - Google Patents

Method for preventing collision of automated guided vehicle for automated guided vehicle system Download PDF

Info

Publication number
KR102515061B1
KR102515061B1 KR1020200162661A KR20200162661A KR102515061B1 KR 102515061 B1 KR102515061 B1 KR 102515061B1 KR 1020200162661 A KR1020200162661 A KR 1020200162661A KR 20200162661 A KR20200162661 A KR 20200162661A KR 102515061 B1 KR102515061 B1 KR 102515061B1
Authority
KR
South Korea
Prior art keywords
guided vehicle
automatic guided
collision detection
detection area
unmanned
Prior art date
Application number
KR1020200162661A
Other languages
Korean (ko)
Other versions
KR20220074311A (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 KR1020200162661A priority Critical patent/KR102515061B1/en
Publication of KR20220074311A publication Critical patent/KR20220074311A/en
Application granted granted Critical
Publication of KR102515061B1 publication Critical patent/KR102515061B1/en

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60RVEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
    • B60R21/00Arrangements or fittings on vehicles for protecting or preventing injuries to occupants or pedestrians in case of accidents or other traffic risks
    • B60R21/01Electrical circuits for triggering passive safety arrangements, e.g. airbags, safety belt tighteners, in case of vehicle accidents or impending vehicle accidents
    • B60R21/013Electrical circuits for triggering passive safety arrangements, e.g. airbags, safety belt tighteners, in case of vehicle accidents or impending vehicle accidents including means for detecting collisions, impending collisions or roll-over
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/50Barriers
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60YINDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2300/00Purposes or special features of road vehicle drive control systems
    • B60Y2300/08Predicting or avoiding probable or impending collision
    • B60Y2300/095Predicting travel path or likelihood of collision
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60YINDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2400/00Special features of vehicle units
    • B60Y2400/30Sensors
    • B60Y2400/304Acceleration sensors
    • B60Y2400/3042Collision sensors

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

본 발명에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법은, 무인운반차 시스템에 구비되어 운행되는 제 1 무인운반차 및 제 2 무인운반차 간의 충돌을 방지하기 위한 무인운반차 시스템의 무인운반차 충돌 방지방법으로서, (a) 중심이 상기 제 1 무인운반차 상에 위치하는 원형으로 이루어지고 상기 제 1 무인운반차의 외곽 영역보다 넓은 상기 제 1 무인운반차의 충돌 감지 영역과, 중심이 상기 제 2 무인운반차 상에 위치하는 원형으로 이루어지고 상기 제 2 무인운반차의 외곽 영역보다 넓은 상기 제 2 무인운반차의 충돌 감지 영역을 각각 설정하는 단계; (b) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역 간의 중첩 여부를 확인하는 단계; (c) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역이 중첩되는 경우, 상기 제 1 무인운반차의 진행 방향 연장선분과 상기 제 2 무인운반차의 진행 방향 연장선분이 교차하는 교차점을 확인하는 단계; 및 (d) 상기 (c) 단계에서 상기 교차점이 존재하는 경우, 상기 제 1 무인운반차와 상기 제 2 무인운반차 중 상기 교차점이 진행 방향에 위치하는 무인운반차를 감속 또는 정지시키는 단계;를 포함한다.A method for preventing collision of an unmanned guided vehicle system according to the present invention is an unmanned guided vehicle system for preventing a collision between a first unmanned guided vehicle and a second unmanned guided vehicle provided and operated in the unmanned guided vehicle system. A vehicle collision avoidance method comprising: (a) a collision detection area of the first automatic guided vehicle which is formed in a circular shape with a center located on the first automatic guided vehicle and which is wider than an outer area of the first automatic guided vehicle; and setting a collision detection area of the second automatic guided vehicle, each having a circular shape located on the second automatic guided vehicle and wider than an outer area of the second automatic guided vehicle; (b) checking whether a collision detection area of the first automatic guided vehicle overlaps with a collision detection area of the second automatic guided vehicle; (c) When the collision detection area of the first automatic guided vehicle overlaps with the collision detection area of the second automatic guided vehicle, an extension line in the traveling direction of the first automatic guided vehicle and an extension line in the traveling direction of the second automatic guided vehicle checking intersections where minutes intersect; and (d) if the intersection exists in step (c), decelerating or stopping the first automatic guided vehicle and the second automatic guided vehicle whose intersection is located in the traveling direction; include

Description

무인운반차 시스템의 무인운반차 충돌 방지방법{METHOD FOR PREVENTING COLLISION OF AUTOMATED GUIDED VEHICLE FOR AUTOMATED GUIDED VEHICLE SYSTEM}Collision avoidance method of unmanned guided vehicle system

본 발명은 무인운반차 시스템의 무인운반차 충돌 방지방법에 관한 것으로, 더욱 상세하게는 운행 중 상호 접근하는 무인운반차들 간의 충돌을 방지하기 위한 무인운반차 시스템의 무인운반차 충돌 방지방법에 관한 것이다.The present invention relates to a method for preventing collision of unmanned guided vehicles of an unmanned guided vehicle system, and more particularly, to a method for preventing collision between unmanned guided vehicles of an unmanned guided vehicle system for preventing collision between unmanned guided vehicles approaching each other during operation. will be.

우리가 살고 있는 현대 사회의 산업에서는 생산된 물품을 신속하게 유통시키는 기술이 물류 산업에 종사하고 있는 업체들에게는 핵심 경쟁력이 되고 있는 실정이다.In the modern society we live in, technology for quickly distributing manufactured goods is becoming a core competitive edge for companies engaged in the logistics industry.

경쟁력을 높이기 위해 무인운반차 시스템을 도입하고 인력으로 작업하기 힘든 곳에 무인운반차나 로봇을 확대 사용함으로써 인건비 절약 및 작업의 효율성과 생산성을 높이고 있다.In order to increase competitiveness, we are introducing an unmanned guided vehicle system and expanding the use of unmanned guided vehicles or robots in places where it is difficult to work with manpower, saving labor costs and increasing work efficiency and productivity.

무인운반차 시스템은 기본적으로 복수의 무인운반차와, 전체 무인운반차의 주행과 작업을 통제하는 주제어부를 포함한다. 무인운반차와 주제어부에는 상호 통신을 통해 명령을 주고받기 위한 무선통신기가 각각 구비된다.The unmanned guided vehicle system basically includes a plurality of unmanned guided vehicles and a main control unit that controls driving and operation of the entire unmanned guided vehicle. The unmanned guided vehicle and the main control unit each have a wireless communication unit for exchanging commands through mutual communication.

무인운반차는 공장 바닥이나 창고 바닥 등의 주행면에 자성도료로 칠해진 운반경로나 주행면 밑에 설치된 유도용 전선 등과 신호를 주고받으면서 이동할 수 있다. 최근에는 초음파센서, 스테레오비젼 카메라, 레이저, GPS 기술을 이용하여 물리적인 궤도가 필요없이 맵을 구성하여 맵 상의 궤도를 따라 주행하는 무인운반차가 등장하고 있다.The unmanned guided vehicle can move while exchanging signals with a transportation path painted with magnetic paint on a driving surface such as a factory floor or warehouse floor, or an induction wire installed under the driving surface. Recently, an unmanned guided vehicle that runs along the track on the map by constructing a map without the need for a physical track using ultrasonic sensor, stereo vision camera, laser, and GPS technology has appeared.

주제어부는 전체 시스템의 상황을 파악하여 각각의 무인운반차가 수행하여야 할 작업명령을 일정한 형식의 통신 포멧으로 무선통신기를 통해 각각의 무인운반차에 송신한다. 무인운반차는 주제어부가 송신한 명령을 무선통신기로 수신하여 지시된 작업명령의 내용에 따라 지시된 경로를 따라 이동하거나, 지시된 운반 작업을 수행하게 된다.The main control unit grasps the status of the entire system and transmits work commands to be executed by each unmanned guided vehicle to each unmanned guided vehicle through a wireless communicator in a certain communication format. The unmanned guided vehicle receives the command transmitted by the main control unit through a wireless communication device, and moves along the indicated path according to the contents of the instructed task command or performs the indicated transport task.

같은 작업 공간에서 여러 대의 무인운반차가 운행되면 무인운반차들이 일정 거리 내로 접근하거나 무인운반차들의 주행 경로가 겹치는 일이 빈번하게 발생하게 된다. 따라서 여러 대의 무인운반차를 운행하기 위해서는 무인운반차들을 주행 중에 충돌하지 않도록 주행 제어하는 것이 필요하다.When several unmanned guided vehicles are operated in the same workspace, it frequently occurs that the unmanned guided vehicles approach within a certain distance or the driving routes of the unmanned guided vehicles overlap. Therefore, in order to operate several unmanned guided vehicles, it is necessary to control driving so that the unmanned guided vehicles do not collide while driving.

현재, 무인운반차들 간의 충돌을 방지하기 위한 다양한 방법이 개발되어 사용되고 있지만, 무인운반차들의 작업 효율을 떨어트리지 않으면서 무인운반차들 간의 충돌을 효과적으로 방지할 수 있는 충돌 방지 기술을 개발하려는 연구 개발이 지속적으로 이루어지고 있다.Currently, various methods for preventing collisions between unmanned guided vehicles have been developed and used, but research is being conducted to develop collision avoidance technology that can effectively prevent collisions between unmanned guided vehicles without reducing the work efficiency of unmanned guided vehicles. Development is continuously taking place.

등록특허공보 제10-2006401호 (2019. 10. 01.)Registered Patent Publication No. 10-2006401 (2019. 10. 01.)

본 발명은 상술한 바와 같은 점을 감안하여 안출된 것으로, 무인운반차들의 작업 효율을 떨어트리지 않으면서 무인운반차들 간의 충돌을 효과적으로 방지할 수 있는 무인운반차 시스템의 무인운반차 충돌 방지방법을 제공하는 것을 목적으로 한다.The present invention has been devised in view of the above-mentioned points, and provides a method for preventing collisions between unmanned guided vehicles of an unmanned guided vehicle system that can effectively prevent collisions between unmanned guided vehicles without reducing the work efficiency of the unmanned guided vehicles. intended to provide

상술한 바와 같은 목적을 해결하기 위한 본 발명에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법은, 무인운반차 시스템에 구비되어 운행되는 제 1 무인운반차 및 제 2 무인운반차 간의 충돌을 방지하기 위한 무인운반차 시스템의 무인운반차 충돌 방지방법으로서, (a) 중심이 상기 제 1 무인운반차 상에 위치하는 원형으로 이루어지고 상기 제 1 무인운반차의 외곽 영역보다 넓은 상기 제 1 무인운반차의 충돌 감지 영역과, 중심이 상기 제 2 무인운반차 상에 위치하는 원형으로 이루어지고 상기 제 2 무인운반차의 외곽 영역보다 넓은 상기 제 2 무인운반차의 충돌 감지 영역을 각각 설정하는 단계; (b) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역 간의 중첩 여부를 확인하는 단계; (c) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역이 중첩되는 경우, 상기 제 1 무인운반차의 진행 방향 연장선분과 상기 제 2 무인운반차의 진행 방향 연장선분이 교차하는 교차점을 확인하는 단계; 및 (d) 상기 (c) 단계에서 상기 교차점이 존재하는 경우, 상기 제 1 무인운반차와 상기 제 2 무인운반차 중 상기 교차점이 진행 방향에 위치하는 무인운반차를 감속 또는 정지시키는 단계;를 포함한다.In order to solve the above object, a method for preventing collision of an unmanned guided vehicle system according to the present invention prevents a collision between a first unmanned guided vehicle and a second unmanned guided vehicle provided and operated in an unmanned guided vehicle system A method for preventing collision of an unmanned guided vehicle system for: (a) the first unmanned guided vehicle having a circular shape with a center located on the first unmanned guided vehicle and wider than an outer area of the first unmanned guided vehicle; setting a collision detection area of a car and a collision detection area of the second automatic guided vehicle which is formed in a circular shape with a center located on the second automatic guided vehicle and is wider than an outer area of the second automatic guided vehicle; (b) checking whether a collision detection area of the first automatic guided vehicle overlaps with a collision detection area of the second automatic guided vehicle; (c) When the collision detection area of the first automatic guided vehicle overlaps with the collision detection area of the second automatic guided vehicle, an extension line in the traveling direction of the first automatic guided vehicle and an extension line in the traveling direction of the second automatic guided vehicle checking intersections where minutes intersect; and (d) if the intersection exists in step (c), decelerating or stopping the first automatic guided vehicle and the second automatic guided vehicle whose intersection is located in the traveling direction; include

상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역의 반경(r)은 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 이동 속도에 비례할 수 있다.The radius (r) of the collision detection area of each of the first and second automatic guided vehicles may be proportional to the moving speed of each of the first and second automatic guided vehicles.

상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역의 반경(r)은 다음의 수식1로 산출될 수 있다.The radius (r) of the collision detection area of each of the first and second automatic guided vehicles may be calculated by Equation 1 below.

수식1Formula 1

Figure 112020128372458-pat00001
Figure 112020128372458-pat00001

(ω: 가중치(ω>1), v: 무인운반차의 현재 이동 속도, t: 무인운반차가 감속하여 정지하는데 걸리는 시간, offset: 관리자에 의해 부여되는 파라미터)(ω: weight (ω>1), v: current moving speed of the automated guided vehicle, t: time required for the automated guided vehicle to decelerate and stop, offset: a parameter given by the manager)

상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역의 반경(r)은 다음의 수식2로 산출될 수 있다.The radius (r) of the collision detection area of each of the first and second automatic guided vehicles may be calculated by Equation 2 below.

Figure 112020128372458-pat00002
Figure 112020128372458-pat00002

(ω: 가중치(ω>1), a: 무인운반차의 감속도, v: 무인운반차의 현재 이동 속도, offset: 관리자에 의해 부여되는 파라미터)(ω: weight (ω>1), a: deceleration of the automated guided vehicle, v: current moving speed of the automated guided vehicle, offset: parameter given by the manager)

상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역의 중심은 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 중심에 위치할 수 있다.The center of the collision detection area of each of the first and second automatic guided vehicles may be located at the center of each of the first and second automatic guided vehicles.

본 발명에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법은, 상기 (b) 단계 이전에, (e) 상기 제 1 무인운반차의 외곽 영역보다 크고 상기 제 1 무인운반차의 외곽 영역을 포함하되 상기 제 1 무인운반차의 충돌 감지 영역보다 작은 상기 제 1 무인운반차의 보호 영역과, 상기 제 2 무인운반차의 외곽 영역보다 크고 상기 제 2 무인운반차의 외곽 영역을 포함하되 상기 제 2 무인운반차의 충돌 감지 영역보다 작은 상기 제 2 무인운반차의 보호 영역을 각각 설정하는 단계; 상기 (b) 단계 이후에, (f) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역이 중첩되는 경우, 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역 중 적어도 하나가 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 보호 영역 중 적어도 하나와 중첩되는지 확인하는 단계; 및 (g) 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역 중 적어도 하나가 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 보호 영역 중 적어도 하나와 중첩되는 경우, 상기 제 1 무인운반차와 상기 제 2 무인운반차 중 충돌 감지 영역이 다른 무인운반차의 보호 영역에 중첩된 무인운반차를 감속 또는 정지시키는 단계;를 포함할 수 있다.In the method for preventing collision of an unmanned guided vehicle system according to the present invention, prior to the step (b), (e) includes an outer area of the first unmanned guided vehicle that is larger than the outer area of the first unmanned guided vehicle. but including a protection area of the first automatic guided vehicle that is smaller than the collision detection area of the first automatic guided vehicle and an outer area of the second automatic guided vehicle that is larger than the outer area of the second automatic guided vehicle, but the second setting a protection area of the second automatic guided vehicle that is smaller than a collision detection area of the automatic guided vehicle; After the step (b), (f) when the collision detection area of the first automatic guided vehicle overlaps with the collision detection area of the second automatic guided vehicle, the first automatic guided vehicle and the second automatic guided vehicle checking whether at least one of the collision detection areas overlaps with at least one of the protection areas of the first and second automatic guided vehicles; and (g) when at least one of the collision detection areas of the first and second automatic guided vehicles overlaps with at least one of the protection areas of the first and second automatic guided vehicles, respectively. and decelerating or stopping an automatic guided vehicle whose collision detection area overlaps with a protection area of another automatic guided vehicle among the first automatic guided vehicle and the second automatic guided vehicle.

본 발명에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법은, 상기 (b) 단계 이전에, (e) 상기 제 1 무인운반차의 외곽 영역보다 크고 상기 제 1 무인운반차의 외곽 영역을 포함하되 상기 제 1 무인운반차의 충돌 감지 영역보다 작은 상기 제 1 무인운반차의 보호 영역과, 상기 제 2 무인운반차의 외곽 영역보다 크고 상기 제 2 무인운반차의 외곽 영역을 포함하되 상기 제 2 무인운반차의 충돌 감지 영역보다 작은 상기 제 2 무인운반차의 보호 영역을 각각 설정하는 단계; 상기 (b) 단계 이후에, (f) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역이 중첩되는 경우, 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역 중 적어도 하나가 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 보호 영역 중 적어도 하나와 중첩되는지 확인하는 단계; 및 (g) 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역 중 적어도 하나가 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 보호 영역 중 적어도 하나와 중첩되는 경우, 상기 제 1 무인운반차와 상기 제 2 무인운반차 중 보호 영역이 다른 무인운반차의 출동 감지 영역과 중첩된 무인운반차를 감속 또는 정지시키는 단계;를 포함할 수 있다.In the method for preventing collision of an unmanned guided vehicle system according to the present invention, prior to the step (b), (e) includes an outer area of the first unmanned guided vehicle that is larger than the outer area of the first unmanned guided vehicle. but including a protection area of the first automatic guided vehicle that is smaller than the collision detection area of the first automatic guided vehicle and an outer area of the second automatic guided vehicle that is larger than the outer area of the second automatic guided vehicle, but the second setting a protection area of the second automatic guided vehicle that is smaller than a collision detection area of the automatic guided vehicle; After the step (b), (f) when the collision detection area of the first automatic guided vehicle overlaps with the collision detection area of the second automatic guided vehicle, the first automatic guided vehicle and the second automatic guided vehicle checking whether at least one of the collision detection areas overlaps with at least one of the protection areas of the first and second automatic guided vehicles; and (g) when at least one of the collision detection areas of the first and second automatic guided vehicles overlaps with at least one of the protection areas of the first and second automatic guided vehicles, respectively. and decelerating or stopping an automatic guided vehicle whose protection area overlaps with an dispatch detection area of another automatic guided vehicle among the first and second automatic guided vehicles.

상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 보호 영역은 각각의 무인운반차가 그 주위의 물체를 감지할 수 있도록 설치되는 감지 센서에 의해 보호되는 영역으로 설정될 수 있다.A protection area of each of the first and second automatic guided vehicles may be set as an area protected by a sensor installed so that each automatic guided vehicle can detect an object around it.

상기 (d) 단계에서, 상기 교차점이 상기 제 1 무인운반차의 진행 방향 및 상기 제 2 무인운반차의 진행 방향에 위치하는 경우, 상기 제 1 무인운반차와 상기 제 2 무인운반차 중 상기 교차점까지의 이동 거리가 상대적으로 긴 무인운반차를 감속 또는 정지시킬 수 있다.In step (d), if the intersection is located in the traveling direction of the first and second automatic guided vehicle, the intersection of the first and second automatic guided vehicle It is possible to decelerate or stop an unmanned guided vehicle with a relatively long moving distance.

본 발명에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법은 운행 중 상호 접근하는 무인운반차들 각각의 이동 속도에 따라 각 무인운반차의 외곽 영역보다 넓은 충돌 감지 영역을 설정하고, 충돌 감지 영역이 중첩되는 조건에 한해 무인운반차를 감속 또는 정지하도록 제어한다. 따라서 다양한 운행 조건에서 무인운반차들 간의 충돌 위험을 효과적으로 줄이면서 무인운반차의 효율적인 운행을 가능하게 한다.According to the collision avoidance method of the unmanned guided vehicle system according to the present invention, a collision detection area wider than the outer area of each unmanned guided vehicle is set according to the moving speed of each unmanned guided vehicle approaching each other during operation, and the collision detection area Only under these overlapping conditions, the automatic guided vehicle is controlled to decelerate or stop. Therefore, it is possible to efficiently operate the unmanned guided vehicles while effectively reducing the risk of collision between the unmanned guided vehicles under various driving conditions.

도 1은 본 발명의 일실시예에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법에 의해 제어되는 무인운반차의 일예를 나타낸 것이다.
도 2는 본 발명의 일실시예에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법을 설명하기 위한 제어흐름도이다.
도 3 내지 도 9는 무인운반차의 다양한 운행 상황에서 본 발명의 일실시예에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법에 따라 무인운반차를 제어하는 구체적인 방법을 예시적으로 나타낸 것이다.
1 illustrates an example of an automatic guided vehicle controlled by an automatic guided vehicle collision avoidance method of an automatic guided vehicle system according to an embodiment of the present invention.
2 is a control flow chart illustrating a method for preventing collision of an automatic guided vehicle in an automatic guided vehicle system according to an embodiment of the present invention.
3 to 9 illustratively illustrate a specific method of controlling an automatic guided vehicle according to the automatic guided vehicle collision avoidance method of the automatic guided vehicle system according to an embodiment of the present invention in various operating situations of the automatic guided vehicle.

이하, 본 발명에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법을 도면을 참조하여 상세히 설명한다.Hereinafter, the automatic guided vehicle collision prevention method of the automatic guided vehicle system according to the present invention will be described in detail with reference to the accompanying drawings.

도 1은 본 발명의 일실시예에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법에 의해 제어되는 무인운반차의 일예를 나타낸 것이고, 도 2는 본 발명의 일실시예에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법을 설명하기 위한 제어흐름도이다.1 shows an example of an unmanned guided vehicle controlled by a method for preventing collision of an unmanned guided vehicle system according to an embodiment of the present invention, and FIG. 2 is an unmanned guided vehicle system according to an embodiment of the present invention. It is a control flow chart to explain the automatic guided vehicle collision avoidance method.

본 발명의 일실시예에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법은 무인운반차 시스템에 구비되어 운행되는 무인운반차들 간의 충돌을 방지하기 위한 것이다. 여기에서, 무인운반차 시스템은 복수의 무인운반차와, 복수의 무인운반차를 제어하기 위한 주제어부를 포함할 수 있다. 주제어부는 각각의 무인운반차에 구비되는 개별제어부와 통신하여 무인운반차를 설정된 경로를 따라 주행하도록 제어할 수 있다. 본 발명의 일실시예에 따른 무인운반차 시스템은 주제어부를 통해 실행되거나, 또는 각각의 무인운반차에 구비되는 개별제어부를 통해 실행될 수 있다.A method for preventing collision of an unmanned guided vehicle system according to an embodiment of the present invention is to prevent a collision between unmanned guided vehicles provided and operated in an unmanned guided vehicle system. Here, the automatic guided vehicle system may include a plurality of automatic guided vehicles and a main control unit for controlling the plurality of automatic guided vehicles. The main control unit may communicate with an individual control unit provided in each unmanned guided vehicle to control the unmanned guided vehicle to travel along a set path. The automatic guided vehicle system according to an embodiment of the present invention may be executed through a main control unit or individual control units provided in each automatic guided vehicle.

본 발명의 일실시예에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법은 도 1에 나타낸 것과 같이, 각각의 무인운반차(10)에 대해서는 보호 영역(30)과 충돌 감지 영역(40)이 설정하고, 각 무인운반차(10) 보호 영역(30)과 충돌 감지 영역(40)을 이용하여 각 무인운반차(10)를 제어할 수 있다.As shown in FIG. 1, in the method for preventing collision of an automatic guided vehicle system according to an embodiment of the present invention, a protection area 30 and a collision detection area 40 are provided for each automatic guided vehicle 10. settings, and each automatic guided vehicle 10 can be controlled using the protection area 30 and the collision detection area 40 of each automatic guided vehicle 10 .

보호 영역(30)은 무인운반차(10)의 외곽 영역(20)보다 소정 넓이 확장된 영역이다. 보호 영역(30)은 무인운반차(10)에 설치되어 무인운반차(10) 주위의 물체를 감지할 수 있는 레이저 스캐너 등의 감지 센서에 의해 결정될 수 있다. 즉 보호 영역(30)은 무인운반차(10)에 설치되는 레이저 스캐너 등의 감지 센서에 의해 보호되는 영역, 또는 레이저 스캐너 등 감지 센서의 감지 영역으로 설정될 수 있다.The protection area 30 is an area that extends a predetermined width from the outer area 20 of the automatic guided vehicle 10 . The protection area 30 may be determined by a detection sensor such as a laser scanner installed in the automatic guided vehicle 10 and capable of detecting an object around the automatic guided vehicle 10 . That is, the protection area 30 may be set as an area protected by a detection sensor such as a laser scanner installed in the automatic guided vehicle 10 or a detection area of a detection sensor such as a laser scanner.

무인운반차(10)는 운행 중에 보호 영역(30) 내로 장애물이나 다른 무인운반차(10)가 도달하지 않도록 제어된다. 즉 무인운반차(10)의 운행 중에 장애물이나 다른 무인운반차(10)가 보호 영역(30)에 도달하는 경우 무인운반차(10)는 비상 정지하도록 제어될 수 있다. 보호 영역(30)은 무인운반차(10)의 크기 등에 따라 적절한 크기로 결정될 수 있다. 무인운반차(10)에 대해 보호 영역(30)이 설정되면 무인운반차(10)의 중심(Cv)을 기준으로 하여 보호 영역(30)의 경계에 대한 상대 좌표가 결정될 수 있다. 따라서 무인운반차(10)의 정지 또는 진행 중에 무인운반차(10)의 중심(Cv)에 대한 좌표값을 확인하면 보호 영역(30)의 경계에 대한 좌표값을 알 수 있다.The automatic guided vehicle 10 is controlled so that obstacles or other automatic guided vehicles 10 do not reach the protection area 30 while driving. That is, when an obstacle or another automatic guided vehicle 10 reaches the protection area 30 while the automatic guided vehicle 10 is in operation, the automatic guided vehicle 10 may be controlled to make an emergency stop. The protection area 30 may be determined to have an appropriate size according to the size of the automatic guided vehicle 10 and the like. When the protection area 30 is set for the automatic guided vehicle 10, relative coordinates of the boundary of the protection area 30 may be determined based on the center Cv of the automatic guided vehicle 10. Therefore, if the coordinate values of the center Cv of the automatic guided vehicle 10 are checked while the automatic guided vehicle 10 is stopped or running, the coordinate values of the boundary of the protection area 30 can be known.

충돌 감지 영역(40)은 중심이 무인운반차(10) 상에 위치하고 보호 영역(30)을 포함하는 원형의 영역으로 설정된다. 충돌 감지 영역(40)의 중심은 무인운반차(10)의 중심(Cv)에 위치할 수 있다. 충돌 감지 영역(40)은 무인운반차(10)가 진행 중에 현재 위치에서 감속하여 정지하기까지 필요한 최대 거리를 감안한 크기로 설정될 수 있다. 충돌 감지 영역(40)의 크기는 무인운반차(10)의 현재 이동 속도에 비례할 수 있다.The collision detection area 40 is set as a circular area whose center is located on the automatic guided vehicle 10 and includes the protection area 30 . The center of the collision detection area 40 may be located at the center Cv of the automatic guided vehicle 10 . The collision detection area 40 may be set to a size considering the maximum distance required until the automatic guided vehicle 10 decelerates and stops from the current position while moving. The size of the collision detection area 40 may be proportional to the current moving speed of the automatic guided vehicle 10 .

구체적으로, 충돌 감지 영역(40)의 반경(r)은 다음의 수식1로 산출될 수 있다.Specifically, the radius r of the collision sensing area 40 may be calculated by Equation 1 below.

수식1Formula 1

Figure 112020128372458-pat00003
Figure 112020128372458-pat00003

여기에서, ω는 가중치(ω>1)이고, v는 무인운반차의 현재 이동 속도이고, t는 무인운반차가 감속하여 정지하는데 걸리는 시간이며, offset은 관리자에 의해 부여되는 파라미터이다. ω는 무인운반차의 중량이나 무인운반차의 운행 환경에 따라 1보다 큰 수로 다양하게 결정될 수 있다. t는 무인운반차가 현재 이동 속도(v)로 주행하다가 감속하여 정지하는데 걸리는 시간으로, 무인운반차의 사양 등에 따라 결정될 수 있으며, 관리자에 의해 지정될 수 있다. offset은 무인운반차의 중량이나 무인운반차의 운행 환경, 무인운반차가 운반하는 화물의 하중이나 종류 등에 따라 관리자가 다양하게 결정할 수 있다. 관리자는 무인운반차의 운행 환경 등에 따라 ω와 offset을 적절한 값으로 결정함으로써 충돌 감지 영역(40)의 크기를 조절할 수 있다.Here, ω is a weight (ω>1), v is the current moving speed of the automatic guided vehicle, t is the time taken for the automatic guided vehicle to decelerate and stop, and offset is a parameter assigned by the manager. ω may be variously determined as a number greater than 1 according to the weight of the automated guided vehicle or the operating environment of the automated guided vehicle. t is the time required for the automatic guided vehicle to decelerate and stop while traveling at the current moving speed (v), which may be determined according to the specifications of the automatic guided vehicle, etc., and may be designated by a manager. The offset can be variously determined by the manager depending on the weight of the automated guided vehicle, operating environment of the automated guided vehicle, and the load or type of cargo transported by the automated guided vehicle. The manager can adjust the size of the collision detection area 40 by determining ω and offset as appropriate values according to the operating environment of the automatic guided vehicle.

예를 들어, 무인운반차의 작업 시간이 지연되더라도 무인운반차의 충돌 위험을 더욱 줄이고자 하는 경우, 관리자는 ω와 offset을 상대적으로 큰 값으로 결정할 수 있다. 반면, 무인운반차의 작업 시간을 단축하고자 하는 경우, 관리자는 ω와 offset를 상대적으로 작은 값으로 결정할 수 있다.For example, in order to further reduce the risk of collision of the automatic guided vehicle even if the operation time of the automatic guided vehicle is delayed, the manager may determine ω and the offset as relatively large values. On the other hand, in the case of reducing the working time of an unmanned guided vehicle, a manager may determine ω and offset as relatively small values.

또한 충돌 감지 영역(40)의 반경(r)은 다음의 수식2로 산출될 수도 있다.In addition, the radius r of the collision sensing area 40 may be calculated by Equation 2 below.

수식2Formula 2

Figure 112020128372458-pat00004
Figure 112020128372458-pat00004

여기에서, ω는 가중치(ω>1)이고, a는 무인운반차의 감속도이고, v는 무인운반차의 현재 이동 속도이며, offset은 관리자에 의해 부여되는 파라미터이다. a는 무인운반차가 정상적인 주행 중에 감속하도록 세팅된 감속도이다. 비상 상황에서 무인운반차는 위 수식2의 a와 다른 감속도로 감속하도록 제어될 수 있다.Here, ω is a weight (ω>1), a is the deceleration of the automatic guided vehicle, v is the current moving speed of the automatic guided vehicle, and offset is a parameter given by the manager. a is the deceleration rate set so that the automatic guided vehicle decelerates during normal driving. In an emergency situation, the automatic guided vehicle may be controlled to decelerate at a deceleration rate different from a in Equation 2 above.

무인운반차(10)가 정지한 경우에도 무인운반차(10)에 최소한의 충돌 감지 영역(40)이 설정될 수 있다.Even when the automatic guided vehicle 10 is stopped, a minimum collision detection area 40 may be set in the automatic guided vehicle 10 .

도 1의 (a)는 진행 중인 무인운반차(10)에 설정되는 충돌 감지 영역(40)을 나타낸 것이고, (b)는 정지한 무인운반차(10)에 설정되는 충돌 감지 영역(40)을 나타낸 것이다. 정지한 무인운반차(10)의 충돌 감지 영역(40)도 보호 영역(30)보다는 큰 크기로 이루어지는 것이 바람직하다.(a) of FIG. 1 shows the collision detection area 40 set in the moving automatic guided vehicle 10, and (b) shows the collision detection area 40 set in the stopped automatic guided vehicle 10. it is shown It is preferable that the collision detection area 40 of the stopped automatic guided vehicle 10 also has a larger size than the protection area 30 .

무인운반차(10)에 대해 충돌 감지 영역(40)이 설정되면 무인운반차(10)의 중심(Cv)을 기준으로 하여 충돌 감지 영역(40)의 경계에 대한 상대 좌표가 결정될 수 있다. 따라서 무인운반차(10)의 정지 또는 진행 중에 무인운반차(10)의 중심(Cv)에 대한 좌표값을 확인하면 충돌 감지 영역(40)의 경계에 대한 좌표값을 알 수 있다.When the collision detection area 40 is set for the automatic guided vehicle 10, relative coordinates of the boundary of the collision detection area 40 may be determined based on the center Cv of the automatic guided vehicle 10. Therefore, if the coordinate value of the center Cv of the automatic guided vehicle 10 is checked while the automatic guided vehicle 10 is stopped or in motion, the coordinate value of the boundary of the collision detection area 40 can be known.

도 2에 나타낸 것과 같이, 본 발명의 일실시예에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법은 무인운반차(10)의 운행 중에 무인운반차(10)의 충돌 감지 영역(40)이 다른 무인운반차(10)의 충돌 감지 영역(40)과 중첩되어 무인운반차들(10)이 충돌할 위험이 있는 경우 무인운반차(10)를 감속 또는 정지하도록 제어함으로써 무인운반차들(10) 간의 충돌을 방지할 수 있다.As shown in FIG. 2 , in the method for preventing collision of an unmanned guided vehicle system according to an embodiment of the present invention, the collision detection area 40 of the unmanned guided vehicle 10 during operation of the unmanned guided vehicle 10 is When there is a risk of collision between the automatic guided vehicles 10 overlapping with the collision detection area 40 of another automatic guided vehicle 10, the automatic guided vehicle 10 is controlled to decelerate or stop so that the automatic guided vehicle 10 ) can prevent conflicts between

이하에서는, 설명의 편의를 위해 운행 중에 상호 접근하는 두 개의 무인운반차를 각각 제 1 무인운반차(10) 및 제 2 무인운반차(10')로 구분하여 설명하기로 한다.Hereinafter, for convenience of description, two automated guided vehicles approaching each other during operation will be described separately as a first automated guided vehicle 10 and a second automated guided vehicle 10'.

본 발명의 일실시예에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법은 각각의 무인운반차(10)(10')에 대해 충돌 감지 영역(40)(40')을 설정하는 단계(S10)와, 충돌 감지 영역(40)(40')의 중첩 여부를 확인하는 단계(S20)와, 중첩 영역(50)이 발생한 무인운반차들(10)(10') 각각의 진행 방향 연장선분(L1)(L2)을 생성하고 진행 방향 연장선분(L1)(L2) 간의 교차점(P)을 계산하는 단계(S30)와, 진행 방향 연장선분(L1)(L2) 간의 교차점(P) 존재 여부를 확인하고(S40), 진행 방향 연장선분(L1)(L2)의 교차점(P) 존재 여부에 따라 각각의 무인운반차(10)(10')를 제어하는 단계(S50~S90)를 포함한다. 각 무인운반차(10)(10')에 대한 보호 영역(30)(30')은 시스템의 세팅 초기에 설정되어 개별제어부 또는 주제어부에 저장될 수 있다.In the method for preventing collision of an unmanned guided vehicle system according to an embodiment of the present invention, the collision detection area 40 (40') is set for each unmanned guided vehicle (10) (10') (S10). ) and the step of checking whether the collision detection areas 40 and 40' overlap (S20), and each of the moving direction extensions of the automatic guided vehicles 10 and 10' where the overlapping area 50 occurs ( A step (S30) of generating L1)(L2) and calculating an intersection point P between the forward direction extension segments L1 and L2, and checking whether or not the intersection point P exists between the progress direction extension segments L1 and L2. Checking (S40), and controlling each of the automatic guided vehicles 10 and 10' according to whether or not the intersection point P of the extension lines L1 and L2 exists (S50 to S90). The protection areas 30 and 30' for each automatic guided vehicle 10 and 10' may be set at an initial stage of system setting and stored in an individual control unit or a main control unit.

여기에서, 무인운반차들(10)(10') 각각의 진행 방향 연장선분(L1)(L2)은 무인운반차들(10)(10') 각각의 진행 방향 벡터로부터 생성될 수 있다. 즉 진행 중인 무인운반차들(10)(10') 각각에 대한 진행 방향 벡터를 생성하고 각 진행 방향 벡터를 연장한 선분을 각 무인운반차(10)(10')의 진행 방향 연장선분(L1)(L2)으로 결정할 수 있다.Here, the moving direction extension lines L1 and L2 of each of the automatic guided vehicles 10 and 10' may be generated from the moving direction vectors of each of the automatic guided vehicles 10 and 10'. That is, a traveling direction vector for each of the unmanned guided vehicles 10 (10') in progress is generated, and a line segment obtained by extending each traveling direction vector is a traveling direction extension line segment (L1) of each unmanned guided vehicle 10 (10'). ) (L2).

본 발명의 일실시예에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법은 상호 접근하는 무인운반차들(10)(10')의 충돌 감지 영역(40)(40')이 충접되는지 여부와, 무인운반차들(10)(10')의 진행 방향 연장선분(L1)(L2)이 교차하는지 여부와, 진행 방향 연장선분(L1)(L2)이 교차하는 교차점(P)이 각 무인운반차(10)(10')의 진행 방향에 존재하는지 여부 등에 따라 무인운반차(10)(10')를 다양하게 제어할 수 있다.A method for preventing collision of an unmanned guided vehicle system according to an embodiment of the present invention determines whether the collision detection areas 40 and 40' of the unmanned guided vehicles 10 and 10' colliding with each other and , whether or not the moving direction extension lines L1 and L2 of the autonomous guided vehicles 10 and 10' intersect, and the intersection point P at which the traveling direction extension lines L1 and L2 intersect is each unmanned guided vehicle. The automatic guided vehicle 10 (10') can be controlled in various ways depending on whether or not the vehicle 10 (10') exists in the traveling direction.

이하에서는, 도 3 내지 도 9에 나타낸 것과 같은 다양한 운행 조건에서 본 발명의 일실시예에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법을 통해 무인운반차를 제어하는 구체적인 방법에 대하여 설명한다.Hereinafter, a specific method of controlling an automatic guided vehicle through the automatic guided vehicle collision avoidance method of the automatic guided vehicle system according to an embodiment of the present invention under various operating conditions as shown in FIGS. 3 to 9 will be described.

먼저, 도 3은 제 1 무인운반차(10) 및 제 2 무인운반차(10')가 평행한 방향으로 진행하면서 각각의 충돌 감지 영역(40)(40')이 중첩되지 않는 조건을 나타낸 것이다. 이러한 경우, 도 2의 S20단계를 통해 각 무인운반차(10)(10')의 충돌 감지 영역(40)(40')이 중첩되지 않음이 확인되면, 제 1 무인운반차(10) 및 제 2 무인운반차(10')는 각각의 이동 속도를 그대로 유지하면서 진행하도록 제어된다.First, FIG. 3 shows a condition in which the collision detection areas 40 and 40' do not overlap while the first and second automatic guided vehicles 10 and 10' move in parallel directions. . In this case, if it is confirmed through step S20 of FIG. 2 that the collision detection areas 40 and 40' of each of the automatic guided vehicles 10 and 10' do not overlap, the first automatic guided vehicle 10 and the 2 The automatic guided vehicle 10' is controlled to proceed while maintaining each moving speed.

도 4는 제 1 무인운반차(10) 및 제 2 무인운반차(10')가 각각의 진행 경로가 중첩되도록 진행하는 조건을 나타낸 것이다. 이 경우, 도 2의 S20단계를 통해 각 무인운반차(10)(10')의 충돌 감지 영역(40)(40')이 중첩되는 중첩 영역(50)이 존재하는 것을 확인하고, S30단계를 통해 무인운반차들(10)(10') 각각의 진행 방향 벡터를 생성하고, 이들 진행 방향 벡터로부터 각 무인운반차(10)(10')의 진행 방향 연장선분(L1)(L2)을 생성한다. 그리고 각 무인운반차(10)(10')의 진행 방향 연장선분(L1)(L2)이 교차하는 교차점(P)을 계산한다. 진행 방향 연장선분(L1)(L2)이 교차하는 교차점(P)은 각 무인운반차(10)(10')에 대한 진행 방향 벡터의 외적을 계산하는 단계와, 각 진행 방향 벡터로부터 생성되는 각 진행 방향 연장선분(L1)(L2)의 좌표 중 중첩되는 좌표가 존재하는지 여부를 확인하는 단계를 통해 산출될 수 있다. 무인운반차(10)(10')가 서로 평행한 방향으로 진행하는 경우 각 무인운반차(10)(10')에 대한 진행 방향 벡터의 외적은 0이므로, 이때 각 진행 방향 연장선분(L1)(L2)의 좌표 중 중첩되는 좌표가 존재하는지 여부를 확인하는 단계는 생략될 수 있다.FIG. 4 shows conditions in which the first automatic guided vehicle 10 and the second automatic guided vehicle 10' proceed so that their traveling paths overlap each other. In this case, it is confirmed through step S20 of FIG. 2 that there is an overlapping region 50 overlapping the collision detection regions 40 and 40' of each automatic guided vehicle 10 and 10', and step S30 is performed. Through this, the traveling direction vectors of each of the unmanned guided vehicles 10 and 10' are generated, and the traveling direction extension lines L1 and L2 of each unmanned guided vehicle 10 and 10' are generated from these traveling direction vectors. do. Then, an intersection point P at which the moving direction extension lines L1 and L2 of each automatic guided vehicle 10 and 10' intersect is calculated. The intersection point P where the traveling direction extension lines L1 and L2 intersect is obtained by calculating the cross product of the traveling direction vectors for each automatic guided vehicle 10 (10'), and the angle generated from each traveling direction vector. It can be calculated through a step of checking whether there are overlapping coordinates among the coordinates of the extension lines L1 and L2 in the traveling direction. When the automatic guided vehicles 10 (10') move in directions parallel to each other, the cross product of the traveling direction vectors for each automatic guided vehicle 10 (10') is 0, so at this time, each traveling direction extension line (L1) The step of checking whether there are overlapping coordinates among the coordinates of (L2) can be omitted.

이후, S40 단계를 통해 진행 방향 연장선분(L1)(L2)이 교차하는 교차점(P)이 존재함을 확인하고, S50 단계를 통해 교차점(P)이 무인운반차(10)(10')의 진행 방향으로 존재하는지 확인한다. 도 4의 조건에서 교차점(P)은 두 개의 무인운반차(10)(10') 각각의 진행 반향에 존재하므로, S60 단계를 통해 각 무인운반차(10)(10')와 교차점(P)까지의 이동 거리(d1)(d2)를 계산한다. 그리고 S70 단계에서 이동 거리가 상대적으로 긴 제 1 무인운반차(10)가 감속 또는 정지하도록 제어된다. 이 단계에서 제 2 무인운반차(10')는 이동 속도 그대로 진행하도록 제어될 수 있다.Thereafter, through step S40, it is confirmed that there is an intersection point P where the traveling direction extension lines L1 and L2 intersect, and through step S50, the intersection point P is the location of the automatic guided vehicle 10 (10'). Checks if it exists in the forward direction. In the condition of FIG. 4, since the intersection point P exists in the forward echo of each of the two automatic guided vehicles 10 and 10', the intersection point P with each automatic guided vehicle 10 and 10' through step S60 Calculate the moving distance (d1) to (d2). In step S70, the first automatic guided vehicle 10 having a relatively long moving distance is controlled to decelerate or stop. In this step, the second automatic guided vehicle 10' can be controlled to proceed at the same moving speed.

제 2 무인운반차(10')가 먼저 교차점(P)을 통과하고 제 1 무인운반차(10)의 충돌 감지 영역(40)과 제 2 무인운반차(10')의 충돌 감지 영역(40')이 중첩되지 않게 되면, 제 1 무인운반차(10)는 원래 이동 속도로 주행하도록 제어될 수 있다.The second automatic guided vehicle 10' first passes through the intersection P, and the collision detection area 40 of the first automatic guided vehicle 10 and the collision detection area 40' of the second automatic guided vehicle 10' ) do not overlap, the first automatic guided vehicle 10 can be controlled to travel at the original moving speed.

도 5는 제 1 무인운반차(10) 및 제 2 무인운반차(10') 각각의 진행 방향 연장선분(L1)(L2)이 교차하되, 교차점(P)이 제 2 무인운반차(10')의 진행 방향에 존재하는 조건을 나타낸 것이다. 이 경우, 도 2의 S20단계를 통해 각 무인운반차(10)(10')의 충돌 감지 영역(40)(40')이 중첩되는 중첩 영역(50)이 존재하는 것을 확인하고, S30단계를 통해 무인운반차들(10)(10') 각각의 진행 방향 연장선분(L1)(L2)을 생성하고, 각 무인운반차(10)(10')의 진행 방향 연장선분(L1)(L2)이 교차하는 교차점(P)을 계산한다.5 shows that the extension lines L1 and L2 of the first and second automatic guided vehicles 10 and 10' intersect, and the intersection point P is the second automatic guided vehicle 10'. ) indicates the condition that exists in the direction of progress. In this case, it is confirmed through step S20 of FIG. 2 that there is an overlapping region 50 overlapping the collision detection regions 40 and 40' of each automatic guided vehicle 10 and 10', and step S30 is performed. Through this, an extension line segment (L1) (L2) in the traveling direction of each of the automatic guided vehicles (10) (10') is generated, and an extension line segment (L1) (L2) in the traveling direction of each automatic guided vehicle (10) (10') is generated. Calculate the intersection point (P) where this intersects.

이후, S40 단계를 통해 진행 방향 연장선분(L1)(L2)이 교차하는 교차점(P)이 존재함을 확인하고, S50 단계를 통해 교차점(P)이 무인운반차(10)(10')의 진행 방향으로 존재하는지 확인한다. 이때, 교차점(P)은 제 1 무인운반차(10)의 진행 방향에 존재하지 않고 제 2 무인운반차(10')의 진행 방향에 존재하므로, 제 1 무인운반차(10)는 이동 속도 그대로 진행시키고, 제 2 무인운반차(10')만 감속 또는 정지하도록 제어된다. 그리고 제 1 무인운반차(10)와 제 2 무인운반차(10') 사이가 멀어져 제 1 무인운반차(10)의 충돌 감지 영역(40)과 제 2 무인운반차(10')의 충돌 감지 영역(40')이 중첩되지 않게 되면, 제 2 무인운반차(10')는 원래 이동 속도로 주행하도록 제어될 수 있다.Thereafter, through step S40, it is confirmed that there is an intersection point P where the traveling direction extension lines L1 and L2 intersect, and through step S50, the intersection point P is the location of the automatic guided vehicle 10 (10'). Checks if it exists in the forward direction. At this time, since the intersection point P does not exist in the traveling direction of the first automatic guided vehicle 10 but in the traveling direction of the second automatic guided vehicle 10', the first automatic guided vehicle 10 moves at the same speed. and only the second automatic guided vehicle 10' is controlled to decelerate or stop. In addition, the collision detection area 40 of the first automatic guided vehicle 10 and the second automatic guided vehicle 10' are detected when the distance between the first automatic guided vehicle 10 and the second automatic guided vehicle 10' is distant. When the areas 40' do not overlap, the second automatic guided vehicle 10' can be controlled to travel at the original moving speed.

도 6은 제 1 무인운반차(10)가 정지 중에 제 2 무인운반차(10')가 제 1 무인운반차(10)를 향해 진행하는 조건을 나타낸 것이다. 이 경우, 도 2의 S20단계를 통해 각 무인운반차(10)(10')의 충돌 감지 영역(40)(40')이 중첩되는 중첩 영역(50)이 존재하는지 확인하고, S30단계를 통해 무인운반차들(10)(10') 각각의 진행 방향 연장선분(L1)(L2)을 생성한다. 이때, 제 2 무인운반차(10')의 진행 방향 연장선분(L2) 상에 제 1 무인운반차(10)가 존재하므로, 제 2 무인운반차(10')가 감속 또는 정지하도록 제어된다.FIG. 6 shows conditions in which the second automatic guided vehicle 10' proceeds toward the first automatic guided vehicle 10 while the first automatic guided vehicle 10 is stopped. In this case, through step S20 of FIG. 2, it is confirmed whether there is an overlapping area 50 where the collision detection areas 40 and 40' of each unmanned guided vehicle 10 and 10' overlap, and then through step S30. Extension lines L1 and L2 in the traveling direction of each of the automatic guided vehicles 10 and 10' are generated. At this time, since the first automatic guided vehicle 10 exists on the extension line L2 of the traveling direction of the second automatic guided vehicle 10', the second automatic guided vehicle 10' is controlled to decelerate or stop.

이러한 운행 조건의 경우, 제 2 무인운반차(10')는 그 충돌 감지 영역(40')이 제 1 무인운반차(10)의 충돌 감지 영역(40)에 중첩되는 시점에 정지, 방향 전환 또는 후진하도록 제어될 수 있다. 또한 제 2 무인운반차(10')는 감속된 상태로 제 1 무인운반차(10) 쪽으로 더욱 접근하여 제 1 무인운반차(10)의 보호 영역(30)이 제 2 무인운반차(10')의 충돌 감지 영역(40')에 중첩되거나, 제 2 무인운반차(10')의 보호 영역(30')이 제 1 무인운반차(10)의 충돌 감지 영역(40)에 중첩되는 시점에 정지, 방향 전환 또는 후진하도록 제어될 수 있다.In the case of these operating conditions, the second automatic guided vehicle 10' stops, changes direction, or It can be controlled to reverse. In addition, the second automatic guided vehicle 10' moves closer to the first automatic guided vehicle 10 in a decelerated state, so that the protection area 30 of the first automatic guided vehicle 10 becomes the second automatic guided vehicle 10'. ) overlaps with the collision detection area 40' or the protection area 30' of the second automatic guided vehicle 10' overlaps the collision detection area 40 of the first automatic guided vehicle 10 It can be controlled to stop, turn or reverse.

도 7 및 도 8은 제 1 무인운반차(10) 및 제 2 무인운반차(10')가 각각 평행한 방향으로 진행하되 각 무인운반차(10)(10')의 충돌 감지 영역(40)(40')이 중첩되는 조건을 나타낸 것이다. 이 경우, 도 2의 S20단계를 통해 각 무인운반차(10)(10')의 충돌 감지 영역(40)(40')이 중첩되는 중첩 영역(50)이 존재하는지 여부를 확인하고, S30단계를 통해 무인운반차들(10)(10') 각각의 진행 방향 연장선분(L1)(L2)을 생성하고, 각 무인운반차(10)(10')의 진행 방향 연장선분(L1)(L2)이 교차하는 교차점(P)을 계산한다.7 and 8 show that the first automatic guided vehicle 10 and the second automatic guided vehicle 10' proceed in parallel directions, respectively, and the collision detection area 40 of each automatic guided vehicle 10 (10') (40') shows the overlapping condition. In this case, it is checked through step S20 of FIG. 2 whether there is an overlapping region 50 where the collision detection regions 40 and 40' of each automatic guided vehicle 10 and 10' overlap, and then step S30. Through this, a line segment (L1) (L2) extending in the traveling direction of each of the automatic guided vehicles (10) (10') is generated, and a line segment (L1) (L2) extending in the traveling direction of each automatic guided vehicle (10) (10') is generated. ) calculates the intersection point (P) at which it intersects.

도 7 및 도 8의 운행 조건에서는 S40 단계에서 통해 진행 방향 연장선분(L1)(L2)이 교차하는 교차점(P)이 존재하지 않음을 확인되므로 S80 단계가 수행된다. S80 단계에서는 각 무인운반차(10)(10')의 충돌 감지 영역(40)(40') 중 적어도 하나가 각 무인운반차(10)(10')의 보호 영역(30)(30') 중 적어도 하나와 중첩되는지 확인된다.In the operating conditions of FIGS. 7 and 8 , it is confirmed in step S40 that there is no intersection point P where the extension lines L1 and L2 intersect, and step S80 is performed. In step S80, at least one of the collision detection areas 40 and 40' of each unmanned guided vehicle 10 and 10' is the protection area 30 and 30' of each unmanned guided vehicle 10 and 10'. Check if it overlaps with at least one of them.

도 7의 조건의 경우, 각 무인운반차(10)(10')의 충돌 감지 영역(40)(40')은 각 무인운반차(10)(10')의 보호 영역(30)(30')과 중첩되지 않으므로, 각 무인운반차(10)(10')는 이동 속도 그대로 진행하도록 제어될 수 있다. 필요에 따라 도 7의 조건에서도 충돌 감지 영역(40)(40')이 중첩되는 무인운반차들(10)(10') 모두 감속하여 진행하도록 제어될 수 있다.In the case of the condition of FIG. 7, the collision detection area 40 (40') of each automatic guided vehicle (10) (10') is the protection area (30) (30') of each automatic guided vehicle (10) (10'). ), each automatic guided vehicle 10 (10') can be controlled to proceed at the same moving speed. If necessary, even under the condition of FIG. 7 , all of the automatic guided vehicles 10 and 10' overlapping the collision detection areas 40 and 40' may be controlled to slow down and proceed.

도 8의 조건의 경우, 제 1 무인운반차(10)의 충돌 감지 영역(40)이 제 2 무인운반차(10')의 보호 영역(30')에 중첩되므로, S90 단계를 통해 제 1 무인운반차(10)가 감속 또는 정지하도록 제어된다. 도 8의 (a)와 같이 제 1 무인운반차(10)가 정해진 이동 속도로 진행하는 중에 제 1 무인운반차(10)의 충돌 감지 영역(40)이 제 2 무인운반차(10')의 보호 영역(30')에 중첩되는 경우, 제 1 무인운반차(10)의 이동 속도를 감속시키면 도 8의 (b)에 나타낸 것과 같이 제 1 무인운반차(10)의 충돌 감지 영역(40) 크기가 작아지게 된다. 따라서 제 1 무인운반차(10)의 이동 속도를 적절하게 감속시킴으로써 제 1 무인운반차(10)의 충돌 감지 영역(40)이 제 2 무인운반차(10')의 보호 영역(30')과 중첩되지 않게 할 수 있다. 이후, 제 1 무인운반차(10)는 감속된 속도로 진행하도록 제어되다가 제 1 무인운반차(10)의 충돌 감지 영역(40)과 제 2 무인운반차(10')의 충돌 감지 영역(40')이 중첩되지 않게 되면 원래의 이동 속도로 진행하도록 제어될 수 있다. 도 8의 운행 조건에서 무인운반차들(10)(10')의 충돌 감지 영역(40)(40')이 중첩되는 동안에는 무인운반차들(10)(10') 모두 감속하여 진행하도록 제어될 수 있다.In the case of the condition of FIG. 8 , since the collision detection area 40 of the first automatic guided vehicle 10 overlaps the protection area 30' of the second automatic guided vehicle 10', the first unmanned guided vehicle 10 through step S90 The transport vehicle 10 is controlled to decelerate or stop. As shown in (a) of FIG. 8, while the first automatic guided vehicle 10 is moving at a predetermined moving speed, the collision detection area 40 of the first automatic guided vehicle 10 is affected by the second automatic guided vehicle 10'. When the moving speed of the first automatic guided vehicle 10 is decelerated when it overlaps with the protection area 30', the collision detection area 40 of the first automatic guided vehicle 10, as shown in (b) of FIG. size becomes smaller. Therefore, by appropriately decelerating the moving speed of the first automatic guided vehicle 10, the collision detection area 40 of the first automatic guided vehicle 10 is changed to the protection area 30' of the second automatic guided vehicle 10'. can be prevented from overlapping. Thereafter, the first automatic guided vehicle 10 is controlled to proceed at a reduced speed, and then the collision detection area 40 of the first automatic guided vehicle 10 and the collision detection area 40 of the second automatic guided vehicle 10' ') can be controlled to proceed at the original movement speed when it does not overlap. Under the driving condition of FIG. 8, while the collision detection areas 40 and 40' of the automatic guided vehicles 10 and 10' overlap, all of the automatic guided vehicles 10 and 10' are controlled to slow down and proceed. can

도 9는 각 무인운반차(10)(10')의 충돌 감지 영역(40)(40') 중 적어도 하나가 각 무인운반차(10)(10')의 보호 영역(30)(30') 중 적어도 하나와 중첩되는 다른 조건을 나타낸 것이다. 도 8은 타 무인운반차의 보호 영역을 침범한 무인운반차의 이동 속도를 감속시키는 제어방법을 나타낸 것인데 반해, 도 9는 반대로 보호 영역을 침범받은 무인운반차의 이동 속도를 감속시키는 제어방법을 설명하기 위한 것이다.9 shows that at least one of the collision detection areas 40 and 40' of each automatic guided vehicle 10 and 10' is a protection area 30 and 30' of each automatic guided vehicle 10 and 10'. Indicates another condition that overlaps with at least one of 8 shows a control method for decelerating the moving speed of an automatic guided vehicle that has invaded the protection area of another automatic guided vehicle, whereas FIG. It is to explain.

도 9의 (a)에 나타낸 것과 같이, 제 1 무인운반차(10)의 충돌 감지 영역(40)이 제 2 무인운반차(10')의 보호 영역(30')과 중첩되는 경우, 제 2 무인운반차(10')의 이동 속도를 감속시킬 수 있다. 제 2 무인운반차(10')의 이동 속도를 적절하게 감속시키면 제 2 무인운반차(10')의 충돌 감지 영역(40')이 축소되어 제 2 무인운반차(10')의 진행에 따라 제 2 무인운반차(10')의 충돌 감지 영역(40')이 제 1 무인운반차(10)의 보호 영역(30)에 중첩되는 상황을 피할 수 있다. 그리고 제 2 무인운반차(10')가 제 1 무인운반차(10)에 충돌하는 문제를 방지할 수 있다.As shown in (a) of FIG. 9, when the collision detection area 40 of the first automatic guided vehicle 10 overlaps the protection area 30' of the second automatic guided vehicle 10', the second The moving speed of the automatic guided vehicle 10' may be reduced. When the moving speed of the second automatic guided vehicle 10' is appropriately decelerated, the collision detection area 40' of the second automatic guided vehicle 10' is reduced and the second automatic guided vehicle 10' progresses. A situation in which the collision detection area 40' of the second automatic guided vehicle 10' overlaps the protection area 30 of the first automatic guided vehicle 10 can be avoided. In addition, a problem in which the second automatic guided vehicle 10' collides with the first automatic guided vehicle 10 can be prevented.

상술한 것과 같이, 본 발명의 일실시예에 따른 무인운반차 시스템의 무인운반차 충돌 방지방법은 운행 중 상호 접근하는 무인운반차들(10)(10') 각각의 이동 속도에 따라 각 무인운반차(10)(10')의 외곽 영역(20)보다 넓은 충돌 감지 영역(40)(40')을 설정하고, 충돌 감지 영역(40)(40')의 중첩 여부에 따라 각 무인운반차(10)(10')를 제어할 수 있다. 따라서 다양한 운행 조건에서 무인운반차들(10)(10') 간의 충돌 위험을 효과적으로 줄이면서 무인운반차(10)(10')의 효율적인 운행을 가능하게 한다.As described above, in the method for preventing collision of an automatic guided vehicle system according to an embodiment of the present invention, each unmanned guided vehicle is moved according to the moving speed of each of the unmanned guided vehicles 10 and 10' approaching each other during operation. A collision detection area 40 (40') wider than the outer area 20 of the car 10 (10') is set, and each automatic guided vehicle ( 10) (10') can be controlled. Therefore, it is possible to efficiently operate the automatic guided vehicle 10 (10') while effectively reducing the risk of collision between the automatic guided vehicle (10) (10') under various operating conditions.

이상 본 발명에 대해 바람직한 예를 들어 설명하였으나 본 발명의 범위가 앞에서 설명되고 도시되는 형태로 한정되는 것은 아니다.Although the preferred examples of the present invention have been described above, the scope of the present invention is not limited to the forms described and illustrated above.

예를 들어, 각 무인운반차(10)(10')의 충돌 감지 영역(40)(40')은 앞서 설명한 수식1 또는 수식2를 이용하는 방식 이외에, 다양한 다른 방식으로 설정될 수 있다.For example, the collision detection areas 40 and 40' of each unmanned guided vehicle 10 and 10' may be set in various ways other than the method using Equation 1 or Equation 2 described above.

또한 도면에는 각 무인운반차(10)(10')에 설정되는 충돌 감지 영역(40)(40')의 중심이 각 무인운반차(10)(10')의 중심(Cv)과 일치하는 것으로 나타냈으나, 충돌 감지 영역(40)(40')의 중심은 각 무인운반차(10)(10') 상의 다른 위치로 변경될 수 있다.In addition, in the drawing, the center of the collision detection area 40 (40') set in each unmanned guided vehicle (10) (10') coincides with the center (Cv) of each unmanned guided vehicle (10) (10'). Although shown, the center of the collision sensing area 40 (40') may be changed to another location on each automatic guided vehicle (10) (10').

이상, 본 발명을 본 발명의 원리를 예시하기 위한 바람직한 실시예와 관련하여 도시하고 설명하였으나, 본 발명은 그와 같이 도시되고 설명된 그대로의 구성 및 작용으로 한정되는 것이 아니다. 오히려 첨부된 청구범위의 사상 및 범위를 일탈함이 없이 본 발명에 대한 다수의 변경 및 수정이 가능함을 당업자들은 잘 이해할 수 있을 것이다.In the above, the present invention has been shown and described in relation to preferred embodiments for illustrating the principles of the present invention, but the present invention is not limited to the configuration and operation as shown and described. Rather, it will be appreciated by those skilled in the art that many changes and modifications may be made to the present invention without departing from the spirit and scope of the appended claims.

10, 10' : 무인운반차 20 : 외곽 영역
30, 30' : 보호 영역 40, 40' : 충돌 감지 영역
50 : 중첩 영역
10, 10 ': unmanned transport vehicle 20: outer area
30, 30': protection area 40, 40': collision detection area
50: overlapping area

Claims (9)

무인운반차 시스템에 구비되어 운행되는 제 1 무인운반차 및 제 2 무인운반차 간의 충돌을 방지하기 위한 무인운반차 시스템의 무인운반차 충돌 방지방법으로서,
(a) 중심이 상기 제 1 무인운반차 상에 위치하는 원형으로 이루어지고 상기 제 1 무인운반차의 외곽 영역보다 넓은 상기 제 1 무인운반차의 충돌 감지 영역과, 중심이 상기 제 2 무인운반차 상에 위치하는 원형으로 이루어지고 상기 제 2 무인운반차의 외곽 영역보다 넓은 상기 제 2 무인운반차의 충돌 감지 영역을 각각 설정하는 단계;
(b) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역 간의 중첩 여부를 확인하는 단계;
(c) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역이 중첩되는 경우, 상기 제 1 무인운반차의 진행 방향 연장선분과 상기 제 2 무인운반차의 진행 방향 연장선분이 교차하는 교차점을 확인하는 단계; 및
(d) 상기 (c) 단계에서 상기 교차점이 존재하는 경우, 상기 제 1 무인운반차와 상기 제 2 무인운반차 중 상기 교차점이 진행 방향에 위치하는 무인운반차를 감속 또는 정지시키는 단계;를 포함하고,
상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역의 반경(r)은 다음의 수식1로 산출되는 것을 특징으로 하는 무인운반차 시스템의 무인운반차 충돌 방지방법.
수식1
Figure 112022115847419-pat00016

(ω: 가중치(ω>1), v: 무인운반차의 현재 이동 속도, t: 무인운반차가 감속하여 정지하는데 걸리는 시간, offset: 관리자에 의해 부여되는 파라미터)
A method for preventing collision of an unmanned guided vehicle system of an unmanned guided vehicle system for preventing a collision between a first unmanned guided vehicle and a second unmanned guided vehicle provided and operated in the unmanned guided vehicle system,
(a) a collision detection area of the first automatic guided vehicle formed of a circle with a center located on the first automatic guided vehicle and wider than an outer area of the first automatic guided vehicle, and a center of the second automatic guided vehicle setting a collision detection area of the second automatic guided vehicle which is circular and wider than an outer area of the second automatic guided vehicle;
(b) checking whether a collision detection area of the first automatic guided vehicle overlaps with a collision detection area of the second automatic guided vehicle;
(c) When the collision detection area of the first automatic guided vehicle overlaps with the collision detection area of the second automatic guided vehicle, an extension line in the traveling direction of the first automatic guided vehicle and an extension line in the traveling direction of the second automatic guided vehicle checking intersections where minutes intersect; and
(d) if the intersection exists in step (c), decelerating or stopping the first and second automatic guided vehicles, the intersection of which is located in the traveling direction; do,
The collision avoidance method of the automatic guided vehicle system, characterized in that the radius (r) of the collision detection area of each of the first automatic guided vehicle and the second automatic guided vehicle is calculated by Equation 1 below.
Formula 1
Figure 112022115847419-pat00016

(ω: weight (ω>1), v: current moving speed of the automated guided vehicle, t: time required for the automated guided vehicle to decelerate and stop, offset: a parameter given by the manager)
삭제delete 삭제delete 무인운반차 시스템에 구비되어 운행되는 제 1 무인운반차 및 제 2 무인운반차 간의 충돌을 방지하기 위한 무인운반차 시스템의 무인운반차 충돌 방지방법으로서,
(a) 중심이 상기 제 1 무인운반차 상에 위치하는 원형으로 이루어지고 상기 제 1 무인운반차의 외곽 영역보다 넓은 상기 제 1 무인운반차의 충돌 감지 영역과, 중심이 상기 제 2 무인운반차 상에 위치하는 원형으로 이루어지고 상기 제 2 무인운반차의 외곽 영역보다 넓은 상기 제 2 무인운반차의 충돌 감지 영역을 각각 설정하는 단계;
(b) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역 간의 중첩 여부를 확인하는 단계;
(c) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역이 중첩되는 경우, 상기 제 1 무인운반차의 진행 방향 연장선분과 상기 제 2 무인운반차의 진행 방향 연장선분이 교차하는 교차점을 확인하는 단계; 및
(d) 상기 (c) 단계에서 상기 교차점이 존재하는 경우, 상기 제 1 무인운반차와 상기 제 2 무인운반차 중 상기 교차점이 진행 방향에 위치하는 무인운반차를 감속 또는 정지시키는 단계;를 포함하고,
상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역의 반경(r)은 다음의 수식2로 산출되는 것을 특징으로 하는 무인운반차 시스템의 무인운반차 충돌 방지방법.
수식2
Figure 112022115847419-pat00006

(ω: 가중치(ω>1), a: 무인운반차의 감속도, v: 무인운반차의 현재 이동 속도, offset: 관리자에 의해 부여되는 파라미터)
A method for preventing collision of an unmanned guided vehicle system of an unmanned guided vehicle system for preventing a collision between a first unmanned guided vehicle and a second unmanned guided vehicle provided and operated in the unmanned guided vehicle system,
(a) a collision detection area of the first automatic guided vehicle formed of a circle with a center located on the first automatic guided vehicle and wider than an outer area of the first automatic guided vehicle, and a center of the second automatic guided vehicle setting a collision detection area of the second automatic guided vehicle which is circular and wider than an outer area of the second automatic guided vehicle;
(b) checking whether a collision detection area of the first automatic guided vehicle overlaps with a collision detection area of the second automatic guided vehicle;
(c) When the collision detection area of the first automatic guided vehicle overlaps with the collision detection area of the second automatic guided vehicle, an extension line in the traveling direction of the first automatic guided vehicle and an extension line in the traveling direction of the second automatic guided vehicle checking intersections where minutes intersect; and
(d) if the intersection exists in step (c), decelerating or stopping the first and second automatic guided vehicles, the intersection of which is located in the traveling direction; do,
The collision avoidance method of the automatic guided vehicle system, characterized in that the radius (r) of the collision detection area of each of the first automatic guided vehicle and the second automatic guided vehicle is calculated by Equation 2 below.
Formula 2
Figure 112022115847419-pat00006

(ω: weight (ω>1), a: deceleration of the automated guided vehicle, v: current moving speed of the automated guided vehicle, offset: parameter given by the manager)
제 1 항 또는 제 4 항에 있어서,
상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역의 중심은 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 중심에 위치하는 것을 특징으로 하는 무인운반차 시스템의 무인운반차 충돌 방지방법.
According to claim 1 or 4,
The center of the collision detection area of each of the first and second automatic guided vehicles is located at the center of each of the first and second automatic guided vehicles. How to prevent truck collision.
무인운반차 시스템에 구비되어 운행되는 제 1 무인운반차 및 제 2 무인운반차 간의 충돌을 방지하기 위한 무인운반차 시스템의 무인운반차 충돌 방지방법으로서,
(a) 중심이 상기 제 1 무인운반차 상에 위치하는 원형으로 이루어지고 상기 제 1 무인운반차의 외곽 영역보다 넓은 상기 제 1 무인운반차의 충돌 감지 영역과, 중심이 상기 제 2 무인운반차 상에 위치하는 원형으로 이루어지고 상기 제 2 무인운반차의 외곽 영역보다 넓은 상기 제 2 무인운반차의 충돌 감지 영역을 각각 설정하는 단계;
(b) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역 간의 중첩 여부를 확인하는 단계;
(c) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역이 중첩되는 경우, 상기 제 1 무인운반차의 진행 방향 연장선분과 상기 제 2 무인운반차의 진행 방향 연장선분이 교차하는 교차점을 확인하는 단계; 및
(d) 상기 (c) 단계에서 상기 교차점이 존재하는 경우, 상기 제 1 무인운반차와 상기 제 2 무인운반차 중 상기 교차점이 진행 방향에 위치하는 무인운반차를 감속 또는 정지시키는 단계;를 포함하고,
상기 (b) 단계 이전에, (e) 상기 제 1 무인운반차의 외곽 영역보다 크고 상기 제 1 무인운반차의 외곽 영역을 포함하되 상기 제 1 무인운반차의 충돌 감지 영역보다 작은 상기 제 1 무인운반차의 보호 영역과, 상기 제 2 무인운반차의 외곽 영역보다 크고 상기 제 2 무인운반차의 외곽 영역을 포함하되 상기 제 2 무인운반차의 충돌 감지 영역보다 작은 상기 제 2 무인운반차의 보호 영역을 각각 설정하는 단계;
상기 (b) 단계 이후에, (f) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역이 중첩되는 경우, 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역 중 적어도 하나가 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 보호 영역 중 적어도 하나와 중첩되는지 확인하는 단계; 및
(g) 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역 중 적어도 하나가 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 보호 영역 중 적어도 하나와 중첩되는 경우, 상기 제 1 무인운반차와 상기 제 2 무인운반차 중 충돌 감지 영역이 다른 무인운반차의 보호 영역에 중첩된 무인운반차를 감속 또는 정지시키는 단계;를 포함하는 것을 특징으로 하는 무인운반차 시스템의 무인운반차 충돌 방지방법.
A method for preventing collision of an unmanned guided vehicle system of an unmanned guided vehicle system for preventing a collision between a first unmanned guided vehicle and a second unmanned guided vehicle provided and operated in the unmanned guided vehicle system,
(a) a collision detection area of the first automatic guided vehicle formed of a circle with a center located on the first automatic guided vehicle and wider than an outer area of the first automatic guided vehicle, and a center of the second automatic guided vehicle setting a collision detection area of the second automatic guided vehicle which is circular and wider than an outer area of the second automatic guided vehicle;
(b) checking whether a collision detection area of the first automatic guided vehicle overlaps with a collision detection area of the second automatic guided vehicle;
(c) When the collision detection area of the first automatic guided vehicle overlaps with the collision detection area of the second automatic guided vehicle, an extension line in the traveling direction of the first automatic guided vehicle and an extension line in the traveling direction of the second automatic guided vehicle checking intersections where minutes intersect; and
(d) if the intersection exists in step (c), decelerating or stopping the first and second automatic guided vehicles, the intersection of which is located in the traveling direction; do,
Before the step (b), (e) the first unmanned guided vehicle including the outer area of the first unmanned guided vehicle but smaller than the collision detection area of the first unmanned guided vehicle Protection of the second automatic guided vehicle including a protection area of the guided vehicle and an outer area of the second automatic guided vehicle that is larger than the outer area of the second automatic guided vehicle but smaller than the collision detection area of the second automatic guided vehicle setting each area;
After the step (b), (f) when the collision detection area of the first automatic guided vehicle overlaps with the collision detection area of the second automatic guided vehicle, the first automatic guided vehicle and the second automatic guided vehicle checking whether at least one of the collision detection areas overlaps with at least one of the protection areas of the first and second automatic guided vehicles; and
(g) when at least one of the collision detection areas of the first and second automatic guided vehicles overlaps with at least one of the protection areas of the first and second automatic guided vehicles; decelerating or stopping an automatic guided vehicle whose collision detection area overlaps with a protection area of another automatic guided vehicle among the first automatic guided vehicle and the second automatic guided vehicle; A method for preventing collisions of unmanned guided vehicles.
무인운반차 시스템에 구비되어 운행되는 제 1 무인운반차 및 제 2 무인운반차 간의 충돌을 방지하기 위한 무인운반차 시스템의 무인운반차 충돌 방지방법으로서,
(a) 중심이 상기 제 1 무인운반차 상에 위치하는 원형으로 이루어지고 상기 제 1 무인운반차의 외곽 영역보다 넓은 상기 제 1 무인운반차의 충돌 감지 영역과, 중심이 상기 제 2 무인운반차 상에 위치하는 원형으로 이루어지고 상기 제 2 무인운반차의 외곽 영역보다 넓은 상기 제 2 무인운반차의 충돌 감지 영역을 각각 설정하는 단계;
(b) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역 간의 중첩 여부를 확인하는 단계;
(c) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역이 중첩되는 경우, 상기 제 1 무인운반차의 진행 방향 연장선분과 상기 제 2 무인운반차의 진행 방향 연장선분이 교차하는 교차점을 확인하는 단계; 및
(d) 상기 (c) 단계에서 상기 교차점이 존재하는 경우, 상기 제 1 무인운반차와 상기 제 2 무인운반차 중 상기 교차점이 진행 방향에 위치하는 무인운반차를 감속 또는 정지시키는 단계;를 포함하고,
상기 (b) 단계 이전에, (e) 상기 제 1 무인운반차의 외곽 영역보다 크고 상기 제 1 무인운반차의 외곽 영역을 포함하되 상기 제 1 무인운반차의 충돌 감지 영역보다 작은 상기 제 1 무인운반차의 보호 영역과, 상기 제 2 무인운반차의 외곽 영역보다 크고 상기 제 2 무인운반차의 외곽 영역을 포함하되 상기 제 2 무인운반차의 충돌 감지 영역보다 작은 상기 제 2 무인운반차의 보호 영역을 각각 설정하는 단계;
상기 (b) 단계 이후에, (f) 상기 제 1 무인운반차의 충돌 감지 영역과 상기 제 2 무인운반차의 충돌 감지 영역이 중첩되는 경우, 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역 중 적어도 하나가 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 보호 영역 중 적어도 하나와 중첩되는지 확인하는 단계; 및
(g) 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 충돌 감지 영역 중 적어도 하나가 상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 보호 영역 중 적어도 하나와 중첩되는 경우, 상기 제 1 무인운반차와 상기 제 2 무인운반차 중 보호 영역이 다른 무인운반차의 출동 감지 영역과 중첩된 무인운반차를 감속 또는 정지시키는 단계;를 포함하는 것을 특징으로 하는 무인운반차 시스템의 무인운반차 충돌 방지방법.
A method for preventing collision of an unmanned guided vehicle system of an unmanned guided vehicle system for preventing a collision between a first unmanned guided vehicle and a second unmanned guided vehicle provided and operated in the unmanned guided vehicle system,
(a) a collision detection area of the first automatic guided vehicle formed of a circle with a center located on the first automatic guided vehicle and wider than an outer area of the first automatic guided vehicle, and a center of the second automatic guided vehicle setting a collision detection area of the second automatic guided vehicle which is circular and wider than an outer area of the second automatic guided vehicle;
(b) checking whether a collision detection area of the first automatic guided vehicle overlaps with a collision detection area of the second automatic guided vehicle;
(c) When the collision detection area of the first automatic guided vehicle overlaps with the collision detection area of the second automatic guided vehicle, an extension line in the traveling direction of the first automatic guided vehicle and an extension line in the traveling direction of the second automatic guided vehicle checking intersections where minutes intersect; and
(d) if the intersection exists in step (c), decelerating or stopping the first and second automatic guided vehicles, the intersection of which is located in the traveling direction; do,
Before the step (b), (e) the first unmanned guided vehicle including the outer area of the first unmanned guided vehicle but smaller than the collision detection area of the first unmanned guided vehicle Protection of the second automatic guided vehicle including a protection area of the guided vehicle and an outer area of the second automatic guided vehicle that is larger than the outer area of the second automatic guided vehicle but smaller than the collision detection area of the second automatic guided vehicle setting each area;
After the step (b), (f) when the collision detection area of the first automatic guided vehicle overlaps with the collision detection area of the second automatic guided vehicle, the first automatic guided vehicle and the second automatic guided vehicle checking whether at least one of the collision detection areas overlaps with at least one of the protection areas of the first and second automatic guided vehicles; and
(g) when at least one of the collision detection areas of the first and second automatic guided vehicles overlaps with at least one of the protection areas of the first and second automatic guided vehicles; decelerating or stopping an automatic guided vehicle whose protection area overlaps with an dispatch detection area of another automatic guided vehicle among the first automatic guided vehicle and the second automatic guided vehicle; A method for preventing collisions of unmanned guided vehicles.
제 6 항 또는 제 7 항에 있어서,
상기 제 1 무인운반차 및 상기 제 2 무인운반차 각각의 보호 영역은 각각의 무인운반차가 그 주위의 물체를 감지할 수 있도록 설치되는 감지 센서에 의해 보호되는 영역으로 설정되는 것을 특징으로 하는 무인운반차 시스템의 무인운반차 충돌 방지방법.
According to claim 6 or 7,
The protection area of each of the first and second automatic guided vehicles is set as an area protected by a detection sensor installed so that each automatic guided vehicle can detect an object around it. A method for preventing collision of an unmanned guided vehicle in a vehicle system.
제 1 항, 제 4 항, 제 6 항, 제 7 항 중 어느 한 항에 있어서,
상기 (d) 단계에서, 상기 교차점이 상기 제 1 무인운반차의 진행 방향 및 상기 제 2 무인운반차의 진행 방향에 위치하는 경우, 상기 제 1 무인운반차와 상기 제 2 무인운반차 중 상기 교차점까지의 이동 거리가 상대적으로 긴 무인운반차를 감속 또는 정지시키는 것을 특징으로 하는 무인운반차 시스템의 무인운반차 충돌 방지방법.
The method of any one of claims 1, 4, 6, and 7,
In step (d), if the intersection is located in the traveling direction of the first and second automatic guided vehicle, the intersection of the first and second automatic guided vehicle A method for preventing collision of an unmanned guided vehicle of an unmanned guided vehicle system, characterized by decelerating or stopping an unmanned guided vehicle having a relatively long moving distance.
KR1020200162661A 2020-11-27 2020-11-27 Method for preventing collision of automated guided vehicle for automated guided vehicle system KR102515061B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020200162661A KR102515061B1 (en) 2020-11-27 2020-11-27 Method for preventing collision of automated guided vehicle for automated guided vehicle system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020200162661A KR102515061B1 (en) 2020-11-27 2020-11-27 Method for preventing collision of automated guided vehicle for automated guided vehicle system

Publications (2)

Publication Number Publication Date
KR20220074311A KR20220074311A (en) 2022-06-03
KR102515061B1 true KR102515061B1 (en) 2023-03-29

Family

ID=81982441

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020200162661A KR102515061B1 (en) 2020-11-27 2020-11-27 Method for preventing collision of automated guided vehicle for automated guided vehicle system

Country Status (1)

Country Link
KR (1) KR102515061B1 (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010241315A (en) * 2009-04-08 2010-10-28 Honda Motor Co Ltd Vehicle collision avoidance apparatus
KR101976403B1 (en) * 2018-03-08 2019-08-28 주식회사 삼우이머션 Safety navigation apparatus for vessel
KR102054644B1 (en) * 2017-07-25 2019-12-11 아주대학교산학협력단 Apparatus and method for predicting collision of moving object

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3032956B2 (en) * 1995-12-11 2000-04-17 株式会社マコメ研究所 Carrier
KR102006401B1 (en) 2017-12-19 2019-10-01 에스아이에스 주식회사 Resets path and speed of automated guided vehicles with possible collisions

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010241315A (en) * 2009-04-08 2010-10-28 Honda Motor Co Ltd Vehicle collision avoidance apparatus
KR102054644B1 (en) * 2017-07-25 2019-12-11 아주대학교산학협력단 Apparatus and method for predicting collision of moving object
KR101976403B1 (en) * 2018-03-08 2019-08-28 주식회사 삼우이머션 Safety navigation apparatus for vessel

Also Published As

Publication number Publication date
KR20220074311A (en) 2022-06-03

Similar Documents

Publication Publication Date Title
JP6020265B2 (en) Goods transport equipment
KR101695557B1 (en) Automated guided vehicle system based on autonomous mobile technique and a method for controlling the same
JP5928402B2 (en) Traveling vehicle control system
AU2002247079B2 (en) Anti-rut system for autonomous-vehicle guidance
US9637123B2 (en) Method for operating a self-propelled mobile platform
EP2855332B1 (en) Determining movement distance of lifting device
JP2015170284A (en) Forklift type unmanned carrier vehicle, control method of the same, and control device of the same
CN102385383A (en) Traveling vehicle and method of controlling the same
AU2002247079A1 (en) Anti-rut system for autonomous-vehicle guidance
KR101660162B1 (en) Automated guided vehicle system based on autonomous mobile technique and a method for controlling the same
US11275386B2 (en) Method for operating an industrial truck
EP3667451B1 (en) Method and system for controlling a plurality of autonomous vehicles
JP2015060336A (en) Automatic guided vehicle and automatic guided vehicle system using floor position detection method
JP2017071455A (en) Collision prevention device of cargo crane
WO2022116649A1 (en) Control method and apparatus for carrying device, carrying device, and storage medium
CN113795802A (en) Autonomous mine car operation
KR102515061B1 (en) Method for preventing collision of automated guided vehicle for automated guided vehicle system
CN115185286B (en) Autonomous obstacle-detouring planning method for mobile robot and task scheduling system thereof
CN116263600A (en) Method and device for controlling the travel of an autonomous mobile robot
JP2018092532A (en) Automatic carrier vehicle control system, and travel area coordinate setting method
EP4109196B1 (en) A method for operating an automated guided vehicle and an automated guided vehicle
KR102007568B1 (en) System and Method for Safe Driving of Crane
US20230267837A1 (en) Traffic Control System and Traffic Control Method
JP7363495B2 (en) Transport vehicle, running monitoring method, and mast monitoring method
KR0156483B1 (en) Automated guided vehicle system

Legal Events

Date Code Title Description
E902 Notification of reason for refusal
E701 Decision to grant or registration of patent right