一种水产养殖作业船自动转塘系统及位姿调整方法与流程

技术特征：
1.一种水产养殖作业船自动转塘系统，其特征在于，包括水产养殖作业船、转塘架、船载控制系统；所述转塘架固定在池塘间堤埂上；所述水产养殖作业船能够自动跨越固定在池塘间堤埂上的转塘架实现跨水域作业；所述转塘架由依池塘间堤埂截面形状搭建的梯形齿条架、梯形导轨及辅助支撑杆件组成；齿条分别固定在于导轨抽对称的两侧的齿条架上，中间引导导轨略低于两侧齿条，以使船体在转塘架上具有一个比较理想的俯仰角；中间引导导轨位于两端的斜坡部分被涂为红色，与周围环境形成鲜明色差，以方便视觉检测；所述水产养殖作业船由位于船体一端对称分布于船体二侧的明轮驱动，与明轮同轴安装有齿轮，齿轮外侧安装喇叭形挡板，船体前端的中间安装一个末端为滑动滚轮的具有自锁功能的机械臂，机械臂通过旋转关节进行状态切换，水产养殖作业时，控制机械臂使滑动滚轮保持在水面之上，以减少船体航行阻力；在接近转塘架时，控制机械臂使滑动滚轮向下，准备转塘；所述船载控制系统包括主控模块、gps/beidou模块、机器视觉模块、imu模块、电机驱动模块及电源管理系统；通过电源管理系统对控制系统进行电源管理，主控模块作为整个控制系统的控制中心，gps/beidou和机器视觉模块通过uart接口与主控模块连接、imu模块通过iic接口接到主控模块、主控模块通过pwm生成模块和gpio对驱动模块进行控制，驱动模块又分别对明轮电机和减速器控制。2.根据权利要求1所述的一种水产养殖作业船自动转塘系统，其特征在于，机器视觉模块的相机安装在作业船纵向中心线上，位于船体前部，朝向作业船正前方，距水面1米高，拍摄角度水平向前。3.根据权利要求1所述的一种水产养殖作业船自动转塘系统，其特征在于，通过船载gps/beidou定位系统实现初定位，在接近转塘架时，通过船载视觉模块检测水产养殖作业船与转塘架的相对位姿，然后船载控制系统根据检测结果调整作业船行进方向，进而使水产养殖作业船自动对接转塘架，其中，齿轮对准齿条，机械臂上的滚轮对准引导导轨，最后通过直流电机驱动使作业船沿转塘架行进实现自动转塘。4.根据权利要求1所述的一种水产养殖作业船自动转塘系统，其特征在于，转塘时，水产养殖作业船的齿轮与转塘架上的齿条啮合产生驱动力、并形成二点支撑，机械臂末端的滑动滚轮作用在转塘架的导轨上形成第三点支撑，水产养殖作业船通过直流电机驱动齿轮沿齿条啮合行进。5.根据权利要求1所述的一种水产养殖作业船自动转塘系统，其特征在于，转塘时，船载控制系统不断检测水产养殖作业船俯仰角以判断其所处状态；在转塘上坡阶段，通过直流电机驱动控制直流电机处于电动状态，提供正向转矩，牵引作业船正向爬坡；在转塘下坡阶段，控制直流电机处于发电制动状态，提供反向转矩，使作业船平稳下坡。6.根据权利要求1所述的一种水产养殖作业船自动转塘系统，其特征在于，船载控制系统通过控制减速器调整机械臂进而控制船体在转塘架上的俯仰角；上坡阶段，机械臂向下与导轨呈较小夹角，以减小机械臂关节与导轨的垂直距离，使船体仰角较小；水平阶段，机械臂向下与导轨呈适中夹角，使船体保持水平；下坡阶段，机械臂向下与导轨呈90度夹角，机械臂关节与导轨的垂直距离最大，使船体仰角较小；
所述机械臂向下与导轨所呈夹角由明轮轴位置、明轮轴与机械臂关节相对位置、机械臂长度以及转塘架结构尺寸决定，通过设计图或现场测量计算获得，转塘过程中船体俯仰角较小可降低作业船爬坡难度和提高船体行进的稳定性。7.根据权利要求1所述的一种水产养殖作业船自动转塘系统，其特征在于，水产养殖作业船在水产养殖作业时，使用船载gps/beidou定位系统和作业池塘电子地图实现路径导航；在转塘时，依靠船载gps/beidou定位系统和转塘架的地理信息，以合适的位置和方向接近转塘架，实现初定位，使作业船具有一个比较合适的转塘初始位姿。8.根据权利要求7所述的一种水产养殖作业船自动转塘系统，其特征在于，还包括，初定位位姿为距离转塘架中间导轨正前方4m左右，航向正对转塘架中间导轨；初定位结束，切换船载视觉模块，通过视觉纠偏对接转塘架，所使用gps/beidou定位系统精度小于50cm，其能确保视觉模块捕捉到转塘架中间导轨的完整信息。9.根据权利要求1所述的一种水产养殖作业船自动转塘系统的位姿调整方法，其特征在于，以转塘架中间引导导轨正投影为纵轴，与其垂直方向为横轴，以两侧齿条入水点连线的中点为原点，建立转塘坐标系，坐标系右下侧区域记为i区，左下侧区域记为ii区，记作业船当前位置为a点；具体包括：步骤1)、通过图像预处理得到待检测图像,图像预处理是指将采集到的大幅面高分辨率图像进行分辨率降低，对于噪声严重的图像还要进行图像滤波处理；步骤2)、选取大量引导导轨上大小为5*5的像素点集和导轨外大小为5*5的像素点集并将其分别作为正例和反例，所述正例和反例选取应包括各种角度拍摄的图像，且各种角度选取的正反例数量需要达到设定数量级；步骤3)、建立bp神经网络并用采集的正例和反例对其进行多次训练，所述bp神经网络输入层节点为75，输出层节点数为1；步骤4)、选取测试误差最小的网络对图像进行识别，所述的图像识别是将每个像素点及其周边5*5范围像素的rgb值共计75个数据输入bp神经网络进行判别；步骤5)、将判别结果进行二值化得到识别后的二值图像，再利用hough变换直线检测提取出转塘架上的红色导轨，采用最小二乘法拟合出一条对应于导轨的直线段；步骤6)、计算提取出的直线段与图像纵线的夹角为α，斜率为正时α为正，斜率为负时α为负；由相机小孔成像原理可知，若α为正，则船载相机位于转塘坐标系i区，若α为负，则船载相机位于转塘坐标系ii区,若α为零,则船载相机位于转塘坐标系y轴上；步骤7)、将处理后的图像分为6个区域，以图像纵中线为界左右对称划分，距图像纵中线图像宽度处定义为调整初始线，距图像纵中线图像宽度处定义为安全边界线；6个部分从左向右依次命名为左侧边界区域，左侧调整区域、左中区域、右中区域、右侧调整区域、右侧边界区域；以上区域划分用于船位姿调整时的姿态检测与姿态控制；设定边界区域防止跟踪的转塘架中间导轨在图像中丢失。10.根据权利要求9所述的一种水产养殖作业船自动转塘系统的位姿调整方法，其特征在于，还包括，根据船载视觉模块所处位置，分别使用下述三类策略进行作业船转塘位姿纠偏：第一类：船载相机位于转塘坐标系y轴上
若图像中提取出的线段位于图像纵中线上，则作业船位姿正确，使左右侧明轮同速，保持航向；若图像中提取出的线段位于图像纵中线的左侧，则作业船位置正确、方向右偏，使右侧明轮转速高于左侧明轮，使航向角左偏；若图像中提取出的线段位于图像纵中线的右侧，则作业船位置正确、方向左偏，使左侧明轮转速高于右侧明轮，使航向角右偏；第二类：船载相机位于转塘坐标系的i区域若图像中提取出的线段的下端点位于右侧调整初始线左侧，使右侧明轮转速高于左侧明轮，使航向角左偏；若图像中提取出的线段的上端点位于右侧安全边界线右侧，使左侧明轮转速高于右侧明轮，使航向角右偏；若图像中提取出的线段的下端点位于右侧调整初始线右侧5个像素内，使左右侧明轮同速，保持航向；第三类：船载相机位于转塘坐标系的ii区域若图像中提取出的线段的下端点位于左侧调整初始线右侧，使左侧明轮转速高于右侧明轮，使航向角右偏；若图像中提取出的线段的上端点位于左侧安全边界线左侧，使右侧明轮转速高于左侧明轮，使航向角左偏；若图像中提取出的线段的下端点位于左侧调整初始线左侧5个像素内，使左右侧明轮同速，保持航向。

技术总结
本发明公开了一种水产养殖作业船自动转塘系统及位姿调整方法，属于自动控制、机械结构和机器视觉领域。包括水产养殖作业船和转塘架。水产养殖作业船进行转塘作业时，先通过船载GPS/BEIDOU定位系统实现初定位，通过船载视觉模块检测水产养殖作业船与转塘架的相对位姿，然后根据检测结果调整作业船行进方向，进而使水产养殖作业船自动对接转塘架(齿轮对准齿条，滚轮对准导轨)。为方便对接，在转塘用齿轮外侧安装喇叭形挡板，辅助船架对接，降低转塘时船架对接所需的难度。转塘时，上坡阶段齿轮电机处于电动状态，下坡阶段齿轮电机处于发电制动状态，使作业船平稳跨越堤埂。本发明能够提高水产养殖作业船的利用率，在水产养殖领域具有较强的实用意义。域具有较强的实用意义。域具有较强的实用意义。


技术研发人员：赵德安 朱增桂
受保护的技术使用者：江苏大学
技术研发日：2021.06.17
技术公布日：2021/9/21