3D ํ๋ฆฐํฐ์ PID ํ๋์ ํตํ ์จ๋ ๋ณ๋ ์ต์ํ ๋ฐ ํ์ง ๊ฐ์ ์ ์ํ ํ
3D ํ๋ฆฐํฐ PID ํ๋ ์ค์ ๋ฐฉ๋ฒ:-์จ๋ ๋ณ๋ ์ต์ํ๋ก ์ถ๋ ฅ ํ์ง ๊ฐ์ ํ๊ธฐ
3D ํ๋ฆฐํฐ์ [ PID ํ๋ ]์ 3D ํ๋ฆฐํฐ์ ์์คํ ์ ์ต์ ํํ์ฌ ์์ ์ ์ธ ์จ๋๋ฅผ ์ ์งํ๋ ๋ฐ ๋์์ด ๋ฉ๋๋ค. ์ด๋ ์ธ์ ๊ณผ์ ์์ ์ด ๋ณ๋์ ์ต์ํํ์ฌ ์ธ์ ํ์ง์ ํฅ์์ํค๊ณ ์๊ธฐ์น ์์ ๋ฌธ์ ๋ฅผ ๋ฐฉ์งํ ์ ์์ต๋๋ค. 3D ํ๋ฆฐํฐ๋ ์์ ์จ๋์ ์ฐจ์ด๋ก ์ธ์ํ์ง์ ์ง์ด ์ข์ฐ๋๊ธฐ ๋๋ฌธ์ ์ถ๋ ฅ ๋์ค์ ์จ๋๋ณํ๊ฐ ์ฌํ๊ฒ ๋๋ฉด ๋ฌธ์ ๊ฐ ๋ฐ์ํ ์ ์์ต๋๋ค.
์ฒ์ ์ค์ ํ ์จ๋๋ ์ฃผ๋ณ์ ํ๊ฒฝ์ ๋ฐ๋ผ ๋ด๋ ค๊ฐ๋ค ์ฌ๋ผ๊ฐ๋ค๋ฅผ ๋ฐ๋ณตํ๋ฉด์ ๊ทผ์ฌ์น๋ฅผ ์ ์ง ํ๋ ค๊ณ ํฉ๋๋ค. ๊ทธ๋ฌ๋ ์ด๋ณ๋ ์์น๊ฐ ํฌ๋ค ๋ณด๋ฉด ์ถ๋ ฅ๋ฌผ ํ์ง์ ๋ฌธ์ ๊ฐ ์๊ธธ์ ์์ต๋๋ค. ์ด๋ฅผ ๋ฐฉ์ง ํ๊ธฐ ์ํด์ ์ผ์ ํ ์จ๋์ ํธ์ฐจ๋ฅผ ์ค์ด๋ ์์ ์ ๋๋ค.
3D ํ๋ฆฐํฐ PID P, I, D ๊ฐ ์กฐ์ ์ผ๋ก ์์ ์ ์ธ ์จ๋ ์ ์งํ๊ธฐ
PID ๊ฐ ์ด๊ธฐํ
PID ๊ฐ๋ค์ ์ด๊ธฐํํ๊ณ , PID ํ๋์ ์์ํ๊ธฐ ์ ์๋ ๊ธฐ๋ณธ๊ฐ์ผ๋ก ์ค์ ํฉ๋๋ค.
- ์ด ์ ์ด ์์น ํ์ธ: ๋จผ์ ํ๋ฆฐํฐ ์ ์กฐ์ฌ์ ๋ฌธ์๋ ์ฌ์ฉ์ ๋งค๋ด์ผ์ ์ฐธ์กฐํ์ฌ ํ์ฌ์ PID ๊ฐ๋ค์ ํ์ธํฉ๋๋ค. ์ด ๊ฐ๋ค์ ์ฃผ๋ก ์ด ์ ์ด๊ธฐ ์ค์ ๋ฉ๋ด์์ ํ์ธํ ์ ์์ต๋๋ค.
- ๋ชฉํ ์จ๋ ์ค์ : ํํฐ์ ๋ชฉํ ์จ๋๋ฅผ ์ค์ ํ๊ณ , ์ด ์ ์ด ์์คํ ์ด ์ด๋ฅผ ๋ฌ์ฑํ๋๋ก ํฉ๋๋ค.
- PID ๊ฐ ์กฐ์ : ํํฐ๊ฐ ๋ชฉํ ์จ๋์ ๋๋ฌํ ๋๊น์ง ์๊ฐ์ ์ธก์ ํฉ๋๋ค. ์ดํ PID ๊ฐ์ ์กฐ์ ํ์ฌ ์ํ๋ ์จ๋์ ๋ ๋น ๋ฅด๊ฒ ๋๋ฌํ๋๋ก ํฉ๋๋ค.
P ๊ฐ ์กฐ์
Proportional(๋น๋ก) ์ ์ด ๊ธฐ๋ฅ์ผ๋ก, ํํฐ ์ถ๋ ฅ์ ํ์ฌ ์จ๋์ ๋ชฉํ ์จ๋์ ์ฐจ์ด์ ๋น๋กํ์ฌ ์กฐ์ ํฉ๋๋ค. P ๊ฐ์ ๋์ด๋ฉด ์กฐ์ ์ด ๋ ๋น ๋ฅด๊ฒ ์ด๋ฃจ์ด์ง์ง๋ง, ์ค์ค๋ ์ด์ (์ง๋)์ด๋ ์์ ์ฑ ๋ฌธ์ ๊ฐ ๋ฐ์ํ ์ ์์ต๋๋ค.
I ๊ฐ ์กฐ์
Integral(์ ๋ถ) ์ ์ด ๊ธฐ๋ฅ์ผ๋ก, ์๊ฐ์ ๋ฐ๋ฅธ ์จ๋ ์ค์ฐจ์ ์ ๋ถ์ ๊ณ์ฐํ์ฌ ์ ์ดํฉ๋๋ค. I ๊ฐ์ ์กฐ์ ํ์ฌ ์๊ฐ์ ๋ฐ๋ฅธ ์ค์ฐจ์ ๋์ ์ ๋ณด์ ํ ์ ์์ต๋๋ค.
D ๊ฐ ์กฐ์
Derivative(๋ฏธ๋ถ) ์ ์ด ๊ธฐ๋ฅ์ผ๋ก, ์จ๋ ๋ณํ์จ์ ๋ํ ์๋ต์ ์ ์ดํฉ๋๋ค. D ๊ฐ์ ๋์ด๋ฉด ์ค์ค๋ ์ด์ ์ ์ค์ด๊ณ ์์ ์ฑ์ ํฅ์์ํฌ ์ ์์ง๋ง, ๋ฐ์ ์๋๊ฐ ๋๋ ค์ง ์ ์์ต๋๋ค.
๋ฐ๋ณต: ์๋ก์ด PID ๊ฐ๋ค์ ์ ์ฉํ๊ณ , ๋ชฉํ ์จ๋์ ๋๋ฌํ ๋๊น์ง ์ํํ๊ณ ์กฐ์ ํฉ๋๋ค. ์ด ๊ณผ์ ์ ๋ฐ๋ณตํ์ฌ ์ต์ ์ PID ๊ฐ๋ค์ ์ฐพ์ต๋๋ค.
ํ ์คํธ ์ธ์
PID ๊ฐ๋ค์ด ์ค์ ๋๋ฉด, ๋ช ๊ฐ์ง ํ ์คํธ ์ธ์๋ฅผ ํตํด ํ๋ฆฐํฐ์ ๋์์ ํ์ธํ๊ณ ์ธ์ ํ์ง์ ํ๊ฐํฉ๋๋ค.PID ํ๋์ ๋ช ๋ฒ์ ์๋๋ฅผ ํตํด ์๋ฒฝํ ๊ฒฐ๊ณผ๋ฅผ ์ป๋ ๊ฒ์ด ์ผ๋ฐ์ ์ ๋๋ค. ๋ฐ๋ผ์ ์ฌ๋ฌ ๋ฒ์ ์กฐ์ ๊ณผ ํ ์คํธ๊ฐ ํ์ํ ์ ์์ต๋๋ค.
๋ํ, ํน์ ํ๋ฆฐํฐ๋ ์ด ์นดํธ๋ฆฌ์ง์ ๋ฐ๋ผ ์ต์ ์ PID ๊ฐ์ด ๋ค๋ฅผ ์ ์์ผ๋ฏ๋ก, ์ ์ ํ ์กฐ์ ์ด ํ์ํฉ๋๋ค.
์๋ ๋ช ๋ น์ด๋ฅผ ์คํํ๋ฉด ๋ ธ์ฆ๊ณผ ๋ฒ ๋์ PID ํ๋์ด ์คํ๋๊ณ , ๊ฒฐ๊ณผ๊ฐ ์ ์ฅ๋ฉ๋๋ค. ์ด๋ ์จ๋ ํธ์ฐจ๋ฅผ ์ค์ด๋ ๋ฐ ๋์์ด ๋ ์ ์์ต๋๋ค.
M303 E-1 S70 C5
M303 E0 S210 C5
M500
M303: PID ์คํ ํ๋์ ์์ํ๋ ๋ช
๋ น์ด์
๋๋ค.
E-1: ํํฐ 1 (๋
ธ์ฆ)์ ๋ํ ํ๋์ ์๋ฏธํฉ๋๋ค.
E0: ํํฐ 0 (๋ฒ ๋)์ ๋ํ ํ๋์ ์๋ฏธํฉ๋๋ค.
S70: ๋ชฉํ ์จ๋๋ก 70C๋ฅผ ์ค์ ํฉ๋๋ค.
S210: ๋ชฉํ ์จ๋๋ก 210C๋ฅผ ์ค์ ํฉ๋๋ค.
C5: 5๋ฒ์ ์ํ์ ์ธก์ ํ์ฌ PID ๊ฐ์ ํ๋ํฉ๋๋ค.
M500: PID ํ๋ ๊ฒฐ๊ณผ๋ฅผ EEPROM์ ์ ์ฅํฉ๋๋ค.
M84: ๋ชจ๋ ๋ชจํฐ๋ฅผ ๋นํ์ฑํํฉ๋๋ค.