Работа системы позиционно-силового управления с реальным объектом управления
Работа системы позиционно-силового управления с реальным объектом управления рассматривается на примере правой кинематической цепи пятизвенника (рис. 14.2). Система управления приводом, установленным в сочленении E, представляет следящую систему управления углом вращения qП. Система управления приводом, установленным в сочленении D, - это следящая система управления моментом, удерживающим звено 3 в любом произвольном положении. Момент, развиваемый данным приводом M
П, противодействует реакциям связей в сочленении C (RП и RЛ) и моментам, создаваемым весом звеньев 3 и 4 (P3 и P4) и весом сочленений PC и Pd.Дифференциальные уравнения, описывающие динамику правого двухзвенного механизма пятизвенника (рис. 14.2) имеют вид
B1q"П+B2
"П+B3q'П'П+B4'2П= =MqП-MП-( P4/2 +Pd)L4cosqП+RПL4sinП, (14.1)B5
"П+B6q'2П+B7q"П = =MП+L3( P3/2 +PC)cos(qП+П)- (14.2) RЛL3(qП+sin(qП+П-qЛ-Л),где
B1=J4+2A1+2A2cos
П+Jц3, B2=A4+A5cosП+Jц3, B3=-2A2П, B4=-A4П, B5= 2A3+Jц3, B6 =A2sinП, B7=B2, A1= m3(4L42+L32)/8 , A2=-m3L3L4/2, A3= m3L32/8, A4= m3L32/4, A5=A2,L3 и L4- длина звеньев 3 и 4; m3 - масса звена 3; Jц3 - момент инерции звена 3 относительно центра масс Ц3; J4 - момент инерции звена 4 относительно оси E; MqП, M
П - моменты, развиваемые двигателями соответственно в сочленениях E и D; RП, RЛ - реакции связей, действующие в сочленении C на звено 2 и 3.