CN105466429B - 一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法 - Google Patents
一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法 Download PDFInfo
- Publication number
- CN105466429B CN105466429B CN201511015905.7A CN201511015905A CN105466429B CN 105466429 B CN105466429 B CN 105466429B CN 201511015905 A CN201511015905 A CN 201511015905A CN 105466429 B CN105466429 B CN 105466429B
- Authority
- CN
- China
- Prior art keywords
- point
- pond
- coordinate
- standing
- traversal
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Farming Of Fish And Shellfish (AREA)
Abstract
本发明公开了一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,所述方法包括如下步骤:第一步,建立池塘区域坐标系;第二步,确定自动投饲工作区域;第三步,判断自动投饲工作区域形状规则情况,对于形状规则池塘,采用内螺旋遍历方式池塘全覆盖自动投饲轨迹规划方法,对于形状不规则池塘,采用梳状往复遍历方式池塘全覆盖自动投饲轨迹规划方法,自动计算特征点坐标,生成池塘全覆盖自动投饲轨迹。本发明提供一种用于河蟹养殖全池自动均匀投饵喂料和其他水产养殖中需要沿池或全池自动均匀投饲的轨迹规划方法,通过池塘顶点坐标可直接解算出均匀投饲路径轨迹方法,实现精确均匀投饲,提高工作效率、降低生产成本,促进水产养殖业的健康发展。
Description
技术领域
本发明涉及一种全覆盖自动均匀投饲轨迹规划方法,特别是涉及一种用于水产养殖池塘全覆盖自动均匀投饲轨迹规划方法。
背景技术
河蟹养殖于20世纪90年代初形成产业规模,目前已成为中国渔业生产中发展最为迅速、最具潜力的支柱产业,投饵喂料是河蟹养殖中任务繁重而又关键的一项工作,因为饲料成本占到整个投资成本的50%以上,投饵喂料技术是否合理,是影响水产养殖效果和环境生态效益的一个最重要的因素。由于河蟹不能大范围运动,只能在自身附近区域觅食,因此,投饲时,饵料要均匀投放在整个池塘水面,对于饵料密度过大的水域,会造成饲料的浪费,残余饲料恶化养殖环境;而对于饵料密度过小的水域,会影响河蟹的摄食量,容易造成河蟹因抢食、争斗而受伤,继而引发疾病,导致河蟹死亡的后果。
目前,国内河蟹养殖投饵喂料一般采用3种方式:一是靠人工撑船投饵喂料,一人撑船,一人投饵,仅凭人工经验,工作效率低,劳动强度大,无法保证投饵的均匀度;二是靠投饵机投饵喂料,这种方式虽然可以通过人工操作定时定量投饵,节约劳动力,但只能固定在同一地点投饵,饵料分布在岸边很小的水域内,其他水域特别是中间水域无法覆盖,不能保证投饵的均匀度;三是通过船载投饵机喂料,通过汽油机或者柴油机驱动船,再通过安装在船上的投饵机将饵料投向池塘,由于船行进的路线全凭人工随意确定,随机性强,很难保证投饵的均匀度。
随着农业电气化、自动化技术的发展,出现了一些自动投饵设备,如申请号为02229989.0的专利“遥控自动投饵船”能根据人为遥控在池塘中投料,但完全靠人工经验确定投喂量,航行路线随机性强,工作效果差;申请号为201310155373.1的专利“水产养殖机器人”能根据实时航程、航速、料量参数实时控制投料速率,做到了出料均匀,但没有对投饵过程进行建模和定量分析,无法保证饵料落在水面上的实际分布均匀度;申请号为201410138938.X的专利“一种基于GPS导航的智能投料施药***及装置”,能接收人机交互子***输入的任务和指令,并控制喂料子***执行喂料动作,实现饲料精准投喂和药物均匀泼洒,也没有给出定量分析,难以保证饵料分布均匀度;申请号为201410243137.X的专利“一种风力驱动自动投饵***及均匀投饵方法”,利用投饵机抛料器建模、饲料颗粒斜抛运动建模、饵料在水面上的累积密度分布建模、自动投饵***均匀投饵的最优运行参数求解等步骤自动确定自动投饵装置喂料器单位时间内落料量、抛盘转速、投饵机抛料扇角、风力驱动船行驶速度、路径规划中两个相邻投饵行程的宽度等自动投饵***最优运行参数,利用北斗卫星导航***,通过北斗导航装置实现路径跟踪,完成自动均匀投饵作业,但没有给出路径规划的具体原理与方法。
发明内容
本发明的目的在于针对现有技术存在的问题,提出了一种用于河蟹养殖全池自动均匀投饵喂料和其他水产养殖中需要沿池或全池自动均匀投饲的轨迹规划方法,提供均匀投饲参考路径轨迹,实现水产养殖精确均匀投饲作业。
本发明是通过以下技术方案实现的:一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,包括以下步骤:
步骤S001,建立池塘区域坐标系:设取池塘区域可以为非规则的四边形,四边形池塘的四个顶点分别为P1、P2、P3和P4,四个顶点坐标分别为和分别求取四条边P1P2、P2P3、P3P4以及P4P1的斜率、对应的四条边的倾斜角、池塘的四个顶角;
步骤S002,确定自动投饲工作区域:投饵***在作业水域行驶路径可分解分为直线和转弯行驶两个基本运动,设置转弯时船体与岸边界的安全距离,进行全覆盖遍历方式投饵;
步骤S003,判断自动投饲工作区域形状是否规则,若是,采用内螺旋遍历方式池塘全覆盖自动投饲轨迹规划方法,跳到步骤S005;若否,采用梳状往复遍历方式池塘全覆盖自动投饲轨迹规划方法,跳到步骤S004;
步骤S004,梳状往复遍历方式池塘全覆盖自动投饲轨迹规划:确定梳状往复遍历方式自动投饲轨迹规划特征点,生成梳状往复遍历方式池塘全覆盖自动投饲轨迹;
步骤S005,内螺旋遍历方式池塘全覆盖自动投饲轨迹规划:确定内螺旋遍历方式池塘全覆盖自动投饲轨迹规划特征点,生成内螺旋遍历方式池塘全覆盖自动投饲轨迹。
进一步,所述步骤S004的具体过程为:
步骤S0041,确定梳状往复遍历方式自动投饲轨迹规划特征点:假设沿着长边P1P2方向进行梳状往复遍历方式投饵,只要作出与P1P2平行的一系列直线,求出平行直线与作业区域边界的交点,可以把P1P2沿着X轴平移就可以得出这些直线与作业区域边界的交点,把这些交点作为直线路径的起止点即投饵作业的路径轨迹特征点,为了确定P1P2向内推平行线的一系列直线沿着X轴平移的方向与距离,引入向内的向量由于 向量绕P1顺时针旋转θ,得到向量则向量因此,当时,P1P2沿着X轴右移,反之左移,分别求解出该平行直线与边P′1P′4的交点坐标与边P′2P′3的交点坐标以及与边P′3P′4的交点坐标作为梳状往复遍历方式自动投饲轨迹规划特征点;
步骤S0042,生成梳状往复遍历方式池塘全覆盖自动投饲轨迹:梳状往复遍历方式自动投饲的轨迹采用如下格式描述:{序号、目标点坐标、航行区间内的航速、喂料器单位时间内落料量、抛盘转速、投饵扇角},其中,航行区间内的航速、喂料器单位时间内落料量、抛盘转速、投饵扇角等参数由***解算给出,因此,只要确定目标点的个数以及遍历顺序,就可以确定梳状往复遍历的轨迹。
进一步,所述步骤S0042中,采用几何推理法按照平行直线扫描特征点的次序来按序依次遍历,用结构体Fpoint[]来表示设定的投饲轨迹点,所述结构体包括变量:轨迹点序号intNum、目标点坐标double pos、航行区间内的航速double vb、投饵机单位时间内下料量double mps、抛盘转速double N0、投饵扇角double
进一步,所述步骤S0042的具体实现过程包括:
步骤S101,开始;
步骤S102,对n赋初始值,n=1;
步骤S103,n对2取余运算结果是否等于1?若是,跳到步骤S105;若否,跳到步骤S104;
步骤S104,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos,跳到步骤S106;
步骤S105,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos;
步骤S106,n=n+1,处理下一个轨迹点;
步骤S107,判断是否n≤nmin+1,若是,跳到步骤S103;若否,跳到步骤S108;
步骤S108,判断是否边P′1P′4的长度小于边P′2P′3的长度,即是否若是,跳到步骤S112;若否,跳到步骤S109;
步骤S109,n对2取余运算结果是否等于1?若是,跳到步骤S110;若否,跳到步骤S111;
步骤S110,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos,跳到步骤S115;
步骤S111,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos,跳到步骤S115;
步骤S112,n对2取余运算结果是否等于1?若是,跳到步骤S114;若否,跳到步骤S113;
步骤S113,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos,跳到步骤S115;
步骤S114,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos;
步骤S115,n=n+1,处理下一个轨迹点;
步骤S116,判断是否n≤nmax+1,若是,跳到步骤S108;若否,跳到步骤S117;
步骤S117,结束。
进一步,所述步骤S005的具体过程为:
步骤S0051,确定内螺旋遍历方式池塘全覆盖自动投饲轨迹规划特征点,内螺旋遍历方式自动投饲轨迹规划特征点可以采用四条边分别向内推平行线,两相邻平移直线求交点的方法获取;
步骤S0052,生成内螺旋遍历方式池塘全覆盖自动投饲轨迹,内螺旋遍历方式自动投饲的轨迹采用如下格式描述:{序号 目标点坐标 航行至目标点的航速 投饵机单位时间内下料量 抛盘转速 抛射幅角},其中,航行至目标点的航速、投饵机单位时间内下料量、抛盘转速、抛射幅角等参数由***解算给出,由于工作区域四边形的形状不确定,因此必须确定内螺旋遍历的圈数,由于等距内螺旋遍历方式轨迹特征点在各内角的角平分线上,因此,分别令为内角θ1和θ2角平分线交点到边P′1P′2的距离,为内角θ2和θ3角平分线交点到边P′2P′3的距离,为内角θ3和θ4角平分线交点到边P′3P′4的距离,为内角θ4和θ1角平分线交点到边P′4P′1的距离,则式中,分别指的是工作区域四条边的边长,则内螺旋遍历的圈数式中R0为投饵机抛洒半径,因此,只要按照(n=1,2,...,nmax+1)来顺序依次遍历即可进行内螺旋遍历方式自动投饲的轨迹坐标点构建。
进一步,所述步骤S0051的具体实现过程为:引入向量分别绕P1、P2、P3、P4顺时针旋转90°,得到向内的向量则 因此,当时,与P1P2平行的直线沿着X轴右移,反之左移;当时,与P2P3平行的直线沿着X轴右移,反之左移;当时,与P3P4平行的直线沿着X轴右移,反之左移;当时,与P4P1平行的直线沿着X轴右移,反之左移;分别求解出边P′1P′2向内的平行线与边P′1P′4向内的平行线的交点坐标边P′2P′3向内的平行线与边P′1P′2向内的平行线的交点坐标边P′3P′4向内的平行线与边P′2P′3向内的平行线的交点坐标以及边P′4P′1向内的平行线与边P′3P′4向内的平行线的交点坐标作为内螺旋遍历方式自动投饲轨迹规划特征点。
本发明采用上述技术后,具有以下技术效果:本发明通过建立池塘区域坐标系:设取池塘区域可以为非规则的四边形,获取四边形池塘的四个顶点坐标,分别求取四条边的斜率、对应的四条边的倾斜角、池塘的四个顶角;然后确定自动投饲工作区域:投饵***在作业水域行驶路径可分解分为直线和转弯行驶两个基本运动,设置转弯时船体与岸边界的安全距离,进行全覆盖遍历方式投饵;接着根据自动投饲工作区域形状是否规则的情况,选用梳状往复遍历方式或者内螺旋遍历方式池塘全覆盖自动投饲轨迹规划方法;对于梳状往复遍历方式池塘全覆盖自动投饲轨迹规划:首先作出与长边平行的一系列直线,求出平行直线与作业区域边界的交点,把该长边沿着X轴平移就可以得出这些直线与作业区域边界的交点,把这些交点作为直线路径的起止点即投饵作业的路径轨迹特征点,为了确定该长边向内推平行线的一系列直线沿着X轴平移的方向与距离,引入向内的向量进行计算,梳状往复遍历方式自动投饲的轨迹采用如下格式描述:{序号、目标点坐标、航行区间内的航速、喂料器单位时间内落料量、抛盘转速、投饵扇角},其中,航行区间内的航速、喂料器单位时间内落料量、抛盘转速、投饵扇角等参数由***解算给出,因此,只要确定目标点的个数以及遍历顺序,就可以确定梳状往复遍历的轨迹;对于内螺旋遍历方式池塘全覆盖自动投饲轨迹规划:首先内螺旋遍历方式自动投饲轨迹规划特征点可以采用四条边分别向内推平行线,两相邻平移直线求交点的方法获取,为了确定与四条边分别向内推平行线的一系列直线沿着X轴平移的方向与距离,引入向内的向量进行计算,由于工作区域四边形的形状不确定,因此必须确定内螺旋遍历的圈数,然后按照顺序依次遍历即可生成内螺旋遍历方式池塘全覆盖自动投饲轨迹。本发明利用一种全覆盖池塘区域面状路径规划方法,自动生成最优投饲路径轨迹,提供一种通过池塘顶点坐标可直接解算出均匀投饲路径轨迹方法,实现精确均匀投饲,提高工作效率、降低生产成本,提高河蟹等水产品产量,保证养殖的河蟹等水产品个头大小均等,提高产值、增加效益,促进水产养殖业的健康发展。
附图说明
图1是本发明的方法流程图;
图2是本发明的池塘区域坐标系示意图;
图3是本发明的梳状往复遍历方式池塘全覆盖轨迹规划示意图;
图4是本发明的梳状往复遍历方式池塘全覆盖轨迹生成的方法流程图;
图5是本发明的内螺旋遍历方式池塘全覆盖轨迹规划示意图;
图6是本发明的内螺旋遍历方式池塘全覆盖轨迹规划具体实施例示意图;
图7是本发明的梳状往复遍历方式池塘全覆盖轨迹规划具体实施例示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及具体实施方式,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施方式仅仅用以解释本发明,并不用于限定本发明。
如图1所示,本发明提供了一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,所述方法包括如下步骤:
1.步骤S001,建立池塘区域坐标系,如图2所示,由于水产养殖池塘一般要求长方形,而一般自然形成或人工开挖的池塘均非规则的矩形,而可能是普通的四边形,为了不失一般性,假设四边形池塘的四个顶点分别为P1、P2、P3和P4,四个顶点坐标分别为和则四条边P1P2、P2P3、P3P4以及P4P1的斜率分别为
对应的四条边的倾斜角分别为
这里定义
池塘的四个顶角分别为
2.步骤S002,确定自动投饲工作区域,如图2所示,投饵***在作业水域行驶路径可分解分为直线行驶和转弯两个基本运动,对于已知的作业水域,自动投饵***从起始点沿着不同的方向行驶,会在不同的位置进行转弯,则全区域覆盖投饵任务完成时的总转弯次数就会不同,因此自动投饵***行驶的距离也将不同。为了保证投饵***能顺利转弯,必须设置转弯时船体与岸边界的安全距离,为了避免饵料抛洒到堤岸上造成浪费,投饵***转弯时停止投饵,待转过弯后直线行驶时继续投饵,同时,最佳的作业方向应平行于四边形的一条长边。假设沿着长边P1P2方向进行全覆盖遍历方式投饵,与岸边界P2P3、P3P4以及P4P1的安全距离为ds=k0Lb,其中Lb为船长,k0为安全距离系数。因此,要确定工作区域的四个边界点,分别为P′1、P′2、P′3和P′4,设四个边界点坐标分别为 和由于边界点的确定存在方向性,在此,引入向量进行相应的计算。
向量
则边界点P′1的坐标为
向量
则边界点P′2的坐标为
向量
则边界点P′3的坐标为
向量
则边界点P′4的坐标为
3.步骤S003,判断自动投饲工作区域形状是否规则,若是,采用内螺旋遍历方式池塘全覆盖自动投饲轨迹规划方法,跳到步骤S005;若否,采用梳状往复遍历方式池塘全覆盖自动投饲轨迹规划方法,跳到步骤S004;
4.步骤S004,梳状往复遍历方式池塘全覆盖自动投饲轨迹规划,如图3所示;
(4-A)首先,确定梳状往复遍历方式自动投饲轨迹规划特征点,假设沿着长边P1P2方向进行梳状往复遍历方式投饵,只要作出与P1P2平行的一系列直线,求出平行直线与作业区域边界的交点,因此,可以把P1P2沿着X轴平移就可以得出这些直线与作业区域边界的交点,把这些交点作为直线路径的起止点即投饵作业的路径轨迹特征点。为了确定与P1P2平行的一系列直线沿着X轴平移的方向与距离,不失一般性,引入向量由于向量绕P1顺时针旋转θ,得到向量则
当θ=90°时,因此,当时,P1P2沿着X轴右移,反之左移。设梳状往复遍历方式第n条平行直线与边P1P2的间距为d(n),则该平行直线与边P′1P′4的交点坐标可通过如下方程组求解,
解之得:
平行直线与边P′2P′3的交点坐标可通过如下方程组求解,
解之得:
平行直线与边P′3P′4的交点坐标可通过如下方程组求解,
解之得:
由于起始投饵行程与边界P1P2的间距应为投饵机抛洒半径R0,因此,第1条平行直线与边P1P2的间距d(1)=R0,假设两个相邻投饵行程的间距为d0,则第n条平行直线与边P1P2的间距d(n)=R0+(n-1)·d0,n∈N,代入式4-1即可得到边P′1P′4上的特征点坐标代入式4-2即可得到边P′2P′3上的特征点坐标代入式4-3即可得到边P′3P′4上的特征点坐标
(4-B)其次,生成梳状往复遍历方式池塘全覆盖自动投饲轨迹,梳状往复遍历方式自动投饲的轨迹采用如下格式描述:{序号、目标点坐标、航行区间内的航速、喂料器单位时间内落料量、抛盘转速、投饵扇角},其中,航行区间内的航速、喂料器单位时间内落料量、抛盘转速、投饵扇角等参数由***解算给出,因此,只要确定目标点的个数以及遍历顺序,就可以确定梳状往复遍历的轨迹,这里,采用几何推理法按照平行直线扫描特征点的次序来按序依次遍历,用结构体Fpoint[]来表示设定的投饲轨迹点,所述结构体包括变量:轨迹点序号int Num、目标点坐标double pos、航行区间内的航速double vb、投饵机单位时间内下料量double mps、抛盘转速double N0、投饵扇角double结构体Fpoint[]详细如下所示,
由于边P′1P′4和P′2P′3长度大小不确定,因此取
取 其中,所述梳状往复遍历方式池塘全覆盖轨迹生成方法,包括如下步骤,如图4所示:
步骤S101,开始;
步骤S102,对n赋初始值,n=1;
步骤S103,n对2取余运算结果是否等于1?若是,跳到步骤S105;若否,跳到步骤S104;
步骤S104,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos,跳到步骤S106;
步骤S105,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos;
步骤S106,n=n+1,处理下一个轨迹点;
步骤S107,判断是否n≤nmin+1,若是,跳到步骤S103;若否,跳到步骤S108;
步骤S108,判断是否边P′1P′4的长度小于边P′2P′3的长度,即是否若是,跳到步骤S112;若否,跳到步骤S109;
步骤S109,n对2取余运算结果是否等于1?若是,跳到步骤S110;若否,跳到步骤S111;
步骤S110,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos,跳到步骤S115;
步骤S111,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos,跳到步骤S115;
步骤S112,n对2取余运算结果是否等于1?若是,跳到步骤S114;若否,跳到步骤S113;
步骤S113,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos,跳到步骤S115;
步骤S114,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos;
步骤S115,n=n+1,处理下一个轨迹点;
步骤S116,判断是否n≤nmax+1,若是,跳到步骤S108;若否,跳到步骤S117;
步骤S117,结束;
5.步骤S005,内螺旋遍历方式池塘全覆盖自动投饲轨迹规划,如图5所示;
(5-A)首先,确定内螺旋遍历方式池塘全覆盖自动投饲轨迹规划特征点,内螺旋遍历方式自动投饲轨迹规划特征点可以采用四条边分别向内推平行线,两相邻平移直线求交点的方法获取,为了确定与四条边分别向内推平行线的一系列直线沿着X轴平移的方向与距离,不失一般性,同理引入向量分别绕P1、P2、P3、P4顺时针旋转90°,得到向内的向量则 因此,当时,与P1P2平行的直线沿着X轴右移,反之左移;当时,与P2P3平行的直线沿着X轴右移,反之左移;当时,与P3P4平行的直线沿着X轴右移,反之左移;当时,与P4P1平行的直线沿着X轴右移,反之左移。
设内螺旋遍历方式第n条平行直线与工作区域对应边界的间距为d2(n),则边P′1P′2向内的平行线与边P′1P′4向内的平行线的交点坐标可通过如下方程组求解,
解之得:
边P′2P′3向内的平行线与边P′1P′2向内的平行线的交点坐标可通过如下方程组求解,
解之得:
边P′3P′4向内的平行线与边P′2P′3向内的平行线的交点坐标可通过如下方程组求解,
解之得:
边P′4P′1向内的平行线与边P′3P′4向内的平行线的交点坐标可通过如下方程组求解,
解之得:
由于起始投饵行程与工作区域对应边界的间距应为投饵机抛洒半径R0,因此,第1条平行直线与工作区域对应边界的间距d2(1)=R0,令d2(0)=0,假设两个相邻投饵行程的间距为d0,则第n条平行直线与工作区域对应边界的间距d2(n)=R0+(n-1)·d0,n∈N,分别代入上述4式即可得到轨迹特征点坐标
(5-B)其次,生成内螺旋遍历方式池塘全覆盖自动投饲轨迹,内螺旋遍历方式自动投饲的轨迹采用如下格式描述:{序号 目标点坐标 航行至目标点的航速 投饵机单位时间内下料量 抛盘转速 抛射幅角},其中,航行至目标点的航速、投饵机单位时间内下料量、抛盘转速、抛射幅角等参数由***解算给出,因此,只要确定目标点的个数以及遍历顺序,就可以确定内螺旋遍历方式的轨迹,这里,按照 来顺序依次遍历,由于工作区域四边形的形状不确定,因此必须确定内螺旋遍历的圈数,由于等距内螺旋遍历方式轨迹特征点在各内角的角平分线上,因此,分别令为内角θ1和θ2角平分线交点到边P′1P′2的距离,为内角θ2和θ3角平分线交点到边的距离,为内角θ3和θ4角平分线交点到边P′3P′4的距离,为内角θ4和θ1角平分线交点到边P′4P′1的距离,则
式中,分别指的是工作区域四条边的边长,则因此,只要按照 (n=1,2,...,nmax+1)来顺序依次遍历即可进行内螺旋遍历方式自动投饲的轨迹坐标点构建。
以下结合附图,对本发明一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法作进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
如图6和图7所示,为本发明的具体实施例。
测试池塘:(1)池塘I的四个顶点P1、P2、P3和P4的经纬度坐标分别为(119.51065753,31.54744914),(119.51392136,31.54601313),(119.51284982,31.54479897),(119.51015859,31.54629197),对基于GPS导航的自动均匀投饲***,***接收到的定位数据是WGS-84坐标系下的大地经纬度坐标,这是一种椭球面坐标,无法直接用于平面路径规划分析与计算,因此,必须对接收到的GPS大地经纬度坐标利用高斯-克吕格投影到高斯平面上,并以笛卡尔直角坐标系来表示。采用6°带高斯投影正算公式计算出四个顶点的高斯-克吕格平面坐标分别为(3494406.59,20738432.55)m,(3494413.70,20738742.60)m,(3494117.39,20738647.55)m,(3494277.14,20738388.09)m,四个顶点的安全距离ds=4m,投饵机抛洒半径R0=8m,两个相邻投饵行程的间距为d0=12m,该池塘形状较为规则,采用内螺旋遍历方式池塘全覆盖自动投饲轨迹规划方法,如图6所示,求解出内螺旋遍历方式自动投饲轨迹规划特征点28个,通过高斯-克吕格投影反算公式,将特征点的高斯平面坐标转换为经纬度坐标,生成内螺旋遍历方式池塘全覆盖自动投饲轨迹结构体Fpoint[],此时,路径总长度为5239.74m,转弯数28个,覆盖率为90.10%;
(2)池塘II的四个顶点P1、P2、P3和P4的经纬度坐标分别为(119.51497756,31.54474264),(119.51657131,31.54661328),(119.51785839,31.54525094),(119.51573338,31.5443866),采用6°带高斯投影正算公式计算出四个顶点的高斯-克吕格平面坐标分别为(3494115.78,20738849.83)m,(3494326.77,20738996.46)m,(3494178.46,20739122.21)m,(3494077.94,20738922.54)m,四个顶点的安全距离ds=4m,投饵机抛洒半径R0=8m,两个相邻投饵行程的间距为d0=12m,该池塘形状不规则,采用梳状往复遍历方式池塘全覆盖自动投饲轨迹规划方法,如图7所示,求解出梳状往复遍历方式自动投饲轨迹规划特征点35个,通过高斯-克吕格投影反算公式,将特征点的高斯平面坐标转换为经纬度坐标,生成梳状往复遍历方式池塘全覆盖自动投饲轨迹结构体Fpoint[],此时,路径总长度为3669.45m,转弯数35个,覆盖率为92.11%。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,其特征在于,包括以下步骤:
步骤S001,建立池塘区域坐标系:设取池塘区域为非规则的四边形,四边形池塘的四个顶点分别为P1、P2、P3和P4,四个顶点坐标分别为和分别求取四条边P1P2、P2P3、P3P4以及P4P1的斜率、对应的四条边的倾斜角、池塘的四个顶角;
步骤S002,确定自动投饲工作区域:投饵***在作业水域行驶路径分解为直线和转弯行驶两个基本运动,设置转弯时船体与岸边界的安全距离,进行全覆盖遍历方式投饵;
步骤S003,判断自动投饲工作区域形状是否规则,若是,采用内螺旋遍历方式池塘全覆盖自动投饲轨迹规划方法,跳到步骤S005;若否,采用梳状往复遍历方式池塘全覆盖自动投饲轨迹规划方法,跳到步骤S004;
步骤S004,梳状往复遍历方式池塘全覆盖自动投饲轨迹规划:确定梳状往复遍历方式自动投饲轨迹规划特征点,生成梳状往复遍历方式池塘全覆盖自动投饲轨迹;
所述步骤S004的具体过程为:
步骤S0041,确定梳状往复遍历方式自动投饲轨迹规划特征点:假设沿着长边P1P2方向进行梳状往复遍历方式投饵,只要作出与P1P2平行的一系列直线,求出平行直线与作业区域边界的交点,把P1P2沿着X轴平移就可以得出这些直线与作业区域边界的交点,把这些交点作为直线路径的起止点即投饵作业的路径轨迹特征点,为了确定P1P2向内推平行线的一系列直线沿着X轴平移的方向与距离,引入向内的向量由于 向量绕P1顺时针旋转θ,得到向量则向量因此,当时,P1P2沿着X轴右移,反之左移,分别求解出该平行直线与边P1′P4′的交点坐标与边P2′P3′的交点坐标以及与边P3′P4′的交点坐标作为梳状往复遍历方式自动投饲轨迹规划特征点;
步骤S0042,生成梳状往复遍历方式池塘全覆盖自动投饲轨迹:梳状往复遍历方式自动投饲的轨迹采用如下格式描述:{序号、目标点坐标、航行区间内的航速、喂料器单位时间内落料量、抛盘转速、投饵扇角},其中,航行区间内的航速、喂料器单位时间内落料量、抛盘转速、投饵扇角参数由***解算给出,因此,只要确定目标点的个数以及遍历顺序,就可以确定梳状往复遍历的轨迹;
步骤S005,内螺旋遍历方式池塘全覆盖自动投饲轨迹规划:确定内螺旋遍历方式池塘全覆盖自动投饲轨迹规划特征点,生成内螺旋遍历方式池塘全覆盖自动投饲轨迹。
2.根据权利要求1所述的一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,其特征在于,所述步骤S0042中,采用几何推理法按照平行直线扫描特征点的次序来按序依次遍历,用结构体Fpoint[]来表示设定的投饲轨迹点,所述结构体包括变量:轨迹点序号intNum、目标点坐标double pos、航行区间内的航速double vb、投饵机单位时间内下料量double mps、抛盘转速double N0、投饵扇角double
3.根据权利要求2所述的一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,其特征在于,所述步骤S0042的具体实现过程包括:
步骤S101,开始;
步骤S102,对n赋初始值,n=1;
步骤S103,n对2取余运算结果是否等于1?若是,跳到步骤S105;若否,跳到步骤S104;
步骤S104,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos,跳到步骤S106;
步骤S105,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos;
步骤S106,n=n+1,处理下一个轨迹点;
步骤S107,判断是否n≤nmin+1,若是,跳到步骤S103;若否,跳到步骤S108;
步骤S108,判断是否边P1′P4′的长度小于边P2′P3′的长度,即是否若是,跳到步骤S112;若否,跳到步骤S109;
步骤S109,n对2取余运算结果是否等于1?若是,跳到步骤S110;若否,跳到步骤S111;
步骤S110,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos,跳到步骤S115;
步骤S111,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos,跳到步骤S115;
步骤S112,n对2取余运算结果是否等于1?若是,跳到步骤S114;若否,跳到步骤S113;
步骤S113,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos,跳到步骤S115;
步骤S114,遍历顺序是从点到点将坐标赋给Fpoint[2n-1].pos,将坐标赋给Fpoint[2n].pos;
步骤S115,n=n+1,处理下一个轨迹点;
步骤S116,判断是否n≤nmax+1,若是,跳到步骤S108;若否,跳到步骤S117;
步骤S117,结束。
4.根据权利要求1所述的一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,其特征在于,所述步骤S005的具体过程为:
步骤S0051,确定内螺旋遍历方式池塘全覆盖自动投饲轨迹规划特征点,内螺旋遍历方式自动投饲轨迹规划特征点采用四条边分别向内推平行线,两相邻平移直线求交点的方法获取;
步骤S0052,生成内螺旋遍历方式池塘全覆盖自动投饲轨迹,内螺旋遍历方式自动投饲的轨迹采用如下格式描述:{序号、目标点坐标航行至目标点的航速、投饵机单位时间内下料量、抛盘转速、抛射幅角},其中,航行至目标点的航速、投饵机单位时间内下料量、抛盘转速、抛射幅角参数由***解算给出,由于工作区域四边形的形状不确定,因此必须确定内螺旋遍历的圈数,由于等距内螺旋遍历方式轨迹特征点在各内角的角平分线上,因此,分别令为内角θ1和θ2角平分线交点到边P1′P2′的距离,为内角θ2和θ3角平分线交点到边P2′P3′的距离,为内角θ3和θ4角平分线交点到边P3′P4′的距离,为内角θ4和θ1角平分线交点到边P4′P1′的距离,则
式中,分别指的是工作区域四条边的边长,则内螺旋遍历的圈数式中R0为投饵机抛洒半径,两个相邻投饵行程的间距为d0,因此,只要按照其中n=1,2,…,nmax+1,来顺序依次遍历即可进行内螺旋遍历方式自动投饲的轨迹坐标点构建。
5.根据权利要求4所述的一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,其特征在于,所述步骤S0051的具体实现过程为:引入向量分别绕P1、P2、P3、P4顺时针旋转90°,得到向内的向量则 因此,当时,与P1P2平行的直线沿着X轴右移,反之左移;当时,与P2P3平行的直线沿着X轴右移,反之左移;当时,与P3P4平行的直线沿着X轴右移,反之左移;当时,与P4P1平行的直线沿着X轴右移,反之左移;分别求解出边P1′P2′向内的平行线与边P1′P4′向内的平行线的交点坐标边P2′P3′向内的平行线与边P1′P2′向内的平行线的交点坐标边P3′P4′向内的平行线与边P2′P3′向内的平行线的交点坐标以及边P4′P1′向内的平行线与边P3′P4′向内的平行线的交点坐标作为内螺旋遍历方式自动投饲轨迹规划特征点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201511015905.7A CN105466429B (zh) | 2015-12-29 | 2015-12-29 | 一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201511015905.7A CN105466429B (zh) | 2015-12-29 | 2015-12-29 | 一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105466429A CN105466429A (zh) | 2016-04-06 |
CN105466429B true CN105466429B (zh) | 2018-06-01 |
Family
ID=55604388
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201511015905.7A Active CN105466429B (zh) | 2015-12-29 | 2015-12-29 | 一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105466429B (zh) |
Families Citing this family (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106305564B (zh) * | 2016-08-23 | 2019-05-31 | 江苏大学 | 一种自主导航河蟹养殖投饵装置的均匀投饵方法 |
CN106547276B (zh) * | 2016-10-19 | 2019-07-26 | 上海圣尧智能科技有限公司 | 自动喷洒回字形路径规划方法及植保机喷洒作业方法 |
CN106679684A (zh) * | 2016-12-27 | 2017-05-17 | 湖南挚新科技发展有限公司 | 自动化作业设备路径规划方法与*** |
CN106998592A (zh) * | 2017-03-13 | 2017-08-01 | 信阳农林学院 | 一种基于无线传感网络的渔业智能施药方法 |
CN107197806B (zh) * | 2017-05-17 | 2019-07-16 | 武汉理工大学 | 基于无人艇的弹性栅格式定点自动投饵方法 |
CN107831773A (zh) * | 2017-11-30 | 2018-03-23 | 深圳市沃特沃德股份有限公司 | 扫地机器人全覆盖清扫的方法及扫地机器人 |
CN108759828A (zh) * | 2018-03-23 | 2018-11-06 | 江苏大学 | 一种无人驾驶插秧机路径规划方法 |
CN109240284B (zh) * | 2018-08-10 | 2021-06-22 | 江苏大学 | 一种无人驾驶农机的自主路径规划方法及装置 |
CN109911643B (zh) | 2019-04-02 | 2020-09-15 | 上海快仓智能科技有限公司 | 物料投放方法、控制装置、设备及*** |
CN110307834B (zh) * | 2019-06-19 | 2021-02-12 | 江苏大学 | 基于低精度gps、激光测距传感器与方位传感器信息融合的蟹塘自动作业船组合导航方法 |
CN110703783B (zh) * | 2019-11-11 | 2021-07-27 | 上海交通大学 | 一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法 |
CN110908376B (zh) * | 2019-11-26 | 2020-12-18 | 江苏大学 | 一种抗风力的自动投饵船精准投饵方法 |
CN111766864B (zh) * | 2019-12-30 | 2022-09-13 | 广州极飞科技股份有限公司 | 路径生成方法、装置、电子设备和计算机可读存储介质 |
CN111257915A (zh) * | 2020-03-18 | 2020-06-09 | 江西省农业科学院农业工程研究所 | 一种手扶式农机具智能导航***及方法 |
CN111693049B (zh) * | 2020-05-20 | 2022-02-11 | 五邑大学 | 一种无人船覆盖投食的动态路径规划方法及设备 |
CN114326796B (zh) * | 2021-12-15 | 2023-07-21 | 中国航空工业集团公司成都飞机设计研究所 | 一种适用于航空巡逻反潜的矩形搜索方法 |
CN114711051A (zh) * | 2022-04-20 | 2022-07-08 | 中交上海航道勘察设计研究院有限公司 | 基于北斗坐标定位的沉水植物种植装置及投放方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103988801A (zh) * | 2014-06-04 | 2014-08-20 | 江苏大学 | 一种风力驱动自动投饵***及均匀投饵方法 |
CN104881037A (zh) * | 2015-04-01 | 2015-09-02 | 广州天翔航空科技有限公司 | 植保无人机的喷药方法 |
CN105116885A (zh) * | 2015-07-16 | 2015-12-02 | 江苏大学 | 一种基于人工标识的自动投饵作业船视觉导航方法 |
-
2015
- 2015-12-29 CN CN201511015905.7A patent/CN105466429B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103988801A (zh) * | 2014-06-04 | 2014-08-20 | 江苏大学 | 一种风力驱动自动投饵***及均匀投饵方法 |
CN104881037A (zh) * | 2015-04-01 | 2015-09-02 | 广州天翔航空科技有限公司 | 植保无人机的喷药方法 |
CN105116885A (zh) * | 2015-07-16 | 2015-12-02 | 江苏大学 | 一种基于人工标识的自动投饵作业船视觉导航方法 |
Non-Patent Citations (2)
Title |
---|
"基于无人机航向的不规则区域作业航线规划算法与验证";徐博;《农业工程学报》;20151215;第31卷(第23期);正文第173-176页 * |
"河蟹养殖船载自动均匀投饵***设计及效果试验";孙月平等;《农业工程学报》;20150630;第31卷(第11期);正文第31-38页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105466429A (zh) | 2016-04-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105466429B (zh) | 一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法 | |
CN107197806B (zh) | 基于无人艇的弹性栅格式定点自动投饵方法 | |
WO2016023071A1 (en) | An aquatic management system | |
CN105116885B (zh) | 一种基于人工标识的自动投饵作业船视觉导航方法 | |
CN106305564B (zh) | 一种自主导航河蟹养殖投饵装置的均匀投饵方法 | |
CN103988801A (zh) | 一种风力驱动自动投饵***及均匀投饵方法 | |
CN109163726A (zh) | 一种回状的全覆盖轨迹规划方法 | |
CN109592036A (zh) | 一种投放赤眼蜂进行生物防治的无人机 | |
Mackay et al. | Making space for community in super-productivist rural settings | |
CN114586722A (zh) | 一种智能投料无人船及其投料方法 | |
CN106998592A (zh) | 一种基于无线传感网络的渔业智能施药方法 | |
Niesterok et al. | Hydrodynamic detection and localization of artificial flatfish breathing currents by harbour seals (Phoca vitulina) | |
CN106651021A (zh) | 基于精英人工鱼群的植保无人机编队航迹规划方法 | |
Urmy et al. | Foraging hotspots of common and roseate terns: the influence of tidal currents, bathymetry, and prey density | |
Craig | It's Not Just an Offshore Wind Farm: Combining Multiple Uses and Multiple Values on the Outer Continental Shelf | |
Ignatius | Aquaculture policy | |
CN205756562U (zh) | 一种全自动除污消毒的水产养殖池 | |
CN108778922B (zh) | 围网的投网航迹显示及控制*** | |
CN109901593A (zh) | 一种基于三点定位技术智能农机路径规划*** | |
Lee et al. | Prediction of shooting trajectory of tuna purse seine fishing | |
CN203664072U (zh) | 一种自动巡塘投药装置 | |
Li et al. | Mission arrangement optimization with improved PSO for multiple plant protecion UAVs in heterogeneous farmlands | |
CN101669453A (zh) | 一种人工鱼礁配置组合效果的量化和评价方法 | |
CN205756560U (zh) | 一种基于传感器的高低串联水产养殖池 | |
CN103749363A (zh) | 定点聚堆式人工鱼礁投放方法以及利用该方法获得的人工鱼礁 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20220211 Address after: 213161 Room 518, block C, Tianrun science and technology building, No. 18-3, Changwu Middle Road, Wujin District, Changzhou City, Jiangsu Province Patentee after: Changzhou huierda Intelligent Equipment Co.,Ltd. Address before: Zhenjiang City, Jiangsu Province, 212013 Jingkou District Road No. 301 Patentee before: JIANGSU University |