ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ
์ด ๊ธ์ ๋จ์ํ ๋ถ์์ผ๋ก ๋ค๋
์จ ์ฑ๊ฐํฌ๋ฅด์ ๊ธฐํ ๋ชจ์ต์ ๋ํ ๊ธ์
๋๋ค. ์๋์ด๋ ์ฆ๊ฒ๊ฒ ๋ด์ฃผ์ธ์. ์๋ ๋งํฌ๋ ๋ฐํ ์์๊ณผ QnA ์์์
๋๋ค. https://youtu.be/dQgA0RhFtkA https://youtu.be/c0_OI3zA_HM ------------------------์ฑ๊ฐํฌ๋ฅด ์ฌ์ง------------------------- ์๋ ๋งํฌ๋ ํ๊ตฌ์ ๊นํ ๋งํฌ์ด๋ค. https://github.com/MOSW626/Tug_of_War_Robot_Project_-2022-.git GitHub - MOSW626/Tug_of_War_Robot_Project_-2022- Contribute to MOSW626/Tug_of_War_Robot_Project_-2022- development by cr..
ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ
๊ทธ๋ ๋ค. ๋๋ฌ๋ค. ๋ฏธ๋ฆฌ ๊ฐ๊ธฐ ์ ์ ์ด๋ค ์์ผ๋ก ๋ฐฐ์นํ ์ง์ ๋ํด์ ์๋ฎฌ๋ ์ด์
์ ๋๋ ค๋ณด์์ผ๋ฉฐ, ์๋ ์ฌ์ง์ฒ๋ผ ๋ฐฐ์น ํ๊ณ ๋ฐํํ๋ค. ๋ฐํ๊ฐ ๋๋๊ณ ๋ ์๊ฐ์ ์ด? ์ฑ๊ณต์ธ๊ฐ ์๋ค. ์๋
๊ณผ ๋ค๋ฅด๊ฒ ๋ฐํ๊ฐ ๋๋ฆ ์ ํ๋ ธ๋ค๋ ์๊ฐ์ด ๋ค์๊ณ , ๊ฒฐ๊ตญ ๋ํต๋ น์์ ๋ฐ์ ์ ์๊ฒ ๋์๋ค. ์ด๋ ๊ฒ ํ๊ตฌ๋ฅผ ์ ๋ง๋ฌด๋ฆฌ ์ง์์ผ๋ฉฐ, ์ดํ ๋ถ์์ผ๋ก ์ฑ๊ฐํฌ๋ฅด๋ฅผ ๋ค๋
์ค๊ฒ ๋์๋ค. ์๋ ๋งํฌ๋ ํ๊ตฌ์ ๊นํ ๋งํฌ์ด๋ค. https://github.com/MOSW626/Tug_of_War_Robot_Project_-2022-.git GitHub - MOSW626/Tug_of_War_Robot_Project_-2022- Contribute to MOSW626/Tug_of_War_Robot_Project_-2022- development by cre..
ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ
์ค์ค์ด 9ํธ๋ฅผ ๊ฐ์ง๊ณ ๊ฒฐ๊ณผ์ ์ผ๋ก ๋ค์๊ณผ ๊ฐ์ ๋ฐฉ์์ ์คํ์ ์งํํ์๋ค. python์ ์ด์ฉํด ๋ค์๊ณผ ๊ฐ์ ์ฝ๋๋ฅผ ์ด์ฉํด์ ์๋์ด๋
ธ์์ ๋ชฉํ๊ฐ๊ณผ ํ์ฌ ๊ฐ๋๋ฅผ ๋ฐ์ผ๋ฉฐ ์ด๋ฅผ ๋
ธํธ๋ถ์ csv๋ก ์ ์ฅํ๋ค. ์๋์ด๋
ธ ์ฝ๋ ๋๋ณด๊ธฐ #include // arduino ==> ์
ํ๋ฐธ๋ฐ์ฑ๋ก๋ด์ ๋ง๋ค์ด ์คํํด๋ณธ ์ฝ๋ //----------------------------- ------------------------------- // PID ์ ์ด, ๋ชจํฐ ์ ์ด, MPU6050์ผ์ ๊ฐ์ ๋ฐ๊ธฐ ์ํ ์ ์ธ๋ฌธ #include #include #include "I2Cdev.h" #include "MPU6050_6Axis_MotionApps20.h" //MPU ๊ฐ์ฒด๋ฅผ ์ ์ธํฉ๋๋ค MPU6050 mpu; //-----------------..
ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ
7ํธ๊ฐ ๋ง๊ฐ์ง๊ณ ๋๋ฌผ์ ๋จธ๊ธ๊ณ ์ด์๊ฒ 8ํธ๋ฅผ ์ ์ํ๊ฒ ๋์๋ค.์ํฌ๋ฆด์ ์ฌ์ฉํ์์ผ๋ฉฐ ์์ ๋ชจํฐ๋ฅผ ์ด์ฉํ๊ณ , ์๋ฉด์ ๊ตฌ๋ฉ์ ๋ซ์ด์ ์ค์ ๋ฌถ๋ ์์น๋ฅผ ์กฐ์ ํ ์ ์๋๋ก ํ์๋ค. ์คํ ์ค ์ค์ ๋ฌถ๋ ์์น๊ฐ ์๋์ด๋
ธ์ ๊ฒน์ณ์ ์คํ์ด ์ด๋ ค์ฐ๋ฉฐ ์ข์ฐ ์์ง์์ด ์ฌํ๋ค๋ ๋ฌธ์ ๊ฐ ์๊ฒผ๋ค. ๋ฐ๋ผ์ 9ํธ๋ฅผ ์ ์ํ์ฌ ์ค์ ๋ฌถ๋ ์์น๋ฅผ ํด๊ฒฐํ์์ผ๋ฉฐ ์ค์ Y์ ํํ๋ก ๋ง๋ค์ด์ ์ข์ฐ ์์ง์์ ์ก์๋ค. ํ๋ ์ ๊ณ ์ ์ ์์ด์ ๋ธ๋ผ์ผ์ ํ์ฉํ๋ค. ํ์ง๋ง ์ด๋ ์ ์์ ์ผ๋ก ์ธํด์ ์คํ์ ์ํฅ์ ๋ฏธ์น๋ค๋ ๋จ์ ์ด ์์๋ค. ์ดํ ๋ฐฐํฐ๋ฆฌ ํฉ์ ์ด์ฉํด์ 10ํธ๋ฅผ ๋ง๋ค๊ธฐ๋ ํ์์ง๋ง PID๊ฐ ์ ๋๋ก ์ ์กํ ๋ฟ๋๋ฌ ์คํ์ ํ์ฉํ๊ธฐ ๋ถ์ ํฉํ๊ธฐ์ 9ํธ๋ก ์ผ๋จ ๋ง๋ฌด๋ฆฌํ์๋ค. ์๋ ๋งํฌ๋ ์งํํ ํ์ผ์ ๊นํ ๋งํฌ์ด๋ค. https://github.com/MOSW..
ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ
์ฐ๋ฆฌ๋ ์ง๊ธ๊น์ง ๋ค์๊ณผ ๊ฐ์ ์์์ ๊ธฐ๋ณธ์ผ๋ก ํด์ ๋ฐ๋์ ๋ฌผ๋ฆฌ์ , ์ํ์ ๋ชจ๋ธ์ ์ธ์ ์คํ์ ์งํํ๊ณ ๊ฒฐ๋ก ์ ๋์ถํ๊ณ ์์๋ค. $$ T = m \csc \theta ( b\sec \theta {{d^2 \theta } \over {d t^2}} + 2{{d \theta} \over {dt}} + g \cos \theta )$$ ํ์ง๋ง ๋ณด๊ณ ์๋ฅผ ์ ์ถํ ๋ค ์ฐจํธ๋ฅผ ๋ง๋ค๋ฉด์ ํ๋ฒ ๋ ์ฆ๋ช
์ ํ๋ ๊ณผ์ ์์ ์ค๋ฅ๊ฐ ์์์ ์๊ฒ ๋์ด ๋ฉ์ธ ์์์ ๊ณ ์น๊ฒ ๋์๋ค. ๋คํํ๋ ๋ฐ๋ ์์์ ํตํด์ ๋ฌธ์ ๊ฐ ํฌ๊ฒ ํน์ ๊ฒฐ๋ก ์ด ๋ฐ๋ ๊ฒ์ด ์๋๋ผ ์ฐ๋ฆฌ๊ฐ ๊ตฌํ๋ ์ ๋ต์์ ์กฐ๊ธ์ฉ ์๊ธด ์ค๋ฅ๋ค์ด ํด๊ฒฐ๋ ๊ฒ์ด์๊ธฐ ๋๋ฌธ์ ์คํ๋ ค ์ข์ ์ํฉ์ด ๋์๋ค. ๋ฐ๋ ์์์ ๋ค์๊ณผ ๊ฐ๋ค. $$ \Sigma \tau = {{d} \over {dt}}(..
ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ
์์์ ์์ฑํ ์ค์ค์ด 5ํธ์ 6ํธ๋ฅผ ์ ์ํ๊ณ , ๋ชจํฐ๋ฅผ ๋ฐ๊พธ๊ธฐ ์ด๋ ค์ธ ๋ฟ๋๋ฌ, ์ค๋ค๋ฆฌ๊ธฐ์ ์ ์ฉํ๊ธฐ ์ด๋ ค์ด ๋ชจ์ต์ด๋ผ๋ ํ๊ณ์ ์ํด์ ์ค์ค์ด 7ํธ๋ฅผ ์ ์ํ๊ฒ ๋์๋ค. ์ค์ค์ด 7ํธ๋ฅผ ๊ธํ๊ฒ ๋ง๋ค๊ฒ ๋๋ฉด์ ์ํฌ๋ฆด์ด ์๋ mdf๋ฅผ ์ง์ ์์ฐ๋ก ์ปคํ
ํ๊ณ , ์ ์ํ ๋๋ฌธ์ ์ด์ง ์ด์คํ ๋ชจ์ต์ด๋ผ๊ณ ์๊ฐํ๋ค...ใ
ใ
๊ฐ๋จํ ๋ณด์๋ฉด ํฌ์ธํธ๋ ๋ค์๊ณผ ๊ฐ๋ค. 1. ๋ฐํด์ ๊ณ ๋ฌด ํจํน์ ์งํํด, ๋ง์ฐฐ์ ๋๋ ค ๊ฐ๋ ๋ณด์ ์ด ์ฝ๋๋ก ๋ง๋ค์๋ค. 2. ์์์ ๋งํ ๊ฒ๊ณผ ๊ฐ์ด mdf๋ก ๋ง๋ค๋ฉฐ ์ค๋ค๋ฆฌ๊ธฐ๋ฅผ ์งํํ๊ธฐ์ ์ ํฉํ ๊ตฌ์กฐ๋ก ์ ์ํ์๋ค. ๋ค์๊ณผ ๊ฐ์ด ์ ์ํ์ฌ ์๋์ ๊ฐ์ด ๊ฐ๋๋ฅผ ์ ์งํ ์ ์๋ ๊ฐ์ ๋ํด์ ํ
์คํธ๋ฅผ ์งํํด๋ณด์๋ค. https://youtu.be/joFds-6ifk0 (์คํ ์์) ์ ์ฌ์ง์ ๋ณด๋ฉด 10๋์์๋ ๊ฐ๋๋ฅผ ์ถฉ๋ถํ ์ ์ง..
ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ
์ ์ค์ค์ด 4ํธ ์ดํ PID ๋ถ๋ถ์์๋ ๋๋ ๊ฑด๋๋ฆด ๋ถ๋ถ์ด ์๋ค๊ณ ํ๋จํ์ฌ ๋ฐํด๋ฅผ ๋ฐ๊พธ์ด๋ณด๋ฉด์ ์ค์ค์ด 5ํธ๋ก ์ค์ค์ด๋ฅผ ์
๊ทธ๋ ์ด๋์์ผฐ๋ค. ์ค์ค์ด 5ํธ์์ ๋ฉ์ธ์ผ๋ก ์
๊ทธ๋ ์ด๋ ํ ๋ถ๋ถ์ ๋ฐํด์ด๋ค. ํ์ฌ ๋ฐํด๋ ์๋์ด๋
ธ ์์จ์ฃผํ ํคํธ์ ๊ธฐ๋ณธ ๋ฐํด๋ก ๋ง์ฐฐ๊ณผ ํฌ๊ธฐ ๋ชจ๋ ๋ค ์์ฝ๋ค๋ ๋ฌธ์ ๊ฐ ์์๋ค. ๋ฐ๋ผ์ ์ ๋ฐํด์ ์ฌํฌ๋ฅผ ๋ถ์ฌ๋ณด๊ธฐ๋ ํ๊ณ , ์ข
์ด๋ฅผ ๋ถ์ฌ๋ณด๊ณ , ๋ค๋ฅธ ๊ณ ๋ฌด๋ฅผ ์์ ๋ง๋์ด์ ๋ง์ฐฐ์ ๋๋ฆฌ๊ฑฐ๋ ํฐ ๋ฐํด๋ก ๋ฐ๊พธ๋ ค๋ ์๋๋ฅผ ์งํํ์๋ค. ๊ทธ์ค์์ ํฐ ๋ฐํด๋ฅผ ์ด์ฉํ ๋ฐฉ์์ด ๋ฐํด์ ํ์ ๊ด์ฑ์ ๋๋ ค์ฃผ๋ฉด์ ์ ์ฒด์ ์ธ ํ์ ๊ด์ฑ์ ๋์ฌ์ฃผ์๊ธฐ ๋๋ฌธ์ ์๋ ์ฌ์ง๊ณผ ๊ฐ์ด ๋ง์ ๊ฐ์์ ๋ฐํด๋ฅผ ํ๋ฆฐํธ๋ฅผ ์งํํด ์ค์ค์ด 5ํธ๋ฅผ ์์ฑํ๊ฒ ๋์๋ค. ์ด๋ฅผ ํตํด ๋ ์์ ์ ์ผ๋ก ๊ฐ๋๋ฅผ ์ ์งํ๋ ์ค์ค์ด๋ฅผ ๋ง๋ค ์ ์์๋ค. ํ์ง๋ง, ๋ชจํฐ๊ฐ ์ข์ง ๋ชปํ..
ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ
์ด๋ฒ ๊ธ์์๋ PID์ ํจ๊ป ๋๋ฅผ ๊ดด๋กญํ์๋ ์นผ๋งํํฐ์ ๋ํด์ ์ฐ๊ณ ์ ํ๋ค. ์ ์ ์นผ๋งํํฐ๋ ์ก์์ด ํฌํจ๋์ด ์๋ ์ธก์ ์น๋ฅผ ๋ฐํ์ผ๋ก ์ ํ ์ญํ๊ณ์ ์ํ๋ฅผ ์ถ์ ํ๋ ์ฌ๊ท ํํฐ์ด๋ค. ์ด๋ ํต๊ณ์ ๋
ธ์ด์ฆ ๋ฐ ๊ธฐํ ๋ถ์ ํ์ฑ์ ํฌํจํ์ฌ ์๊ฐ์ด ์ง๋จ์ ๋ฐ๋ผ ๊ด์ฐฐ๋ ์ผ๋ จ์ ์ธก์ ์ ์ฌ์ฉํ๊ณ ๊ฒฐํฉ ํ๋ฅ ๋ถํฌ๋ฅผ ์ถ์ ํ์ฌ ๋จ์ผ ์ธก์ ๋ง์ผ๋ก๋ ๋ ์ ํํ ๊ฒฝํฅ์ด ์๋ ์๋ ค์ง์ง ์์ ๋ณ์์ ์ถ์ ์น๋ฅผ ์์ฑํ๋ ์๊ณ ๋ฆฌ์ฆ์ด๋ค. ์ด๋ Rudolf E.Kálmán์ด ์ฃผ์ ๊ฐ๋ฐํ์๋ค. ์? ์ฌ์ฉํ ๊น ์นผ๋งํํฐ๋ฅผ ์ฌ์ฉํ๋ ์ด์ ๋ ์ด๋์ ์ฌ์ฉ๋๋ ๊ฐ๋ฅผ ๋จผ์ ์์์ผ ํ๋ค. ์นผ๋งํํฐ๋ ํ์๊ฐ ๋ก๋ด ์ค์ค์ด๋ฅผ ๋ง๋ค ๋ ์ฌ์ฉํ ๊ฒ๊ณผ ๊ฐ์ด ๋ก๋ด๊ณผ ์์จ์ฃผํ ์๋์ฐจ์ ๊ฐ์ ๊ณณ์ ์ด์ฉ๋๋ค. ๊ทธ ์ด์ ๋ ์ฃผํ ์ค์ ๋ณ์ ๊ฐ์ง์ ์ฃผํ ์ ์ด์์ ํ์ฌ ์์น๋ฅผ ์ธก์ ํ๋ ..
ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ
์ด๋ฒ์๋ ์ ๊ตญ๊ณผํ์ ๋ํ์ ์ง์ถ ํ ๋ค์ ๊ฐ์ฅ ๋ง์ ์๊ฐ์ ๋ค์ฌ์ ๊ณต๋ถํ๋ PID์ ๋ํด์ ๊ธ์ ์จ๋ณด๊ณ ์ ํ๋ค. ๋จผ์ , ๋๋ ์ผ๋ฐ์ ์ผ๋ก ๊ทธ๋ฐ ์๊ณ ๋ฆฌ์ฆ์ ์ ํ ๋ชจ๋ฅด๋ ์ํฉ์ด์๋ค. ๊ทธ๋ฐ๋ฐ ์ค์ค์ด๋ก ์ธํด์ ์๋์ ์ด๋ฅผ ํด์ผ ํ๋ ์ํฉ์ด ์ค๊ฒ ๋์๊ณ , ๊ฒฐ๊ตญ pid๋ฅผ ๊ณต๋ถํ๊ธฐ ์์ํ๋ค. 1. ์ ์ PID์ ์ด๋ ๋น๋ก-์ ๋ถ-๋ฏธ๋ถ ์ ์ด๊ธฐ(Proportional-Integral-Differential controller)๋ก ์ค์ ์์ฉ๋ถ์ผ์์ ๊ฐ์ฅ ๋ง์ด ์ฌ์ฉ๋๋ ๋ํ์ ์ธ ํํ์ ์ ์ด๊ธฐ๋ฒ์ด๋ค. ๋ค์๊ณผ ๊ฐ์ ๊ทธ๋ฆผ์ ๋ชจ์ต์ผ๋ก ์ด๋ฃจ์ด์ง๋ ์ ์ด๊ธฐ์ด๋ค. ๊ธฐ๋ณธ์ ์ผ๋ก feedback ์ ์ด๊ธฐ์ ํํ๋ฅผ ๊ฐ์ง๊ณ ์์ผ๋ฉฐ, ์ ์ดํ๊ณ ์ ํ๋ ๋์์ output์ ์ธก์ ํ์ฌ ์ํ๊ณ ์ ํ๋ Set point๊ณผ ๋น๊ตํด์ error๊ฐ์ ๊ณ์ฐํ๊ณ ์ด ์ค์ฐจ๊ฐ์ ..
ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ
์ ์ ์ ๊ธ๋ค์์ ๋ง๋ ์ด๋ก ๊ณผ ๋ก๋ด์ ๊ฐ์ง๊ณ , ๋ํ์ฅ์ ๊ฐ๋ค. 2023.03.01 - [ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ] - [22' ์ ๋ํ] ์ถฉ๋ถ๊ณผํ์ ๋ํ (2) - ์ค๋ค๋ฆฌ๊ธฐ๋ฅผ ์ญํ์ ์ผ๋ก ์์๋ณด์ 2023.03.03 - [ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ] - [22' ์ ๋ํ] ์ถฉ๋ถ๊ณผํ์ ๋ํ (3) - ์ค๋ค๋ฆฌ๊ธฐ๋ฅผ ๋ก๋ด์ผ๋ก ๊ตฌํํ์ (1) 2023.03.03 - [ํ๊ตฌ ๐พ/2022 ํ๊ตฌ ์ด์ผ๊ธฐ] - [22' ์ ๋ํ] ์ถฉ๋ถ๊ณผํ์ ๋ํ (4) - ์ค๋ค๋ฆฌ๊ธฐ๋ฅผ ๋ก๋ด์ผ๋ก ๊ตฌํํ์ (2) ๊ทธ๋ฆฌ๊ณ ๋ค์๊ณผ ๊ฐ์ด ์ธํ
ํ์๊ณ , ๋ฐํ๋ฅผ ์งํํ์๋ค. ์ฐจํธ ํ์ผ๋ ๊นํ์ ์์ผ๋, ์๋ตํ๊ณ ์ ํ๋ค. ์ด๋ ๊ฒ ๋ฐํ๋ฅผ ํ๊ณ ์ ๊ตญ๊ณผํ์ ๋ํ์ ๊ฐ๊ฒ ๋์๋ค. ๊ทธ๋๋ ์๋
์ ๊ฒฝํ์ด ๋์์ด ๋์ด ๋น๊ต์ ์ฝ๊ฒ ์งํํ ์ ์๋ ๊ฑฐ ๊ฐ๋ค. ์ ๊ตญ๊ณผํ์ ๋ํ๋ก..