Skip to content

junhyukch7/ABS-Controller

Folders and files

NameName
Last commit message
Last commit date

Latest commit

ย 

History

15 Commits
ย 
ย 
ย 
ย 
ย 
ย 

Repository files navigation

ABS-Controller

ABS(Anti lock Braking System) using longitudinal dynamics

  1. Longitudinal model (์ข…๋ฐฉํ–ฅ)

fbd_vehicle

์ฐจ๋Ÿ‰ ๋™์—ญํ•™์€ ํฌ๊ฒŒ ์ข…๋ฐฉํ–ฅ,ํšก๋ฐฉํ–ฅ,์ˆ˜์ง๋ฐฉํ–ฅ์œผ๋กœ ๋‚˜๋‰˜๋Š”๋ฐ ์ด 3๊ฐ€์ง€์˜ ์›€์ง์ž„์€ ๋…๋ฆฝ์ ์ด์ง€ ์•Š๋‹ค. ABS ์ปจํŠธ๋กค๋Ÿฌ์˜ ์„ฑ๋Šฅ์„ ๊ฒ€์ฆํ•˜๊ธฐ ์œ„ํ•ด ์‚ฌ์šฉํ•œ ์ฐจ๋Ÿ‰๋™์—ญํ•™ ๋ชจ๋ธ์„ ์‚ฌ์šฉํ•˜์˜€๋‹ค.

  • Vehicle dynamics equation

์œ„ ์ž์œ ๋ฌผ์ฒด๋„๋ฅผ ๊ธฐ๋ฐ˜์œผ๋กœ vehicle dynamics ๋ฐฉ์ •์‹์„ ์„ธ์›Œ๋ณด๋ฉด ๋‹ค์Œ๊ณผ ๊ฐ™๋‹ค. vehicle_eq

๋‰ดํ„ด์˜ ์šด๋™๋ฒ•์น™์„ ์ด์šฉํ•œ ํ‰ํ˜•์‹์ด๋ฉฐ Froad๋Š” ์ฐจ๋Ÿ‰์ด ์•ž์œผ๋กœ ๋‚˜์•„๊ฐ€๋Š” traction force๋ฅผ ์˜๋ฏธํ•˜๊ณ  Froll์€ ์•ž๋ฐ”ํ€ด์™€ ๋’ท๋ฐ”ํ€ด์—์„œ ๋ฐœ์ƒํ•˜๋Š” ๊ตฌ๋ฆ„์ €ํ•ญ์„ ์˜๋ฏธํ•œ๋‹ค. Fair๋Š” ๊ณต๊ธฐ์ €ํ•ญ์„ ์˜๋ฏธํ•˜๊ณ  Mgsin(theta)๋Š” ๊ฒฝ์‚ฌ์— ์˜ํ•œ ํž˜์œผ๋กœ ๋‚˜๋ˆ„์—ˆ๋‹ค.

  • Wheel Dynamics equation

ํœ ์—์„œ๋Š” ํšŒ์ „์šด๋™์ด ๋ฐœ์ƒํ•˜๊ธฐ ๋•Œ๋ฌธ์— ํ•„ํžˆ ๊ด€์„ฑ๋ชจ๋ฉ˜ํŠธ๊ฐ€ ์กด์žฌํ•œ๋‹ค. ๊ด€์„ฑ๋ชจ๋ฉ˜ํŠธ์™€ ํ† ํฌ์˜ ๊ด€๊ณ„๋Š” ๋‹ค์Œ๊ณผ ๊ฐ™์ด ๋‚˜ํƒ€๋‚ผ ์ˆ˜ ์žˆ๋‹ค. inerita_eq

์ด๋ฅผ ๊ธฐ๋ฐ˜์œผ๋กœ Wheel Dynamics ๋ฐฉ์ •์‹์€ ๋‹ค์Œ๊ณผ ๊ฐ™์ด ๋„์ถœํ•  ์ˆ˜ ์žˆ๋‹ค. wheel_eq

Tshaft๋Š” ์—”์ง„์—์„œ ๋ฐœ์ƒํ•œ ์ถœ๋ ฅ์ด shaft๋ฅผ ํ†ตํ•ด ์ „๋‹ฌ๋˜๋Š” ํ† ํฌ์ด๊ณ  Brake๋Š” ์ œ๋™์‹œ ๋ฐœ์ƒํ•˜๋Š” ํ† ํฌ๋ฅผ ์˜๋ฏธํ•œ๋‹ค. ๋งˆ์ง€๋ง‰์œผ๋กœ (heff * Froad)๋Š” ์ง€๋ฉด๊ณผ์˜ ์ ‘์ด‰์—์„œ ๋ฐœ์ƒํ•œ ๋งˆ์ฐฐ๋ ฅ์„ ์˜๋ฏธํ•œ๋‹ค.

  • Tire model

tire

์ถœ๋ ฅ์ด ๊ฐ๊ฐ์˜ ๊ตฌ๋™๊ณ„๋ฅผ ๊ฑฐ์ณ ์ตœ์ข…์œผ๋กœ ํƒ€์ด์–ด๋ฅผ ์ง€๋‚˜๊ฒŒ ๋˜๋ฉด Traction Force๊ฐ€ ๋ฐœ์ƒํ•˜๊ฒŒ ๋œ๋‹ค. ํ•ด๋‹น ์ข…๋ฐฉํ–ฅ ๋ชจ๋ธ์—์„œ๋Š” Bakker - Pacejka์˜ Magic Tire Formula ๊ณต์‹์„ ์ด์šฉํ•˜์—ฌ Froad๋ฅผ ์ •์˜ํ•œ๋‹ค. froad_eq

ํ•ด๋‹น ๊ณต์‹์„ ์‚ฌ์šฉํ•˜๊ธฐ ์œ„ํ•ด Tire์—์„œ ๋ฐœ์ƒํ•˜๋Š” slip ratio๋Š” ๋‹ค์Œ๊ณผ ๊ฐ™์ด ์ •์˜ํ•œ๋‹ค.

slip_eq

v๋Š” ์ฐจ๋Ÿ‰ body์˜ ์†๋„๋ฅผ ์˜๋ฏธํ•˜๋ฉฐ ๊ฐ€์†์‹œ w(๊ฐ์†๋„)๊ฐ€ ์ปค์ง€๋ฉด์„œ slip์ด ์ฆ๊ฐ€ํ•˜๊ฒŒ ๋˜๊ณ  ์ œ๋™์‹œ w(๊ฐ์†๋„)๊ฐ€ ์ค„์–ด slip์ด ์ค„๊ฒŒ๋œ๋‹ค. ratio๋ฅผ ๊ตฌํ•˜๊ธฐ ์œ„ํ•ด hw-v๊ฐ€ 0๋ณด๋‹ค ํฐ ๊ฒฝ์šฐ hw(์„ ์†๋„)๋กœ ๋‚˜๋ˆ„๊ฒŒ ๋˜๊ณ  ๋ฐ˜๋Œ€์ธ ๊ฒฝ์šฐ v๋กœ ๋‚˜๋ˆ„๊ฒŒ ๋œ๋‹ค.

  • Brake model

brake_Eq

brake spec

๋ธŒ๋ ˆ์ดํฌ ๋กœ์ง์€ ๋‹ค์Œ๊ณผ ๊ฐ™๋‹ค. ์œ ์••์‹ ๋ธŒ๋ ˆ์ดํฌ๋Š” ๋ธŒ๋ ˆ์ดํฌ๋ฅผ ๋ฐŸ๋Š” ์••๋ ฅ(Pw)์ด ๋ธŒ๋ ˆ์ดํฌ ํ”ผ์Šคํ†ค์„ ๋ฐ€์–ด๋‚ด๊ณ  ์žˆ๋Š” ์Šคํ”„๋ง ์••๋ ฅ(Ppo)๋ณด๋‹ค ๋” ์ปค์•ผ ๋ธŒ๋ ˆ์ดํฌ ํ† ํฌ๊ฐ€ ๋ฐœ์ƒํ•˜๊ฒŒ ๋œ๋‹ค. ๋˜ํ•œ ๋ธŒ๋ ˆ์ดํฌ ๋ ˆ๋ฒ„๋ฅผ ๋ฐŸ๋Š” ํž˜์€ ์œ ์••์˜ ํž˜์œผ๋กœ ์ „ํ™˜๋˜๊ธฐ๊นŒ์ง€ ์ผ์ •๊ธฐ๊ฐ„์˜ Delay๊ฐ€ ์กด์žฌํ•˜๊ณ  ๋ธŒ๋ ˆ์ดํฌ์˜ ์••๋ ฅ์€ First order Transfer-Function์— ๋”ฐ๋ผ ๋ธŒ๋ ˆ์ดํฌ ์••๋ ฅ์ด ๋ถ€๋“œ๋Ÿฝ๊ฒŒ ์ฆ๊ฐ€ํ•œ๋‹ค. ๊ธฐ์–ด์˜ ๊ฒฝ์šฐ ํŠน์ • ์†๋„๊ฐ’๋“ค์„ ์ž„๊ณ„์ ์œผ๋กœ ๋‘์–ด ์†๋„์— ๋”ฐ๋ผ ๊ธฐ์–ด๋น„๊ฐ€ ๋ณ€ํ•˜๊ฒŒ ์„ค๊ณ„ํ•˜์˜€๊ณ , ์—”์ง„์˜ ๊ฒฝ์šฐ ๊ฐ„๋‹จํ•˜๊ฒŒ ์Šค๋กœํ‹€ ๊ฐ๊ณผ ์—”์ง„์˜ ํšŒ์ „์ˆ˜์— ๋”ฐ๋ผ ํ† ํฌ๋ฅผ mappingํ•˜์˜€๋‹ค. engine

  1. ABS controller
  • ๋„๋กœํ™˜๊ฒฝ

hw2_1_result

์œ„ ์‚ฌ์ง„์€ ๋‚ ์”จ์— ๋”ฐ๋ผ ๋„๋กœ์˜ ํ™˜๊ฒฝ์ด ๋‹ฌ๋ผ์ง€๋Š” ํŠน์„ฑ์„ ๋ฐ˜์˜ํ•œ ๊ฒƒ์ด๋‹ค. ABS์˜ ๋ชฉ์ ์€ ๊ฐ€์žฅ ์ตœ๋Œ€์ •์ง€๋งˆ์ฐฐ๊ณ„์ˆ˜๋ฅผ ์–ป๋Š” ์ง€์ ์—์„œ์˜ slip์„ ์œ ์ง€ํ•˜๊ฒŒ ํ•˜์—ฌ ์ฐจ๋Ÿ‰์ด ๋ฏธ๋„๋Ÿฌ์ง€์ง€ ์•Š๊ณ  ์กฐํ–ฅ์ด ๋˜๋„๋ก ์ฃผํ–‰ํ•˜๊ฒŒ ํ•˜๋Š” ๊ฒƒ์ด๋‹ค.๊ทธ๋ž˜ํ”„์—์„œ๋„ ๋ณผ ์ˆ˜ ์žˆ๋“ฏ์ด ๋ณดํŽธ์ ์œผ๋กœ ์ œ๋™์‹œ slip์ด -5~-30% ์ผ ๋•Œ ์ตœ๋Œ€์ •์ง€๋งˆ์ฐฐ๊ณ„์ˆ˜๋ฅผ ๋ณด์ด๋ฏ€๋กœ ์ด slip๊ฐ’์„ ์œ ์ง€ํ•˜๋„๋ก ์„ค๊ณ„ํ•˜์˜€๋‹ค.

abs

  • ABS logic

abs_logic

  • Result
  1. slip ratio ABS_slip

  2. speed ABS_speed

Dry condition ๊ณผ Wet condition์—์„œ๋Š” ABS๊ฐ€ ์ž‘๋™ํ•˜์ง€ ์•Š๊ณ  ์ œ๋™ํ•œ ๊ฒƒ์„ ํ™•์ธ ํ•  ์ˆ˜ ์žˆ๋‹ค. Snow condition์—์„œ๋ถ€ํ„ฐ ์„ค๊ณ„ํ•œ๋Œ€๋กœ ABS๊ฐ€ ์ž‘๋™ํ•˜๋ฉฐ ์ œ๋™ํ•˜๋Š” ๋ชจ์Šต์„ ๊ทธ๋ž˜ํ”„๋ฅผ ํ†ตํ•ด ํ™•์ธ ํ• ์ˆ˜ ์žˆ๋‹ค. 4๊ฐ€์ง€ ์กฐ๊ฑด์œผ๋กœ๋ถ€ํ„ฐ ๊ณตํ†ต์ ์œผ๋กœ ์–ป์„ ์ˆ˜ ์žˆ๋Š” ๊ฒฐ๊ณผ๋Š” ๋„๋กœ์˜ ์กฐ๊ฑด์ด ๋” ๊ฐ€ํ˜นํ•ด์งˆ์ˆ˜๋ก ์ œ๋™ํ•˜๋Š”๋ฐ ๊ฑธ๋ฆฌ๋Š” ์‹œ๊ฐ„์ด ๋” ๊ธธ์–ด์ง€๋Š” ๊ฒƒ์„ ํ™•์ธ ํ•  ์ˆ˜ ์žˆ์—ˆ๋‹ค. ๋˜ํ•œ ํ›„๋ฅœ๊ตฌ๋™์ด๋ผ Rear์—์„œ slip์ด ๋” ํฌ๊ฒŒ ๋ฐœ์ƒํ•˜๋Š” ๊ฒƒ์„ ํ™•์ธํ–ˆ๋‹ค. ๊ทธ๋ฆฌ๊ณ  ๋ชจ๋“  ์กฐ๊ฑด์—์„œ ์„ค๊ณ„ํ•œ slip์˜ ์ž„๊ณ„๊ฐ’์„ ๋„˜์–ด๊ฐ€์ง€ ์•Š๊ณ  ์ž˜ ์œ ์ง€ํ•˜๋Š” ๊ฒƒ์„ ํ†ตํ•ด ABS๋กœ์ง์ด ์ •์ƒ์ ์œผ๋กœ ์ž‘๋™ํ•œ ๊ฒƒ์„ ํ™•์ธ ํ•  ์ˆ˜ ์žˆ์—ˆ๋‹ค.

About

ABS(Anti lock Braking System) using longitudinal dynamics

Resources

Stars

Watchers

Forks

Releases

No releases published

Packages

 
 
 

Contributors