基于CAN总线的水下机器人执行节点设计与实现

与传统的缆控水下航行器(ROV)相比，自主水下航行器(AUV)具有如下特点：(1)环境适应性强，活动范围大，可冲破人工潜水极限进入现场进行接近观测；(2)体积小，使用方便，便于布放和回收；(3)可根据水声信号遥控或预置程序控制，按要求进行相关项目观测；(4)有自主动力，水下运行时间相对较长，有源噪声低等。

因水下机器人装配有大量传感器，要求控制系统具有较高的处理速度，又因开发费用较高，必须具有很好的可扩展性来改变测量装置以实现多功能。分布式控制系统在适用范围、可扩展性、控制速度、系统模块化、可维护性、抗单点故障等方面具有明显优势，是极佳的选择。

图1所示为本文开发的基于CAN总线的分布式水下机器人控制系统结构。CAN总线具有如下特性：(1)实时性高。多主站工作方式，优先级高的节点优先传输数据，数据传输率高(1Mbit/s)；(2)检错和纠错机制强。发送信息损坏自动重发，采用独特的非破坏总线仲裁技术，有CRC及其它校验；(3)连接简单，可扩展性强，开发方便。通讯协议与开放系统互连模型OSI一致，应用层协议可有用户自己定义。

图1　水下机器人控制系统结构

控制系统由各个功能节点通过CAN总线连接构成，各节点大部分时间并行工作，只在必要时与中央控制节点通讯。其中的执行节点直接控制AUV的现场执行机构，对AUV的功能实现性起着至关重要的作用。在研究开发的AUV中，执行节点除完成CAN通信外，还有以下几个主要功能：(1)航行速度控制功能。其执行部件为一三叶螺旋桨，产生主推力；(2)航行方向控制功能。执行部件是一对垂直舵；(3)航行深度控制功能。实现深度控制与纵倾控制，执行部件是一对水平舵；(4)传感器模块的旋转调平控制功能，实现部分传感器位姿调整。其中，(1)为速度伺服控制系统，(2)，(3)，(4)为位置伺服控制系统，均由无刷直流伺服电机进行驱动。

执行节点硬件设计

CAN接口设计
节点主芯片选用Philips公司的P87C591，其兼容80C51指令集，并成功的集成了Philips公司的SJAl000CAN控制器，该嵌入式CAN控制器具有以下特点：(1)完全符合CAN210规范，控制CAN帧的接收和发送；(2)CAN接口包含5个实现CPU与CAN控制器连接的特殊功能寄存器。对重要CAN寄存器的访问通过快速自动增加的寻址特性和对特殊功能寄存器的位寻址来实现；(3)CAN控制器的发送缓冲区能够保存一个完整的CAN信息帧(扩展或标准帧)，只要通过CPU启动发送，信息就从发送缓冲区传输到CAN内核模块；(4)当接收一个信息时，CAN内核模块将串行数据流转换成并行数据传输到验收滤波器，通过此可编程滤波器，P87C591确认接收需要的信息。

图2所示为以P87C591为核心的CAN节点接口电路。P1.0，P1.1分别对应CAN的收(RXDC)和发(TXDC)线，通过高速光耦(6N137)与总线实现光电隔离。CAN收发器选用Philips的P82C250，以差分方式发送，CAN总线末端加124的终端匹配电阻。

图2　CAN总线接口电路

无刷直流伺服系统构建
根据应用场合，选择了瑞士Maxon公司的EC系列无刷直流伺服电机(DCBrushless ServoMotor)，其满足以下要求：(1)电机重量轻，体积小，这在水下潜器设计中是十分关心的问题，而且转动惯量约可减少50%左右；(2)无机械换向，大大减少了电磁干扰，适合AUV在狭小空间容纳多种传感器的特点；(3)特征曲线基本为直线，控制性好；(4)有一定的防潮和耐高温能力。螺旋桨驱动和舵驱动功率不同，分别为400W和80W；工作电压分别为直流48V和直流24V。

电机驱动器采用美国Accelus公司的直流无刷数字伺服驱动器，其有以下特点：(1)全数字驱动器，电流、速度和位置三环控制可以自由配置；(2)驱动器中集成有flash存储器，其有配套的计算机软件，通过驱动器上的RS232端口对驱动器进行部分功能设定。(3)由于为全数字驱动器，与控制器连接简单。

图3表示了一路直流无刷电机伺服系统。对螺旋桨，驱动器设置成速度控制模式，其它设置为位置控制模式。螺旋桨驱动电机采用PWM调速方式，其它驱动电机都通过微控制器I/O口输出脉冲控制。

图3　无刷电机伺服控制系统示意图

电机驱动器按要求进行合理设置和连接后，与控制器P87C591密切相关的信号线有两条：一条控制电机的转速或位置，一条控制电机的转向。对螺旋桨控制，将其驱动器设置为速度模式，采用PWM调速控制，电机的转速与PWM的占空比成正比。其它电机控制系统，驱动器设置为位置模式，由于这几个电机控制系统对电机的转速要求不高，采用定转速，这样脉冲频率恒定，通过对P87C591的定时器编程产生脉冲，另外用控制器的一个端口控制电机的转向。

为了保证系统工作安全、可靠，在控制器与驱动器之间，采用高速光耦6N137进行隔离，其原因：(1)控制器和驱动器存在接地电位差；(2)抑制环境干扰信号；(3)控制器供电4.5～5V，为弱电，而驱动器供电20～70V，相对较高。在电源输入和电机输出都配置保险丝进行安全保护。

执行节点软件设计

应用层协议制定
在CAN210规范标准中，为了用户使用的灵活性，只对物理层和数据链路层进行了规定，没有定义应用层，这就需要用户根据自己需求制定应用层协议。虽然目前可以使用一些成熟的应用层协议，如HiLon、CANOpen、DeviceNET和SDS协议等，但缺乏针对性，因此首先制定CAN应用层协议。