基于TwinCAT3的Stewart平台控制系统设计

摘要

基于倍福TwinCAT3软件,本文详细阐述了使用倍福PC控制技术完成Stewart平台的控制系统的设计流程。首先推导了六自由度并联平台的正、逆解算法。其次利用MATLAB/SIMULINK软件中的M函数生成正、逆解模块。再次，通过TwinCAT3的TE1400组件将SIMULINK代码生成器的目标配置为TwinCAT，生成可以集成到TwinCAT3环境的SIMULINK语言的TcCOM模型。最后在TwinCAT3软件中加载TcCOM模型，利用TwinCAT软件自带的运动控制功能块和NC轨迹生成器通过EtherCAT总线实时地对电机和平台进行控制。结果显示TwinCAT3软件与MATLAB结合使用给机器人控制系统设计带来的显著优越性。%Based on BECKHOFF software in TwinCAT3, this paper describes the process of control system design using BECKHOFF PC technology for Stewart platform in detail. First, the direct and inverse solution algorithms of the 6-degrees parallel connection platform are developed. Second, the direct and inverse solution modules are generated through the M functions in MATLAB/SIMULINK. Third, the target of SIMULINK code generator is configured to TwinCAT via TE1400 in TwinCAT3 and the TcCOM model in SIMULINK language can be integrated to TwinCAT3 environment. Finally, the TcCOM model is loaded into TwinCAT3. Using TwinCAT motion control function blocks and NC trajectory generator, the motors and platform can be controlled in real time via EtherCAT bus, which realizes the desired functions. Results show that Twinca3 combined with MATLAB improves the efficiency for control system design.