๐ ๋ชจ์๊ณ ์ฌ โ 3๊ณผ๋ชฉ ๋ชจ์ ์ํํธ์จ์ด
- 20๋ฌธํญ ยท ๊ถ์ฅ ์ ํ์๊ฐ 30๋ถ (์ค์ ์ํ์ 4๊ณผ๋ชฉ 80๋ฌธํญ / 2์๊ฐ)
- 4์ง์ ๋ค, ๋ฌธํญ๋น 5์ . 40์ (8๋ฌธํญ) ๋ฏธ๋ง์ด๋ฉด ๊ณผ๋ฝ, ์ ๊ณผ๋ชฉ ํ๊ท 60์ ์ด์ ํฉ๊ฒฉ
- ์ ๋ต ์ฝ์์์ ์ด์ง ๋ง๊ณ ๋๊น์ง ํผ ๋ค ๋งจ ์๋ ์ฑ์ ํ๋ก ์ฑ์ ํ์ธ์. ํ๋ฆฐ ๋ฌธํญ์ ํด์ค์ "์ถ์ฒ" ๋ ธํธ๋ก ๋์๊ฐ ๋ณต์ตํฉ๋๋ค.
ํ๋ ฌ ๊ณฑ์ ๊ตํ๋ฒ์น์ด ์ฑ๋ฆฝํ์ง ์๋๋ค. ๊ณ ์ ์ขํ๊ณ ๊ธฐ์ค ๋ณํ์ ์ผ์ชฝ์(์ ๊ณฑ), ํ์ฌ ์ขํ๊ณ ๊ธฐ์ค ๋ณํ์ ์ค๋ฅธ์ชฝ์(ํ๊ณฑ) ๊ณฑํด์ผ ํ๋ฉฐ, ์์๊ฐ ๋ฐ๋๋ฉด ๊ฒฐ๊ณผ๊ฐ ๋ฌ๋ผ์ง๋ค. โ โก๋ ์ง๊ตํ๋ ฌ์ธ ํ์ ํ๋ ฌ์ ๊ธฐ๋ณธ ์ฑ์ง, โข์ ๋์ฐจ๋ณํํ๋ ฌ์ ๊ตฌ์กฐ๋ก ๋ชจ๋ ์ณ๋ค.
๐ ์ถ์ฒ: ๋ณํํ๋ ฌ
๋ ๋ฒ์งธ ๋งํฌ์ ์ ๋๊ฐ์ \theta_1 + \theta_2 = 90ยฐ.
x = l_1\cos\theta_1 + l_2\cos(\theta_1+\theta_2) = 2\cos 90ยฐ + 1\cos 90ยฐ = 0 + 0 = 0
y = l_1\sin\theta_1 + l_2\sin(\theta_1+\theta_2) = 2\sin 90ยฐ + 1\sin 90ยฐ = 2 + 1 = 3
๋ ๋งํฌ๊ฐ ๋ชจ๋ ์์ง์ผ๋ก ๊ณง๊ฒ ๋ป์ ์์ธ์ด๋ฏ๋ก (0, 3)์ด ์ง๊ด๊ณผ๋ ์ผ์นํ๋ค.
๐ ์ถ์ฒ: ๋ก๋ด ๊ธฐ๊ตฌํ ํด์
ํน์ด์ ์ ์ํ์ ์กฐ๊ฑด์ \det J(q) = 0 โ ์์ฝ๋น์์ ์ญํ๋ ฌ์ด ์กด์ฌํ์ง ์์ ๋ง๋จ์ ์ด๋ ์์ ๋๋ฅผ ํ๋ ์ด์ ์๊ณ , ๊ทธ ๊ทผ์ฒ์์๋ ์กฐ์ธํธ ์๋๊ฐ ๋น์ ์์ ์ผ๋ก ์ปค์ง๋ค. ์๊ธฐ๊ตฌํ์ ์ด๋ค ์์ธ์์๋ ํด๊ฐ ํญ์ ์ ์ผํ๋ฏ๋ก โ ์ ํ๋ฆฌ๊ณ , ์์ ๋๋ ์ฆ๊ฐ๊ฐ ์๋๋ผ ์์ค๋๋ฏ๋ก โข๋ ํ๋ฆฌ๋ค.
๐ ์ถ์ฒ: ๋ก๋ด ์ญ๊ธฐ๊ตฌํ ํด์
๋คํญ์์ ๊ณ์ ๊ฐ์๋งํผ ๊ฒฝ๊ณ์กฐ๊ฑด์ ๊ฑธ ์ ์๋ค. 5์ฐจ ๋คํญ์์ ๊ณ์๊ฐ 6๊ฐ(a_0{\sim}a_5)์ด๋ฏ๋ก ์กฐ๊ฑด 6๊ฐ๋ฅผ ๋ง์กฑ์ํฌ ์ ์๋ค. 3์ฐจ ๋คํญ์(๊ณ์ 4๊ฐ)์ ์์ยท๋์ ์์น์ ์๋(4๊ฐ)๊น์ง๋ง ์ง์ ๊ฐ๋ฅํ๊ณ ๊ฐ์๋๋ ๋ถ์ฐ์์ผ ์ ์๋ค.
๐ ์ถ์ฒ: ๋จธ๋ํฐ๋ ์ดํฐ ๊ฒฝ๋ก๊ณํ
A*์ ์ต์ ์ฑ์ ํ์ฉ ๊ฐ๋ฅ(admissible) ์กฐ๊ฑด h(n) \le h^*(n)์ด ์ ์ ๋ค. ๊ณผ๋ํ๊ฐํ๋ฉด ํ์์ ๋ชฉํ ์ชฝ์ผ๋ก ๋ ๊ณต๊ฒฉ์ ์ผ๋ก ์ ๋ ค ๋นจ๋ผ์ง ์ ์์ง๋ง, ์ค์ ์ต๋จ ๊ฒฝ๋ก๋ฅผ ์ง๋์ณ ๋ฒ๋ ค ์ต์ ์ฑ ๋ณด์ฅ์ ์๋๋ค. h=0์ผ ๋ Dijkstra์ ๊ฐ์์ง๋ ๊ฒ(โข)๊ณผ ํผ๋ํ์ง ๋ง ๊ฒ.
๐ ์ถ์ฒ: ์ด๋๋ก๋ด ์ ์ญ ๊ฒฝ๋ก๊ณํ
ํฌํ
์
ํ๋์ ๋ํ์ ์ฝ์ ์ด ์ง์ญ ์ต์๊ฐ(local minimum)์ด๋ค. U์ํ ์ฅ์ ๋ฌผ ์์ฒ๋ผ ์ธ๋ ฅ๊ณผ ์ฒ๋ ฅ์ด ์์๋๋ ์ง์ ์ ๊ฐํ๋ฉด ๋ชฉํ์ ๋๋ฌํ์ง ๋ชปํ๋ฉฐ, ์ต์ ์ฑ์ ์ ์ด์ ๋ณด์ฅ๋์ง ์๋๋ค. โ โกโข์ ๊ฐ ๊ธฐ๋ฒ์ ํต์ฌ ์๋ฆฌ๋ก ์ณ๋ค.
๐ ์ถ์ฒ: ์ด๋๋ก๋ด ์ง์ญ ๊ฒฝ๋ก๊ณํ
์๋ยท๋ถ๋ฆฌ ๊ฐ์๋ ์ ์ด์ด ์ผ์ด๋๊ธฐ ์ ์ ๊ฑฐ๋ฆฌ ๊ธฐ๋ฐ์ผ๋ก ๊ฐ์ยท์ ์งํ๋ ๋ฐฉ์์ด๋ค. โข ๋๋ ฅยทํ ์ ํ์ ์ ์ด์ ์ ์ ๋ก ํยท์๋ ฅ ์์ฒด๋ฅผ ์ธ์ฒด ๋ฌดํด ์์ค์ผ๋ก ์ ํํ๋ ๋ฐฉ์์ด๋ผ๋ ์ ๊ณผ ๊ตฌ๋ถํด์ผ ํ๋ค. โ ์ ์ฌ๋์ด ํ๋ ๊ณต๊ฐ์ ๋ค์ด์ค๋ฉด ๊ฐ์ ์ํ๋ก ์ ์ง, โก๋ ์์
์๊ฐ ๋ก๋ด์ ์ง์ ์ก๊ณ ๊ต์ํ๋ ๋ฐฉ์์ด๋ค.
๐ ์ถ์ฒ: ๋จธ๋ํฐ๋ ์ดํฐ ์ถฉ๋ํํผ
d_{stop} = v\,t_{react} + \dfrac{v^2}{2a} = 2 \times 0.5 + \dfrac{2^2}{2 \times 2} = 1.0 + 1.0 = 2.0 m
๋ฐ์(๊ณต์ฃผ) ๊ฑฐ๋ฆฌ์ ์ ๋ ๊ฑฐ๋ฆฌ์ ํฉ์ด๋ค. ์ ๋ ๊ฑฐ๋ฆฌ๋ ์๋์ ์ ๊ณฑ์ ๋น๋กํ๋ฏ๋ก ์๋๊ฐ 2๋ฐฐ๊ฐ ๋๋ฉด ์ ๋ ๊ฑฐ๋ฆฌ๋ 4๋ฐฐ๊ฐ ๋๋ค โ ์์ ์ค์บ๋์ ๋ณดํธ ์์ญ์ ์๋์ ๋ฐ๋ผ ํค์ฐ๋ ์ด์ ๋ค.
๐ ์ถ์ฒ: ์ด๋๋ก๋ด ์ถฉ๋ํํผ
์์์ง๋(Topological Map)๋ ์ฅ์(๋
ธ๋)์ ์ฐ๊ฒฐ ๊ด๊ณ(๊ฐ์ )๋ง ๋ด๋ ๊ทธ๋ํ ์ง๋๋ก, ๋ฉ๋ชจ๋ฆฌ๊ฐ ๊ทนํ ์ ๊ณ ๋๊ท๋ชจ ํ๊ฒฝ์ ์์ ์์ค ๊ณํ์ ์ ๋ฆฌํ ๋์ ์ ๋ฐํ ๊ธฐํ ์ ๋ณด๊ฐ ์์ด ์ ๋ฐ ์ฃผํยทํํผ์๋ ๋ถ์ ํฉํ๋ค. ๊ทธ๋์ ์ค๋ฌด์์๋ ๊ฒฉ์์ง๋(์ ๋ฐ ์ฃผํ)์ ์์ ํ์ด๋ธ๋ฆฌ๋ ๊ตฌ์ฑ์ ์ฐ๊ธฐ๋ ํ๋ค.
๐ ์ถ์ฒ: ์ด๋๋ก๋ด ์ง๋ ์์ฑ
v = \dfrac{v_R + v_L}{2} = \dfrac{1.0 + 0.6}{2} = 0.8 m/s
\omega = \dfrac{v_R - v_L}{L} = \dfrac{1.0 - 0.6}{0.4} = 1.0 rad/s
์ค๋ฅธ์ชฝ ๋ฐํด๊ฐ ๋ ๋น ๋ฅด๋ฏ๋ก ๋ก๋ด์ ์ผ์ชฝ์ผ๋ก ํ์ ํ๋ค. ์ด ์์ ๋ฐ๋ณต ์ ๋ถํ๋ ๊ฒ์ด ์ค๋๋ฉํธ๋ฆฌ์ด๋ฉฐ, ๋งค ๋จ๊ณ์ ์ค์ฐจ๊ฐ ๋์ (๋๋ฆฌํํธ)๋๋ค๋ ์ ๋ ํจ๊ป ๊ธฐ์ตํ์.
๐ ์ถ์ฒ: ์ด๋๋ก๋ด ์์น์ธ์
Gmapping์ FastSLAM ๊ณ์ด(ํํฐํด ํํฐ ๊ธฐ๋ฐ) ์ ๊ฒฉ์์ง๋ ๊ตฌํ์ด๋ค. ๊ทธ๋ํ ์ต์ ํ ๊ธฐ๋ฐ์ ๋ํ ์์คํ
์ ๊ตฌ๊ธ Cartographer๋ค. โ ์ EKF-SLAM์ ๋๋๋งํฌ ์ n์ ๋ํด ๊ณ์ฐ๋์ด O(n^2)์ผ๋ก ๋์ด๋๋ ํ๊ณ๊ฐ ์๊ณ , โข์ ๊ทธ๋ํ SLAM์ด ํ๋ ํ์ค ๊ตฌ์กฐ๋ค.
๐ ์ถ์ฒ: ์ด๋๋ก๋ด SLAM
์ถ๋ ฅ ๊ณต์ P = \tau\omega์์ \omega๋ rad/s ๋จ์์ฌ์ผ ํ๋ค.
\omega = 3000 \times \dfrac{2\pi}{60} \approx 314.2 rad/s โ P = 1 \times 314.2 \approx 314 W
rpm์ ๊ทธ๋๋ก ๊ณฑํ๋ ์ค์(โข)๋ฅผ ์ ๋ํ๋ ์ ํ์ ์ธ ํจ์ ์ด๋ค. rpm โ rad/s ํ์ฐ ๊ณ์ 2\pi/60 \approx 0.1047์ ๊ธฐ์ตํ์.
๐ ์ถ์ฒ: ์ก์ถ์์ดํฐ ์ฌ์ ๋ถ์
\tau_{rms} = \sqrt{\dfrac{\sum \tau_i^2 t_i}{\sum t_i}} = \sqrt{\dfrac{3^2 \times 1 + 0^2 \times 3}{1+3}} = \sqrt{\dfrac{9}{4}} = 1.5 Nยทm
์ ์ง(ํด์ง) ์๊ฐ๋ ๋ถ๋ชจ์ ํฌํจํด์ผ ํ๋ค. ๋ชจํฐ ๋ฐ์ด์ด ํ ํฌ(์ ๋ฅ)์ ์ ๊ณฑ์ ๋น๋กํ๋ฏ๋ก ์ฐ์ ์ด์ ๊ฐ๋ฅ ์ฌ๋ถ๋ ํ๊ท ์ด ์๋ RMS ํ ํฌ๊ฐ ์ ๊ฒฉ ํ ํฌ ์ดํ์ธ์ง๋ก ํ์ ํ๋ค.
๐ ์ถ์ฒ: ์ก์ถ์์ดํฐ ๋์ญํ์ ๊ตฌ๋ ํ๋กํ์ผ
๋ฌด๋ถํ ์๋ \omega_0 = \dfrac{V}{k_e} = \dfrac{12}{0.05} = 240 rad/s (ํ ํฌ 0์ผ ๋์ ์ต๊ณ ์๋)
์ค์ ํ ํฌ \tau_s = k_t\dfrac{V}{R} = 0.05 \times \dfrac{12}{1} = 0.6 Nยทm (์๋ 0 โ ์ญ๊ธฐ์ ๋ ฅ์ด ์์ด ์ ๋ฅ ์ต๋)
์ด ๋ ์ ์ ์ด์ ์ฐํํฅ ์ง์ ์ด DC ๋ชจํฐ์ ํ ํฌ-์๋ ํน์ฑ์ด๋ฉฐ, ์ ์์ ๋์ด๋ฉด ์ง์ ์ด ํํ์ด๋ํ๋ค.
๐ ์ถ์ฒ: ์ก์ถ์์ดํฐ ํน์ฑ ๋ชจ๋ธ๋ง
0.2์ด๋ ์์ ์์ 2๋ฐฐ(2\tau)๋ค. 1์ฐจ ์์คํ
์ ์คํ
์๋ต \omega(t) = \omega_{final}(1-e^{-t/\tau})์์ t=\tau์ผ ๋ 63.2%, t=2\tau์ผ ๋ 1-e^{-2} \approx 86.5\%, 3\tau์์ 95%๋ค. "์์ ์ = 63.2% ๋๋ฌ ์๊ฐ"๋ง ์ธ์ฐ๊ณ 2\tau ๋ฌธ์ ์์ โ ์ ๊ณ ๋ฅด์ง ์๋๋ก ์ฃผ์.
๐ ์ถ์ฒ: ์ก์ถ์์ดํฐ ๋์ญํ ๋ชจ๋ธ๋ง
๋ฐ๊นฅ์ชฝ๋ถํฐ ์์น โ ์๋ โ ์ ๋ฅ ์์๋ค. ์์น ๋ฃจํ๊ฐ ์๋ ์ง๋ น์ ๋ง๋ค๊ณ , ์๋ ๋ฃจํ๊ฐ ์ ๋ฅ(ํ ํฌ) ์ง๋ น์ ๋ง๋ค๋ฉฐ, ๊ฐ์ฅ ์์ชฝ์ ์ ๋ฅ ๋ฃจํ๊ฐ PWM ์ ์ ์ง๋ น์ ์ถ๋ ฅํ๋ค(โก ๋ ์ ๋ฅ ๋ฃจํ์ ์ถ๋ ฅ). \tau = k_t i์ด๋ฏ๋ก ์๋ ๋ฃจํ ์ถ๋ ฅ์ ๋ฆฌ๋ฏธํธ๋ฅผ ๊ฑธ๋ฉด ๊ทธ๋๋ก ํ ํฌ ์ ํ์ด ๋๋ค.
๐ ์ถ์ฒ: ์ก์ถ์์ดํฐ ์ ์ด๊ตฌ์กฐ ์ค๊ณ
ํ๊ณ ๊ฒ์ธ K_u = 10, ํ๊ณ ์ฃผ๊ธฐ P_u = 0.2์ด์ด๋ฏ๋ก ์ง๊ธ๋ฌ-๋์ฝ์ค PID ๊ณต์์ ๋ฐ๋ผ
K_p = 0.6K_u = 6, T_i = 0.5P_u = 0.1์ด, T_d = 0.125P_u = 0.025์ด.
Z-N ๊ฒฐ๊ณผ๋ ๋ค์ ์ง๋์ ์ด๋ฏ๋ก ์ค๋ฌด์์๋ ์ฌ๊ธฐ์ ์ถ๋ฐํด ๋ฏธ์ธ ์กฐ์ ํ๋ค.
๐ ์ถ์ฒ: ์ ์ด๊ธฐ ๊ฒ์ธ ์ค์
ํ๋ ์ค์๊ฐ์ ๋ฐ๋๋ผ์ธ์ ํ ๋ฒ์ด๋ผ๋ ๋์น๋ฉด ์์คํ
์คํจยท์์ ์ฌ๊ณ ๋ก ์ด์ด์ง๋ ์์
์ด๋ค. ์ ๋ฅ ์ ์ดยท๊ณผ์ ๋ฅ ๋ณดํธ๋ ์์ญ ยตs ๋ง์ ์ ๋ ฅ ์์๊ฐ ํ์๋ ์ ์์ด ๋งค ์ฃผ๊ธฐ ๋ณด์ฅ์ด ํ์๋ค. โ โกโข์ ๊ฐ๋ ๋ฆ์ด๋ ํ์ง ์ ํ์ ๊ทธ์น๋ ์ํํธ ์ค์๊ฐ ์์
์ด๋ฉฐ, ์ธํฐ๋ฝํธ ์ฐ์ ์์๋ ์ ๋ฅ(+๋ณดํธ) > ์๋ > ์์น > ํต์ > ๋ฐฐ๊ฒฝ ์์ผ๋ก ๋ฐฐ์ ํ๋ค.
๐ ์ถ์ฒ: ์๋ฒ ๋๋ ํ๋ก๊ทธ๋๋ฐ ํน์ฑ
X-in-the-Loop ์๋ฆฌ์ฆ๋ "๋ฌด์์ด ์ง์ง์ธ๊ฐ"๋ก ๊ตฌ๋ถํ๋ค. MIL์ ๋ชจ๋ธ+๋ชจ๋ธ(์๊ณ ๋ฆฌ์ฆ ๋
ผ๋ฆฌ), SIL์ ์ค์ฝ๋๋ฅผ PC์์ ์คํ(๊ตฌํ ์ค๋ฅ), PIL์ ์ค์ฝ๋๋ฅผ ์ค์ MCU์์ ์คํ(์ฐ์ฐ ์๊ฐยท์์น ์ ๋ฐ๋), HIL์ ์ค์ ์ ์ด๊ธฐ ํ๋์จ์ด์ ์ค์๊ฐ ์๋ฎฌ๋ ์ดํฐ๊ฐ ๋ง๋ ๊ฐ์ ํ๋ํธ ์ ํธ๋ฅผ ๋ฌผ๋ ค ํตํฉ ๊ฒ์ฆํ๋ค.
๐ ์ถ์ฒ: ์ ์ด๊ธฐ ์ํํธ์จ์ด ์ฑ๋ฅ์ํ
M_p = \dfrac{y_{peak} - y_\infty}{y_\infty} \times 100 = \dfrac{2.3 - 2.0}{2.0} \times 100 = 15\%
๋ถ๋ชจ๋ ๋ชฉํ๊ฐ์ด ์๋๋ผ ์ต์ข
๊ฐ์ด๋ค. ์ค๋ฒ์ํธ๊ฐ ํฌ๋ค๋ ๊ฒ์ ๊ฐ์ ๋ถ์กฑ์ ์ ํธ์ด๋ฏ๋ก, ๊ฐ์ ํ๋ ค๋ฉด K_p๋ฅผ ์ค์ด๊ฑฐ๋ K_d๋ฅผ ๋๋ ค ๊ฐ์ ๋ฅผ ๋ณด๊ฐํ๋ค.
๐ ์ถ์ฒ: ์ ์ด๊ธฐ ์ํํ๊ฐ ๊ฒฐ๊ณผ ์ฑ๋ฅ ๋ถ์
๐งฎ ์ฑ์ ํ
์ ๋ต ํ๋์ ๋ณด๊ธฐ (๋ค ํผ ๋ค์ ์ด๊ธฐ)
| ๋ฌธํญ | 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 | 9 | 10 |
|---|---|---|---|---|---|---|---|---|---|---|
| ์ ๋ต | โฃ | โ | โก | โข | โก | โฃ | โฃ | โข | โฃ | โ |
| ๋ฌธํญ | 11 | 12 | 13 | 14 | 15 | 16 | 17 | 18 | 19 | 20 |
|---|---|---|---|---|---|---|---|---|---|---|
| ์ ๋ต | โฃ | โก | โก | โ | โข | โข | โ | โฃ | โข | โก |
ํ์ : 16๊ฐ ์ด์ = ์์ ๊ถ ยท 12~15๊ฐ = ํฉ๊ฒฉ๊ถ(ํ๊ท 60์ ๊ธฐ์ค) ยท 8๊ฐ ๋ฏธ๋ง = ๊ณผ๋ฝ ์ํ, ์๋ ๋งคํ์ผ๋ก ์ทจ์ฝ ์ธ๋ถํญ๋ชฉ ์ง์ค ๋ณต์ต
๋ฌธํญ โ ์ธ๋ถํญ๋ชฉ ๋งคํ (๋ณต์ต ๊ฐ์ด๋)
๐ ๊ด๋ จ
- _MOC ๋ชจ์ ์ํํธ์จ์ด โ ๊ณผ๋ชฉ ์ ์ฒด ๋ชฉ์ฐจ
- ๐ Home์ผ๋ก