
์ด ๊ธ์ ์์ ๊ธ๊ณผ ์ด์ด์ง๋๋ค.
1. ์๋์ฐจ ํ์
์คํ์ ์์ ์๋์ฐจ๊ฐ ๋ํํ๋ ๊ณผ์ ์ ์ดํด๋ณด๊ณ ์ ํ๋ค.

์ ์ฌ์ง์ฒ๋ผ ์๋๊ฐ ๋๋ฆฐ ์ํ์ ์ฐจ์ฒด๋ ๊ทธ๋ฅ ๋ฐ๋ก ๋จ์ด์ ธ ์ ์ด๊ฐ ๋ถ๊ฐ๋ฅํ๊ธฐ์ ์ฐจ๋ผ๋ฆฌ ์๋๊ฐ ๋นจ๋๋ ์ํฉ์ ์ ์ด๋ฅผ ํ๋ ๊ฒ์ผ๋ก ๋ชฉํ๋ฅผ ์ ์ ํ์๋ค.
์ดํ ์ฐจ์ฒด๊ฐ ์๋ ์ฌ์ง๊ณผ ๊ฐ์ด ์์ง์ด๋ ๋ชจ์ต์ ๋ณด๋ฉด์ ์ ์ดํ ๋ถ๋ถ์ ๊ณ ๋ฏผํ๊ธฐ ์์ํ๋ค.

์ด ๊ณผ์ ์์ ๊ณ ์์ด์ ๋ชจ์ต์ ๋ค์ ๋ณด๊ฒ ๋์๋ค. ๊ทธ๋ฌ๋๋ ๊ณ ์์ด๋ ๋ค๋ฆฌ์ ํ๋ฆฌ, ๊ผฌ๋ฆฌ๋ฅผ ๋๋ฆฌ๋ ๋ฐฉ์์ผ๋ก ๋ชธ์ ์กฐ์ ํ๊ณ ์์๋ค. ๋ฐ๋ผ์ ๋ค๋ฆฌ์ ํด๋นํ๋ ๋ฐํด, ๊ผฌ๋ฆฌ๋ฅผ ์ถ๊ฐ์ ์ผ๋ก ๋ฌ์์ ์ ์ดํ๋ ๋ฐฉ์์ผ๋ก ํด๋ณด๊ณ ์ ํ๋ค.
2. ๋ค๋ฆฌ(๋ฐํด)์ ๊ฐ์ด๋๋ ๋ณด์กด์ ์ด์ฉํ ์ฐจ์ฒด ์ ์ด
(1) ์ด๋ก ์ ํตํ ๊ณ์ฐ
๊ฐ์ฅ ๋จผ์ ๋ฐํด ๋ถ๋ถ์ ๊ฐ์ด๋๋ ๋ณด์กด์ ํตํ ์ ์ด๋ฅผ ํ๊ณ ์ ํ๋ค. ์ฐจ์ฒด๋ฅผ ์๋ ๊ทธ๋ฆผ์ฒ๋ผ ์์ ๋ฌผ์ฒด๋๋ฅผ ๊ทธ๋ฆฌ๊ณ ๊ทธ์ ๋ง๊ฒ ์์์ ์ธ์๋ณด์๋ค.

$$I_{wheel} = mr^2$$
$$I_M = \frac {1} {12} M{L_x}^2 $$
$$I_{m_c} = 4m({l_x}^2+{l_z}^2+r^2)+\frac{1}{12} M {L_x}^2$$
$$L_{m_c} = I_{m_c} \omega _{m_c}$$
$$L_{M} = I_{M} \omega _{M}$$
$$L_{wheel.f} = I_{mf} \omega _{mf}$$
$$L_{wheel.b} = I_{mb} \omega _{mb}$$
$$\therefore L_{m_c} = 4mr^2 \bar{\omega _m} = (4m({l_x}^2+{l_z}^2+r^2)+\frac{1}{12} M {L_x}^2) \omega _c $$
$$(\bar{\omega _m} = \frac {\omega_f + \omega_b}{2}) $$
$$\therefore \omega_c = k \bar{\omega _m} = \frac {4mr^2}{4m({l_x}^2+{l_z}^2+r^2)+\frac{1}{12} M {L_x}^2} \bar{\omega _m} $$
(2) ์ค์ ๋ฐํด์ ์๋ ์ธก์ ๋ฐ ๋ฌด๊ฒ ์ธก์

์ด์ ๊ฐ์ด ์ค์ ๋ฐํด์ ์๋๋ฅผ ์ธก์ ํ ๋ค, ๋ฐํด์ ์ง๋, ์ฐจ์ฒด ์ง๋๊ณผ ๊ฐ์ ๋ค์ํ ๊ฐ๋ค์ ์ธก์ ํ ์ดํ ์ด๋ฅผ ์ด๋ก ๊ฐ๊ณผ ๋น๊ตํด๋ณด์๋ค.
๋ฐํด๋ $\omega _{wh} = 18.4 rad/s, \alpha = 58.3 rad/s^2 $์ ๋ฌผ๋ฆฌ๋์ ๊ฐ์ก์ผ๋ฉฐ, ์ด๋ ์ด๋ก ์ ํตํด $\omega_c = 1rad/s$๊ฐ ๋์๋ค.
(3) ์ค์ ์คํ๊ณผ ์ด๋ก ์ ๋น๊ต
์ด๋ฅผ ํตํด ์ค์ ์คํ์ ์ํด ํ์ ํ(rotating platform)์ ์ด์ฉํด ์คํํ์์ผ๋ฉฐ, ์ด๋, ํ์ ํ์ ๋ฌผ๋ฆฌ๋๋ ํฌํจํด ๋ค์ ์์์ ์ธ์ ๊ณ์ฐํ์๋ค.

์ด๋ฅผ ํตํด ์จ์ ํ ๋ฐํด๋ก ํ์ ํ ํํธ๋ฅผ ์ฐพ์ ์์ธก ๊ฐ๊ฐ์๋, ๊ฐ์๋์ ์ค์ ๊ฐ๊ฐ์๋, ๊ฐ์๋๋ฅผ ํ์ธํ์๋ค.
| ์ค์ | ์์ธก | |
| $\omega$ | $0.003 rad/s $ | $ 0.075 rad/s $ |
| $\alpha$ | $ 0.018 rad/s^2$ | $ 0.24rad/s^2 $ |
์ด ์คํ์ผ๋ก ๋ฐํด๋ฅผ ์ด์ฉํ ์ ์ด๋ ๋ฏธ๋ฏธํ๊ฒ ๋๊ธด ํ์ง๋ง ๊ฑฐ์ ํจ๊ณผ๊ฐ ์์์ ํ์ธํ์๋ค. ๋ฐ๋ผ์ ์ฐ๋ฆฌ๋ ์ ๋ต์ ์ผ๋ก ์ ๊ทผํ๊ฑฐ๋ ๊ผฌ๋ฆฌ๋ฅผ ์ด์ฉํ๋ ๋ฐฉ๋ฒ์ ์ฌ์ฉํ๊ธฐ๋ก ํ์๋ค.
3. ๊ผฌ๋ฆฌ๋ฅผ ์ด์ฉํ ์ฐจ์ฒด ์ ์ด
๊ผฌ๋ฆฌ๋ฅผ ์ด์ฉํ ์คํ๊ณผ ๊ฐ์ ๋ฐฉ์์ผ๋ก ์งํํ๊ฒ ๋์๋ค.
(1) ์ด๋ก ์ ํตํ ๊ณ์ฐ

$$I_{b} = \frac{1}{3}m_b {l_b}^2$$
$$I = \frac{2}{5} m R^2 + m_b {I_b}^2$$
$$L_{p} = (I + I_b) \omega^{*} = I_p \omega^* = \frac{2}{5} R^2 + m_{b} {I_b}^2 \omega^*$$
$$L = (I_c + I_p) \omega = 0 + I_p \omega^*$$
$$\therefore \omega = \frac{I_p}{1.089 \times 10^{-2} + I_p} \omega^* $$
์ด ๊ณผ์ ์์ $I_p = \frac {2} {5} mR^2 + m{b}{I_b}^2$ ์ธ๋ฐ $m_b$๋ ๋งค์ฐ ์๊ณ , $R$๋ ๋งค์ฐ ์๋ค๊ณ ๊ฐ์ ํ ๊ฒ์ด๊ธฐ์ $l_b$๊ฐ ์ปค์ผ ํ ๊ฒ์ด๋ผ๊ณ ์๊ฐํ๋ค.
(2) ๊ณ ์์ด์ ๊ผฌ๋ฆฌ ์์ง์ ์ฌ๋ถ์๊ณผ ์ด๋ก
์ดํ ๊ณ ์์ด์ ๊ผฌ๋ฆฌ ์์ง์์ ๋ค์ ๋ถ์ํ์ฌ ๋ํํ๋ฉด ์๋ค๋ก ๊ผฌ๋ฆฌ๋ฅผ ํ๋ ๋ค๋ ๊ฒ, ์ด๋ฅผ dc๋ชจํฐ๋ก ๊ตฌํํ์๋๊ฒ๊น์ง ํ๋ค.
๋ํ ์ด๋ฅผ ์์์ผ๋ก ํ์ฌ ์๊ณผ ๋์ผํ ๊ณผ์ ์ผ๋ก ๋ค์๊ณผ ๊ฐ์ ๊ด๊ณ์์ ์ป์ ์ ์์๋ค.
$$ \omega _c = \frac{1}{58.33} \omega _r $$
(3) ์ค์ ์คํ
์ด๋ฅผ ์ค์ ๋ํ ์คํ์ ์งํํ์๊ณ , ์ด๋ฅผ ํตํ ๊ฒฐ๊ณผ๋ ์คํ๋ ค ๋ฐ๋๋ก ๋์ ์๋ฌธ์ ๋ง ๋จ๊ธด ์ํ๋ก ์ผ๋จ ๋ํ ๋ฐํ๋ฅผ ํ๊ฒ ๋์๋ค.
4. ๊ฒฐ๋ก ๋์ถ
๋จผ์ ๋ฐํด๋ฅผ ํ์ ํ๋ ํ์ด๋ฐ์ ๋ํ ๊ฒฐ๊ณผ๋ ๋ค์๊ณผ ๊ฐ์๋ค.


๊ทธ๋ฆฌ๊ณ ๊ผฌ๋ฆฌ๋ฅผ ํ๋๋ ๊ฒ์ ๋ํ ๊ทธ๋ํ๋ ๋ค์๊ณผ ๊ฐ์๋ค.


์ด๋ฅผ ํตํด ์๋์ฒ๋ผ ๋ํ์์ ๋ฐํ๋ฅผ ์งํํ๊ฒ ๋์๋ค.
5. ๋ํ์ ๋ง๋ฌด๋ฆฌ


ํ๋ก์ ํธ์ ๋ํ github๋งํฌ๋ ๋ค์๊ณผ ๊ฐ๋ค.
https://github.com/MOSW626/automobile-stability-control_ionic-Robotic-Cat.git
GitHub - MOSW626/automobile-stability-control_ionic-Robotic-Cat
Contribute to MOSW626/automobile-stability-control_ionic-Robotic-Cat development by creating an account on GitHub.
github.com
์ด ๋ํ์์ ์ฃผ์ด์ง ์๊ฐ์ด ์งง์ ๊ฒฐ๊ตญ ์๋ฏธ์๋ ๊ฒฐ๊ณผ๊ฐ ๋์ค์ง๋ ๋ชปํ์์ง๋ง, ์กฐ๊ธ์ด๋๋ง ๋์ค์ ์ฐ๊ตฌ๋ฅผ ์งํํ๊ณ ์ถ์ ์ฃผ์ ๋ฅผ ์ฐพ์ ์ ์์ด ๋งค์ฐ ์๋ฏธ ์๋ ๊ฒฐ๊ณผ์๋ ๊ฒ ๊ฐ๋ค.