Sistema de Control de un péndulo Simple

(1)

��

P��:

G�� B�� M��

M��:

��

A��:

H�� A�� L�� E��

I�:

00012332

(2)

��

I��: E� �� , �� PID (P�� I�� D��). E� �� 1.1 M�� : P�� PID � �� . L�� PID, �� : �� (P), �� (I) � �� (D). E�� P, I, PI, PD � PID � �� 1.2

(3)

�� . L� �� :

  



 

_



_

 

_













_

D�� :





  



 

_

_{  }





�� E�� PID, ��



_

 

�



_

 

, �� , ��



_

�� 0� ��





�� . D�� 2.1 E� ��:





  



  

_

_{  }





� �� . E� ��



_

 

�



_

 

� �� (2) �� :





  



� �� 2.2 (2)

(4)

� �� (�� 2.3) � ��



_

, �� (�� 2.4) �� O��H. F�� : D��: E� �� (�� ) �� . E�� . E� �� H�� . L� �� . �� O��H � ��



_

�� , ��



_

��



_

. ��



_

, �� . �� , �� ω�ј�� . �� ω, �� :

  

E� ��:

  

(5)

P�� :

  

D�� P��:

  

� ��



_

. �� , �� N��, �� : ��



_



_



_

� .5*



_

∞ 0 �� .45*



_

1/1.2*



_

. 0 �� .6*



_

.5*



_

.125*



_

� ��



_

� ��



_

, �� (2):





  





1 � 1

_

 � 





� �� . �� A�� : A�� E��L��:

ℒ   − 

E� �� K �� .

  −

∗  ∗ ℓ ∗ ��





 

12ℓ ∗ c���



� 12−ℓ ∗ ���



��:

 = 12ℓ



�



�� 1.1

(6)

��:

ℒ = 12ℓ



�



�  ∗  ∗ ℓ ∗ C��





�� :







ℒ

´

− ℒ

  

E� ��:







ℒ

´

 

∗ ℓ



_��

ℒ

  − ∗  ∗ ℓ ∗��

P�� :







ℒ

´

− ℒ

   ∗ ℓ



_{��   ∗  ∗ ℓ ∗ ��  }

M�� :

 ∗ ℓ



_{��   ∗  ∗ ℓ ∗��  }

D��

��

:

��  

1 ∗ ℓ

_

 −  ∗  ∗ ℓ ∗ ��

�� :





= 





= 

´





� = 

′

 







�  

´´

 

1 ∗ ℓ



 −  ∗  ∗ ℓ ∗ ��

��





�





:





= 







=  1 ∗ ℓ

_

 −  ∗  ∗ ℓ ∗ �� 





(7)

L�� : F�� 1:







_

_







= 









= 1

F�� 2:













= −













= 

E��:



_{ }



_{}

_{= }



_{ }



_{}

_{= 1 ∗ }

_

P�� : �� :

� =   1

_{−ℓ  ∗  }



_

� 

_{� �  1 ∗ }



 ∗ 

 = 1  ∗  

_



_



�� :

 =  ∗  − 



∗ 

E� ��:

(8)

 − 



= 1

_{ −  ∗  − }



 − 



= 1

_

� ℓ ∗ 

ℓ  

 −1



 − 



= 1

_

� ℓ ∗ 

−ℓ 

 1

 − 



=



� ℓ





� ℓ

1

− ℓ

_

_

_� ℓ

_

_� ℓ



�� :

 =  

_

_

_{� ℓ ∗ }

_

_

�� :





= 

�





= 

�� :

(9)

A�� A�� B��: H�� : D�� :

 = 

_







� 







ℓ � 

_



E� �� , �� : ��:

ℓ = 1

�=1;

(10)

N�� :





� 

_

 � 9811

�� :





1

9811







_

0





981/100 P��





�� 0





> 

P�� 0 �� 1





= 1

P�� :





= 1

��





 = 



� 

_

 � 9811

 = 



� 1 � 9811

�� ω�ј

  



_

1 � 981

��

�� : ��:

−



_{� ��}

��

I��:

� � �

�� :

(11)

 � ��

_��





��:

 �  ��(��





�� :

 � � ∗  ∗ 

�

 � �

��:

 � � ∗ 

_

D��

 � � ∗ 

_

�� ω:

 � � ∗ 

 ��(��





��:





�  � ��∗ 

_{(�� (��}





��



_

�



_

�� 1.1 � �� PID: ��



_



_



_

�� .6*



_

.5*



_

.125*



_

�� :





� ��(��





� �5 ∗ �� ∗ 

_{(�� (��}





� ��

(12)





� ��5 ∗ �� ∗ 

_{(�� (��}





� �

�5��5

P�� :





 � ��  �

_{�� ∗  ��5��5 ∗ }





 � �  �

_{�� ∗  ��5�5 ∗ }





 � ��5��

_{�� ∗}



 ��  �



�� MA�LAB ��

(13)

�� 100

(14)

(15)

�� A� �� , �� PID, �� .

��

�� . (�.�.). �� 28 �� 2011, �� ://��.��.��.��.��.��/��2/C��III��2.�� , �. (M�� 2002). C�� A��.�� . ��, A��. M��, G. B. (28 �� M�� 2011). A�� .�� . D.F., M��.

(16)

Sistema de Control de un péndulo Simple

������� �� ������� �� ��

������� �� ������� �� �� ������� ������

������� ������

P�������:

P�������:

G������ B������ M���

G������ B������ M���

M������:

M������:

������ �� �������

������ �� �������

A�����:

A�����:

H��� A�������� L��� E��������

H��� A�������� L��� E��������

I�:

I�:

00012332

00012332

������� �� ������� �� �� ������� ������

  



 







 





















  



 



  









 





 













  



  



  









 





 





  















��

��

��

P��:

P��:

G�� B�� M��

G�� B�� M��

M��:

M��:

��

��

A��:

A��:

H�� A�� L�� E��

H�� A�� L�� E��

��

_

_

_

_

_

_{  }

_

_

_

_

_{  }

_

_

_

_

_

_

_

_

_

_

_

_

_

_

_

_

_

_

_

_

∗  ∗ ℓ ∗ ��

� 12−ℓ ∗ ���