基于NiosⅡ的机器人视觉伺服控制器的研究与设计

　　引言

　　Altera公司的Nios II处理器是可编程逻辑器件的软核处理器。NiosII软核处理器和存储器、I/O接口等外设可嵌入到FPGA中，组成一个可编程单芯片系统(SOPC)，大大降低了系统的成本、体积和功耗。适合网络、电信、数据通信、嵌入式和消费市场等各种嵌入式应用场合。

　　本文提出一个基于Nios II处理器结构的系统用于实现机器人实时运动检测跟踪，使用线性卡尔曼滤波器算法来快速完成运动估计及进一步分析和校正，算法中的乘除利用MATLAB/DSP Builder生成的模块作为Nios II处理器的自定义指令的设计方法。

　　机器人视觉伺服控制器的研究与设计

　　机器人视觉伺服控制就是用各种成像系统代替视觉器官作为输入的敏感手段，并由高速处理器替代大脑完成相应的处理和解释，其最终研究目标就是使机器人视觉伺服控制器能像人那样通过视觉观察和理解世界，具有自主适应环境的能力，可依据视觉敏感和反馈，以某种程度的智能完成一定的任务。

　　系统硬件实现

　　基于SOPC的机器人视觉伺服控制器，主要由FPGA、存储器和外设三个部分，如图1所示。

　　摄像头位置固定，它所能采集图像的范围称为视觉区域，调整摄像机使视觉区域覆盖机器人的工作空间，即机器人要跟踪的曲线在该视觉区域内。利用摄像机采集图像，而后系统对采集的图像进行处理，分析、提取出离散的采样点序列，最后再根据采样点序列规划机器人的运动路径。其中，FPGA部分核心是Nios II处理器Core。在一般的嵌入式系统开发中，当需要新的外设模块时往往需要在PCB上加入相应的外设芯片或者换用更高档的CPU，而SOPC设计可以同一个FPGA芯片内加入相应的外设模块核，并通过在片上的Avalon总线与NiosⅡ处理器Core相连，因而不需要在PCB这个层面上作更多的修改。成像采集装置从目标对象场景中采集图像序列，保存在SOPC的片外存储器中，然后利用NiosⅡ处理器和定制的乘法、除法等DSP运算指令来实现线形卡尔曼滤波器的算法，从而实现运动目标的识别与跟踪。

　　系统软件的实现

　　离散线性卡尔曼滤波算法

　　线性卡尔曼滤波是美国工程师Kalman在线性最小方差估计的基础上，提出的数学结构上比较简单的最优线性递推滤波方法，具有计算量、存储量低，实时性高的优点。特别是经历了初始滤波的过渡状态后，滤波效果非常好。

　　线性卡尔曼滤波基本算法如下：设一随机动态系统，其数学模型为：

　　公式1中x(k)为系统状态矢量，w(k)为系统噪音矢量,φ(k),Г(k)为系统矩阵,公式2中Z(k)为系统观测矢量，H(k)为系统观测矩阵，V(k)为系统观测噪音矩阵。