KR20030003014A - Automatic guided vehicle - Google Patents

Automatic guided vehicle Download PDF

Info

Publication number
KR20030003014A
KR20030003014A KR1020020035347A KR20020035347A KR20030003014A KR 20030003014 A KR20030003014 A KR 20030003014A KR 1020020035347 A KR1020020035347 A KR 1020020035347A KR 20020035347 A KR20020035347 A KR 20020035347A KR 20030003014 A KR20030003014 A KR 20030003014A
Authority
KR
South Korea
Prior art keywords
steering
induction
signal
sensor
guide line
Prior art date
Application number
KR1020020035347A
Other languages
Korean (ko)
Other versions
KR100478595B1 (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 산요 덴키 가부시키가이샤
Publication of KR20030003014A publication Critical patent/KR20030003014A/en
Application granted granted Critical
Publication of KR100478595B1 publication Critical patent/KR100478595B1/en

Links

Classifications

    • 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
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/20Conjoint control of vehicle sub-units of different type or different function including control of steering systems
    • 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/10Path keeping
    • B60W30/12Lane keeping

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Steering Controls (AREA)
  • Platform Screen Doors And Railroad Systems (AREA)

Abstract

PURPOSE: To provide an unmanned carrier equipped with a guide sensor capable of accurately receiving a signal from a guide line. CONSTITUTION: This unmanned carrier is controlled by a control circuit 13 to travel along the center of a pair of guide sensors 33 for detecting a guide line 49 embedded on a road, and for controlling the steering of front wheels 4, and the sum and difference of the signals of the pair of guide sensors 33 are calculated so that when the sum is not more than a prescribed value, it is possible to decide that the unmanned carrier is running off the guide line 49.

Description

무인 반송차{Automatic guided vehicle}Unmanned Carrier Vehicle {Automatic guided vehicle}

본 발명은, 유도 센서를 설치하고 유도 센서에 의해 유도선을 따라 조타하여 주행하는 무인 반송차에 관한 것이다.The present invention relates to an unmanned carrier vehicle which is provided with an inductive sensor and steered along the guideline by the inductive sensor.

종래 이와 같은 무인 반송차에 있어서, 일본특개 2000-148245 에 나타나는 바와 같이 조타바퀴와 함께 조타되는 유도 센서를 설치하고, 유도선에서 교대 자계를 한쌍의 유도 센서로 검출하고 양쪽의 유도 센서의 검출치가 동일하게 이루어지도록 조타바퀴를 조타하면서 주행한다. 또 이 유도 센서와는 별도로 한 쌍의 유도 센서의 대략 중앙으로 검출 코일이 설치되고,유도선으로부터의 자장 강도를 검출하는 것으로 무인 반송차가 유도 선상에 존재하는지 안하는지를 검출할 수 있도록 되어 있다. 그리고 이 유도선으로부터의 신호값이 소정치를 밑돌때에 유도선으로부터 벗어났다고 판단하고 정지하여 제어하는 것으로 알려져 있다.Conventionally, in such an unmanned carrier vehicle, as shown in Japanese Patent Application Laid-Open No. 2000-148245, an induction sensor steered together with a steering wheel is provided, and a pair of induction sensors are detected on the induction line, and the detected values of both induction sensors are Drive while steering the wheel to achieve the same. In addition to the inductive sensor, a detection coil is provided at approximately the center of the pair of inductive sensors, and the magnetic field strength from the induction line can be detected to detect whether or not an unmanned carrier is present on the inductive line. And it is known that when the signal value from this guide line falls below a predetermined value, it judges that it came out of the guide line, and it stops and controls.

그렇지만, 이와 같은 구성이라면 유도 센서가 3개 필요해지는 것에 의해 생산 원가를 비싸게 드는것 외에도, 검출 코일의 부착위치가 어긋나는 것 등으로 인해 정확한 검출을 할수 없는 경우가 있다는 우려가 있었다.However, in such a configuration, the need for three inductive sensors increases the production cost, and there is a concern that accurate detection may not be possible due to a shift in the mounting position of the detection coil.

본 발명은 염가로 유도선으로부터 신호를 정확하게 수신할 수 있는 유도센서를 구비한 무인 반송차를 제공하는 것을 과제로 한다.    An object of the present invention is to provide an unmanned carrier vehicle having an induction sensor which can accurately receive a signal from an induction line at low cost.

본 발명의 청구항 1 의 구성에 의하면, 노면에 매설한 유도선을 검출하고 조타바퀴와 함께 회동하는 한 쌍의 유도센서와, 그 유도센서로부터의 신호를 검출하고 상기 한 쌍의 유도 센서의 중앙을 주행하도록 조타바퀴를 조타 제어하는 제어회로를 구비한 무인 반송차로서,상기 유도 센서로부터의 신호에 기초해서 상기 유도선상에 상기 무인 반송차가 존재하는지 안하는지를 판단하는 판정 수단을 설치한 것을 특징으로 한다.According to the structure of Claim 1 of this invention, a pair of induction sensors which detect the induction line embedded in the road surface and rotate with a steering wheel, detect the signal from the induction sensor, and center the center of the pair of induction sensors An unmanned carrier vehicle having a control circuit for steering control of a steering wheel to travel, characterized in that a judging means is provided for judging whether or not the unmanned carrier vehicle exists on the guide line based on a signal from the inductive sensor. .

앞에 서술한 구성에 의해 한 쌍의 유도센서가 유도선으로부터의 거리를 검출하고, 서로의 유도센서가 유도선으로부터의 거리가 같아지도록 조타바퀴를 조타하면서 주행한다. 그리고 이 한 쌍의 유도센서의 신호에 기초해서 유도선상에 무인 반송차가 존재하는지 안하는지를 판단한다. 그리고 유도 선상에 존재한다면 계속해서 유도센서에 의해 주행을 계속한다.   With the above-described configuration, the pair of induction sensors detect the distance from the induction line, and the induction sensors travel while steering the steering wheel so that the distances from the induction line are the same. Then, based on the signal of the pair of induction sensors, it is determined whether or not an unmanned carrier is present on the induction line. If it is on the guidance ship, the vehicle continues to be driven by the guidance sensor.

또 청구항 2 및 청구항 3 에 의하면 상기 판정 수단은 상기 한 쌍의 유도 센서의 검출치의 합과 차이의 연산 값으로부터 판단하고, 서로의 유도센서의 차이에기초해서 조타를 행하고 서로의 유도센서의 신호의 차가 제로가 되도록 조타하며 주행한다. 이때 동시에 2개의 센서의 합도 입력하고, 그 연산값이 소정치 이상이 되지 않을 때에는2개의 코일이 유도선 보다 크게 떨어져 있어서 판정 수단에 의해 무인 반송차에 바퀴가 이탈했다고 판정한다.    Further, according to Claims 2 and 3, the judging means judges from the calculation value of the sum and difference of the detected values of the pair of inductive sensors, performs steering based on the difference between the inductive sensors of each other, and Steer your car to zero. At this time, the sum of the two sensors is also input, and when the calculated value does not exceed the predetermined value, the two coils are farther than the guide line, and the judging means judges that the wheel is separated from the unmanned carrier.

그리고, 청구항 4의 구성에 의하면 노면에 매설한 유도선을 검출하고 조타바퀴와 함께 회동하는1개의 유도센서와 그 유도센서로부터의 신호를 검출하여 상기 유도선상을 주행하도록 조타바퀴를 조타제어 하는 제어회로를 구비하고,상기 유도 센서로부터 신호가 소정값 이하가 됐을 때 상기 유도센서를 좌우 어느 한쪽으로 스티어링 모터를 동작하고,그 때의 유도센서의 검출레벨에 기초하여 조타바퀴를 조타하는 것을 특징으로 한다.    In addition, according to the configuration of claim 4, the control for steering the steering wheel to detect the guide line embedded in the road surface, and the steering wheel to travel on the guide line by detecting a signal from the induction sensor and one inductive sensor that rotates with the steering wheel Circuitry, and when the signal from the induction sensor is below a predetermined value, the steering motor is operated either to the left or right of the induction sensor, and steering the steering wheel based on the detection level of the induction sensor at that time. do.

상기 기술한 구성에 의해 주행중 유도센서가 유도선상에 위치하도록 배치하고, 유도센서로부터의 신호가 소정값 이하, 예를 들면 유도선으로부터 벗어나기 시작한 상태에서 스티어링 모터를 좌우 한쪽으로 동작하고,그 때의 검출레벨에 의해 유도센서가 유도선상에 오도록 조타한다.The above-described configuration is arranged such that the induction sensor is positioned on the induction line while driving, and the steering motor is operated left and right in a state where the signal from the induction sensor is below a predetermined value, for example, starting from the induction line. Steer the inductive sensor on the guideline by the detection level.

그리고 청구항 5의 구성에 의하면, 상기 유도센서는 상기 유도선에 흐르는 전류에 의해 생기는 교대 자계를 검출하는 것을 특징으로 한다.According to the configuration of claim 5, the inductive sensor is characterized in that for detecting the alternating magnetic field generated by the current flowing in the induction line.

또 청구항 6 의 구성에 의하면,상기 무인 반송차에는 제동력을 부여하는 제동수단을 설치하고,상기 판정 수단이 상기 무인 반송차가 상기 유도선상에 존재하지 않는다고 판정했을 때 상기 제동 수단에 의해 정지하는 것을 특징으로 한다.According to the sixth aspect of the present invention, there is provided a braking means for applying a braking force to the unmanned vehicle, and when the judging means determines that the unmanned vehicle is not present on the guide line, the braking means is stopped by the braking means. It is done.

상기 구성에 의해 무인 반송차가 유도선상을 벗어나면 제동 수단이 동작하고정지한다.The braking means operates and stops when the unmanned carrier moves out of the guide line by the above configuration.

또 청구항 7 의 구성에 의하면, 상기 무인 반송차가 상기 유도선상에 존재하지 않는다라고 판정할 때 이 판정으로부터 소정 시간 후에 상기 제동 수단을 동작하는 것을 특징으로 한다.According to the configuration of claim 7, the braking means is operated after a predetermined time from this determination when it is determined that the unmanned carrier does not exist on the guide line.

이 구성에 의하면 소정 시간이 경과한 때에 제동 수단이 동작하므로 바퀴가 이탈했을 때에 정지해 버리지 않고, 소정 시간 경과후의 바퀴의 이탈이 확정된 때에 정차하기 때문에 순조로운 주행을 행할 수 있다.According to this configuration, since the braking means operates when the predetermined time has elapsed, the braking means does not stop when the wheel is disengaged, but stops when the disengagement of the wheel after the predetermined time elapses is determined.

더구나 청구항 8의 구성에 의하면, 상기 무인 반송차의 상기 유도선의 중심으로부터 어긋난 크기에 따른 제어량으로 스티어링 모터를 제어하는 것을 특징으로 하기 때문에,유도선으로부터의 어긋난 크기에 따른 제어량으로 동작하고 유도선에 따라 주행하기 쉬워진다.Furthermore, according to the configuration of claim 8, the steering motor is controlled by a control amount in accordance with a magnitude shifted from the center of the guide line of the unmanned carrier, so that it operates in a control amount in accordance with the magnitude shifted from the guide line and It becomes easy to drive along.

도 1 은 본 발명의 실시의 형태를 나타내는 제어 블록도이다.1 is a control block diagram showing an embodiment of the present invention.

도 2 는 동일 골프 카트 본체의 전체 사시도이다.2 is an overall perspective view of the same golf cart body.

도 3 은 본 발명의 제1의 실시 형태를 나타내는 골프 카트 본체의 주요 부분 개략도이다.  3 is a schematic view of a main part of a golf cart body showing a first embodiment of the present invention.

도 4 는 동일 유도 센서의 수신신호를 나타내는 파형이다.4 is a waveform showing the received signal of the same inductive sensor.

도 5 는 동일 유도 센서로부터의 신호에 기초하여 조타 제어를 행하기 위한 플로차트이다.5 is a flowchart for performing steering control based on a signal from the same inductive sensor.

도 6 은 동일 골프카트 본체 정지시의 플로차트이다.Fig. 6 is a flowchart when the same golf cart body stops.

도 7 은 동일 스티어링(steering) 모터의 제어량을 나타내는 타임 테이블이다.7 is a time table showing the control amount of the same steering motor.

도 8 은 본 발명의 제2의 실시의 형태를 나타내는 골프 카트 본체의 주요 부분 개략도 이다.Fig. 8 is a schematic view of the main part of a golf cart body showing a second embodiment of the present invention.

도 9 는 동일 유도 센서의 수신 신호를 나타내는 파형이다.9 is a waveform showing a received signal of the same inductive sensor.

도 10 은 동일 유도 센서로부터의 신호에 기초하여 조타 제어를 행하기 위한 플로차트이다10 is a flowchart for performing steering control based on signals from the same inductive sensor.

* 주요 부위를 나타내는 도면부호의 설명 *  Explanation of reference numbers indicating major parts

49 : 유도선       49: induction line

4 : 조타바퀴(steering wheel)(앞바퀴)     4: Steering wheel (front wheel)

33 : 유도 센서         13 : 제어 회로    33: inductive sensor 13: control circuit

13 : 판정수단(제어 회로)   25 : 스티어링 모터    13: Judgment means (control circuit) # 25: steering motor

24 : 제동수단(파킹 브레이크) 23 : 제동수단(브레이크 모터)24: braking means (parking brake) 23: braking means (brake motor)

본 발명의 무인 반송차에 관하여 골프카트를 예로 실시 형태를 도면에 기초하여 설명한다.With reference to the drawings, an embodiment of a golf cart is described with reference to the drawings of the unmanned transport vehicle of the present invention.

우선, 골프카트에 있어서 제어회로의 블록도를 도1에, 골프카트 본체의 전체 사시도를 도2에 나타내고,전체의 구성에 관하여 도면에 기초해서 설명한다.First, a block diagram of a control circuit in a golf cart is shown in FIG. 1, and an overall perspective view of the golf cart body is shown in FIG.

1은,사용자가 승차하여 운전 주행하는 것이 가능한 수동모드와 후기술하는 노면에 매설한 유도선(49)에 따라 주행하는 것이 가능한 자동모드를 구비하고 골프백을 탑재하고 주행하는 골프카트 본체로,그 골프카트 본체(1)는 주행모터(17)를구동원으로 주행한다.  1 is a golf cart main body equipped with a golf bag, which has a manual mode in which a user can ride and drive and an automatic mode in which a user can travel according to a guide line 49 embedded in a road surface described later. The golf cart body 1 drives the traveling motor 17 with a drive source.

2는 메인 프레임(미도시)에 설치되고 상기 본체(1)의 전후 방향에 설치한 기대(基臺)로 그 기대(2)에는 사용자가 승차하기 위한 좌석(3),조타를 행하기 위해 조타바퀴로 된 앞바퀴(4), 구동바퀴로 되는 뒷바퀴(5)가 설치되어 있다.2 is a base installed in the main frame (not shown) and installed in the front-rear direction of the main body 1, and the base 2 is steered to perform the seat 3 and steering for the user to ride. Front wheels (4) made of wheels and rear wheels (5) made of driving wheels are provided.

6은 수동모드 선택시에 사용자가 상기 좌석(3)에 앉아서 조작 가능한 위치에 설치되고 조작에 의해 상기 앞바퀴(4)를 조타하기 위한 핸들이다.6 is a steering wheel for steering the front wheel 4 by the user, which is installed at an operable position when the user sits in the seat 3 when the manual mode is selected.

7은 골프카트 본체(1)의 뒷부분에 경사진 뒤쪽이 상부에 늘어나도록 설치되고 골프백을 탑재하기 위한 짐받이이다.7 is a carrier for mounting the golf bag is installed so that the inclined rear portion is extended to the rear of the golf cart body (1).

8은 상기 핸들(6)과 상기 앞바퀴(4)와의 연결 부분을 덮는 수지제의 프런트 카울(Front Cowl)로 그 프런트 카울(8)은 그 중앙에 뚜껑부(9)를 설치하고 그 뚜껑부(9)를 개구하면 골프공이나 글러브등을 넣기 위한 소모품 트렁크로 이루어져 있다.8 is a front cowl made of resin covering the connection portion between the handle 6 and the front wheel 4, and the front cowl 8 is provided with a lid 9 at the center thereof and the lid ( 9) When opening, it consists of consumable trunk for putting golf ball and glove.

10은 상기 본체(1)의 앞부분에서 상기 프런트 카울(8)의 상부에 설치된 투명한 수지제의 프런트 실(Front Seal)로 그 프런트 실(10) 상부보다 뒤쪽에 걸치고, 상기 좌석(3)상부를 덮는 수지제의 루프(11)가 설치 되어있다. 또 상기 루프(11)의 뒷 부분은 상기 짐받이(7) 부근보다 위쪽을 향하여 설치된 2개의 지주(12)에 의해 지지되어 있다.   10 is a transparent resin front seal provided on the upper part of the front cowl 8 at the front of the main body 1, and is disposed behind the upper part of the front seal 10, and the upper part of the seat 3 A resinous loop 11 is provided. Moreover, the back part of the said loop 11 is supported by the two support | pillars 12 provided upward rather than the said carrier 7 vicinity.

다음 제어회로의 블록도에 관하여 설명한다. The block diagram of the following control circuit will be described.

13은 골프카트 본체(1)의 주행을 제어하는 제어 회로로 상기 제어 회로(13)는 마이크로 컴퓨터인 메인 CPU(14),유도센서 처리 CPU(15),마그넷 센서 처리CPU(16)으로 되어 있고, 상기 메인 CPU(14)는 주행을 위한 제어나 조타를 위한 제어, 또 제동을 위한 제어등을 행하기 위해서 신호를 생성하여 출력하고 있다.상기 유도센서 처리 CPU(15) 는 후에 기술하는 유도센서(33)로부터의 신호를 처리하기 위한 마이크로 컴퓨터이고,또 마그넷 센서 처리CPU(16)은 후에 기술한 마그넷 센서(32)로부터의 신호를 처리하기 위한 마이크로 컴퓨터이다.또,상기 메인 CPU(14) 는 상기 유도센서 처리 CPU(15) 및 상기 마그넷 센서 처리 CPU(16)와 시리얼 통신에 의해 접속되어 있다.그리고 이와 같이 상기 제어 회로(13)를 복수의 마이크로 컴퓨터로 구성하는 것에 의해 연산 처리 속도가 빨라지는 것 외에 부분적으로 파손 등이 생긴 경우에 있어서도 파손된 마이크로 컴퓨터만을 교환하는 것만으로 좋고 수리가 간단하게 되는 효과가 있다.13 is a control circuit for controlling the running of the golf cart main body 1, and the control circuit 13 is composed of a main CPU 14 which is a microcomputer, an induction sensor processing CPU 15, and a magnet sensor processing CPU 16. The main CPU 14 generates and outputs a signal in order to perform control for driving, control for steering, control for braking, and the like. The inductive sensor processing CPU 15 describes the induction sensor described later. A microcomputer for processing the signal from 33, and the magnet sensor processing CPU 16 is a microcomputer for processing the signal from the magnet sensor 32 described later. The main CPU 14 Is connected to the induction sensor processing CPU 15 and the magnet sensor processing CPU 16 by serial communication. In this manner, the control circuit 13 is constituted by a plurality of microcomputers to calculate the processing speed. Well as faster is only partially damaged, such as the even replacing the damaged microcomputer when looking in addition to the effect that the repair is easy.

17은 상기 뒷바퀴(5)를 회전 구동하기 위해 구동원으로 된 주행모터로 그 주행모터(17)는 주행 배터리(18)를 전원으로서 상기 메인 CPU(14)로부터의 신호에 기초해서 모터 컨트롤러(19)를 이용해 PWM 제어에 의해 구동한다. 또 주행 배터리(18)는 충전하기 위한 충전기(20)가 설치되어 있고 그 충전기(20)에 의해 1라운드가 종료된 때 등에 적절히 충전 할 수 있다.또 21은 상기 제어 회로(13)에 급전을 행하기 위한 제어용 배터리이고,상기 제어용 배터리(21)는 상기 충전기(20)에 의해 동시에 충전을 할 수 있다. 22는 상기 좌석(3)의 전면에 설치되고 사용자의 스위치 등의 교체에 의한 주행 모드의 전환을 검출하는 자동/수동 검출 수단으로,그 자동/수동 검출 수단(22)은 사용자에 의해 선택된 주행 모드를 메인 CPU(14)에 입력하도록 되어 있다.17 is a driving motor which is a driving source for rotationally driving the rear wheel 5, the driving motor 17 is a motor controller 19 based on a signal from the main CPU 14 using the driving battery 18 as a power source. It is driven by PWM control using. The running battery 18 is also provided with a charger 20 for charging and can be appropriately charged when the first round is completed by the charger 20. It is a control battery for performing, and the said control battery 21 can be charged simultaneously by the said charger 20. 22 is an automatic / manual detection means which is installed on the front of the seat 3 and detects the switching of the driving mode by the replacement of a user's switch or the like, and the automatic / manual detection means 22 is a driving mode selected by the user. Is input to the main CPU 14.

23은 상기 앞바퀴(4) 및 상기 뒷바퀴(5)에 설치된 유압의 힘에 의해 동작하는 디스크 브레이크(미도시)의 제동력을 조정하기 위한 브레이크 모터이고, 브레이크 모터(23)는 메인 CPU(14)로부터의 신호에 의해 PWM 제어되는 것으로 되어있다.  23 is a brake motor for adjusting the braking force of the disk brake (not shown) which is operated by the hydraulic force installed in the front wheel 4 and the rear wheel 5, the brake motor 23 is from the main CPU (14) PWM is controlled by the signal of.

24는 본체(1)를 정차시키기 위한 전자 브레이크로 된 파킹 브레이크로 그 파킹 브레이크(24)는 통전시에 제동력이 해제되고,비통전시에는 스프링의 힘에 의해 제동력이 부여된다.그리고,비통전 시에는 주행모터(17)부근의 구동계에 제동력이 부여되고 상기 뒷바퀴(5)를 고정하도록 동작한다.24 is a parking brake which is an electromagnetic brake for stopping the main body 1. The parking brake 24 is braked when energized and braked by a spring force when not energized. The braking force is applied to the drive system near the traveling motor 17 and operates to fix the rear wheel 5.

25는 상기 메인 CPU(14) 에 접속되고,상기 메인 CPU(14) 로부터의 제어 신호에 기초하여 동작하는 스티어링 모터로,그 스티어링 모터(25)는 자동모드 선택 시에는 스티어링 모터(25)만의 구동력으로 상기 앞바퀴(4)를 조타하고, 수동 모드 선택 시에는 핸들(6)을 조작하는 사람의 힘을 가하여 스티어링 모터(25)의 힘이 보조적으로 동작한다.25 is a steering motor connected to the main CPU 14, the steering motor operating based on a control signal from the main CPU 14, the steering motor 25 driving force of the steering motor 25 only when the automatic mode is selected. By steering the front wheel (4), and when the manual mode is selected, the force of the steering motor 25 is assisted by applying the force of the person operating the steering wheel (6).

26은 핸들(6)축의 도중에 설치되고 자동 모드 선택 시와 수동 모드 선택시에 핸들(6)과 앞바퀴(4)와의 연결을 전기적으로 단속하기 위한 핸들 모터로, 핸들 모터(26)에 의해 자동 모드에 교체된 때에는 핸들(6)이 조작하지 않도록 고정되고 수동 모드로 교체될 때는 핸들(6)의 조작에 따라서 앞바퀴(4)가 조타되도록 연결하여 전기적으로 조작된다.26 is a handle motor which is installed in the middle of the handle (6) shaft and electrically controls the connection between the handle (6) and the front wheel (4) during automatic mode selection and manual mode selection. When the steering wheel 6 is replaced, the handle 6 is fixed so as not to be operated. When the steering wheel 6 is replaced in the manual mode, the front wheel 4 is steered in accordance with the operation of the handle 6 to be electrically operated.

27은 사용자가 브레이크 페달(미도시)을 조작할 때에 신호가 출력하도록 구성된 브레이크 스위치로,자동 모드 선택 시에 브레이크 스위치(27)로부터의 신호가 출력하면 상기 메인 CPU(14)에 의해 브레이크 모터(23)가 동작하도록 신호를 출력하고 소정 시간 경과 후에 파킹 브레이크(24)가 동작하도록 되어 있다.    27 is a brake switch configured to output a signal when a user operates a brake pedal (not shown). When the signal from the brake switch 27 is output at the time of automatic mode selection, the brake motor (27) The parking brake 24 is operated after a predetermined time elapses after the signal is outputted so that the 23 is operated.

28은 브레이크 모터(27) 동작량의 동작 초기를 검출하기 위한 브레이크 홈 스위치이고 이 스위치(28)가 들어가 있을 때는 디스크 브레이크는 동작하지 않는 상태인 것을 검출한다.28 is a brake home switch for detecting the initial operation of the brake motor 27 operation amount, and when this switch 28 is inserted, it detects that the disc brake is not operating.

29는 브레이크 모터(27) 동작량의 동작 종료를 검출하기 위한 브레이크 리미트 스위치이고,그 브레이크 리미트 스위치(29)가 동작하고 있을 때는 디스크 브레이크의 제동량이 최대한으로 동작하고 있는 것을 검출한다.29 is a brake limit switch for detecting the end of operation of the brake motor 27 operation amount, and when the brake limit switch 29 is operating, it detects that the brake amount of the disc brake is operating to the maximum.

30은 브레이크의 유압이 적량인지 어떤지를 검출하기 위한 브레이크 오일 검출 수단이다.30 is brake oil detecting means for detecting whether the hydraulic pressure of the brake is appropriate.

31은 골프카트 본체(1)에 설치되고 골프카트 본체(1)의 경사각도를 검출하는 경사 센서로 상기 경사 센서(31)는 검출한 경사 각도를 전압치에 변환하고 메인 CPU(14)에 입력한다.그리고 이 값에 기초하여 발진시와 정지시의 제어를 행하도록 되어 있다.31 is an inclination sensor installed in the golf cart body 1 and detecting the inclination angle of the golf cart body 1, and the inclination sensor 31 converts the detected inclination angle into a voltage value and inputs it to the main CPU 14. And based on this value, control at the start and stop is performed.

32는 유도선(49) 부근에 매설한 마그넷의 자장을 검출하는 마그넷 센서로 상기 마그넷 센서(32)는 마그넷의 자극이 S 극인지 N 극인지를 검출하고 펄스하여 마그넷 센서 처리 CPU(16)에 입력한다.32 is a magnet sensor that detects the magnetic field of the magnet embedded near the induction line 49. The magnet sensor 32 detects and pulses whether the magnetic pole of the magnet is the S pole or the N pole, and pulses the magnet sensor processing CPU 16 with the magnet sensor. Enter it.

33은 상기 골프카트 본체(1)에 설치되고,조타 된 앞바퀴(4)의 조타와 동시에 좌우로 회동하는 한 쌍의 유도 센서로 상기 유도 센서(33)는 유도선(49)으로부터의 자계를 검출하고 서로의 유도 센서(33)의 검출 레벨이 동일해지도록앞바퀴(4)를 조타한다. 따라서 앞바퀴(4)가 조타되면 유도 센서(33)도 좌우로 회동되기 때문에 유도선(49)이 한 쌍의 유도 센서(33)의 중앙에 위치하도록 조타된다.33 is a pair of inductive sensors installed in the golf cart body 1 and rotating at the same time to the left and right at the same time as the steering of the steered front wheel 4. The inductive sensor 33 detects a magnetic field from the inductive line 49. And the front wheels 4 are steered so that the detection levels of the inductive sensors 33 are the same. Therefore, when the front wheel 4 is steered, the induction sensor 33 is also rotated from side to side, so that the induction line 49 is steered to be positioned at the center of the pair of induction sensors 33.

34는 골프카트 본체(1) 앞부분에 설치된 수신기와 뒷 부분에 설치된 송신기로 된 카트 가드로, 그 카트 가드(34)는 앞쪽에 있는 골프카트 본체(1)의 송신기로부터의 전자파를 수신하고 소정의 수신 레벨,즉 소정의 거리가 된 때에 파킹 브레이크(24)가 동작하도록 제어를 행한다.34 is a cart guard composed of a receiver installed at the front of the golf cart body 1 and a radio transmitter installed at the rear part, the cart guard 34 receiving electromagnetic waves from the transmitter of the golf cart body 1 at the front and The parking brake 24 is controlled to operate when the reception level, i.e., the predetermined distance, is reached.

35는 앞쪽의 장애물을 초음파의 반사에 의해 검출하는 초음파 센서이고, 그 초음파 센서(35)도 장애물과의 거리가 소정의 거리가 됐었을 때에 파킹 브레이크(24)가 동작하도록 되어 있다.35 is an ultrasonic sensor that detects an obstacle in front of the ultrasonic wave, and the ultrasonic sensor 35 is also configured to operate the parking brake 24 when the distance to the obstacle becomes a predetermined distance.

36은,뒷바퀴(5)의 회전수를 검출하는 인코더 이고,그 인코더(36)에  의해 검출된 신호는 메인 CPU(14)에 입력되도록 되어 있다.또 상기 인코더 (36)와는 다르게 뒷바퀴(5)의 회전수를 검출하는 서브 인코더(37)도 설치되어 있고 그 서브 인코더(37)의 신호도 상기 메인 CPU(14)에 입력되어, 이 신호에 의거하여 인코더(36)가 정상으로 동작하고 있는지 어떤지를 판단하거나, 인코더(36)가 이상하게 된 때에 메인 인코더로서 사용하거나 하기 위해 설치되어 있다.36 is an encoder for detecting the number of revolutions of the rear wheel 5, and the signal detected by the encoder 36 is input to the main CPU 14. The rear wheel 5 is different from the encoder 36. The sub-encoder 37 is also provided for detecting the number of revolutions of the signal. The signal of the sub-encoder 37 is also input to the main CPU 14, and whether or not the encoder 36 is operating normally based on this signal. It is provided for judging, or for use as a main encoder when the encoder 36 is abnormal.

38은 상기 핸들(6)축 에 설치되어 핸들(6)의 조작에 의해 조작 토크를 검출하는 토크 센서로 상기 토크 센서(38)는 메인 CPU(14)에 접속되어 있고 조작 토크가 전기 신호로서 입력되고 이 토크의 크기에 따라 스티어링 모터 (25)가 동작하도록 되어 있다.38 is a torque sensor which is provided on the shaft of the handle 6 and detects the operating torque by the operation of the handle 6. The torque sensor 38 is connected to the main CPU 14, and the operating torque is input as an electric signal. The steering motor 25 is operated according to the magnitude of this torque.

39는 상기 골프카트 본체(1) 앞부분에 설치된 범퍼(40)에 설치되고, 장애물등이 범퍼(40)에 접합한 때에 동작하는 범퍼 스위치로,범퍼 스위치(39)로부터의 신호가 입력되면 메인 CPU(14)에 신호가 입력되도록 되어 있다.39 is a bumper switch installed at the bumper 40 provided in front of the golf cart main body 1 and operated when an obstacle light is joined to the bumper 40. When the signal from the bumper switch 39 is input, the main CPU The signal is input to (14).

41은 엑셀 부근에 설치된 사용자의 엑셀의 조작이 이루어지고 있을 때에 메인 CPU(14) 에 신호 출력하는 엑셀 스위치로,그 엑셀 스위치(41)는 자동 주행 모드 선택시에 엑셀 스위치(41)로부터의 신호 입력에 의해 발진하도록 되어 있다.    41 is an Excel switch which outputs a signal to the main CPU 14 when an Excel operation of a user installed near the Excel is being performed, and the Excel switch 41 is a signal from the Excel switch 41 at the time of automatic driving mode selection. It is supposed to oscillate by input.

42는 사용자의 조작이 가능한 위치에 설치되고 사용자에 의해 진행 방향을 지시하는 전후진 스위치로, 상기 전후진 스위치(42)는 메인 CPU(14) 에 접속되고, 전진 및 후진의 어느 한쪽으로 선택되어 있는지 신호가 입력되면 지시된 방향으로 주행하도록 주행 모터(17)가 구동하도록 되어 있다.42 is a forward / backward switch installed at a position where a user can operate and instructs the direction of travel by the user. The forward / backward switch 42 is connected to the main CPU 14, and is selected as one of forward and backward. When a signal is input, the travel motor 17 is driven to travel in the direction indicated.

 43은 사용자의 조작 가능한 위치에 설치되고 자동 모드가 선택되어 있을 때 골프카트 본체(1)의 발진 및 정지를 지시하기 위한 스타트 스톱 스위치로 그 스타트 스톱 스위치(43)는 조작될 때의 신호가 메인 CPU(14) 에 입력되도록 되어 있고 이 신호 입력에 의거하여 주행 모터가 구동시작,구동 정지하도록 되어 있다.43 is a start stop switch for instructing the start and stop of the golf cart body 1 when the auto mode is installed at the user's operable position and the start stop switch 43 is operated when the signal of the start stop switch 43 is operated. The CPU 14 is input to the CPU 14, and the driving motor is driven to start and stop based on this signal input.

44는 골프 카트 본체(1)의 발진 및 정지를 원격 조작하기 위해 리모콘으로부터 신호를 수신하기 위한 리모콘 수신기로, 상기 리모콘 콘트롤 수신기(44)도 메인 CPU(14)에 접속되고 수신한 신호에 의해 주행 제어 되도록 되어 있다.또 상기 리모콘에는 1개의 조작 버튼이 설치되고 조작 버튼을 압박한 때에 신호가 출력되도록 되어 있고, 상기 골프카트 본체(1)가 주행중에 신호가 입력되면 정지 제어가 이루어져 정지중에 신호가 입력되면 발진 제어가 이루어지도록 되어 있다.44 is a remote control receiver for receiving a signal from a remote control to remotely start and stop the golf cart body 1, and the remote control control receiver 44 is also connected to the main CPU 14 and travels by the received signal. In addition, the remote controller is provided with one operation button and a signal is output when the operation button is pressed. When a signal is input while the golf cart body 1 is traveling, a stop control is performed and a signal is stopped. Is input, oscillation control is performed.

45는 사용자가 상기 좌석(3)에 승차했을 때에 정면에 오는 위치에 설치된 표시부로 상기 표시부(45)는 배터리 잔량이나 선택된 주행 모드의 표시등이 표시 되도록 되어 있다.45 is a display unit provided at a position that comes to the front when the user rides on the seat 3, the display unit 45 is such that the battery remaining amount or the indicator of the selected driving mode is displayed.

다음에 상술한 구성에 있어서 동작에 관하여 설명한다. Next, the operation in the above-described configuration will be described.

상기 자동 수동 검출 수단(22)에 의해 수동 모드의 선택이 검출되고,주행을 시작하는 경우 엑셀을 조작할 때에 엑셀의 조작량에 따른 구동력으로 주행 모터(17)가 구동한다.이것에 의해 뒷바퀴(5)가 회전하여 주행을 시작한다.주행 시작과 동시에 파킹 브레이크(24)는 해제된다.Selection of the manual mode is detected by the automatic manual detection means 22, and when the driving starts, the traveling motor 17 is driven by the driving force according to the operation amount of the Excel when operating the Excel. ) And the vehicle starts to travel. The parking brake 24 is released at the same time as driving starts.

또 정지하는 경우,브레이크의 조작량에 따른 제동량으로 브레이크 모터(23)가 동작하고 인코더(36)에 의해 차의 속력이 제로인 것을 검출할 때에 파킹 브레이크(24)가 동작하게 되어 있다.When the motor is stopped, the parking brake 24 is operated when the brake motor 23 is operated by the braking amount corresponding to the brake operation amount and the encoder 36 detects that the speed of the car is zero.

주행중의 조타에 관해서는 핸들(6)의 조작에 따라 앞바퀴(4)가 조타되고,그 때 동시에 토크 센서(38)에 의해 핸들(6)의 조작 토크가 검출된다. 이 토크에 따라 스티어링 모터(25)가 구동하고 핸들(6)의 조작력을 보조하도록 구동력이 부여된다.As for steering while running, the front wheel 4 is steered in accordance with the operation of the handle 6, and at the same time, the operating torque of the handle 6 is detected by the torque sensor 38 at the same time. According to this torque, the driving force is provided to drive the steering motor 25 and to assist the operating force of the handle 6.

다음에 자동 모드가 선택되고 있는 경우에 관하여 설명을 한다. Next, the case where the automatic mode is selected will be described.

정차중에 스타트 스톱 스위치(43)가 눌러지면 파킹 브레이크(24)가 해제됨과 동시에 주행 모터(17)가 구동을 시작한다.이 때의 주행 속도는 노면에 매설된 마그넷으로부터의 속도 지시 신호에 의거하여 행해진다.그리고 뒤에 기술하는 유도 센서(33)의 동작에 의해 노면에 매설한 유도선(43)에 따라서 조타되며 주행한다.주행중 스타트 스톱 스위치(43)가 눌러지면 골프 카트 본체(1)는 회생 제동하게되는데 브레이크 모터(23)의 동작과 파킹 브레이크(24)의 동작을 행하고 정차한다.When the start stop switch 43 is pressed while the vehicle is stopped, the parking brake 24 is released and the drive motor 17 starts to drive. At this time, the traveling speed is based on the speed indication signal from the magnet embedded in the road surface. Then, the vehicle is steered and driven along the guide line 43 embedded in the road surface by the operation of the induction sensor 33 described later. When the start stop switch 43 is pressed during driving, the golf cart body 1 regenerates. Braking is performed, and the brake motor 23 and the parking brake 24 are stopped.

다음에 자동모드 시의 스티어링 부분의 동작에 관하여 도3에 의거하여 설명한다.Next, the operation of the steering portion in the automatic mode will be described based on FIG.

46은 선단부에 상기 유도 센서(33)를 설치한 유도 센서 암(arm)으로 상기 암(46)은 앞바퀴(4)의 좌우의 조타와 동시에 회동하도록 연결되어 있다.또 상기 암(46)의 중도에는 기어(47)가 설치되어 있고, 이 기어(47)는 상기 스티어링 모터(25)의 출력축에 설치된 기어(48)와 결합하도록 되어 있다.46 is an induction sensor arm provided with the induction sensor 33 at the distal end, and the arm 46 is connected to rotate simultaneously with the left and right steering of the front wheel 4. The middle of the arm 46 The gear 47 is installed in the gear 47, and the gear 47 is engaged with the gear 48 provided on the output shaft of the steering motor 25.

골프카트 본체(1)의 조타에 있어서는 자동 모드 선택시, 주행하면서 한 쌍 유도 센서(33)에 의해 노면에 매설된 유도선(49)으로부터의 자계를 검출하고 두개의 유도 센서(33)의 신호의 레벨이 동일해지도록 앞바퀴(4)를 조타한다.구체적인 신호의 흐름에 관하여 설명하면 유도선(49)으로부터 발생하는 자계는 각각의 유도 센서(33)에 의해 수신되고, 유도 센서 처리 CPU(15)에 입력된다. 그리고 2개의 유도 센서(33)의 신호 레벨을 비교하여 좌우 어느 한쪽으로 어긋나는지가 연산되고 한 쌍의 유도 센서(33)의 중심이 유도선(49)위에 오도록 메인 CPU(14)로부터 스티어링 모터(25)에 신호가 출력되고, 스티어링 모터(25)의 구동에 의해 앞바퀴(4)를 조타한다.앞바퀴(4)를 조타하는 것에 의해 2개의 유도 센서(33)의 중심에 유도선(49)이 위치하도록 제어 된다.In steering of the golf cart main body 1, when the automatic mode is selected, the magnetic field from the guide line 49 embedded in the road surface is detected by the pair of induction sensors 33 while traveling, and the signals of the two induction sensors 33 are detected. The front wheels 4 are steered so that the level of the same is the same. When the specific signal flow is explained, the magnetic field generated from the induction line 49 is received by each of the induction sensors 33, and the induction sensor processing CPU 15 ) Is entered. The signal levels of the two inductive sensors 33 are compared to calculate the deviation of the left and right, and the steering motor 25 from the main CPU 14 so that the center of the pair of inductive sensors 33 is on the inductive line 49. Signal is outputted, and the front wheel 4 is steered by the steering motor 25. The guide line 49 is positioned at the center of the two induction sensors 33 by steering the front wheel 4. Is controlled.

다음에 이러한 한 쌍의 유도 센서(33)에 의해 골프 카트 본체(1)가 유도선(49)위에 위치하는지 안하는지를 판단하는 방법에 관하여 도4 또는 도7에기초하여 설명한다.Next, a method of judging whether or not the golf cart body 1 is positioned on the guide line 49 by the pair of inductive sensors 33 will be described based on FIG. 4 or FIG.

도4에 나타내는 파형은 유도 센서(33)가 수신하는 신호 레벨을 나타내고 있고,횡축은 유도선(49)으로부터의 거리를 나타내고 종축은 수신한 신호의 크기를 나타내고 있다.The waveform shown in Fig. 4 represents the signal level received by the induction sensor 33, the horizontal axis represents the distance from the induction line 49, and the vertical axis represents the magnitude of the received signal.

(A)에 나타내는 그래프는 좌우 각각의 유도 센서(33)의 신호 크기를 나타내고 유도 센서(R33)(우측의 유도 센서)는, 왼쪽으로 소정 거리만큼 떨어져있는 유도선(49)의 상측위치에서 수신 레벨이 가장 크도록 되어 있다. 또 유도 센서(L33)(좌측의 유도 센서)는, 반대로 오른쪽으로 소정 거리만큼 떨어져있는 위치에서 수신레벨이 가장 커지도록 되어 있다.The graph shown in (A) shows the signal magnitude of each of the left and right induction sensors 33, and the induction sensor R33 (right induction sensor) is received at an upper position of the induction line 49 spaced a predetermined distance to the left. The level is intended to be the largest. In addition, the induction sensor L33 (left induction sensor) has the largest reception level at a position separated by a predetermined distance to the right.

(B)에 나타내는 그래프는 유도 센서(R33)와 유도 센서(L33)의 신호 합을 산출하고 그래프화 한 파형으로 횡축 및 종축은 (A)와 동일하다.The graph shown in (B) is a waveform obtained by calculating the signal sum of the induction sensor R33 and the induction sensor L33 and graphing the horizontal axis and the vertical axis equal to (A).

(C)에 나타내는 그래프는 유도 센서(R33)와 유도 센서(L33)의 신호 차이를 산출하고 그래프화 한 파형으로 횡축 및 종축은 (A),(B)함께 동일하다.The graph shown in (C) is a waveform in which the signal difference between the induction sensor R33 and the induction sensor L33 is calculated and graphed. The horizontal and vertical axes are the same with (A) and (B).

앞에 서술한 파형의 그래프에 기입한 A 및 -A 의 기재는 골프 카트 본체(1)의 유도선(49)으로부터 바퀴의 이탈을 판정하는 기준치를 나타내고 유도 센서(33)의 신호 크기가 이 값이 됐을 때에 바퀴가 이탈한다고 판단 한다.The description of A and -A written in the graph of the above-described waveform indicates a reference value for determining the deviation of the wheel from the guide line 49 of the golf cart body 1 and the signal size of the induction sensor 33 is set to this value. It is judged that the wheel breaks off when it does.

다음에 골프카트 본체(1)의 조타 제어에 관하여 도 5의 플로차트에 기초하여 설명한다.Next, the steering control of the golf cart main body 1 is demonstrated based on the flowchart of FIG.

먼저 유도 센서(R33)의 수신 신호를 유도 센서 처리 CPU(15)에 전달하고(S1),다음에 유도 센서(L33)의 수신 신호를 유도 센서 처리 CPU(15) 에 전달한다(S2).다음에 유도 센서(R33)와 유도 센서(L33)의 차이를 연산하고(S3) 또 합을 연산한다(S4).First, the reception signal of the induction sensor R33 is transmitted to the induction sensor processing CPU 15 (S1), and then the reception signal of the induction sensor L33 is transferred to the induction sensor processing CPU 15 (S2). The difference between the induction sensor R33 and the induction sensor L33 is calculated (S3) and the sum is calculated (S4).

이 때,유도 센서(33)의 합이 탈륜(脫輪)레벨인 A(절대치)를 넘고 있는지 어떤지를 판정하고(S5) A보다도 큰 신호 레벨, 즉 바퀴가 이탈하고 있지 않는 신호 레벨이라면 도 7에 나타나는 테이블 데이터를 참조하고(S6) 이 데이터에 기초하여 제어가 행해진다(S7).At this time, it is determined whether or not the sum of the induction sensors 33 exceeds A (absolute value), which is the dismounting level (S5). If the signal level is larger than A, that is, the signal level at which the wheel does not deviate, FIG. Reference is made to the table data shown in (S6), and control is performed based on this data (S7).

한편,유도 센서(33)의 합이 탈륜 레벨인 A 를 넘고 있지 않는 경우(S5), 골프카트 본체(1)가 유도선(49)으로부터 바퀴가 이탈하고 있다고 판단하고 이탈한 바퀴 상태가 소정시간 경과하고 있지 않으면 S7로 진행하여 스티어링 모터(25) 제어가 행해진다.이 때 탈륜 레벨이 판정되고,R-L 값은 최대치의 200을 초과하고 있기 때문에,스티어링 모터(25)로 통하는 전기는 100%의 최대치로 제어가 계속 되어진다.그리고 소정 시간경과 후 이 상태가 계속될 때(S8) 골프카트 본체(1)가 바퀴가 이탈하고 있다고 판정하고(S9) 정지 제어로 이행한다(S10).On the other hand, when the sum of the induction sensors 33 does not exceed A, which is the disengagement level (S5), the golf cart body 1 determines that the wheel is departed from the guide line 49, and the state of the disengaged wheels is determined for a predetermined time. If it has not elapsed, the control proceeds to S7 and the steering motor 25 control is performed. At this time, the disengagement level is determined, and since the RL value exceeds 200 of the maximum value, the electricity to the steering motor 25 is 100%. The control continues to the maximum value. When this state continues after a predetermined time elapses (S8), the golf cart body 1 determines that the wheel is disengaged (S9) and shifts to stop control (S10).

다음에 도6에 기초하여 정지 제어에 관하여 설명한다. Next, the stop control will be described based on FIG.

앞에 서술한 플로차트에 있어서 정지 제어가 이루어진 경우나 자동 모드로 주행중에 스타트 스톱 스위치(43)가 압박된 경우,또 자동 모드로 브레이크 스위치(27)로부터의 신호가 입력된 경우 주행 모터(17)에 의한 회생제어를 강화하도록 동작함과 동시에 브레이크 모터(23)의 동작을 최대로 하여 감속시킨다(S1).그리고 감속 후,인코더(36)로부터의 신호가 차의 속도 제로를 검출하는지 어떤지를 판정하고(A2),제로가 되지 않는 상태가 소정 시간 계속한 경우에는(S3) 파킹브레이크(24)를 동작하고 강제 정지시킨다(S4).또 소정 시간내에 차의 속도가 제로가 되면 그 시점에서 파킹 브레이크(24)를 동작하여 정지시킨다(S4).In the above-described flowchart, when the stop control is made or when the start stop switch 43 is pressed while driving in the automatic mode, and when the signal from the brake switch 27 is input in the automatic mode, the traveling motor 17 The operation of the brake motor 23 is maximized and decelerated (S1). After deceleration, it is determined whether the signal from the encoder 36 detects the speed zero of the vehicle. (A2) If the non-zero state continues for a predetermined time (S3), the parking brake 24 is operated and forcibly stopped (S4). If the speed of the car reaches zero within the predetermined time, the parking brake occurs at that time. Operation 24 stops it (S4).

이상과 같이 한 쌍의 유도 센서(33)의 신호에 기초하여,조타를 행하면서, 유도선(49)위에 골프 카트 본체(1)가 존재하는지 안하는지를 판단할 수 있으므로 종래와 비교하여 1개의 센서를 적게 할 수 있고 비용이 적어지는 효과가 있다.As described above, it is possible to judge whether or not the golf cart body 1 is present on the guide line 49 while performing steering based on the signal of the pair of inductive sensors 33. This can reduce the cost and reduce the cost.

또,한 쌍의 유도 센서(33)로부터의 신호를 검출하고,그 신호의 합과 차에 의해 바퀴가 이탈하는 것을 판정할 수 있으므로 간단한 연산에 의해 주행시키는 것이 가능하다.In addition, since the signal from the pair of induction sensors 33 can be detected, and the wheels can be departed by the sum and difference of the signals, it is possible to drive by simple calculation.

다음에 제2의 실시의 형태에 관하여 도 8 내지 도 10에 기초하여 설명한다.Next, a second embodiment will be described based on FIGS. 8 to 10.

먼저 스티어링 부분에 관하여 도 8에 기초하여 설명한다.도 8에 관해서는 도 3과 동일 부분에 관해서는 동일한 번호를 부여하고 설명을 생략한다.또 도 3과 도 8에 있어서 다른 부분은, 도3에 있어서는 유도 센서(33)가 유도선(49)을 넘어서 한 쌍으로 구성하고 있는 것에 대하여, 도 8에서는 유도선(49)위에 1개의 유도 센서(33)가 설치되어 있는 점에서 다른 것이다.First, the steering portion will be described with reference to Fig. 8. The same reference numerals are used for the same parts as in Fig. 3, and the description thereof will be omitted. In the case where the induction sensor 33 is formed in a pair beyond the induction line 49 in FIG. 9, the induction sensor 33 is different in that one induction sensor 33 is provided on the induction line 49.

다음에 도 9에 나타낸 파형은 유도 센서(33)가 수신하는 신호 레벨을 나타내고 있고 도 4와 마찬가지로 횡축은 유도선(49)으로부터의 거리를 나타내고 종축은 수신한 신호의 크기를 나타내고 있다.Next, the waveform shown in FIG. 8 represents the signal level received by the induction sensor 33, and as in FIG. 4, the horizontal axis represents the distance from the induction line 49 and the vertical axis represents the magnitude of the received signal.

도 9의 경우, 도 4와 같이 2개의 유도 센서(33)를 사용하고 있지 않기 때문에 1개의 파형으로 또한 유도선(49)위에 유도 센서(33)가 위치할때가 신호 레벨이 가장 높아지도록 되어 있다.In the case of Fig. 9, since the two inductive sensors 33 are not used as in Fig. 4, the signal level is the highest when one inductive waveform 33 is placed on the inductive line 49 with one waveform. .

앞에 서술한 파형의 그래프에 있어서 종축에 기입한 B 및 -B의 기재는 골프카트 본체(1)가 유도선(49)에 대해 대략 직진 주행하고 있다고 판단할 수 있는 허용 범위이고, 이 범위로부터 벗어나면 조타 제어가 필요하다고 판단할 수 있는 설정치이다.The descriptions of B and -B written in the vertical axis in the graph of the above-described waveforms are allowable ranges in which the golf cart body 1 can travel approximately straight with respect to the guide line 49, and is out of this range. It is the set value that can be judged that surface steering control is necessary.

다음에 골프카트 본체(1)의 조타 제어에 관하여 도 10의 플로차트에 기초해서 설명한다.Next, the steering control of the golf cart main body 1 is demonstrated based on the flowchart of FIG.

 먼저 유도 센서(33)의 수신 신호를 유도 센서 처리 CPU(15)에 전달하고(S1),그 신호 레벨이 소정치 B 이상인지 어떤지를 판단한다(S2).소정치 B 이상이면,골프카트 본체(1)가 유도선(49)위를 주행하고 있다고 판단하고 S1에 되돌아와서 주행을 계속한다.그러나 소정치 B 이하 이면, 유도선(49)위로부터 벗어나는 것으로 판단하고(S2),스티어링 모터(25)를 오른쪽에 PMW 10%만 동작하여(S3) 한번 더 유도 센서(33)의 신호 레벨을 입력하고(S4),이전의 레벨보다 상승하는지 안하는지를 판정한다(S5).커졌다고 판단하면 오른쪽에 선회에 의해 유도선(49)위에 위치하고 있다고 판단하고 더욱 오른쪽에 PMW10%로 스티어링 모터(25)를 동작한다(S6).그리고 이 때의 유도 센서(33)의 레벨을 입력하고(S7) 수신 레벨이 소정치 B 이상인지 어떤지를 판정한다(S8).그리고 소정치 B 이상으로 골프 카트(S8) 본체(1)가 유도선(49)위에 위치하고 있다고 판단한 때는 S1로 돌아오고 조타를 계속 한다.또 소정치 B 이상이 되지 않는 때는 소정 시간 경과했는지 안했는지를 판단하고(S9),소정 시간 이내라면 S6에 되돌아와서 더욱 오른쪽으로 스티어링 모터(25)를 동작한다.그러나 오른쪽의 스티어링 모터(25)의 구동을 계속하고도 소정치 B 에 이르지 않을 때에는 바퀴가 이탈하고 있다고 판정하고(S10) 정지 제어를 행한다(S11).여기에서 행해지는 정지 제어는 앞에 서술한 도 6에 나타내는 플로 차트에 기초하여 행해진다.First, the reception signal of the induction sensor 33 is transmitted to the induction sensor processing CPU 15 (S1), and it is judged whether the signal level is more than the predetermined value B (S2). It is determined that (1) is traveling on the guide line 49, and the vehicle returns to S1 and continues to run. However, if it is less than or equal to the predetermined value B, it is determined to be out of the guide line 49 (S2), and the steering motor ( 25) operates only 10% of PMW on the right side (S3) and inputs the signal level of the induction sensor 33 once more (S4), and determines whether it rises above the previous level (S5). It is judged that it is located on the guide line 49 by turning on, and operates the steering motor 25 at PMW10% on the right side further (S6). At this time, the level of the induction sensor 33 is input (S7) and received. It is determined whether or not the level is equal to or greater than the predetermined value B (S8). When it is judged that the main body 1 of the golf cart S8 is located on the guide line 49, it returns to S1 and continues steering. When it does not become more than the predetermined value B, it is judged whether or not the predetermined time has elapsed ( S9), if it is within the predetermined time, the motor returns to S6 and operates the steering motor 25 to the right. However, when the driving of the right steering motor 25 does not reach the predetermined value B, it is determined that the wheel is out of position. (S10) Stop control is performed (S11). The stop control performed here is performed based on the flowchart shown in FIG.

또,S5에 있어서 오른쪽에 스티어링 모터(25)를 구동할 때, 신호 레벨이 커지지 않은 경우 역으로 선회하고 있다고 판단하고 왼쪽으로 스티어링 모터(25)를 구동한다(S12).그리고 유도 센서(33)의 수신 레벨을 입력하고(S13) 수신 레벨이 소정치B 이상인지 어떤지를 판단하고(S14) 소정치B 이상이라면 골프 카트 본체(1)가 유도선(49) 위로 되돌아온 것으로 판단해서 S1로 돌아오게 조타를 계속한다.그러나 소정치 B 이상이 되지 않는 경우에는 S9와 같이 소정 시간이 경과했는지 아닌지를 판단하고(S15),소정 시간 이내이라면 S12로 돌아오고 또한 왼쪽으로 스티어링 모터(25)를 동작한다.그러나 왼쪽으로의 스티어링 모터(25)의 구동을 계속해도 소정치 B에 이르지 않을때에는 바퀴가 이탈했다고 판정하고(S10),정지 제어를 행한다(S11).여기에서 행해지는 정지제어도 앞에 서술한 도 6에 나타내는 플로차트에 기초하여 행해진다.Further, when driving the steering motor 25 on the right side in S5, if the signal level does not increase, it is determined that the vehicle is turning in reverse, and the steering motor 25 is driven on the left side (S12). Input the reception level of (S13) and determine whether the reception level is greater than or equal to the predetermined value B (S14), and if it is greater than or equal to the predetermined value B, it is determined that the golf cart body 1 has returned above the guide line 49 Steering continues. However, if it does not exceed the predetermined value B, it is determined whether a predetermined time has elapsed as in S9 (S15), and if it is within a predetermined time, the control returns to S12 and the steering motor 25 is operated to the left. However, when the steering motor 25 continues to the left and does not reach the predetermined value B, it is determined that the wheel has come off (S10) and stop control is performed (S11). Also performed based on the flowchart shown in FIG. 6 described before.

본 실시 예의 S3에서는,소정의 레벨 이하가 됐을 때에 오른쪽으로의 조타를 행했지만 이것을 왼쪽으로 조타해도 좋고 유도선(49)의 어느 한쪽 으로 어긋나 있는지 판별할 수 있으면 용이하다.또 PWM도 10%로 설정하고 있지만 주행에 영향 없다면 5%나 20%등 설정치는 얼마라도 상관하지 않는다.In S3 of this embodiment, the steering is performed to the right when the predetermined level is lower than the predetermined level. However, the steering may be performed to the left or it is easy if it is possible to determine which side of the induction line 49 is displaced. If it is set but it does not affect driving, setting values such as 5% or 20% do not matter much.

이처럼 유도선(49)에 따른 조타를 행하기 위한1개의 유도 센서(33)를 이용하여 유도선(49)으로부터의 바퀴가 이탈하는 것을 검출하는 것이 가능하므로 종래와 비교하여 2개나 유도 센서의 수를 삭감할 수 있다.In this way, it is possible to detect the departure of the wheel from the guide line 49 by using one induction sensor 33 for performing steering along the guide line 49. Can be reduced.

본 발명의 청구항 1에 의하면, 조타의 제어를 행하기 위해 유도 센서로부터 신호에서 기초해서 유도선상으로 상기의 무인 반송차가 존재하는지 안하는지를 판단하는 판정수단을 설치하였으므로, 조타를 행하는 2개의 유도센서로 유도선상에 무인 반송차가 존재 하는지 어떤지를 판정할 수 있고, 종래에 비해 1개의 유도센서를 삭감 할 수 있는 효과가 있다.According to claim 1 of the present invention, since judging means for judging whether or not said unmanned carrier vehicle exists on an induction line based on a signal from an induction sensor for controlling steering is provided, two induction sensors for steering are provided. It is possible to determine whether or not there is an unmanned carrier on the induction line, and there is an effect that one induction sensor can be reduced as compared with the prior art.

또 청구항 2 및 청구항 3 에 의하면, 판정수단은 한쌍의 유도센서의 검출치의 합과 차의 연산치로부터 판단하므로 종래의 구성에서 크게 변경 하지 않고 간단한 제어에 의해 주행제어가 가능한 등의 효과가 있다.Further, according to Claims 2 and 3, the judging means judges from the sum of the detected values of the pair of inductive sensors and the calculated values of the difference, so that the running control can be performed by simple control without greatly changing the conventional configuration.

그리고 청구항 4에 의하면, 1개의 유도 센서에서의 신호가 소정치 이하로 됐을 때 유도 센서를 좌우 어긋나게 스티어링 모터를 동작하고, 그 때의 유도 센서의 검출 레벨에 기초해서 조타바퀴를 조타하므로, 1개의 유도 센서로 조타와 바퀴의 이탈 판정을 행하기 때문에 종래에 비해 2개의 유도 센서를 삭감하는 등의 효과를 가진다.According to claim 4, when the signal from one induction sensor is below a predetermined value, the steering motor is operated to shift the induction sensor from side to side, and the steering wheel is steered based on the detection level of the induction sensor at that time. Since the steering and the wheel deviation determination are performed by the induction sensor, it has the effect of reducing the two induction sensors compared with the prior art.

그리고 청구항 5 에 의하면 유도 센서는 유도선으로 흐르는 전류에서 생기는 교대자계를 검출하므로 무인반송차의 제어만을 변경하는 것에 의해종래의 설비를 이용해서 제어를 실행하는 것이 가능한 등의 효과를 가진다.According to claim 5, since the inductive sensor detects an alternating magnetic field generated by the current flowing in the induction line, it is possible to perform control using conventional equipment by changing only the control of the unmanned vehicle.

또 청구항 6에 의하면 무인 반송차에는 제동력을 부여하는 제어수단을 설치,판정 수단이 무인 반송차가 유도선상에 존재하지 않는다라고 판정했을 때 제동 수단에 의해 정지하므로 바퀴의 이탈을 판정했을때 정지하므로 안전의 효과를 가진다.Further, according to claim 6, a control means for applying a braking force is provided for an unmanned transport vehicle, and when the determination means determines that the unmanned transport vehicle does not exist on the guide line, it is stopped by the braking means. Has the effect of.

또 청구항 7에 의하면, 무인 반송차가 유도 선상에 존재하지 않다고 판정했을 때 이 판정으로부터 소정 시간 후에 제동 수단을 동작하므로, 소정 시간내의 유도 선상으로 돌아오면 주행을 계속하고, 유도 선상으로 돌아오지 않는다고 판단했을 때에만 정지하고 정지를 필요최소한으로 가능하기 때문에 순조로운 주행이 가능해지는 등의 효과를 가진다.According to claim 7, the braking means is operated after a predetermined time from the determination when the unmanned carrier is not present on the guide line. Therefore, when the vehicle is returned to the guide line within the predetermined time, it continues to travel and does not return to the guide line. Only when the vehicle is stopped, it is possible to stop the vehicle at the minimum and smoothly.

또한 청구항 8에 의하면 무인 반송차의 유도선의 중심으로부터 벗어나는 크기에 따른 제어량으로 스티어링 모터를 제어하므로 유도선으로부터 이탈 정도에 따른 제어량으로 동작하고, 유도선에 따라서 주행이 수월해지는등의 효과를 가진다.In addition, according to claim 8, since the steering motor is controlled by a control amount according to the size deviating from the center of the guide line of the unmanned carrier vehicle, the steering motor operates with a control amount according to the deviation amount from the guide line, and the driving is facilitated according to the guide line.

Claims (8)

노면에 매설한 유도선을 검출하고 조타바퀴와 동시에 회동하는 한쌍의 유도센서와 그 유도센서의 신호를 검출하고 상기 한쌍의 유도센서의 중앙을 주행하도록 조타바퀴를 조타 제어하는 제어회로를 구비한 무인 반송차로서,Unmanned with a pair of induction sensors that detect guide lines embedded on the road surface and rotate simultaneously with the steering wheel, and a control circuit that detects signals from the induction sensors and steers and controls the steering wheels to travel in the center of the pair of induction sensors As a carrier, 상기 유도 센서로부터의 신호에 의거하여 상기 유도 선상에 상기 무인 반송차가 존재 하는지 아닌지를 판단하는 판정수단을 설치한 것을 특징으로 하는 무인 반송차.And an determining means for determining whether or not the unmanned carrier is present on the guide line based on a signal from the inductive sensor. 제 1 항에 있어서.The method of claim 1. 상기 판정 수단은 상기 한쌍의 유도 센서 검출치의 합과 차의 연산치로 판단하는 것을 특징으로 하는 무인 반송차.And said determining means determines the sum of the pair of inductive sensor detection values and the calculated value of the difference. 제 2 항에 있어서,The method of claim 2, 상기 판정 수단은 상기 유도 센서의 합이 소정치 이하이면 바퀴가 이탈하고 있다고 판단하는 것을 특징으로 하는 무인 반송차.And said determining means judges that the wheel is disengaged if the sum of said induction sensors is less than or equal to a predetermined value. 노면에 매설한 유도선을 검출하고 유도선과 함께 회동하는 1개의 유도 센서와 상기 유도 센서로부터의 신호를 검출하여 상기 유도선상을 주행하도록 조타바퀴를 조타 제어하는 제어 회로를 구비하고,And a control circuit for detecting a guide line embedded in the road surface and steering control of the steering wheel to travel on the guide line by detecting a signal from the inductive sensor and a signal from the inductive sensor. 상기 유도 센서로부터의 신호가 소정치 이하가 됐을 때, 상기 유도센서를 좌우 어느 한쪽으로 스티어링 모터를 동작하고 그 때의 유도 센서의 검출 레벨에 의거하여 조타 바퀴를 조타하는 것을 특징으로 하는 무인 반송차.When the signal from the induction sensor is below a predetermined value, the steering motor is operated to either the left or right of the induction sensor, and steering the steering wheel based on the detection level of the induction sensor at that time. . 제 1 항 또는 제 4 항에 있어서,The method according to claim 1 or 4, 상기 유도 센서는 상기 유도선에 흐르는 전류에 의해 발생하는 교대자계를 검출하는 것을 특징으로 하는 무인 반송차.And the inductive sensor detects an alternating magnetic field generated by a current flowing in the inductive line. 제 1항 또는 제 4 항에 있어서,The method according to claim 1 or 4, 상기 무인 반송차에는 제동력을 부여하는 제어 수단을 설치하고,The driverless vehicle is provided with control means for applying a braking force, 상기 판정 수단이 상기 무인 반송차의 상기 유도선상에 존재하지 않는다고 판정했을 때 상기 제동수단에 의해 정지하는 것을 특징으로 하는 무인 반송차.And said stopping means stops by said braking means when it is determined that said determining means does not exist on said guide line of said unmanned carrier. 제 6 항에 있어서,The method of claim 6, 상기 무인 반송차가 상기 유도 선상에 존재하지 않는다고 판정했을 때 상기 판정으로부터의 소정 시간 뒤에 상기 제동 수단을 동작하는 것을 특징으로 하는 무인 반송차.And the braking means is operated after a predetermined time from the determination when it is determined that the unmanned carrier does not exist on the guide line. 제 1항 또는 제 4 항에 있어서,The method according to claim 1 or 4, 상기 무인 반송차의 상기 유도선의 중심으로부터 벗어난 정도에 따른 제어량으로 스티어링 모터를 제어하는 것을 특징으로 하는 무인 반송차.And the steering motor is controlled by a control amount corresponding to a deviation from the center of the guide line of the unmanned carrier.
KR10-2002-0035347A 2001-06-29 2002-06-24 Automatic guided vehicle KR100478595B1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JPJP-P-2001-00198603 2001-06-29
JP2001198603A JP2003015737A (en) 2001-06-29 2001-06-29 Unmanned carrier

Publications (2)

Publication Number Publication Date
KR20030003014A true KR20030003014A (en) 2003-01-09
KR100478595B1 KR100478595B1 (en) 2005-03-28

Family

ID=19036025

Family Applications (1)

Application Number Title Priority Date Filing Date
KR10-2002-0035347A KR100478595B1 (en) 2001-06-29 2002-06-24 Automatic guided vehicle

Country Status (3)

Country Link
JP (1) JP2003015737A (en)
KR (1) KR100478595B1 (en)
CN (1) CN1182449C (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105676850A (en) * 2016-04-13 2016-06-15 广州市远能物流自动化设备科技有限公司 Steering wheel type automatic guided transport vehicle

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7574290B2 (en) * 2004-11-30 2009-08-11 Trimble Navigation Limited Method and system for implementing automatic vehicle control with parameter-driven disengagement
JP2014085982A (en) * 2012-10-26 2014-05-12 Sensatec Co Ltd Magnetic guide sensor for automatic conveyer
JP6224319B2 (en) * 2012-12-18 2017-11-01 キヤノンプレシジョン株式会社 Automated traveling vehicle and automated traveling system, automated traveling vehicle control method, automated traveling control program
CN103529450A (en) * 2013-10-21 2014-01-22 深圳市米克力美科技有限公司 Barrier detection method and device thereof for automatic guided vehicle
CN103885448A (en) * 2014-03-28 2014-06-25 芜湖蓝宙电子科技有限公司 Intelligent vehicle control system for teaching
KR20160069810A (en) * 2014-12-09 2016-06-17 디와이 주식회사 Apparatus and Method of Controlling the Driving of Golf-Cart using the Induction Sensor
CN105589472B (en) * 2016-03-03 2018-10-23 深圳市智美达科技股份有限公司 Unmanned equipment avoids the method, apparatus and system of obstacle

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR880000898B1 (en) * 1985-03-25 1988-05-30 삼성전자 주식회사 Control circuit of two axes of driving of manless convey car
JPS62204314A (en) * 1986-03-05 1987-09-09 Fanuc Ltd Control system for unmanned carrier
JPH0778686B2 (en) * 1986-05-09 1995-08-23 株式会社ダイフク Traveling control device for magnetically guided vehicles
KR890004487B1 (en) * 1987-03-31 1989-11-06 삼성전자 주식회사 A loading out sensor device and a leading out method for manless vehicles
JPH05119831A (en) * 1991-10-30 1993-05-18 Sanyo Electric Co Ltd Guided golf cart
JPH09128048A (en) * 1995-10-31 1997-05-16 Sanyo Electric Co Ltd Guided golf cart
JP2001014029A (en) * 1999-06-29 2001-01-19 Yanmar Diesel Engine Co Ltd Magnetic sensor for automatic traveling golf cart

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105676850A (en) * 2016-04-13 2016-06-15 广州市远能物流自动化设备科技有限公司 Steering wheel type automatic guided transport vehicle

Also Published As

Publication number Publication date
JP2003015737A (en) 2003-01-17
KR100478595B1 (en) 2005-03-28
CN1395150A (en) 2003-02-05
CN1182449C (en) 2004-12-29

Similar Documents

Publication Publication Date Title
JP5456654B2 (en) Electric car
JP2011078828A5 (en)
JPH1178936A (en) Automatic steering device for vehicle
US20030163252A1 (en) Self-traveling vehicle
KR100478595B1 (en) Automatic guided vehicle
JP2003111212A (en) Electric car
JP3999982B2 (en) Guided vehicle
US20050274558A1 (en) Electric vehicle
JP2002229645A (en) Control method for automatic traveling vehicle
JP2003306139A (en) Golf cart
KR101347741B1 (en) Maned and unmaned steering motion control apparatus for electric car with in-wheel motor
JP2003005832A (en) Automatic traveling vehicle
JP2003256044A (en) Guided vehicle
JP2004152117A (en) Obstacle avoidance system of electromagnetic induction type golf cart
JP2883461B2 (en) Golf cart
JP2003250943A (en) Golf cart
JP4017455B2 (en) Golf cart
JP2004145726A (en) Leading vehicle
JP2004126717A (en) Guide device for guided vehicle
JP2002258947A (en) Controller for automatic traveling vehicle
JP2013215613A (en) Electric-powered vehicle
JP2003284798A (en) Golf cart
JP2004126718A (en) Guided vehicle and path of travel therefor
JP2004121332A (en) Golf cart
JP2003084829A (en) Carrier

Legal Events

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

Payment date: 20090311

Year of fee payment: 5

LAPS Lapse due to unpaid annual fee