论文部分内容阅读
机器人视觉伺服控制是机器人研究领域的一个重要方向,云台是实现机器人视觉伺服控制的主要载体。传统云台主要应用于大型场所的安防监控,具有体积大、结构复杂、调速范围小等特点,而真正适用于小型移动机器人视觉伺服控制的云台不多见。国外机器人云台又因成本较高,目前尚未在国内大量使用。因此,研制体积小、结构简单、定位准确、价格低廉的机器人云台具有重要的意义和应用价值。本文重点分析和研究了一种基于DSP的控制驱动一体化二自由度云台。主要工作如下:根据二自由度云台的功能要求,确定了云台设计的主要技术指标;通过分析比较,确定了二自由度云台的结构形式,提出了采用直流伺服电机驱动、齿轮传动、增量式光电编码器和基于DSP的控制驱动一体化总体实现方案。采用D-H法对二自由度云台进行了正运动学位置分析,采用几何法进行了逆运动学求解,采用蒙特卡洛方法对云台工作空间进行了分析,并对杆长参数进行了优化设计。在此基础上,重点研究了基于多项式插补算法的云台关节空间轨迹规划和基于圆弧插补算法的云台直角坐标空间轨迹规划,实验结果表明,关节空间三次多项式插补算法计算量小、控制策略简单,更适合于二自由度云台运动轨迹规划。分析和研究了基于差动齿轮系传动的二自由度云台结构布局和基于简单齿轮传动的混合交叉结构布局,设计了二自由度云台的水平回转机构和俯仰机构,给出了设计图纸,完成了样机制作。研制了基于DSP的控制驱动一体化二自由度云台控制系统。主要硬件包括驱动电路、电源、接口电路、传感器检测电路以及通信电路等部分。利用DSP控制驱动一体化硬件平台,分别采用PID算法、模糊控制算法和参数自整定模糊PID算法,对二自由度云台运动控制进行了仿真实验。实验结果表明,参数自整定模糊PID算法控制精度高、自适应能力强,可以满足二自由度云台运动控制的要求。