검색결과 리스트
글
2010년 1월 24일을 기준으로 사소한 오타와 잘못된 식을 다시 정리했습니다. 혹시 이전에 이 글을 읽으셨던 분들이라면 다시 확인하시길 바랍니다.
이번에 크리스마스때 태국에서 개최되는 학회를 다녀왔는데요. 비행시간이 6시간인데 갈때 너무 지루하더군요. 잠도 오질 않고... 그래서 이전에 밸런싱로봇([공학기초/Robot] - Balancing Robot 밸런싱 로봇) 동역학이 엉망으로 정리된듯해서 그걸 다시 정리해서 올려야겠다고 생각하고 정리했습니다. 비행기 안에서 주는거 다 받아 먹으면서 정리했더니 대략 한 3시간 정도 걸렸네요. 뭐 그래도 지루하지 않은 비행이었습니다^^.
이번엔 저도 이걸 다시 만들어야겠다는 생각을 해서 제가 만들어 가는 과정을 당연히 정리하는 과정에서 예상 기구부를 생각하고 위와 같이 개념도를 만들었습니다. 일단 기구부의 자세한 설명은 나중에 다시 이야기 하고, 로봇은 전체적으로 하단과 상단에 질랴이 모여있도록 만들것입니다. 동역학을 유도해보면 그게 식도 간편하고 편하거든요^^ 하단의 질량체의 위치벡터와 상단의 위치벡터는 각각
입니다. 여기서 R은 하단 질량체를 원형이라고 가정했을 때 반지름이고, l은 하단과 상단 질량체간의 거리입니다. 또한, theta는 전체 밸런싱로봇의 기울어진 각도, y는 하단 질량체의 이동거리입니다. 질량체의 회전각속도와 y의 관계는
이므로
라고 생각할 것입니다.
위의 위치벡터에서 속도벡터는
입니다.
라그랑지 방법을 사용하기 위해 각 운동에너지와 위치에너지를 정의하면
입니다.
여기서 라그랑지
는
입니다.
각 상태, y, theta에 대해서 일반적 외부힘을 고려한 라그랑지 방정식
을 유도하면
입니다. 여기서 로봇을 이동시키는 힘을 고려하여 외력을 잡으면
입니다. 여기서 f_i는 마찰계수입니다.
상태
에 대해
의 형태로 위 라그랑지방정식을 다시 표현하면
입니다. 이제
를 이용해서 흔히 사용하는 동역학을 구해보면
입니다. 이렇게 동역학이 완성이 되었네요. 이 동역학대로 로봇을 만들려고 하는데요. 기구부는 뭐 언제 만들어질진 저도 잘 모르겠네요^^ 근데 꼭 필요한 것은 theta와 y의 상태를 꼭 알아야한다는 것을 알 수 있네요. 아참 MATLAB으로 정리한 것을 일반적 수식 전개법을 사용하지 않아 각 문자의 배치가 영엉망이네요... 그래도 식이 간단하니 알아보실 수는 있겠죠?^^
'The Robot > ControlTheory' 카테고리의 다른 글
| Reaction Wheel Pendulum. 리액션 휠 펜들럼의 동역학 유도과정 수정 (6) | 2010/06/15 |
|---|---|
| Reaction Wheel Pendulum. 리액션 휠 펜들럼의 동역학 및 시뮬레이션 (10) | 2010/05/14 |
| T-S 퍼지를 기본으로 한 선택적 선형화를 이용한 Two-Rotor (VTOL) 시스템 제어 (4) | 2010/04/19 |
| 밸런싱 로봇의 동역학 유도 (16) | 2010/01/03 |
| 제어입력의 크기를 가늠하기 위한 단순 진자 시뮬레이션 실험 (0) | 2009/11/30 |
| Cart Pendulum의 동역학 유도 (20) | 2009/11/06 |
| 내부모델설계기법 Internal Model Design (2) | 2009/10/07 |
| T-S 퍼지를 이용한 쿼드콥터 제어 (14) | 2009/07/23 |
설정
트랙백
http://pinkwink.kr/trackback/244
안녕하세요~ pinkwink님 블로그 내용들이 너무 좋아 이것저것 보고있는 전기과학생입니다.
다름아니라, 위의 동영학유도과정에서 궁금점이 생겼는데요.
운동에너지 TM을 정의하시는데 있어서, 파이는 각속도를 의미하는게 맞나요?
그럼 Jm은 관성모멘트가 되는지...
주변 기계과 친구들한테 물어봐도, 이친구들 속빈 강정이라!-_-a 시원한 대답이 없어서 이곳에 질문글 남겨봅니다.
오늘 하루 날씨 너무 좋은데요~ 그럼 수고하세요!
phi는 각도입니다^^
운동에너지는 속도성분을 고려해야하니 dot_phi를 사용한 것입니다. 그리고 회전운동성분이 1/2 * Jm * dot_phi^2 이고, 여기서 Jm은 회전관성모멘트입니다^^
우옷! 빠르고 친절한 답변 정말 감사드립니다.
실은 제가 저번학기 제어 과목 수강중에, 도립진자의 모델링부터 매트랩을 이용한 PID제어까지 해봄으로써 이런 제어 분야에 관심이 생기게 되었고, 그와중에 이 밸런싱로봇을 한번 직접 만들어보자!! 라는 생각에..
학부생 혼자서 무턱대고 들이대는거라, 기간을 길게 2년 안쪽으로 잡고 차근히 해보려는 중입니다. (기간이 긴건 중간에 휴학하고 이것저것 할 계획인지라 ㅎ;)
일단 시간 낸만큼! 또 pinkwink님의 이 글을 발견한지라! 동역학유도부터 이해해보려고 질문글을 올렸네요.ㅎ
염치없지만 자주자주 찾아와서 도움요청하겠습니다! (그래봐야 실제론 드문드문 -_-a)
좋은하루보내시길! 'ㅡ'
네... 좋은 성과 있으시길 바랍니다^^
질문이야.. 제가 답변할 수 있는 정도라면 언제든 방갑지요^^
라그랑지 Ξθ 가 의미하는 것이 토크 아니예요?? 그래서 바로 로봇토크에 Ξθ식 넣어주면 되지 않나요?? 굳이 왜 q''=M(inv)*(F-G-Cq')으로 고쳐서 θ''에 대한 식으로 뽑아내는 것입니까??
제가 전자공학을 전공하고 있는 학생이라서 이런 기계나 동역학쪽에는 살짝 문외한이라 많이 부족합니다. 자동제어 쪽에 관심이 있어서 밸런싱 로봇을 만들어 볼려 하는데 보통일이 아니네요.... 답변 부탁하겠습니다.
좋은 하루 되세요~~
더블닷으로 정리하는 이유는 여러가지가 있겠지만 시뮬레이션을 위해서는 꼭 필요합니다. Algebric Loop Warning이 일어나거든요. 또한 선형화후 특성방정식을 만들때도 필요합니다. ^^
학과공부를 하다가 다시 본격적으로 방학 때 Balancing Robot을 하려다 보니까 질문이 조금 늦었습니다.ㅎㅎ
특성 방정식을 알아내는 이유는 무엇인지 궁금합니다.
그 방정식으로 부터 plant의 특성인 G(s)를 알아내서 transfer function을 알아내고, 그 G(s)와 T(s)로 부터 나이퀴스트 plot이라던가 bode plot을 그려서 시스템 안정도를 다 따져보고, 그 안정할 때의 gain값을 찾아서 PID 제어기를 설계하기 위함인가요??
제가 공부하기론 그런거 같은데 pinkwink님의 관련 포스트를 봤을 땐 그쪽으로 유도하지는 않았던 것 같았습니다.. 그래서 그게 궁금합니다. ㅎㅎㅎ
좋은 하루 되세요~
그거야 당연히 제어기를 설계하기 위해서이고, 또한 시뮬레이션을 위해서이지요
y에 대해 편미분 한 방정식은 시뮬레이션을 위한 것인가요??
실제 DSP에 코딩한 방정식은 θ'에 대한 식을 PWM으로 넣어 준건가요?
혹시 그렇다면 그 이유를 듣고 싶습니다.
pinkwink님의 생각을 들어 보고 싶어서요.........제가 공부를 바닥부터
하고 있는데 제대로 하고있는지, 잘 나아가고 있는지 의문도 들고 해서요..
좋은 하루 되세요~~~
순전히 저의 경우에 대한 답변입니다.
동역학을 유도하는 것의 첫 목표는 시뮬레이션을 위해서입니다. 저는 MATLAB이라는 프로그램을 많이 사용하는데, 실제로 만들어보거나 혹은 만들어져있다하더라도 각종 테스트를 위해 동역학을 유도하여 그 수식을 MATLAB에 구현해서 시뮬레이션을 합니다. 대상으로하는 시스템 대신 시뮬레이션을 하기 때문에 당연히 실제 시스템과 가급적 유사하게 동역학을 유도할려고 애를 씁니다.
두번째는 제어기를 만들기 위해서 입니다.
그럼 실제 시스템에는 제어기가 들어가는 것이지요.
위와 같이 유도된건 실제 시스템 대신 사용할려고 한거고, 실제로 구현할때는 위 동역학은 필요없습니다. 그저 도출된 제어기가 필요하죠. 그래서 그 제어기를 마이크로프로세서든 혹은 PC기반이든 이식하면 됩니다.
아하!!!! 그렇군요.... 그렇다면 그 쪽 관련 공부를 더 해 봐야겠네요.....
좋은 답변 감사합니다.~~ㅎㅎ
네... 화이팅입니다.
안녕하세요. 항상 많이 배우고 있습니다.
동역학식에서 바퀴의 위치에너지는 추가하시지 않았는데 이유가 궁금하네요.
질량의 밀도가 균일한 바퀴가 무게중심축에 고정된 상태에서
바닥에 접지하고 있다면
위치에너지는 고려하지 않아도 됩니다.
고려하고 식을 유도해도 바퀴반지름만큼 떠 있어도
그 바퀴반지름이 시간에 대한 변수가 아니라서
라그랑지안을 유도하는 과정에서 미분할때 없어져버립니다.
근데 밸런스로봇에 응용분야가 무엇인가요 왜만드는건지?
음.. 글쎄요...
당시 전.. 제어기술은 이런걸 보유하고 있고, 또, 자이로+가속도센서로 각도 측정은 잘 되고 있다...의 예제로서 .. 그러니까 한마디로 그냥 재미있어 보이길래 만들었는데요...