[Motor Control] Geared Motor Modeling

JeongMin·2023년 10월 19일

모터제어

목록 보기
2/2

Geared Motord의 회전력

모터에 달린 기어:부하 쪽 기어 = N1:N2N_1:N_2

1) T=TM+TGM=JMθM¨+BMθM˙+JGMθM¨+BGMθM˙T = T_M+T_{GM} = J_M\ddot{\theta_M}+B_M\dot{\theta_M}+J_{GM}\ddot{\theta_{M}}+B_{GM}\dot{\theta_M},(TGMT_{GM}: 모터에서 바라본 기어측 수식)

2) TG=JGθG¨+BGθG˙T_G = J_G\ddot{\theta_G}+B_G\dot{\theta_G}

3) N1θM˙=N2θG˙θG˙=N1N2θM˙N_1\dot{\theta_M} = N_2\dot{\theta_G} \rightarrow \dot{\theta_G}=\frac{N1}{N2}\dot{\theta_M}

만약 기어에서 손실이 발생하지 않는다면 P=TGθG˙=TGMθM˙P = T_G\dot{\theta_G} = T_{GM}\dot{\theta_M}

하지만 손실은 발생할 수 밖에 없음. 이때 기어의 효율을 α\alpha라고 하면 TGθG˙=αTGMθM˙T_G\dot{\theta_G} = \alpha T_{GM}\dot{\theta_M}.

이 식에 3)번 식 대입 후 정리

TGN1N2=αTGMθM˙T_G\frac{N_1}{N_2} = \alpha T_{GM}\dot{\theta_M}

TG=αN2N1TGMθM˙T_G = \alpha \frac{N_2}{N_1} T_{GM}\dot{\theta_M}

2)번식 대입 후 정리

JGθG¨+BGθG˙=αN2N1TGMθM˙J_G\ddot{\theta_G}+B_G\dot{\theta_G}=\alpha \frac{N_2}{N_1} T_{GM}\dot{\theta_M}

3)번식 대입

JGN1N2θM¨+BGN1N2θM˙=αN2N1TGMθM˙J_G\frac{N1}{N2}\ddot{\theta_M}+B_G\frac{N1}{N2}\dot{\theta_M}=\alpha \frac{N_2}{N_1} T_{GM}\dot{\theta_M}

TGMT_{GM}에 대해 정리하면 아래와 같다.

TGM=1α(N1N2)2JGθM¨+1α(N1N2)2BGθM˙T_{GM} = \frac{1}{\alpha} (\frac{N_1}{N_2})^2 J_G\ddot{\theta_M}+\frac{1}{\alpha} (\frac{N_1}{N_2})^2 B_G\dot{\theta_M}

T=TM+TGM=JMθM¨+BMθM˙+1α(N1N2)2JGθM¨+1α(N1N2)2BGθM˙=JeqθM¨+BeqθM˙\therefore T = T_M+T_{GM} =J_M\ddot{\theta_M}+B_M\dot{\theta_M}+\frac{1}{\alpha} (\frac{N_1}{N_2})^2 J_G\ddot{\theta_M}+\frac{1}{\alpha} (\frac{N_1}{N_2})^2 B_G\dot{\theta_M}=J_{eq}\ddot{\theta_M}+B_{eq}\dot{\theta_M}

(Jeq=JM+1α(N1N2)2JGJ_{eq}=J_M+\frac{1}{\alpha} (\frac{N_1}{N_2})^2 J_G, Beq=BM+1α(N1N2)2BGB_{eq}=B_M+\frac{1}{\alpha} (\frac{N_1}{N_2})^2 B_G)

Intertia

ρ=massvolume=mV\rho = \frac{mass}{volume} = \frac{m}{V}

J=r2dmJ=\int r^2 dm

Ex) 반지름이 R인 원판의 intertia

ρ=mπr2ρπr2=mρ2πrdr=dm\rho = \frac{m}{\pi r^2} \rightarrow \rho \pi r^2 = m \rightarrow \rho 2\pi r dr = dm

J=r2dm=ρ2πr3dr=ρ12π[r4]0R=ρ12πR4,(ρ=mπR2)J = \int r^2 dm = \rho \int 2\pi r^3dr=\rho\frac{1}{2}\pi[r^4]^R_0 = \rho\frac{1}{2}\pi R^4, (\rho = \frac{m}{\pi R^2})

J=12mR2\therefore J=\frac{1}{2}mR^2

1) Stretch Rule

회전축과 동일한 방향으로 강체를 늘려도 intertia는 변하지 않는다.

반지름이 R인 원판과 반지름이 R, 높이가 H인 원기둥의 interita는 12mR2\frac{1}{2}mR^2으로 동일하다.

2) 평행축 정리

회전축과 물체의 질량중심이 평행하게 d만큼 떨어져 있다면 intertia는 다음과 같이 게산한다.

J=JCM+Md2J=J_{CM}+Md^2

3) 수직축 정리

Jz=Jx+JyJ_z = J_x+J_y

위 규칙들을 이용하여 부하의 intertia JLJ_L을 계산하고 회전력 수식에 포함시키면 다음과 같다.

T=(Jeq+1α(N1N2)2JL)θM¨+(Beq+1α(N1N2)2BL)θM˙T = (J_{eq}+\frac{1}{\alpha} (\frac{N_1}{N_2})^2 J_L)\ddot{\theta_M}+(B_{eq}+\frac{1}{\alpha} (\frac{N_1}{N_2})^2 B_L)\dot{\theta_M}

Jeq+1α(N1N2)2JL)θM¨J_{eq}+\frac{1}{\alpha} (\frac{N_1}{N_2})^2 J_L)\ddot{\theta_M}JeqJ_{eq}BeqB_{eq}를 다시 정의할 수 있다.

Jeq=JM+1α(N1N2)2JG+1α(N1N2)2JLJ_{eq} = J_M+ \frac{1}{\alpha} (\frac{N_1}{N_2})^2 J_G+\frac{1}{\alpha} (\frac{N_1}{N_2})^2 J_L, Beq=BM+1α(N1N2)2BG+1α(N1N2)2BLB_{eq} = B_M+ \frac{1}{\alpha} (\frac{N_1}{N_2})^2 B_G+\frac{1}{\alpha} (\frac{N_1}{N_2})^2 B_L

profile
영상처리와 AI에 관심이 있는 학생입니다.

0개의 댓글