Consider the rotational inverted pendulum mounted to a DC motor as shown in Fig. 1. The DC motor is used to apply a torque au_1 to Arm 1. The link between Arm 1 and Arm 2 is not actuated but free to rotate. The two arms have lengths L_1 and L_2. The arms have masses m_1 and m_2 which are located at l_1 and l_2 respectively, which are the lengths from the point of rotation of the arm to its center of mass. The arms have inertia tensors oldsymbol{J}_1 and oldsymbol{J}_2 (about the centre of mass of the arm). Each rotational joint is viscously damped with damping coefficients b_1 and b_2, where b_1 is the damping provided by the motor bearings and b_2 is the damping arising from the pin coupling between Arm 1 and Arm 2.
A right hand coordinate system has been used to define the inputs, states and the Cartesian coordinate systems 1 and 2. The coordinate axes of Arm 1 and Arm 2 are the principal axes such that the inertia tensors are diagonal.
The angular rotation of Arm 1, heta_1, is measured in the horizontal plane where a counter-clockwise direction (when viewed from above) is positive. The angular rotation of Arm 2, heta_2, is measured in the vertical plane where a counter-clockwise direction (when viewed from the front) is positive. When the Arm is hanging down in the stable equilibrium position heta_2=0 .
The torque the servo-motor applies to Arm 1, au_1, is positive in a counter-clockwise direction (when viewed from above). A disturbance torque, au_2, is experienced by Arm 2, where a counter-clockwise direction (when viewed from the front) is positive.
พิจารณาลูกตุ้มคว่ำหมุนติดกับมอเตอร์กระแสตรงดังแสดงในรูป 1 มอเตอร์กระแสตรงถูกนำมาใช้เพื่อนำไปใช้ tau_1 แรงบิดถึง 1 แขน การเชื่อมโยงระหว่าง 1 และ 2 แขนแขนไม่ได้เป็น actuated แต่มีอิสระที่จะหมุน แขนทั้งสองมีความยาวและ l_1 L_2 แขนมีฝูง m_1 และ m_2 ซึ่งตั้งอยู่ที่ l_1 และ L_2 ตามลำดับซึ่งเป็นความยาวจากจุดหมุนของแขนเพื่อเป็นจุดศูนย์กลางของมวล แขนมี tensors ความเฉื่อย boldsymbol {J} _1 และ boldsymbol {J} _2 (ประมาณจุดศูนย์กลางมวลของแขน) แต่ละทุนหมุนเป็นชื้น viscously ที่มีสัมประสิทธิ์หมาด ๆ b_1 และ b_2,ที่ b_1 คือการทำให้หมาด ๆ โดยแบริ่งยนต์และ b_2 คือการทำให้หมาด ๆ ที่เกิดจากการมีเพศสัมพันธ์ระหว่างขา 1 และ 2 แขนแขน.
มือระบบการประสานงานที่เหมาะสมได้รับการใช้ในการกำหนดปัจจัยการผลิตรัฐและระบบพิกัดคาร์ทีเซียนที่ 1 และ 2 . แกนของแขน 1 และ 2 แขนเป็นแกนหลักดังกล่าวที่ tensors ความเฉื่อยเป็นเส้นทแยงมุม.
หมุนเชิงมุม 1 แขน theta_1, เป็นวัดในระนาบแนวนอนที่ทิศทางทวนเข็มนาฬิกา (เมื่อมองจากด้านบน) เป็นบวก การหมุนเชิงมุมจาก 2 แขน, theta_2, เป็นวัดในระนาบแนวตั้งที่ทิศทางทวนเข็มนาฬิกา (เมื่อมองจากด้านหน้า) เป็นบวก เมื่อแขนที่ห้อยลงมาอยู่ในตำแหน่งที่สมดุลมั่นคง theta_2 = 0.
แรงบิดเซอร์โวมอเตอร์ที่ใช้กับ 1 แขน, tau_1 เป็นบวกในทิศทางทวนเข็มนาฬิกา (เมื่อมองจากด้านบน) แรงบิดรบกวน tau_2, มีประสบการณ์ตามแขน 2 ที่ทิศทางทวนเข็มนาฬิกา (เมื่อมองจากด้านหน้า) เป็นบวก
การแปล กรุณารอสักครู่..
![](//thimg.ilovetranslation.com/pic/loading_3.gif?v=b9814dd30c1d7c59_8619)