论文部分内容阅读
本文主要针对国内研究较少的机械臂模块化关节进行了相关控制技术研究。首先以模块化关节通过轴线平行式和轴线垂直式连杆构成的六自由度机械臂为研究对象,综合分析其控制基础。再以模块化关节为研究对象进行了模块化系统集成和总体控制结构设计以及控制系统的仿真和优化,为模块化关节控制技术的应用提供了理论依据。在六自由度机械臂控制基础方面主要进行了基于D-H参数法的机械臂正运动学解算,并利用Matlab Robotic Toolbox建立了机械臂正运动学数学模型进行了仿真验证。综合分析了解析解法在机械臂逆运动学方面存在解的存在性、多重性和奇异点等问题,提出了采用基于BP神经网络的运动学逆解算法并进行了数学建模和算法实现,为机械臂运动学逆解引入了新思路。在建立机械臂正逆运动学模型的基础上进行了机械臂的关节空间和笛卡尔空间的轨迹规划算法的仿真分析;在关节空间进行三次多项式和高阶多项式插值算法的分析并以五次多项式插值算法为例进行了轨迹仿真;在笛卡尔空间分别就空间直线插补算法和空间圆弧插补算法进行了分析并进行了仿真,分析机械臂末端轨迹各路径点处的关节位姿。在机械臂动力学方面以机械臂任意关节为研究对象,建立了拉格朗日方程并具体分析了机械臂动力学正问题和动力学逆问题;结合本文的六自由度模块化机械臂的构型在Adams软件平台下进行了基于关节空间轨迹规划的动力学逆问题的仿真,就给定各关节转速的情况下得到了关节驱动力矩的仿真数据,为机械臂的轨迹跟踪控制奠定了理论基础。在模块化关节控制系统方面,首先进行了模块化关节内部系统集成设计,提出了基于CAN总线通讯协议的分布式控制系统的设计思想,确定了关节内部具体走线策略和控制硬件具体布局。其次就模块化关节的核心驱动原件-直流伺服电机的控制进行了位置-速度-电流的三闭环控制器设计,使用Matlab/Simulink建立了直流伺服电机三闭环控制器数学模型并进行了仿真分析。针对三闭环控制系统的仿真结果提出了采用自适应模糊PID控制的方式来对三闭环系统进行调节和优化,最后进行了自适应模糊PID控制器设计和自适应模糊PID三闭环控制系统的仿真,实现了模块化关节控制系统的优化设计,为模块化关节控制技术的应用提供给了理论分析依据。