Wang Lejun, Lai Xuzhi, Meng Qingxin, Wu Min
IEEE Trans Cybern. 2023 Jun;53(6):3782-3793. doi: 10.1109/TCYB.2021.3125187. Epub 2023 May 17.
For a three-link vertical underactuated manipulator (TVUM) with only one active joint, the control target is to swing up its endpoint from the straight-down equilibrium point (SDEP) and to stabilize the endpoint at the straight-up equilibrium point (SUEP) eventually. Up to now, there are few effective control strategies to achieve the above control target. In this article, we propose an effective control method based on the trajectory optimization to realize the system control target, and the main steps of this article are: 1) a continuous trajectory that consists of two segments with design parameters is planned for the actuated link, along which the actuated link can be swung up from the initial states to the final states; 2) the design parameters are optimized by using the intelligent optimization algorithm to guarantee that the states of the underactuated links are continuous at the junction. In this way, the underactuated links are also moved to their final states with the actuated link simultaneously; 3) a tracking controller is designed by using the sliding-mode method to track the trajectory with optimized design parameters, so the endpoint is swung up from the SDEP to the SUEP directly; and 4) a stabilizing controller is further devised through the LQR method to keep the endpoint being stable at the SUEP. Finally, simulation results show that the proposed control method achieves the swing-up and stable control target of the system, and the control performance of the proposed method is superior than that of the existing control methods through the comparisons.
对于一个只有一个主动关节的三连杆垂直欠驱动机械手(TVUM),其控制目标是将其端点从垂直向下平衡点(SDEP)向上摆动,并最终将端点稳定在垂直向上平衡点(SUEP)。到目前为止,几乎没有有效的控制策略来实现上述控制目标。在本文中,我们提出了一种基于轨迹优化的有效控制方法来实现系统控制目标,本文的主要步骤如下:1)为主动关节规划一条由两段带有设计参数的连续轨迹,沿着该轨迹主动关节可以从初始状态摆动到最终状态;2)利用智能优化算法对设计参数进行优化,以保证欠驱动连杆的状态在连接处连续。通过这种方式,欠驱动连杆也会与主动关节同时移动到它们的最终状态;3)利用滑模方法设计一个跟踪控制器来跟踪具有优化设计参数的轨迹,从而使端点直接从SDEP向上摆动到SUEP;4)通过线性二次调节器(LQR)方法进一步设计一个稳定控制器,以使端点在SUEP处保持稳定。最后,仿真结果表明,所提出的控制方法实现了系统的向上摆动和稳定控制目标,并且通过比较,该方法的控制性能优于现有控制方法。