KR102004344B1 - Steering control device and method thereof - Google Patents
Steering control device and method thereof Download PDFInfo
- Publication number
- KR102004344B1 KR102004344B1 KR1020170080386A KR20170080386A KR102004344B1 KR 102004344 B1 KR102004344 B1 KR 102004344B1 KR 1020170080386 A KR1020170080386 A KR 1020170080386A KR 20170080386 A KR20170080386 A KR 20170080386A KR 102004344 B1 KR102004344 B1 KR 102004344B1
- Authority
- KR
- South Korea
- Prior art keywords
- angle
- steering
- wheel
- obstacle
- contact
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 238000001514 detection method Methods 0.000 claims abstract description 5
- 238000004364 calculation method Methods 0.000 claims abstract description 4
- 230000007423 decrease Effects 0.000 claims description 4
- 230000003247 decreasing effect Effects 0.000 claims description 4
- 230000002542 deteriorative effect Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000006870 function Effects 0.000 description 1
- 230000007935 neutral effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Purposes 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, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/09—Taking automatic action to avoid collision, e.g. braking and steering
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/20—Conjoint control of vehicle sub-units of different type or different function including control of steering systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D5/00—Power-assisted or power-driven steering
- B62D5/04—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
- B62D5/0457—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such
- B62D5/046—Controlling the motor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo or light sensitive means, e.g. infrared sensors
- B60W2420/403—Image sensing, e.g. optical camera
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/42—Image sensing, e.g. optical camera
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2540/00—Input parameters relating to occupants
- B60W2540/18—Steering angle
-
- B60W2550/10—
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Input parameters relating to infrastructure
- B60W2552/50—Barriers
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/20—Steering systems
- B60W2710/207—Steering angle of wheels
Abstract
본 발명은 조향 제어 장치 및 그 방법에 관한 것으로서, 차량에 설치되어 차량 주위를 촬영한 영상을 출력하며, 복수의 카메라를 포함하는 촬상장치; 차량 주위의 장애물을 감지하는 장애물 검출부; 장애물 검출부에서 장애물이 감지되면, 영상을 이용하여 바퀴가 장애물에 접촉하기 위해 회동해야 하는 접촉 각도를 산출하는 접촉각 산출부; 접촉 각도에 도달하기 소정 각도 전부터 조향 모터에 제공되는 어시스트 전류값을 감소시키는 조향제어부;를 포함한다. 이에 의해, 조향 모터, 배터리 및 관련 부품에 과도한 부하가 발생하여 수명과 내구성이 저하되는 것을 방지할 수 있다. The present invention relates to a steering control apparatus and method thereof, and more particularly, to a steering control apparatus and method thereof, which includes an image pickup apparatus that is mounted on a vehicle and outputs an image of the surroundings of the vehicle and includes a plurality of cameras; An obstacle detecting unit for detecting an obstacle around the vehicle; A contact angle calculation unit for calculating a contact angle at which the wheel should be rotated to contact the obstacle by using the image when an obstacle is detected in the obstacle detection unit; And a steering control section for reducing an assist current value provided to the steering motor before a predetermined angle to reach the contact angle. As a result, an excessive load is generated in the steering motor, the battery, and the related parts, thereby preventing the service life and the durability from deteriorating.
Description
본 실시예들은 조향 제어 장치 및 방법에 관한 것이다. The embodiments relate to a steering control apparatus and method.
일반적으로 차량에는 스티어링 휠을 용이하게 조향할 수 있도록 전동식 조향장치(EPS: Electronic Power Steering)가 구비되어 있으며, EPS는 조향 모터의 회전력을 이용하여 운전자의 조향력을 보조한다. Generally, a vehicle is provided with an electronic power steering (EPS) so as to easily steer the steering wheel, and the EPS assists the steering force of the driver by using the turning force of the steering motor.
EPS는 스티어링 휠의 조타시 조향 모터의 구동을 제어하는 ECU(Electronic Control Unit)를 구비하고 있으며, ECU는 조향각 센서, 토크 센서, 차속 센서 및 엔진 회전수 센서 등으로부터 신호를 입력받아 어시스트 전류값을 연산하고, 이를 조향 모터에 제공하여 스티어링 휠의 조향감을 조절하게 된다. The EPS includes an electronic control unit (ECU) that controls the steering motor driving when the steering wheel is steered. The ECU receives a signal from a steering angle sensor, a torque sensor, a vehicle speed sensor, an engine speed sensor, And provides it to the steering motor to adjust the steering feeling of the steering wheel.
한편, 주행 중 차량의 바퀴가 연석이나 장애물에 접촉하게 되면, 도 1에 도시된 바와 같이, 토크 센서에서 감지되는 토크는 증가하게 되고, 조향각 센서에서 감지되는 조향각속도는 감소하게 된다. 이러한 경우, ECU는 토크가 미리 설정된 임계값 이상이고, 조향각속도가 일정 이하인 상태가 미리 설정된 시간동안 지속되면, 바퀴가 연석이나 장애물에 접촉한 것으로 판단하여 어시스트 전류를 일정 기울기를 가지고 감소시켜 조향 모터에 최소의 어시스트 전류가 제공되도록 한다. On the other hand, when the wheels of the vehicle come into contact with the curb or obstacle during driving, the torque sensed by the torque sensor increases and the steering angle speed sensed by the steering angle sensor decreases, as shown in FIG. In this case, the ECU determines that the wheels are in contact with the curb or the obstacle when the torque is equal to or greater than a preset threshold value and the steering angle velocity is constant or less for a preset time, reduces the assist current with a certain gradient, So that a minimum assist current is provided.
그런데, 이렇게 바퀴가 연석이나 장애물에 접촉한 이후, 토크와 조향각속도에 의해 어시스트 전류를 감소시키게 되면, 바퀴가 연석이나 장애물에 접촉하고 어시스트 전류를 감소시키기까지 시간(t) 동안 조향 모터에는 필요 이상의 어시스트 전류가 제공된다. 이에 따라, 조향 모터에 과부하가 걸리고, 조향 모터뿐만 아니라 배터리나 관련 전자부품의 내구성을 저하시키게 된다. However, if the assist current is reduced by the torque and the steering angle velocity after the wheels come into contact with the curb or the obstacle, the steering motor will not need more than the necessary time (t) until the wheel contacts the curb or obstacle and reduces the assist current An assist current is provided. As a result, the steering motor is overloaded, and the durability of the steering motor as well as the battery and related electronic parts is lowered.
본 발명의 목적은, 상기와 같은 문제점을 해결하기 위한 것으로, 연석이나 장애물이 바퀴에 접촉하는 것을 예상하여 어시스트 전류를 조절함으로써, 조향 모터, 배터리, 관련 전자부품에 과부하가 걸리는 것을 방지할 수 있는 조향 제어장치 및 그 제어방법을 제공하고자 한다.SUMMARY OF THE INVENTION An object of the present invention is to solve the above-mentioned problems, and it is an object of the present invention to provide a steering control device and a control method thereof, which can prevent an overload from being applied to a steering motor, a battery and related electronic components by controlling an assist current in anticipation of a curb or an obstacle coming into contact with a wheel A steering control device and a control method thereof.
상기 목적은, 차량에 설치되어 상기 차량 주위를 촬영한 영상을 출력하며, 복수의 카메라를 포함하는 촬상장치; 상기 차량 주위의 장애물을 감지하는 장애물 검출부; 상기 장애물 검출부에서 장애물이 감지되면, 상기 영상을 이용하여 바퀴가 상기 장애물에 접촉하기 위해 회동해야 하는 접촉 각도를 산출하는 접촉각 산출부; 및 상기 접촉 각도에 도달하기 소정 각도 전부터 조향 모터에 제공되는 어시스트 전류값을 감소시키는 조향제어부;를 포함하는 조향 제어 장치에 의해 달성될 수 있다. The above-described object is achieved by an image pickup apparatus comprising: an image pickup device provided in a vehicle and outputting an image of the surroundings of the vehicle; An obstacle detection unit for detecting an obstacle around the vehicle; A contact angle calculating unit for calculating a contact angle at which the wheel should be rotated to contact the obstacle by using the image when the obstacle detecting unit detects the obstacle; And a steering control unit for reducing an assist current value provided to the steering motor before a predetermined angle to reach the contact angle.
상기 목적은, 차량 주위를 촬영하여 영상을 출력하는 촬영단계; 상기 차량 주위의 장애물을 감지하는 단계; 상기 차량 주위에 장애물이 감지되면, 상기 영상을 이용하여 바퀴가 상기 장애물에 접촉하기 위해 회동해야 하는 접촉 각도를 산출하는 접촉각 산출단계; 및 상기 접촉 각도에 도달하기 소정 각도 전부터 조향 모터에 제공되는 어시스트 전류값을 감소시키는 전류 제어단계;를 포함하는 조향 제어 방법에 의해 달성될 수 있다.The above object is achieved by an image pickup apparatus comprising: a photographing step of photographing the surroundings of a vehicle and outputting an image; Sensing an obstacle around the vehicle; A contact angle calculation step of calculating, when an obstacle is detected around the vehicle, a contact angle at which the wheel should turn to contact the obstacle using the image; And a current control step of reducing an assist current value provided to the steering motor before a predetermined angle to reach the contact angle.
이상에서 설명한 바와 같은 본 실시예들에 의하면, 차량의 바퀴 주변에 연석을 미리 감지하고, 연석이 바퀴와 접촉한다고 판단되는 경우, 바퀴가 연석에 접촉하기 전에 어시스트 전류를 감소시킴으로써, 조향 모터, 배터리 및 관련 부품에 과도한 부하가 발생하여 수명과 내구성이 저하되는 것을 방지할 수 있다.According to the embodiments as described above, the curb is detected around the wheel of the vehicle in advance, and when the curb is judged to be in contact with the wheel, by reducing the assist current before the wheel contacts the curb, It is possible to prevent the lifetime and the durability from deteriorating due to the occurrence of an excessive load on the parts and related parts.
도 1은 종래의 연석 접촉시 토크와 어시스트 전류 간의 관계를 나타낸 그래프이다.
도 2는 본 발명에 따른 조향 제어 장치의 개략적 구성도이다.
도 3 내지 도 5는 본 발명에 따라 바퀴가 연석에 접촉하는 접촉 각도를 산출하기 위한 모식도이다.
도 6은 본 발명의 조향 제어에 따라 연석 접촉시 토크와 어시스트 전류 간의 관계를 나타낸 그래프이다.
도 7은 본 발명의 조향제어장치에서 연석 감지에 따라 어시스트 전류값을 제어하는 과정을 보인 흐름도이다.FIG. 1 is a graph showing a relationship between a torque and an assist current in a conventional curved contact.
2 is a schematic configuration diagram of a steering control apparatus according to the present invention.
Figs. 3 to 5 are schematic diagrams for calculating a contact angle at which a wheel contacts a curb according to the present invention. Fig.
FIG. 6 is a graph showing the relationship between the torque and the assist current at the time of contact with the tread according to the steering control of the present invention.
7 is a flowchart illustrating a process of controlling the assist current value according to the curb detection in the steering control apparatus of the present invention.
이하, 본 발명의 일부 실시예들을 예시적인 도면을 참조하여 상세하게 설명한다. 각 도면의 구성요소들에 참조부호를 부가함에 있어서, 동일한 구성요소들에 대해서는 비록 다른 도면상에 표시되더라도 가능한 한 동일한 부호를 가질 수 있다. 또한, 본 발명을 설명함에 있어, 관련된 공지 구성 또는 기능에 대한 구체적인 설명이 본 발명의 요지를 흐릴 수 있다고 판단되는 경우에는 그 상세한 설명은 생략할 수 있다.Hereinafter, some embodiments of the present invention will be described in detail with reference to exemplary drawings. In the drawings, like reference numerals are used to denote like elements throughout the drawings, even if they are shown on different drawings. In the following description of the present invention, a detailed description of known functions and configurations incorporated herein will be omitted when it may make the subject matter of the present invention rather unclear.
또한, 본 발명의 구성요소를 설명하는 데 있어서, 제 1, 제 2, A, B, (a), (b) 등의 용어를 사용할 수 있다. 이러한 용어는 그 구성요소를 다른 구성요소와 구별하기 위한 것일 뿐, 그 용어에 의해 해당 구성요소의 본질, 차례, 순서 또는 개수 등이 한정되지 않는다. 어떤 구성요소가 다른 구성요소에 "연결", "결합" 또는 "접속"된다고 기재된 경우, 그 구성요소는 그 다른 구성요소에 직접적으로 연결되거나 또는 접속될 수 있지만, 각 구성요소 사이에 다른 구성요소가 "개재"되거나, 각 구성요소가 다른 구성요소를 통해 "연결", "결합" 또는 "접속"될 수도 있다고 이해되어야 할 것이다.In describing the components of the present invention, terms such as first, second, A, B, (a), and (b) may be used. These terms are intended to distinguish the components from other components, and the terms do not limit the nature, order, order, or number of the components. When a component is described as being "connected", "coupled", or "connected" to another component, the component may be directly connected or connected to the other component, Quot; intervening "or that each component may be" connected, "" coupled, "or " connected" through other components.
도 2는 본 발명에 따른 조향 제어 장치의 개략적 구성도이다. 2 is a schematic configuration diagram of a steering control apparatus according to the present invention.
본 발명에 따른 조향 제어 장치는, 연석의 감지시 바퀴(3)가 연석에 접촉하기 전에 미리 어시스트 전류를 조절하여 부하를 감소시킬 수 있다. The steering control apparatus according to the present invention can reduce the load by controlling the assist current in advance before the
본 조향 제어 장치는, 토크 센서(10), 조향각 센서(20), 촬상장치(30), 장애물 검출부(40), 접촉각 산출부(50), 메모리(70), 조향제어부(60), 구동회로부(80)를 포함할 수 있다. The steering control device includes a
토크 센서(10)는, 스티어링 휠에 연결된 스티어링 컬럼에 설치되며, 스티어링 휠의 좌우 조타시 발생하는 스티어링 컬럼의 토크를 검출하여 토크값을 출력하고, 출력된 토크값은 조향제어부(60)로 제공될 수 있다. 이때, 토크값은 스티어링 휠을 중립 위치로부터 반시계방향으로 조타시키는지, 시계방향으로 조타시키는지에 따라 플러스 또는 마이너스 값을 가질 수 있다. The
조향각 센서(20)는 스티어링 휠의 조향시 스티어링 휠의 회전정도를 나타내는 조향각과, 회전방향을 나타내는 조향방향을 감지하여 조향제어부(60) 로 제공할 수 있다. 이때, 스티어링 휠의 조향방향을 플러스 또는 마이너스로 나타낼 수 있으며, 본 발명에서는 설명의 편의성을 위해 스티어링 휠의 조향방향이 시계방향인 경우를 플러스로 설정하고, 조향방향이 반시계방향인 경우를 마이너스로 설정하도록 한다. 이에 따라, 조향각 센서(20)에서 감지된 조향각은 시계방향으로 조타하는 경우에는 플러스 각도값을 갖고, 반시계방향으로 조타하는 경우에는 마이너스 각도값을 갖게 된다.The
촬상장치(30)는, 복수의 카메라(31)와, 카메라(31)에서 촬영된 영상을 처리하는 영상처리부(33)를 포함할 수 있다. 복수의 카메라(31)는 차량(1)의 둘레를 따라 소정 간격을 두고 장착되며, 본 실시예에서는 차량(1)의 바퀴(3) 상부로부터 하부 바닥면을 향하도록 배치되어 도 3에 도시된 바와 같이, 차량(1)의 바퀴(3)와 차량(1) 주변의 물체를 촬영할 수 있다. 영상처리부(33)는 복수의 카메라(31)에서 촬영된 영상을 하나의 영상으로 통합하고, 통합된 영상을 흑백 처리 및/또는 이진화 처리할 수 있다. The
장애물 검출부(40)는, 영상처리부(33)에서 처리된 영상에서 차량(1) 주변을 관심영역(ROI: Region of Interest)로 설정하고, 관심영역에서 연석 등의 장애물을 판단할 수 있다. 일반적으로 연석은 일측으로 길게 형성되어 있고, 바닥면과의 단차, 색상, 재질의 상이함에 따라 바닥면과 상이한 조도를 갖게 된다. 이에 따라, 장애물 검출부(40)는 관심영역에서 조도 차이를 이용하여 연석을 판단할 수 있다. 한편, 장애물 검출부(40)는 이진화 처리된 영상에서 엣지를 검출하고, 관심영역 내에서 검출된 엣지를 이용하여 연석 등의 장애물을 검출할 수도 있다. The
장애물 검출부(40)는 초음파 센서, 레이저 센서, 레이더 센서 등을 포함하여 구성할 수도 있다. 이러한 센서들에서 장애물이 감지되면, 장애물 검출부(40)는 카메라(31)에서 촬영된 영상과 비교하여 장애물의 위치와 연석 인지 여부 등을 판단할 수 있다. The
장애물 검출부(40)에서는 다양한 방법으로 연석 등의 장애물을 검출할 수 있으며, 본 발명은 장애물 검출부(40)에서 사용하는 특정 장애물 판단 방법에 한정되지 아니한다. The
접촉각 산출부(50)에서는 장애물 검출부(40)에서 연석 등의 장애물이 검출되면, 접촉각 산출부(50)에서는 바퀴(3)가 연석 등의 장애물에 접촉하기 위한 바퀴(3)의 접촉 각도(α)를 산출할 수 있다. In the contact
도 3에 도시된 바와 같이, 접촉각 산출부(50)에서는 바퀴(3)의 중심과 연석과의 거리(a)를 측정하고, 바퀴(3)가 회전했을 때 연석과 바퀴(3)가 만나는 접촉점(P2)을 파악할 수 있다. 이때, 바퀴(3)의 중심과 연석과의 거리(a)는 차체 또는 바퀴(3)의 크기를 이미 아는 상태이므로, 차체 또는 바퀴(3)의 크기와 비교하면 바퀴(3)의 중심과 연석과의 직선 거리(a)를 산출할 수 있다. 여기서, 바퀴(3)의 중심과 연석을 잇는 직선이 연석에 만나는 점을 접점(P1)이라 한다. 3, the contact
연석과 바퀴(3)가 만나는 접촉점(P2)의 경우, 바퀴(3)의 반경에 따라 회전궤도가 정해지므로, 바퀴(3)의 중심과 연석과의 거리(a)와 이미 알고 있는 바퀴(3)의 회전궤도를 이용하면, 접촉점(P2)을 파악할 수 있다. 여기서, 바퀴(3)의 중심과 접촉점(P2) 간의 거리(c)는 바퀴(3)의 반경이 된다. The distance a between the center of the
그런 다음, 접촉각 산출부(50)는, 접점(P1)과 접촉점(P2) 간의 거리(b)를 산출할 수 있다. 접점(P1)과 접촉점(P2) 간의 거리(b)와, 바퀴(3)의 중심에서 연석까지의 거리(a)를 이용하여 바퀴(3)가 연석에 접촉하기 위한 바퀴(3)의 접촉 각도(α)를 산출할 수 있다. Then, the contact
한편, 도 4에 도시된 바와 같이, 차량(1)이 연석에 대해 비스듬하게 위치한 경우, 접촉각 산출부(50)는 바퀴(3)의 중심에서 연석까지의 거리(a)를 산출하고, 연석과 바퀴(3)가 만나는 접촉점(P2)을 파악한 다음, 바퀴(3)와 접촉점(P2) 간의 직선 거리(d)를 산출한다. 그리고 접촉점(P2)과 접점(P1) 간의 거리(b)를 산출한다. 그런 다음, 이 세 거리를 이용하여 바퀴(3)의 접촉 각도(α)를 산출할 수 있다. 4, when the
한편, 도 5에 도시된 바와 같이, 바퀴(3)가 차량(1)과 연석에 대해 비스듬하게 위치한 경우, 접촉각 산출부(50)는 바퀴(3)의 중심에서 연석까지의 거리(a)를 산출하고, 연석과 바퀴(3)가 만나는 접촉점(P2)을 파악한 다음, 바퀴(3)와 접촉점(P2) 간의 직선 거리(d)를 산출한다. 그리고 접촉점(P2)과 접점(P1) 간의 거리(b)를 산출한다. 그런 다음, 이 세 거리를 이용하여 바퀴(3)의 접촉 각도(α)를 산출할 수 있다. 5, when the
메모리(70)에는 차량(1)의 바퀴(3)의 직경과, 바퀴(3)의 회전궤도에 대한 정보가 저장되어 있다. 또한 메모리(70)에는 토크 센서(10)에서 입력되는 토크와 접촉 각도(α)에 따라, 조향 모터에 제공되는 어시스트 전류값을 산출하기 위한 알고리즘이 저장되어 있다. The
조향제어부(60)는, 접촉각 산출부(50)에서 산출된 접촉 각도(α)에 따라 메모리(70)에 저장된 알고리즘을 이용하여 조향 모터로 인가되는 어시스트 전류값을 산출할 수 있다. 이때, 조향제어부(60)는, 도 6에 도시된 바와 같이, 스티어링 휠이 접촉 각도(α)에 도달하기 이전의 소정 각도까지는 토크에 따라 일반적인 어시스트 전류값을 출력하지만, 스티어링 휠이 소정 각도에 도달하면, 어시스트 전류값을 미리 설정된 기울기를 따라 감소시키게 된다. The
이때, 소정 각도는 설계자에 의해 다양하게 선택될 수 있으며, 미리 선택된 일정 각도가 될 수도 있고, 산출된 접촉 각도(α)에 대해 일정 비율의 각도가 될 수도 있다. 예를 들어, 소정 각도가 5도로 설정된 경우, 접촉 각도(α)가 30도이면, 조향제어부(60)는 스티어링 휠의 조향각이 25도가 되면 어시스트 전류값을 미리 설정된 기울기를 따라 감소시키게 된다. 다른 예로서, 소정 각도가 접촉 각도(α)의 10%로 설정된 경우, 접촉 각도(α)가 30도이면, 조향제어부(60)는 스티어링 휠의 조향각이 27도가 되면 어시스트 전류값을 미리 설정된 기울기를 따라 감소시키게 된다. At this time, the predetermined angle may be variously selected by the designer, may be a predetermined angle selected, or may be an angle of a certain ratio with respect to the calculated contact angle [alpha]. For example, when the predetermined angle is set to 5 degrees, if the contact angle? Is 30 degrees, the
한편, 조향제어부(60)는 접촉 각도(α)가 스티어링 휠의 최대 조향각을 초과하는 경우, 스티어링 휠의 최대 조향각을 기준으로 어시스트 전류값을 산출할 수 있다. 즉, 접촉 각도(α)가 스티어링 휠의 최대 조향각을 초과하게 되면, 바퀴(3)가 연석에 닿기 전에 스티어링 휠의 조향이 정지하게 되므로, 조향제어부(60)는 스티어링 휠을 어시스트 전류값을 급격히 감소시킬 필요가 없다. On the other hand, the
구동회로부(80)는, 조향제어부(60)로부터 선택된 어시스트 전류값에 따른 제어신호를 입력받아 조향 모터에 제공되는 전류를 제어한다.The driving
이러한 구성에 의한 조향 제어장치에서 연석 감지에 따라 어시스트 전류값을 제어하는 과정을 도 7을 참조하여 설명하면 다음과 같다. A process of controlling the assist current value according to the curb detection in the steering control apparatus having such a configuration will now be described with reference to FIG.
차량(1)의 운행 중 또는 주차 중에 복수의 카메라(31)에서는 차량(1)의 둘레를 촬영하고(S700), 촬영된 복수의 영상은 영상처리부(33)에서 통합되어 흑백처리 및/또는 이진화 처리 되어 장애물 검출부(40)로 전달될 수 있다(S710). A plurality of
장애물 검출부(40)에서는 센서 또는 영상을 이용하여 연석 등의 장애물을 검출할 수 있다(S720). 연석 등의 장애물이 감지되면, 접촉각 산출부(50)는 도 3 내지 도 5에 개시된 방법을 이용하여 바퀴(3)가 연석에 접촉하기 위한 접촉 각도(α)를 산출할 수 있다(S730). The
조향제어부(60)에서는 접촉 각도(α)에 대한 정보를 제공받는다. 접촉 각도(α)가 스티어링 휠의 최대 조향각보다 작은 경우(S740), 조향제어부(60)는 미리 설정된 소정 각도까지는 토크와 조향각에 기초하여 어시스트 전류값을 산출하고(S750-N, S755), 소정 각도 이상에서는 미리 설정된 기울기에 따라 어시스트 전류값을 감소시키도록 한다(S750-Y, S760). The
한편, 접촉 각도(α)가 스티어링 휠의 최대 조향각보다 큰 경우, 조향 제어부는 조향각, 토크, 조향각속도 등에 기초하여 어시스트 전류값을 산출할 수 있다(S745). On the other hand, if the contact angle? Is larger than the maximum steering angle of the steering wheel, the steering control unit may calculate the assist current value based on the steering angle, the torque, the steering angle speed, and the like (S745).
이렇게 조향제어부(60)에서 산출된 어시스트 전류값은 제어신호로 구동회로부(80)로 전달되고, 구동회로부(80)에서는 조향제어부(60)에서 산출된 어시스트 전류값에 대응되는 어시스트 전류를 조향 모터로 제공할 수 있다(S770). The assist current value calculated by the
이와 같이, 본 발명에서는 차량(1)의 바퀴(3) 주변에 연석을 미리 감지하고, 연석이 바퀴(3)와 접촉한다고 판단되는 경우, 바퀴(3)가 연석에 접촉하기 전에 어시스트 전류를 감소시킴으로써, 조향 모터, 배터리 및 관련 부품에 과도한 부하가 발생하여 수명과 내구성이 저하되는 것을 방지할 수 있다. As described above, in the present invention, the curb is detected beforehand around the
상술한 실시예에 설명된 특징, 구조, 효과 등은 본 발명의 적어도 하나의 실시예에 포함되며, 반드시 하나의 실시예에만 한정되는 것은 아니다. 나아가, 각 실시예에서 예시된 특징, 구조, 효과 등은 실시예들이 속하는 분야의 통상의 지식을 가지는 자에 의하여 다른 실시예들에 대해서도 조합 또는 변형되어 실시 가능하다. 따라서 이러한 조합과 변형에 관계된 내용들은 본 발명의 범위에 포함되는 것으로 해석되어야 할 것이다. The features, structures, effects and the like described in the foregoing embodiments are included in at least one embodiment of the present invention and are not necessarily limited to one embodiment. Further, the features, structures, effects, and the like illustrated in the embodiments may be combined or modified in other embodiments by those skilled in the art to which the embodiments belong. Therefore, it should be understood that the present invention is not limited to these combinations and modifications.
또한, 이상에서 실시예들을 중심으로 설명하였으나 이는 단지 예시일 뿐 본 발명을 한정하는 것이 아니며, 본 발명이 속하는 분야의 통상의 지식을 가진 자라면 본 실시예의 본질적인 특성을 벗어나지 않는 범위에서 이상에 예시되지 않은 여러 가지의 변형과 응용이 가능함을 알 수 있을 것이다. 예를 들어, 실시예들에 구체적으로 나타난 각 구성 요소는 변형하여 실시할 수 있는 것이다. 그리고 이러한 변형과 응용에 관계된 차이점들은 첨부한 청구 범위에서 규정하는 본 발명의 범위에 포함되는 것으로 해석되어야 할 것이다.While the present invention has been particularly shown and described with reference to exemplary embodiments thereof, it is clearly understood that the same is by way of illustration and example only and is not to be construed as limiting the scope of the present invention. It can be seen that various modifications and applications are possible. For example, each component specifically shown in the embodiments may be modified and implemented. It is to be understood that the present invention may be embodied in many other specific forms without departing from the spirit or essential characteristics thereof.
1 : 차량 3 : 바퀴
30 : 촬상장치 31 : 카메라
40 : 장애물 검출부 50 : 접촉각 산출부
60 : 조향제어부1: vehicle 3: wheels
30: Image pickup device 31: Camera
40: an obstacle detecting unit 50: a contact angle calculating unit
60:
Claims (12)
상기 차량 주위의 장애물을 감지하는 장애물 검출부;
상기 장애물 검출부에서 장애물이 감지되면, 상기 영상을 이용하여 바퀴가 상기 장애물에 접촉하기 위해 회동해야 하는 접촉 각도를 산출하는 접촉각 산출부; 및
상기 접촉 각도에 도달하기 소정 각도 전부터 조향 모터에 제공되는 어시스트 전류값을 감소시키는 조향제어부를 포함하고,
상기 접촉각 산출부는, 상기 바퀴의 축에서 상기 장애물까지의 직선 거리와, 상기 바퀴의 회동시 상기 바퀴가 상기 장애물에 접촉하는 접촉점과 상기 바퀴의 축에서 상기 장애물을 잇는 직선이 상기 장애물에 만나는 접점 간의 거리를 이용하여 상기 접촉 각도를 산출하는 조향 제어장치. An image pickup apparatus, comprising: a plurality of cameras; an image pickup device mounted on the vehicle and outputting an image of the surroundings of the vehicle;
An obstacle detection unit for detecting an obstacle around the vehicle;
A contact angle calculating unit for calculating a contact angle at which the wheel should be rotated to contact the obstacle by using the image when the obstacle detecting unit detects the obstacle; And
And a steering control section for reducing an assist current value provided to the steering motor before a predetermined angle to reach the contact angle,
The contact angle calculating unit calculates the contact angle between the contact point at which the wheel contacts the obstacle at the time of turning the wheel and the contact point at which the straight line connecting the obstacle at the axis of the wheel contacts the obstacle, And calculates the contact angle using a distance.
상기 접촉각 산출부는, 상기 바퀴의 회동시 상기 바퀴가 상기 장애물에 접촉하는 접촉점에서 상기 바퀴를 잇는 직선 거리를 추가로 이용하여 상기 접촉 각도를 산출하는 조향 제어장치. The method according to claim 1,
Wherein the contact angle calculating section calculates the contact angle by further using a straight line connecting the wheel at a contact point at which the wheel contacts the obstacle when the wheel rotates.
상기 조향제어부는 상기 접촉 각도의 일정 비율을 소정 각도로 설정하고, 상기 소정 각도에 도달하면 미리 설정된 일정 기울기를 따라 상기 어시스트 전류를 감소시키는 조향 제어장치. The method according to claim 1,
Wherein the steering control unit sets a certain ratio of the contact angle to a predetermined angle and decreases the assist current along a preset predetermined slope when the predetermined angle is reached.
상기 조향제어부는 상기 소정 각도를 일정 각도로 설정하고, 상기 소정 각도에 도달하면 미리 설정된 일정 기울기를 따라 상기 어시스트 전류를 감소시키는 조향 제어장치. The method according to claim 1,
Wherein the steering control unit sets the predetermined angle to a predetermined angle and decreases the assist current according to a predetermined slope when the predetermined angle is reached.
상기 조향제어부는 상기 접촉 각도가 스티어링 휠의 최대 조향각보다 큰 경우, 상기 조향각에 따라 상기 조향 모터에 제공되는 어시스트 전류값을 산출하는 조향 제어장치. The method according to claim 1,
Wherein the steering control unit calculates the assist current value provided to the steering motor according to the steering angle when the contact angle is larger than the maximum steering angle of the steering wheel.
상기 차량 주위의 장애물을 감지하는 단계;
상기 차량 주위에 장애물이 감지되면, 상기 영상을 이용하여 바퀴가 상기 장애물에 접촉하기 위해 회동해야 하는 접촉 각도를 산출하는 접촉각 산출단계; 및
상기 접촉 각도에 도달하기 소정 각도 전부터 조향 모터에 제공되는 어시스트 전류값을 감소시키는 전류 제어단계를 포함하고,
상기 접촉각 산출단계는, 상기 바퀴의 축에서 상기 장애물까지의 직선 거리와, 상기 바퀴의 회동시 상기 바퀴가 상기 장애물에 접촉하는 접촉점과 상기 바퀴의 축에서 상기 장애물을 잇는 직선이 상기 장애물에 만나는 접점 간의 거리를 이용하여 상기 접촉 각도를 산출하는 단계를 포함하는 조향 제어방법. A photographing step of photographing the surroundings of the vehicle and outputting an image;
Sensing an obstacle around the vehicle;
A contact angle calculation step of calculating, when an obstacle is detected around the vehicle, a contact angle at which the wheel should turn to contact the obstacle using the image; And
And a current control step of reducing an assist current value provided to the steering motor before a predetermined angle to reach the contact angle,
The contact angle calculating step may include calculating a contact distance between the contact point at which the wheel contacts the obstacle at the time of the rotation of the wheel and a straight line connecting the obstacle at the axis of the wheel at a contact point And calculating the contact angle using a distance between the steering angle and the steering angle.
상기 접촉각 산출단계는, 상기 바퀴의 회동시 상기 바퀴가 상기 장애물에 접촉하는 접촉점에서 상기 바퀴를 잇는 직선 거리를 추가로 이용하여 상기 접촉 각도를 산출하는 단계를 포함하는 조향 제어방법. 8. The method of claim 7,
Wherein the contact angle calculating step includes calculating the contact angle by further using a straight line connecting the wheel at a contact point at which the wheel contacts the obstacle when the wheel rotates.
상기 전류 제어단계는 상기 접촉 각도의 일정 비율을 소정 각도로 설정하고, 상기 소정 각도에 도달하면 미리 설정된 일정 기울기를 따라 상기 어시스트 전류를 감소시키는 단계를 포함하는 조향 제어방법. 8. The method of claim 7,
Wherein the current control step includes setting a certain ratio of the contact angle to a predetermined angle and decreasing the assist current along a predetermined constant slope when the predetermined angle is reached.
상기 전류 제어단계는 일정 각도로 상기 소정 각도를 설정하고, 상기 소정 각도에 도달하면 미리 설정된 일정 기울기를 따라 상기 어시스트 전류를 감소시키는 단계를 포함하는 조향 제어방법. 8. The method of claim 7,
Wherein the current control step includes setting the predetermined angle at an angle and decreasing the assist current according to a predetermined constant slope when the predetermined angle is reached.
상기 전류 제어단계는 상기 접촉 각도가 스티어링 휠의 최대 조향각보다 큰 경우, 상기 조향각에 따라 상기 조향 모터에 제공되는 어시스트 전류값을 산출하는 단계를 포함하는 조향 제어방법.8. The method of claim 7,
Wherein the current control step includes calculating an assist current value provided to the steering motor according to the steering angle when the contact angle is larger than the maximum steering angle of the steering wheel.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020170080386A KR102004344B1 (en) | 2017-06-26 | 2017-06-26 | Steering control device and method thereof |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020170080386A KR102004344B1 (en) | 2017-06-26 | 2017-06-26 | Steering control device and method thereof |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20190001043A KR20190001043A (en) | 2019-01-04 |
KR102004344B1 true KR102004344B1 (en) | 2019-07-29 |
Family
ID=65018095
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020170080386A KR102004344B1 (en) | 2017-06-26 | 2017-06-26 | Steering control device and method thereof |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102004344B1 (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7445387B2 (en) * | 2019-02-27 | 2024-03-07 | 株式会社ジェイテクト | Steering control device |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006111099A (en) * | 2004-10-13 | 2006-04-27 | Nissan Motor Co Ltd | Steering control device for vehicle |
JP2010241320A (en) * | 2009-04-08 | 2010-10-28 | Toyota Motor Corp | Vehicular steering device |
JP5168362B2 (en) * | 2009-01-22 | 2013-03-21 | トヨタ自動車株式会社 | Electric power steering device |
JP2013091462A (en) * | 2011-10-27 | 2013-05-16 | Suzuki Motor Corp | Driving assist device |
-
2017
- 2017-06-26 KR KR1020170080386A patent/KR102004344B1/en active IP Right Grant
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006111099A (en) * | 2004-10-13 | 2006-04-27 | Nissan Motor Co Ltd | Steering control device for vehicle |
JP5168362B2 (en) * | 2009-01-22 | 2013-03-21 | トヨタ自動車株式会社 | Electric power steering device |
JP2010241320A (en) * | 2009-04-08 | 2010-10-28 | Toyota Motor Corp | Vehicular steering device |
JP2013091462A (en) * | 2011-10-27 | 2013-05-16 | Suzuki Motor Corp | Driving assist device |
Also Published As
Publication number | Publication date |
---|---|
KR20190001043A (en) | 2019-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10899385B2 (en) | Vehicle and trailer backup guidance system | |
US20190291732A1 (en) | Vehicular lane keeping system | |
US11001271B2 (en) | Drive assistance device | |
US9592852B2 (en) | Parking assist system and parking assist method | |
JP5747482B2 (en) | Vehicle environment recognition device | |
US20180023951A1 (en) | Apparatus and method for determining wheel alignment change of vehicle | |
KR20170058718A (en) | Smart parking assist system and method | |
US11560174B2 (en) | Automatic steering control device | |
US11117616B2 (en) | Lane maintaining assistance device and lane maintaining assistance method | |
US20220363250A1 (en) | Vehicular driving assistance system with lateral motion control | |
US11718294B2 (en) | Lane departure prevention control apparatus for vehicle | |
CN109562784B (en) | Assist force control device and assist force control method | |
KR20220090651A (en) | Apparatus for controlling autonomous, system having the same, and method thereof | |
KR102004344B1 (en) | Steering control device and method thereof | |
JP5136315B2 (en) | Driving assistance device | |
KR20150128066A (en) | Lane keeping asssit system and control method thereof | |
US11591021B2 (en) | Method for preparing and/or performing a steering intervention that assists the driver of a vehicle | |
US11794536B2 (en) | Vehicle control system and vehicle control method for determining chance of collision | |
KR20220085198A (en) | Apparatus and method for detecting blockage of radar sensor and, radar apparatus | |
US11173901B2 (en) | Vehicle control apparatus | |
KR102299490B1 (en) | Apparatus and method for controlling lane keeping | |
KR101523824B1 (en) | Apparatus and method for smart parking assist recognizing parking lot | |
JP2005190375A (en) | White line detector | |
JP2023039777A (en) | Obstacle detection device, obstacle detection method and obstacle detection program | |
US10752259B2 (en) | Back warning apparatus, and method and control system therefor |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A201 | Request for examination | ||
E902 | Notification of reason for refusal | ||
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant |