毕后执行步骤6);
[0050]6)判断是否是视频采集控制信息，若是Y，则执行步骤7)，若是N，则转向执行步骤8)；
[0051]7)执行视频采集程序，完毕后执行步骤8);
[0052]8)执行电机控制转速和舵机角度控制程序；
[0053]9)打开传感器模块，并收集温度、压力传感模块采集到的数据信息；
[0054]10)打开串口发送模块，封装采集到的传感器数据，并发送回控制台。
[0055]如图2所示为本发明提供的系统通信流程图。主要包括如下步骤:
[0056](I)初始化串口模块，并打开串口接收中断；
[0057](2)判断是否接收到控制信息包头，若是Y，则执行步骤(3)，若是N，则转向执行步骤⑵；
[0058](3)判断控制信息是否接收完成，若是Y，则执行步骤(4)，若是N，则转向执行步骤
(7)；
[0059](4)将接受到的控制命令与最后一个字节进行对比校验，若是Y，则执行步骤(5)，若是N，则转向执行步骤(7);
[0060](5)存储控制信息到BUFFER并置完成标志位为I ;
[0061](6)清空存储缓冲区并发送完成标志位；
[0062](7)结束。
[0063]如图3所示为本发明提供的视频采集跟踪流程图。主要包括如下几个步骤:
[0064](I)初始化视频采集模块及卡尔曼滤波器；
[0065](2)摄像头开始采集图像；
[0066](3)获取连续三帧图像并做差分处理；
[0067](4)图像增强并作形态学处理；
[0068](5)是否捕捉到目标，若是Y，则更新卡尔曼滤波器，若是N，则重置卡尔曼滤波器，完成后转向步骤(6)；
[0069](6)传送采集处理后的视频到陆地控制台。
[0070]如图4所示为本方法的超声波测距算法流程图。当超声波接受模块接收到发送模块发送的测距波形之后，经过测距算法的处理，测出水下机器人的位深。测距算法主要包括如下主要步骤:
[0071](I)初始化超声波接收模块，并打开接收中断；
[0072](2)判断接受中断标志位是否置位，若是Y，则执行步骤(3)，若是N，则转向执行步骤⑵；
[0073](3)在2T个周期内截取接收到的波形并采样；
[0074](4)将2T个周期内的采样值做相关处理；
[0075](5)判断是否得到峰值，若是Y，则执行步骤(6)，若是N，则转向执行步骤(3);
[0076](6)计算距离并上传至控制台。
[0077]本发明可以满足全天候、实时监测的要求，能够应用在水下探测机器人的探测工作过程中。主要包括控制、通信方法以及超声波自动测深方法。控制主要实现了水下主控器控制水下推进器的转动与舵机的角度、控制视频采集跟踪、控制温度压力传感器。通信采用串口透传方法来实现陆地控制台对水下机器人的控制信息的传送与处理。实现陆地控制台与水下机器人的双向通信，并采用自己的串口透传通信协议，让水下探测机器人通过串口指令对控制信息进行判定从而采取相应的控制动作，实现控制信息的接受、水下机器人的工作状态与参数的采集信息的上传。而且本发明采用了一种新型的超声波测距方法实现水下机器人的自动测深。通过超声波测距电路与算法的实现，增加了水下机器人自动测深的准确性与实时性。
【主权项】
1.一种用于控制水下探测机器人的方法，其特征在于包括以下步骤: 1)初始化程序，并打开串口接收通信模块； 2)串口接收中断是否完成，判断控制信息完成标志位，设标志位置为1，若是Y，则执行步骤3)，若是N，则执行步骤2); 3)检测控制信息参数，若是Y，则执行步骤4)，若是N，则执行步骤7); 4)检测是否是超声波自动测深控制信息，若是Y，则执行步骤5)，若是N，则转向步骤6)； 5)执行超声波自动测深程序，完毕后执行步骤6); 6)判断是否是视频采集控制信息，若是Y，则执行步骤7)，若是N，则转向执行步骤8); 7)执行视频采集程序，完毕后执行步骤8); 8)执行电机控制转速和舵机角度控制程序； 9)打开传感器模块，并收集温度、压力传感模块采集到的数据信息； 10)打开串口发送模块，封装采集到的传感器数据，并发送回控制台。
2.如权利要求1所述一种用于控制水下探测机器人的方法，其特征在于在步骤2)中，控制水下探测机器人的方法的通信方式采用串口透明传输方式，自定义通信协议即串口控制命令，通信系统流程主要步骤如下: (1)初始化串口模块，并打开串口接收中断； (2)判断是否接收到控制信息包头，若是Y，则执行步骤(3)，若是N，则转向执行步骤(2)； (3)判断控制信息是否接收完成，若是Y，则执行步骤(4)，若是N，则转向执行步骤(7)； (4)将接受到的控制命令与最后一个字节进行对比校验，若是Y，则执行步骤(5)，若是N，则转向执行步骤(7)； (5)存储控制信息到BUFFER并置完成标志位为I; (6)清空存储缓冲区并发送完成标志位； (7)结束。
3.如权利要求1所述一种用于控制水下探测机器人的方法，其特征在于在步骤5)中，控制水下机器人的探测方法的超声波自动测深是当超声波接收模块接收到发送模块发送的测距波形之后，经过测距计算的处理，测出水下机器人的位深，测距算法主要步骤如下: (1)初始化超声波接收模块，并打开接收中断； (2)判断接受中断标志位是否置位，若是Y，则执行步骤(3)，若是N，则转向执行步骤(2)； (3)在2T个周期内截取接收到的波形并采样； (4)将2T个周期内的采样值做相关处理； (5)判断是否得到峰值，若是Y，则执行步骤(6)，若是N，则转向执行步骤(3); (6)计算距离并上传至控制台。
4.如权利要求1所述一种用于控制水下探测机器人的方法，其特征在于在步骤6)中，控制水下机器人的控制方法的视频采集跟踪主要是:对采集后的连续三幅图像进行差分运算，将前后相邻的两幅图像进行差分，得到的差分图像除去了背景的干扰，对差分图像做滤波处理，用于滤除在图像采集或传输转换过程中产生的噪声，消除特征提取和目标分割的不利影响。对分割得到的运动目标做形态学处理，以消除图像分割后出现的不连续和间隙的视频。并采用卡尔曼滤波跟踪定位目标，通过卡尔曼滤波预测下一帧图像的运动状态，缩小运动目标的提取范围，准确实现运动目标的动态跟踪和视频的采集，视频采集程序主要步骤如下: (1)初始化视频采集模块及卡尔曼滤波器； (2)摄像头开始采集图像； (3)获取连续三帧图像并做差分处理； (4)图像增强并作形态学处理； (5)是否捕捉到目标，若是Y，则更新卡尔曼滤波器，若是N，则重置卡尔曼滤波器，完成后转向步骤(6)； (6)传送采集处理后的视频到陆地控制台。
【专利摘要】一种用于控制水下探测机器人的方法，涉及机器人控制。1)初始化程序并打开串口接收通信模块；2)串口接收中断是否完成，判断控制信息完成标志位，设标志位为1，若是Y则转步骤3)，若是N则转步骤2)；3)检测控制信息参数，若是Y则转步骤4)，若是N则转步骤7)；4)检测是否是超声波自动测深控制信息，若是Y则转步骤5)，若是N则转步骤6)；5)执行超声波自动测深程序；6)判断是否是视频采集控制信息，若是Y则转步骤7)，若是N则转步骤8)；7)执行视频采集程序；8)执行电机控制转速和舵机角度控制程序；9)打开传感器模块，收集传感模块采集的数据；10)打开串口发送模块，封装采集到的传感器数据并发送回控制台。
【IPC分类】G01S15-08, G05D1-10
【公开号】CN104820433
【申请号】CN201510288685
【发明人】孙海信, 成垦, 齐洁, 蒯晓燕, 颜佳泉, 丁思达, 刘丽丽
【申请人】厦门大学
【公开日】2015年8月5日
【申请日】2015年5月31日