KR101639815B1 - Detecting method of bank-road - Google Patents

Detecting method of bank-road Download PDF

Info

Publication number
KR101639815B1
KR101639815B1 KR1020100007831A KR20100007831A KR101639815B1 KR 101639815 B1 KR101639815 B1 KR 101639815B1 KR 1020100007831 A KR1020100007831 A KR 1020100007831A KR 20100007831 A KR20100007831 A KR 20100007831A KR 101639815 B1 KR101639815 B1 KR 101639815B1
Authority
KR
South Korea
Prior art keywords
yaw rate
gradient angle
vehicle
filtering
estimated
Prior art date
Application number
KR1020100007831A
Other languages
Korean (ko)
Other versions
KR20110088095A (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 KR1020100007831A priority Critical patent/KR101639815B1/en
Publication of KR20110088095A publication Critical patent/KR20110088095A/en
Application granted granted Critical
Publication of KR101639815B1 publication Critical patent/KR101639815B1/en

Links

Images

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
    • B60W40/00Estimation 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/02Estimation 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
    • B60W40/06Road conditions
    • 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
    • B60W40/00Estimation 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/02Estimation 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
    • B60W40/06Road conditions
    • B60W40/072Curvature of the road
    • 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
    • B60W40/00Estimation 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/10Estimation 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 vehicle motion
    • 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
    • B60W40/00Estimation 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/10Estimation 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 vehicle motion
    • B60W40/114Yaw movement
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D61/00Motor vehicles or trailers, characterised by the arrangement or number of wheels, not otherwise provided for, e.g. four wheels in diamond pattern
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P15/00Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T2210/00Detection or estimation of road or environment conditions; Detection or estimation of road shapes
    • B60T2210/20Road shapes
    • B60T2210/22Banked curves
    • 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
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W2050/0001Details of the control system
    • B60W2050/0043Signal treatments, identification of variables or parameters, parameter estimation or state estimation
    • B60W2050/0052Filtering, filters
    • 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/30Road curve radius

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Mathematical Physics (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • General Physics & Mathematics (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

본 발명은 뱅크 로드 검출 방법에 관한 것으로, 요레이트 센서에서 측정된 값을 통해 추정된 제1요레이트와 횡가속도센서에서 측정된 값을 통해 추정된 제2요레이트와 조향 각을 통해 추정된 제3요레이트를 비교하여, 저 마찰 노면을 주행하는지 뱅크 로드를 주행하는지 여부를 판단할 수 있다. The present invention relates to a bank load detecting method, and more particularly, to a method and apparatus for detecting a bank load, which includes a first yaw rate estimated through a value measured by a yaw rate sensor, a second yaw rate estimated through a value measured by a lateral acceleration sensor, It is possible to judge whether or not the low friction road surface is running or the bank road is running.

Description

뱅크 로드 검출 방법{DETECTING METHOD OF BANK-ROAD}DETECTING METHOD OF BANK-ROAD [0002]

본 발명은 뱅크 로드 검출 방법에 관한 것으로서, 보다 자세하게는 추정된 복수의 요레이트 값을 비교하여, 차량이 뱅크 로드를 주행하는지 여부를 판단할 수 있는 뱅크 로드 검출 방법에 관한 것이다.BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a bank load detecting method, and more particularly, to a bank load detecting method capable of comparing a plurality of estimated yaw rate values to determine whether or not a vehicle runs on a bank load.

일반적으로, 차량의 안정성 제어 시스템(Electronic Stability Program ; 이하 ESP라 칭함)은 차량의 주행안정성을 확보 하기위한 시스템으로서 차량이 원하는 주행코스보다 바깥쪽으로 밀려나가는 언더스티어나 차량의 원하지 않는 선회속도 증가로 인하여 선회반경이 급격히 줄어들면서 차량안정성을 잃어버리는 오버스티어시 제동력 및 구동력을 제어함으로서 원하지 않는 차량 선회모멘트를 보상하여 차량을 원하는 선회궤적으로 유지시킨다.2. Description of the Related Art Generally, an electronic stability program (hereinafter referred to as ESP) of a vehicle is a system for securing stability of a vehicle as an understeer which is pushed outward beyond a desired traveling course or an undesired turning speed of the vehicle By controlling the braking force and the driving force at oversteering which causes the vehicle stability to be lost due to the sudden decrease of the turning radius, it compensates the undesired vehicle turning moment and maintains the vehicle as a desired turning trajectory.

이러한 차량 안정성 제어시스템은 차량이 차량 성능 시험 등에 사용되는 뱅크 로드(bank road)와 같이 차량의 횡방향으로 급경사를 이루는 노면을 주행하게 되면 차량은 적은 조향각만으로 기울어진 노면을 주행하게 됨으로써 운전자가 원하는 선회속도량은 적게 계산되어지나, 차량에서 측정되는 차량 선회속도량은 크게 발생하므로 이러한 선회속도량의 차이에 따라 차량 상태를 오버스티어인 상태로 오판함으로써 부적절한 선회 모멘트 제어를 수행하여 오히려 차량의 선회 안정성을 해치는 문제점이 있다.Such a vehicle stability control system allows a vehicle to travel on a sloping road surface with only a small steering angle when the vehicle runs on a steep road surface in a lateral direction of the vehicle, such as a bank road used for vehicle performance test, The turning speed is small but the vehicle turning speed measured by the vehicle is large. Therefore, the turning state of the vehicle is incorrectly controlled by mistaking the vehicle state as the oversteer state according to the difference of the turning speed, There is a problem that stability is impaired.

또한, 이를 방지하기 위해서 차량의 속도와 횡가속도 센서를 통해 측정된 횡가속도 값을 통해서 횡방향 기울어짐 각도를 산출하고 산출된 노면의 횡방향 기울어짐 각도 크기에 기초하여 오버스티어 제어를 변경할 수는 있으나, 이는 뱅크 로드와 노면이 저 마찰 노면인 경우를 구별할 수는 없는 문제점이 있다. In order to prevent this, it is also possible to calculate the lateral inclination angle through the vehicle speed and the lateral acceleration value measured through the lateral acceleration sensor, and to change the oversteer control based on the calculated lateral inclination angle magnitude of the road surface However, there is a problem that the bank road and the road surface can not be distinguished from the low friction road surface.

본 발명은 상술한 종래의 문제점을 극복하기 위한 것으로서, 본 발명의 목적은 차량의 각각의 센서들로부터 추정된 복수의 요레이트 값들을 통해서 차량이 뱅크 로드를 주행하는지 여부를 판단하여 ESP시스템의 신뢰성을 향상 시킬 수 있는 뱅크 로드 검출 방법을 제공하는데 있다.SUMMARY OF THE INVENTION It is an object of the present invention to provide a method and system for determining the reliability of an ESP system by determining whether or not a vehicle is traveling on a bank load through a plurality of estimated yaw rate values from respective sensors of a vehicle, And a method for detecting a bank load.

상기한 목적을 달성하기 위해 본 발명에 의한 뱅크 로드 검출 방법은 차량의 요레이트 센서에서 측정된 값을 통해 산출된 제1요레이트에서, 차량의 횡 가속도 센서에서 측정된 값을 통해 산출된 제2요레이트를 빼서 구배각을 추정하는 구배각 추정 단계와, 상기 구배각 추정 단계에서 추정된 추정 구배각이 제1기준 값 이상인지 여부를 확인하는 구배각 비교 단계와, 상기 추정 구배각이 상기 제1기준 값 이상이면, 상기 제1요레이트의 절대값(|Yaw1|)이 차량의 조향 각을 통해 산출된 제3요레이트의 절대값(|Yaw3|)보다 크고, 상기 제3요레이트의 절대값이 상기 제2요레이트의 절대값(|Yaw2|) 보다 큰 |Yaw1|>|Yaw3|>|Yaw2|를 만족하는지 확인하는 요레이트 비교 단계와, 상기 제3요레이트가 상기 제2요레이트보다 크고, 상기 제3요레이트 보다 상기 제1요레이트가 커서 |Yaw1|>|Yaw3|>|Yaw2|를 만족하면, 제1게인을 상기 추정 구배각에 곱해서 추정 구배각을 필터링한 필터링 구배각을 산출하는 필터링 단계와, 상기 필터링 구배각이 제2기준 값 이상인지 여부를 확인하고, 상기 제2기준 값보다 상기 필터링 구배각이 더 크면, 차량이 주행하는 주행로는 구배각이 존재하는 뱅크 로드인 것으로 판단하는 뱅크 로드 주행 판단 단계를 포함할 수 있다.In order to achieve the above-mentioned object, a bank load detecting method according to the present invention is a method for detecting a bank load of a vehicle, comprising the steps of: detecting, at a first yaw rate calculated from a yaw rate sensor of a vehicle, A gradient angle estimating step of estimating a gradient angle by subtracting the yaw rate from the yaw rate and estimating a gradient angle; and a gradient angle comparing step of determining whether the estimated gradient angle estimated in the gradient angle estimating step is equal to or greater than a first reference value, Wherein the absolute value of the first yaw rate is greater than the absolute value of the third yaw rate | Yaw3 | calculated through the steering angle of the vehicle, and the absolute value of the third yaw rate is greater than the absolute value of the third yaw rate Yaw2 |> | Yaw3 |> | Yaw2 |, which is greater than an absolute value (| Yaw2 |) of the second yaw rate, when the third yaw rate is greater than the second yaw rate And the first yaw rate is larger than the third yaw rate, a filtering step of calculating a filtering gradient angle obtained by filtering an estimated gradient angle by multiplying a first gain by the estimated gradient angle when aw1 |> | Yaw3 |> | Yaw2 | And if the filtering gradient angle is larger than the second reference value, it is determined that the running road on which the vehicle travels is a bank load having a gradient angle.

상기 필터링 단계에서는 상기 요레이트 비교 단계에서, |Yaw1|>|Yaw3|>|Yaw2|를 만족하지 못하면, 상기 제1게인보다 더 작은 값인 제2게인을 상기 추정 구배각에 곱해서 필터링한 필터링 구배각을 산출할 수 있다.In the filtering step, if the yaw rate comparison step does not satisfy | Yaw1 |> | Yaw3 |> | Yaw2 |, the filtered gradient angle obtained by multiplying the estimated gradient angle by the second gain, which is a value smaller than the first gain, Can be calculated.

상기 필터링 단계에서는 상기 구배각 비교 단계에서 상기 추정 구배각이 상기 제1기준 값 미만이면, 상기 제2게인보다 작은 값인 제3게인을 상기 추정 구배각에 곱해서 필터링한 필터링 구배각을 산출할 수 있다.In the filtering step, if the estimated gradient angle is less than the first reference value in the gradient angle comparing step, a filtering gradient angle obtained by filtering the third gradient, which is smaller than the second gain, by the estimated gradient angle may be calculated .

상기 구배각 판단 단계에서 상기 필터링 구배각이 상기 제2기준 값 미만이면, 차량이 뱅크 로드를 주행하는 것이 아닌 것으로 판단할 수 있다.If the filtering gradient angle is less than the second reference value in the gradient angle determination step, it can be determined that the vehicle is not traveling on the bank road.

본 발명에 의한 뱅크 로드 검출 방법은 차량의 각각의 센서들로부터 추정된 복수의 요레이트 값들을 통해서 차량이 뱅크 로드를 주행하는지 여부를 판단하여 ESP시스템의 신뢰성을 향상 시킬 수 있게 된다.The bank load detecting method according to the present invention can improve the reliability of the ESP system by determining whether the vehicle is traveling through the bank load through a plurality of estimated yaw rate values from respective sensors of the vehicle.

도 1은 본 발명의 일실시예에 따른 뱅크 로드 검출 방법을 도시한 순서도이다. 1 is a flowchart illustrating a bank load detection method according to an embodiment of the present invention.

본 발명이 속하는 기술 분야에서 통상의 지식을 가진 자가 본 발명을 용이하게 실시할 수 있을 정도로 본 발명의 바람직한 실시예를 첨부된 도면을 참조하여 상세하게 설명하면 다음과 같다.DETAILED DESCRIPTION OF EXEMPLARY EMBODIMENTS Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the accompanying drawings, so that those skilled in the art can easily carry out the present invention.

도 1을 참조하면, 본 발명의 일실시예에 따른 뱅크 로드 검출 방법이 도시되어 있다.Referring to FIG. 1, a method of detecting a bank load according to an embodiment of the present invention is illustrated.

우선 뱅크 로드 검출 방법은 차량의 요레이트 센서(Yaw rate sensor)에서 측정된 요레이트 값을 통해서 제1요레이트(Yaw1)를 산출하고, 차량의 횡방향 가속도 센서에서 측정된 횡가속도값을 통해서 제2요레이트(Yaw2)를 산출한다. 그리고 제1요레이트(Yaw1)에서 제2요레이트(Yaw2)를 빼서 차량이 주행하는 노면이 뱅크 로드(bank road)인지 여부를 추정하기 위해서 추정 구배각(Bc)을 산출(S1)한다. 여기서 뱅크 로드는 차량이 주행하는 노면에 횡경사가 존재하는 곡선 도로로, 구배각이 존재하는 방향으로 회전해야하는 도로를 의미합니다. First, the bank load detection method calculates a first yaw rate (Yaw1) based on a yaw rate value measured at a yaw rate sensor of a vehicle, calculates a first yaw rate (Yaw1) based on a lateral acceleration value measured by a vehicle lateral acceleration sensor 2 Yaw rate (Yaw2) is calculated. The estimated gradient angle Bc is calculated S1 by subtracting the second yaw rate Yaw2 from the first yaw rate Yaw1 to estimate whether the road surface on which the vehicle travels is a bank road. Here, a bank road is a curved road on which the road on which the vehicle is traveling has biaxial sideways, and means a road that must be rotated in the direction in which the draft angle exists.

이러한 추정 구배각(Bc)의 산출은 차량의 주행 안전성을 확보하기 위한 차량 안정화 시스템(Electronic Stability Program, 이하 ESP)의 제어기에서 산출한다.The calculation of the estimated gradient angle (Bc) is performed by a controller of an electronic stability program (ESP) for securing the driving safety of the vehicle.

우선, 제1요레이트는 차량에서 발생되는 요레이트값으로 수학식1을 통해서 산출한다.First, the first yaw rate is calculated from the equation (1) as the yaw rate value generated in the vehicle.

Figure 112010005968542-pat00001
Figure 112010005968542-pat00001

여기서, Yaw1은 제1요레이트고, ψ는 요레이트 센서에서 측정된 요레이트 값이고, Yos는 요레이트 오프셋 값이다. Here, Yaw1 is the first yaw rate, ψ is the yaw rate measured by the yaw rate sensor, and Yos is the yaw rate offset value.

그리고 제2요레이트(Yaw2)는 차량에서 발생되는 횡가속도를 통해서 추정된 요레이트로 수학식 2를 통해서 산출한다. The second yaw rate (Yaw2) is calculated from the equation (2) by the yaw rate estimated through the lateral acceleration generated in the vehicle.

Figure 112010005968542-pat00002
Figure 112010005968542-pat00002

여기서, Yaw2는 제2요레이트고, ay는 횡가속도 센서에서 측정된 차량의 횡가속도 값이고, Vref는 차량의 주행 속도이다. Here, Yaw2 is the second yaw rate, ay is the lateral acceleration value of the vehicle measured by the lateral acceleration sensor, and Vref is the running speed of the vehicle.

그리고 제1요레이트(Yaw1)에서 제2요레이트(Yaw2)를 빼서 산출된 추정 구배각(Bc)이 ESP 제어기에 저장되어 있는 제1기준 값(Bt1)보다 더 큰지 여부를 확인하는 구배각 비교 단계(S2)를 실행 한다. 이러한 제1기준 값(Bt1)은 바람직하게는 0.2(g)일 수 있으나, 본 발명에서 이를 한정하는 것은 아니다. And a gradient angle comparator for determining whether the estimated gradient angle Bc calculated by subtracting the second yaw rate Yaw2 from the first yaw rate Yaw1 is greater than a first reference value Bt1 stored in the ESP controller Step S2 is executed. The first reference value Bt1 may preferably be 0.2 (g), but the present invention is not limited thereto.

상기 추정 구배각(Bc)이 상기 제1기준 값(Bt1)보다 더 크면, 차량이 주행하는 주행로가 구배각을 갖는 경사진 노면임을 확인하기 위해서 게인 값을 결정하기 위한 요레이트 비교 단계(S3)를 실행한다. 우선 ESP 제어기는 차량의 조향 각을 통해 제3요레이트(Yaw3)를 산출한다. 이러한 제3요레이트(Yaw3)는 차량의 조향 각을 통해 추정된 요레이트 수학식 3을 통해서 산출한다. A yaw rate comparing step S3 for determining a gain value to confirm that the traveling path on which the vehicle travels is an inclined road surface having a gradient angle if the estimated gradient angle Bc is larger than the first reference value Bt1 ). First, the ESP controller calculates the third yaw rate (Yaw3) through the steering angle of the vehicle. This third yaw rate (Yaw3) is calculated by the yaw rate equation (3) estimated through the steering angle of the vehicle.

Figure 112010005968542-pat00003
Figure 112010005968542-pat00003

여기서, δswa는 차량의 조향 휠이 조타된 각인 조향 각이고 , IL는 조향비이고, l은 차량의 앞바퀴와 뒷바퀴 사이의 거리인 축간 거리이며, Vch는 ESP 제어기에 세팅되어 있는 차량의 특성 속도이다. 그러므로 제3요레이트(Yaw3)는 동일한 속도로 주행하는 차량에서는 차량의 조향 각에 비례한다.Where I L is the steering ratio, I is the inter-axis distance, which is the distance between the front and rear wheels of the vehicle, and V ch is the characteristic speed of the vehicle set in the ESP controller, to be. Therefore, the third yaw rate (Yaw3) is proportional to the steering angle of the vehicle in a vehicle traveling at the same speed.

그리고 제1요레이트(Yaw1)의 절대값(|Yaw1|)이 제3요레이트(Yaw3)의 절대값(|Yaw3|)보다 크고, 제3요레이트(Yaw3)의 절대값(|Yaw3|)이 제2요레이트(Yaw2)의 절대값(|Yaw2|) 보다 큰지 확인한다. 즉 요레이트 비교 단계(S3)에서는 차량이 뱅크 로드를 주행하고 있는지 여부를 판단하기 위해서 |Yaw1|>|Yaw3|>|Yaw2|를 만족하는지 확인한다. And the absolute value | Yaw3 | of the third yaw rate Yaw3 is greater than the absolute value | Yaw3 | of the third yaw rate Yaw3, Is larger than the absolute value (| Yaw2 |) of the second yaw rate (Yaw2). That is, in the yaw rate comparison step S3, it is determined whether or not the vehicle satisfies | Yaw1 |> | Yaw3 |> | Yaw2 | to determine whether or not the vehicle is traveling on the bank road.

그리고 차량이 뱅크 로드를 주행하고 있다면, 차량에는 제1요레이트(Yaw1), 제2요레이트(Yaw2) 및 제3요레이트(Yaw3)가 발생된다. Then, if the vehicle is traveling on the bank road, the first yaw rate (Yaw1), the second yaw rate (Yaw2) and the third yaw rate (Yaw3) are generated in the vehicle.

그리고 뱅크 로드에서 차량은 평지 주행을 할 때 보다 더 작은 조향 각으로 동일한 차량 회전이 가능하다. 그러므로 차량이 뱅크 로드에서 주행하고 있다면, 요레이트 센서 값을 통해 산출된 제1요레이트(Yaw1)가 차량의 조향 각을 통해 추정된 제3요레이트(Yaw3)보다 더 큰 값이 된다. 이때, 요레이트에 절대값을 씌운 이유는 요레이트의 크기만을 비교하기 위함이다.And on the bank road, the vehicle is able to rotate the same vehicle at a smaller steering angle than when driving on a flat road. Therefore, if the vehicle is traveling on the bank road, the first yaw rate (Yaw1) calculated through the yaw rate sensor value becomes larger than the third yaw rate (Yaw3) estimated through the steering angle of the vehicle. In this case, the reason why the absolute value is added to the yaw rate is to compare only the yaw rate.

그리고 차량이 뱅크 로드에서 주행하고 있다면, 차량에 적용되던 중력이, 회전에 의한 원심력에 의해서 상쇄되어 횡가속도 센서 값을 통해 추정한 제2요레이트(Yaw2)값은 0과 가까운 값이 된다. 그리고 차량이 저 마찰 노면을 주행할 경우에는 원심력이 중력에 의해서 상쇄될 수 없으므로 제2요레이트 값이 0과 가까운 값이 될 수 없다. 즉, 차량이 뱅크 로드에서 주행하고 있을 때에만, 제2요레이트(Yaw2) 보다 제1요레이트(Yaw1)와 제3요레이트(Yaw3)가 더 큰 값이 된다. If the vehicle is traveling on the bank road, the gravity applied to the vehicle is canceled by the centrifugal force due to the rotation, and the second yaw rate (Yaw2) estimated through the lateral acceleration sensor value is close to zero. When the vehicle travels on a low friction surface, the second yaw rate value can not be close to 0 because the centrifugal force can not be canceled by gravity. That is, the first yaw rate Yaw1 and the third yaw rate Yaw3 become larger than the second yaw rate Yaw2 only when the vehicle is traveling on the bank road.

그러므로 |Yaw1|>|Yaw3|>|Yaw2|를 만족한다면, 차량이 뱅크 로드에서 주행하고 있는 것으로 판단한다. Therefore, if | Yaw1 |> | Yaw3 |> | Yaw2 | is satisfied, it is determined that the vehicle is traveling on the bank road.

그러나 |Yaw1|>|Yaw3|>|Yaw2|를 만족하지 않아도 차량이 뱅크 로드를 주행하고 있을 수 있기 때문에, |Yaw1|>|Yaw3|>|Yaw2|를 만족하지 않을 때도 뱅크 로드 주행 여부를 다시 한 번 확인하기 위해서 게인을 이용하여 추정 구배각을 필터링하고, 필터링 구배각을 통해 뱅크 로드 확인을 수행한다.However, even if the vehicle does not satisfy the condition of | Yaw1 |> | Yaw3 |> | Yaw2 |, the vehicle may be traveling on the bank road, so that even if | Yaw1 |> | Yaw3 |> | Yaw2 | To confirm once, the estimated gradient angle is filtered using the gain, and the bank load verification is performed through the filtering gradient angle.

그리고 필터링 구배각을 통해 뱅크 로드 주행 여부를 확인하기 위해서는 구배각 비교 단계(S2)와 요레이트 비교 단계(S3)를 만족여부에 따라, 추정 구배각(Bc)을 필터링 하기 위해 제1게인, 제2게인 및 제3게인 중에 하나의 게인을 게인으로 설정(S4)한다. 그리고 추정 구배각(Bc)에 산출된 각각의 게인을 곱해서 필터링 구배각을 산출(S5)한다. 그리고 필터링 구배각(Bf)이 제2기준 값(Bt2)보다 더 큰지 여부(S6)에 따라, 차량이 뱅크 로드를 주행하고 있는지 여부를 판단한다. In order to confirm whether or not the bank road is running through the filtering gradient angle, the first gain and the second gain are filtered to filter the estimated gradient angle Bc according to whether the gradient angle comparison step S2 and the yaw rate comparison step S3 are satisfied. 2 gain and the third gain is set to gain (S4). Then, the filtering gradient angle is calculated by multiplying each of the gains calculated for the estimated gradient angle Bc (S5). Then, it is determined whether or not the vehicle is traveling on the bank road, based on whether or not the filtering gradient angle Bf is larger than the second reference value Bt2 (S6).

여기서, 구배각 비교 단계(S2)에서 추정 구배각(Bc)이 제1기준 값(Bt1) 보다 더 작다면, 차량이 뱅크 로드를 주행할 확률이 거의 없는 것으로 판단하고 제1게인과 제2게인보다 작은 제3게인을 게인으로 설정(S43)하고, 추정 구배각(Bc)에 제3게인을 곱해서 필터링 구배각(Bt)을 산출한다. If the estimated gradient angle Bc is smaller than the first reference value Bt1 in the gradient angle comparing step S2, it is determined that the vehicle is not likely to travel on the bank road. If the first gain and the second gain (S43), and the filtered gradient angle Bt is calculated by multiplying the estimated gradient angle Bc by the third gain.

그리고 구배각 비교 단계(S2)에서 추정 구배각(Bc)이 제1기준 값(Bt1) 보다 크지만, 요레이트 비교 단계(S3)에서 |Yaw1|>|Yaw3|>|Yaw2|를 만족하지 않는다면, 제1게인보다 작고 제3게인보다 큰 제2게인을 게인으로 설정(S42)하고, 추정 구배각(Bc)에 제2게인을 곱해서 필터링 구배각(Bt)을 산출한다. If the estimated gradient angle Bc is larger than the first reference value Bt1 in the gradient angle comparing step S2 but the yaw rate comparing step S3 does not satisfy | Yaw1 |> | Yaw3 |> | Yaw2 | A second gain smaller than the first gain and larger than the third gain is set to gain (S42), and the filtering gradient angle Bt is calculated by multiplying the estimated gradient angle Bc by the second gain.

그리고 구배각 비교 단계(S2)에서 추정 구배각(Bc)이 제1기준 값(Bt1) 보다 크지만, 요레이트 비교 단계(S3)에서 |Yaw1|>|Yaw3|>|Yaw2|를 만족하면, 제2게인과 제3게인보다 큰 제1게인을 게인으로 설정(S41)하고 추정 구배각(Bc)에 제1게인을 곱해서 필터링 구배각(Bt)을 산출한다. If the estimated gradient angle Bc is larger than the first reference value Bt1 in the gradient angle comparing step S2 but the yaw rate comparing step S3 satisfies | Yaw1 |> | Yaw3 |> | Yaw2 | The first gain larger than the second gain and the third gain is set to gain (S41), and the filtering gradient angle Bt is calculated by multiplying the estimated gradient angle Bc by the first gain.

즉, 구배각 비교 단계(S2)와 요레이트 비교 단계(S3)의 만족 여부에 따라서 추정 구배각(Bc)을 필터링 하기 위한 게인 값을 결정한다. That is, the gain value for filtering the estimated gradient angle Bc is determined according to whether or not the gradient angle comparing step S2 and the yaw rate comparing step S3 are satisfied.

예를 들어, 제1게인은 0.95, 제2게인은 0.4, 제3게인은 0.1로 설정할 수 있다. 그리고 설정된 게인 값에 따라 필터링 구배각(Bt)이 상이해지므로, 차량이 뱅크 로드를 주행하고 있는지 여부를 판단하기 위한 제2기준 값(Bt2)은 설정된 게인 값에 의해서 상이하게 설정할 수 있다. 상기와 같이 각 게인 값을 설정하였을 경우에 제2기준 값(Bt2)은 0.082(g)로 설정할 수 있다.For example, the first gain may be set to 0.95, the second gain to 0.4, and the third gain to 0.1. Since the filtering gradient angle Bt is different according to the set gain value, the second reference value Bt2 for determining whether or not the vehicle is traveling on the bank road can be set differently depending on the set gain value. When each gain value is set as described above, the second reference value Bt2 can be set to 0.082 (g).

이와 같이 추정 구배각(Bc)에 게인을 곱해서 필터링한 필터링 구배각(Bf)이 ESP 제어기에 저장되어 있는 제2기준 값(Bt2)과 비교해서 필터링 구배각(Bf)이 제2기준 값(Bt2)보다 더 크다면 차량이 뱅크 로드에서 주행하는 것으로 판단(S7)한다. The filtering gradient angle Bf is calculated by multiplying the estimated gradient angle Bc by the gain and compared with the second reference value Bt2 stored in the ESP controller so that the filtering gradient angle Bf is smaller than the second reference value Bt2 , It is determined that the vehicle is traveling on the bank road (S7).

즉, 구배각 비교 단계(S2)와 요레이트 비교 단계(S3)를 모두 만족하지 않아도, 제3게인에 의해서 필터링된 필터링 구배각(Bf)이 제2기준 값(Bt2)보다 더 크다면 차량이 뱅크 로드에서 주행하는 것으로 판단한다. 그러나 제1게인이나 제2게인에 비해서 더 작은 제3게인을 추정 구배각(Bc)에 곱해서 필터링 구배각(Gf)을 산출하므로, 차량이 뱅크 로드에서 주행하는 것으로 판단될 확률은 구배각 비교 단계(S2)와 요레이트 비교 단계(S3)를 만족할 때에 비해서 더 낮다. That is, if the filtering gradient angle Bf filtered by the third gain is larger than the second reference value Bt2 even if both of the gradient angle comparing step S2 and the yaw rate comparing step S3 are not satisfied, It is judged that the vehicle runs on the bank road. However, since the filtered gradient angle Gf is calculated by multiplying the estimated gradient angle Bc by the third gain smaller than the first gain or the second gain, the probability that the vehicle is judged to run on the bank load is calculated by the gradient angle comparison step (S2) and the yaw rate comparing step (S3) are satisfied.

그리고 필터링 구배각(Bf)이 제2기준 값(Bt2)이하라면, 차량이 뱅크 로드를 주행하지 않고, 평지를 주행 또는 저 마찰 노면을 주행하는 것으로 판단(S8)한다. If the filtering gradient angle Bf is equal to or less than the second reference value Bt2, it is determined that the vehicle does not travel on the bank road but runs on a flat or low friction road surface (S8).

이와 같이 본 발명은 차량이 뱅크 로드를 주행하는지 여부를 검출하기 위해서, 요레이트 센서에서 측정된 값을 통해 추정된 제1요레이트(Yaw1)와 횡가속도센서에서 측정된 값을 통해 추정된 제2요레이트(Yaw2)와 조향 각을 통해 추정된 제3요레이트(Yaw3)를 비교하여, 차량이 뱅크 로드를 주행하는지 여부를 판단할 수 있다. Thus, in order to detect whether or not the vehicle is traveling on the bank road, the present invention is characterized in that the first yaw rate (Yaw1) estimated through the measured value at the yaw rate sensor and the second yaw rate The yaw rate Yaw2 is compared with the third yaw rate Yaw3 estimated through the steering angle to determine whether or not the vehicle is traveling on the bank road.

이상에서 설명한 것은 본 발명에 의한 뱅크 로드 검출 방법을 실시하기 위한 하나의 실시예에 불과한 것으로서, 본 발명은 상기한 실시예에 한정되지 않고, 이하의 특허청구범위에서 청구하는 바와 같이 본 발명의 요지를 벗어남이 없이 당해 발명이 속하는 분야에서 통상의 지식을 가진 자라면 누구든지 다양한 변경 실시가 가능한 범위까지 본 발명의 기술적 정신이 있다고 할 것이다.As described above, the present invention is not limited to the above-described embodiments, but may be applied to a method of detecting a bank load according to the present invention, It will be understood by those of ordinary skill in the art that various changes in form and details may be made therein without departing from the spirit and scope of the invention.

Yaw1; 제1요레이트 Yaw2; 제2요레이트
Yaw3; 제3요레이트 Bc; 추정 구배각
Bf; 필터링 구배각 Bt1; 제1기준 값
Bt2; 제2기준 값
Yaw1; First yaw rate Yaw2; Second yaw rate
Yaw3; Third yaw rate Bc; Estimated gradient angle
Bf; Filtering gradient angle Bt1; The first reference value
Bt2; The second reference value

Claims (4)

차량의 요레이트 센서에서 측정된 값을 통해 산출된 제1요레이트에서, 차량의 횡 가속도 센서에서 측정된 값을 통해 산출된 제2요레이트를 빼서 구배각을 추정하는 구배각 추정 단계;
상기 구배각 추정 단계에서 추정된 추정 구배각이 제1기준 값 이상인지 여부를 확인하는 구배각 비교 단계;
상기 추정 구배각이 상기 제1기준 값 이상이면, 상기 제1요레이트의 절대값(|Yaw1|)이 차량의 조향 각을 통해 산출된 제3요레이트의 절대값(|Yaw3|)보다 크고, 상기 제3요레이트의 절대값이 상기 제2요레이트의 절대값(|Yaw2|) 보다 큰 |Yaw1|>|Yaw3|>|Yaw2|를 만족하는지 확인하는 요레이트 비교 단계;
상기 제3요레이트가 상기 제2요레이트보다 크고, 상기 제3요레이트 보다 상기 제1요레이트가 커서 |Yaw1|>|Yaw3|>|Yaw2|를 만족하면, 제1게인을 상기 추정 구배각에 곱해서 추정 구배각을 필터링한 필터링 구배각을 산출하는 필터링 단계;
상기 필터링 구배각이 제2기준 값 이상인지 여부를 확인하고, 상기 제2기준 값보다 상기 필터링 구배각이 더 크면, 차량이 주행하는 주행로는 구배각이 존재하는 뱅크 로드인 것으로 판단하는 뱅크 로드 주행 판단 단계를 포함하여 이루어진 것을 특징으로 하는 뱅크 로드 검출 방법.
A gradient angle estimating step of estimating a gradient angle by subtracting a second yaw rate calculated from a value measured by a lateral acceleration sensor of the vehicle at a first yaw rate calculated through a value measured by a yaw rate sensor of the vehicle;
A gradient angle comparing step of determining whether the estimated gradient angle estimated in the gradient angle estimating step is equal to or greater than a first reference value;
Wherein the absolute value of the first yaw rate is greater than the absolute value of the yaw rate of the third yaw rate calculated based on the steering angle of the vehicle, Comparing the absolute value of the third yaw rate with the absolute value of the second yaw rate | Yaw1 |> | Yaw3 |> | Yaw2 |
If the third yaw rate is larger than the second yaw rate and the first yaw rate is larger than the third yaw rate and satisfies | Yaw1 |> | Yaw3 |> | Yaw2 |, the first gain may be set to the estimated gradient angle A filtering step of calculating a filtering gradient angle obtained by filtering an estimated gradient angle by multiplying the estimated gradient angle by a filtering step;
If the filtering gradient angle is larger than the second reference value, determining whether the filtering gradient angle is equal to or greater than the second reference value, and determining whether the filtering gradient angle is greater than the second reference value, And determining a traveling direction of the vehicle.
청구항 1에 있어서,
상기 필터링 단계에서는
상기 요레이트 비교 단계에서, |Yaw1|>|Yaw3|>|Yaw2|를 만족하지 못하면, 상기 제1게인보다 더 작은 값인 제2게인을 상기 추정 구배각에 곱해서 필터링한 필터링 구배각을 산출하는 것을 특징으로 하는 뱅크 로드 검출 방법.
The method according to claim 1,
In the filtering step
If the yaw rate comparison step does not satisfy | Yaw1 |> | Yaw3 |> | Yaw2 |, the filtering gradient angle obtained by filtering the second gradient, which is smaller than the first gain, by the estimated gradient angle is calculated And detecting a bank load.
청구항 2에 있어서,
상기 필터링 단계에서는
상기 구배각 비교 단계에서 상기 추정 구배각이 상기 제1기준 값 미만이면, 상기 제2게인보다 작은 값인 제3게인을 상기 추정 구배각에 곱해서 필터링한 필터링 구배각을 산출하는 것을 특징으로 하는 뱅크 로드 검출 방법.
The method of claim 2,
In the filtering step
Wherein when the estimated gradient angle is less than the first reference value in the gradient angle comparison step, the filtering gradient angle obtained by filtering the third gradient, which is smaller than the second gain, by the estimated gradient angle is calculated. Detection method.
청구항 1 내지 3항 중 어느 한 항에 있어서,
상기 뱅크 로드 주행 판단 단계에서
상기 필터링 구배각이 상기 제2기준 값 미만이면, 차량이 뱅크 로드를 주행하는 것이 아닌 것으로 판단하는 것을 특징으로 하는 뱅크 로드 검출 방법.
The method according to any one of claims 1 to 3,
In the bank load running determination step
And judges that the vehicle does not travel on the bank road if the filtering gradient angle is less than the second reference value.
KR1020100007831A 2010-01-28 2010-01-28 Detecting method of bank-road KR101639815B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020100007831A KR101639815B1 (en) 2010-01-28 2010-01-28 Detecting method of bank-road

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020100007831A KR101639815B1 (en) 2010-01-28 2010-01-28 Detecting method of bank-road

Publications (2)

Publication Number Publication Date
KR20110088095A KR20110088095A (en) 2011-08-03
KR101639815B1 true KR101639815B1 (en) 2016-07-14

Family

ID=44926762

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020100007831A KR101639815B1 (en) 2010-01-28 2010-01-28 Detecting method of bank-road

Country Status (1)

Country Link
KR (1) KR101639815B1 (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102049338B1 (en) * 2013-11-05 2019-11-27 현대모비스 주식회사 Apparatus and method for controlling velocity of vehicle considering slope of road
KR102253161B1 (en) * 2014-11-28 2021-05-18 현대모비스 주식회사 Operation method for electronic stability program
CN106184220B (en) * 2016-06-30 2018-08-21 南京航空航天大学 Abnormal driving detection method in a kind of track based on vehicle location track

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6351694B1 (en) * 2001-01-16 2002-02-26 Ford Global Technologies, Inc. Method for robust estimation of road bank angle
US6804584B2 (en) * 2002-03-20 2004-10-12 Ford Global Technologies, Llc Method for determining the roll angle of a vehicle using an estimation of road bank angle

Also Published As

Publication number Publication date
KR20110088095A (en) 2011-08-03

Similar Documents

Publication Publication Date Title
EP3209529B1 (en) Method for estimating a vehicle side slip angle, computer program implementing said method, control unit having said computer program loaded, and vehicle comprising said control unit
US20130090828A1 (en) Method for stabilizing a two-wheeled vehicle having a laterally slipping rear wheel
US20150191158A1 (en) Method for operating a wheel slip control apparatus with compensated wheel speeds
US9823111B2 (en) Method and device for estimating loading state of vehicle
US20150175140A1 (en) Braking/driving force control device
EP3659878A1 (en) Vehicle disturbance detection apparatus
US20180037222A1 (en) Methods and systems for determining a vehicle spin-out condition
JP7232048B2 (en) Method and apparatus for measuring vehicle roll angle
US20150224978A1 (en) Braking/driving force control device
CN111114551B (en) Vehicle ramp gradient identification method and device
JP2019535594A5 (en)
US20100131141A1 (en) Bank angle estimation via vehicle lateral velocity with force tables
KR101639815B1 (en) Detecting method of bank-road
US20160167699A1 (en) Vehicle control apparatus
KR101997432B1 (en) Electronic stability control apparatus for vehicle and control method therfor
KR102460857B1 (en) Apparatus for determining rollover conditions of vehicle and method thereof
US11970176B2 (en) Abnormality determination device, abnormality determination method, vehicle state estimation device, and non-transitory computer-readable storage medium
US10328914B2 (en) Method for setting a slip threshold and vehicle movement dynamics control device
JP2011068256A (en) Presumed acceleration computing device
JP5135062B2 (en) Road shape learning device
JP5521943B2 (en) Vehicle total weight estimation device
KR20080088052A (en) Device for detecting different kinds of tires in esp and method thereof
CN109910889B (en) Vehicle turning control method and control device
KR20170032870A (en) Vehicle Stability control apparatus and control method thereof
US20220203998A1 (en) Vehicle state estimation device, vehicle state estimation method, and non-transitory computer-readable storage medium

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: 20190624

Year of fee payment: 4