CN105466429A - 一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法 - Google Patents
一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法 Download PDFInfo
- Publication number
- CN105466429A CN105466429A CN201511015905.7A CN201511015905A CN105466429A CN 105466429 A CN105466429 A CN 105466429A CN 201511015905 A CN201511015905 A CN 201511015905A CN 105466429 A CN105466429 A CN 105466429A
- Authority
- CN
- China
- Prior art keywords
- prime
- point
- pond
- coordinate
- automatic switching
- 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.)
- Granted
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、目标点坐标doublepos、航行区间内的航速doublevb、投饵机单位时间内下料量doublemps、抛盘转速doubleN0、投饵扇角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[]来表示设定的投饲轨迹点,所述结构体包括变量:轨迹点序号intNum、目标点坐标doublepos、航行区间内的航速doublevb、投饵机单位时间内下料量doublemps、抛盘转速doubleN0、投饵扇角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的距离,则
以下结合附图,对本发明一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法作进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
如图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 (6)
1.一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,其特征在于,包括以下步骤:
步骤S001,建立池塘区域坐标系:设取池塘区域可以为非规则的四边形,四边形池塘的四个顶点分别为P1、P2、P3和P4,四个顶点坐标分别为和分别求取四条边P1P2、P2P3、P3P4以及P4P1的斜率、对应的四条边的倾斜角、池塘的四个顶角;
步骤S002,确定自动投饲工作区域:投饵***在作业水域行驶路径可分解分为直线和转弯行驶两个基本运动,设置转弯时船体与岸边界的安全距离,进行全覆盖遍历方式投饵;
步骤S003,判断自动投饲工作区域形状是否规则,若是,采用内螺旋遍历方式池塘全覆盖自动投饲轨迹规划方法,跳到步骤S005;若否,采用梳状往复遍历方式池塘全覆盖自动投饲轨迹规划方法,跳到步骤S004;
步骤S004,梳状往复遍历方式池塘全覆盖自动投饲轨迹规划:确定梳状往复遍历方式自动投饲轨迹规划特征点,生成梳状往复遍历方式池塘全覆盖自动投饲轨迹;
步骤S005,内螺旋遍历方式池塘全覆盖自动投饲轨迹规划:确定内螺旋遍历方式池塘全覆盖自动投饲轨迹规划特征点,生成内螺旋遍历方式池塘全覆盖自动投饲轨迹。
2.根据权利要求1所述的一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,其特征在于,所述步骤S004的具体过程为:
步骤S0041,确定梳状往复遍历方式自动投饲轨迹规划特征点:假设沿着长边P1P2方向进行梳状往复遍历方式投饵,只要作出与P1P2平行的一系列直线,求出平行直线与作业区域边界的交点,可以把P1P2沿着X轴平移就可以得出这些直线与作业区域边界的交点,把这些交点作为直线路径的起止点即投饵作业的路径轨迹特征点,为了确定P1P2向内推平行线的一系列直线沿着X轴平移的方向与距离,引入向内的向量由于 向量绕P1顺时针旋转θ,得到向量则向量因此,当时,P1P2沿着X轴右移,反之左移,分别求解出该平行直线与边P′1P′4的交点坐标与边P′2P′3的交点坐标以及与边P′3P′4的交点坐标作为梳状往复遍历方式自动投饲轨迹规划特征点;
步骤S0042,生成梳状往复遍历方式池塘全覆盖自动投饲轨迹:梳状往复遍历方式自动投饲的轨迹采用如下格式描述:{序号、目标点坐标、航行区间内的航速、喂料器单位时间内落料量、抛盘转速、投饵扇角},其中,航行区间内的航速、喂料器单位时间内落料量、抛盘转速、投饵扇角等参数由***解算给出,因此,只要确定目标点的个数以及遍历顺序,就可以确定梳状往复遍历的轨迹。
3.根据权利要求2所述的一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,其特征在于,所述步骤S0042中,采用几何推理法按照平行直线扫描特征点的次序来按序依次遍历,用结构体Fpoint[]来表示设定的投饲轨迹点,所述结构体包括变量:轨迹点序号intNum、目标点坐标doublepos、航行区间内的航速doublevb、投饵机单位时间内下料量doublemps、抛盘转速doubleN0、投饵扇角
4.根据权利要求3所述的一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,其特征在于,所述步骤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,结束。
5.根据权利要求1所述的一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,其特征在于,所述步骤S005的具体过程为:
步骤S0051,确定内螺旋遍历方式池塘全覆盖自动投饲轨迹规划特征点,内螺旋遍历方式自动投饲轨迹规划特征点可以采用四条边分别向内推平行线,两相邻平移直线求交点的方法获取;
步骤S0052,生成内螺旋遍历方式池塘全覆盖自动投饲轨迹,内螺旋遍历方式自动投饲的轨迹采用如下格式描述:{序号目标点坐标航行至目标点的航速投饵机单位时间内下料量抛盘转速抛射幅角},其中,航行至目标点的航速、投饵机单位时间内下料量、抛盘转速、抛射幅角等参数由***解算给出,由于工作区域四边形的形状不确定,因此必须确定内螺旋遍历的圈数,由于等距内螺旋遍历方式轨迹特征点在各内角的角平分线上,因此,分别令为内角θ1和θ2角平分线交点到边P′1P′2的距离,为内角θ2和θ3角平分线交点到边P′2P′3的距离,为内角θ3和θ4角平分线交点到边P′3P′4的距离,为内角θ4和θ1角平分线交点到边P′4P′1的距离,则
6.根据权利要求5所述的一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法,其特征在于,所述步骤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向内的平行线的交点坐标作为内螺旋遍历方式自动投饲轨迹规划特征点。
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 true CN105466429A (zh) | 2016-04-06 |
CN105466429B 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) |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106305564A (zh) * | 2016-08-23 | 2017-01-11 | 江苏大学 | 一种自主导航河蟹养殖投饵装置及均匀投饵方法 |
CN106547276A (zh) * | 2016-10-19 | 2017-03-29 | 上海圣尧智能科技有限公司 | 自动喷洒回字形路径规划方法及植保机喷洒作业方法 |
CN106679684A (zh) * | 2016-12-27 | 2017-05-17 | 湖南挚新科技发展有限公司 | 自动化作业设备路径规划方法与*** |
CN106998592A (zh) * | 2017-03-13 | 2017-08-01 | 信阳农林学院 | 一种基于无线传感网络的渔业智能施药方法 |
CN107197806A (zh) * | 2017-05-17 | 2017-09-26 | 武汉理工大学 | 基于无人艇的弹性栅格式定点自动投饵方法 |
CN107831773A (zh) * | 2017-11-30 | 2018-03-23 | 深圳市沃特沃德股份有限公司 | 扫地机器人全覆盖清扫的方法及扫地机器人 |
CN108759828A (zh) * | 2018-03-23 | 2018-11-06 | 江苏大学 | 一种无人驾驶插秧机路径规划方法 |
CN109240284A (zh) * | 2018-08-10 | 2019-01-18 | 江苏大学 | 一种无人驾驶农机的自主路径规划方法及装置 |
CN109911643A (zh) * | 2019-04-02 | 2019-06-21 | 上海快仓智能科技有限公司 | 物料投放方法、控制装置、设备及*** |
CN110307834A (zh) * | 2019-06-19 | 2019-10-08 | 江苏大学 | 基于低精度gps、激光测距传感器与方位传感器信息融合的蟹塘自动作业船组合导航方法 |
CN110703783A (zh) * | 2019-11-11 | 2020-01-17 | 上海交通大学 | 一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法 |
CN110908376A (zh) * | 2019-11-26 | 2020-03-24 | 江苏大学 | 一种抗风力的自动投饵船精准投饵方法 |
CN111257915A (zh) * | 2020-03-18 | 2020-06-09 | 江西省农业科学院农业工程研究所 | 一种手扶式农机具智能导航***及方法 |
CN111693049A (zh) * | 2020-05-20 | 2020-09-22 | 五邑大学 | 一种无人船覆盖投食的动态路径规划方法及设备 |
CN111766864A (zh) * | 2019-12-30 | 2020-10-13 | 广州极飞科技有限公司 | 路径生成方法、装置、电子设备和计算机可读存储介质 |
CN114326796A (zh) * | 2021-12-15 | 2022-04-12 | 中国航空工业集团公司成都飞机设计研究所 | 一种适用于航空巡逻反潜的矩形搜索方法 |
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 |
---|
孙月平等: ""河蟹养殖船载自动均匀投饵***设计及效果试验"", 《农业工程学报》 * |
徐博: ""基于无人机航向的不规则区域作业航线规划算法与验证"", 《农业工程学报》 * |
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106305564A (zh) * | 2016-08-23 | 2017-01-11 | 江苏大学 | 一种自主导航河蟹养殖投饵装置及均匀投饵方法 |
CN106547276A (zh) * | 2016-10-19 | 2017-03-29 | 上海圣尧智能科技有限公司 | 自动喷洒回字形路径规划方法及植保机喷洒作业方法 |
CN106679684A (zh) * | 2016-12-27 | 2017-05-17 | 湖南挚新科技发展有限公司 | 自动化作业设备路径规划方法与*** |
CN106998592A (zh) * | 2017-03-13 | 2017-08-01 | 信阳农林学院 | 一种基于无线传感网络的渔业智能施药方法 |
CN107197806A (zh) * | 2017-05-17 | 2017-09-26 | 武汉理工大学 | 基于无人艇的弹性栅格式定点自动投饵方法 |
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 | 江苏大学 | 一种无人驾驶农机的自主路径规划方法及装置 |
CN109240284A (zh) * | 2018-08-10 | 2019-01-18 | 江苏大学 | 一种无人驾驶农机的自主路径规划方法及装置 |
CN109911643A (zh) * | 2019-04-02 | 2019-06-21 | 上海快仓智能科技有限公司 | 物料投放方法、控制装置、设备及*** |
US11472641B2 (en) | 2019-04-02 | 2022-10-18 | Shanghai Quicktron Intelligent Technology Co., Ltd | Material dropping method, control device, dropping apparatus, and system |
CN110307834A (zh) * | 2019-06-19 | 2019-10-08 | 江苏大学 | 基于低精度gps、激光测距传感器与方位传感器信息融合的蟹塘自动作业船组合导航方法 |
CN110703783A (zh) * | 2019-11-11 | 2020-01-17 | 上海交通大学 | 一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法 |
CN110908376A (zh) * | 2019-11-26 | 2020-03-24 | 江苏大学 | 一种抗风力的自动投饵船精准投饵方法 |
CN111766864A (zh) * | 2019-12-30 | 2020-10-13 | 广州极飞科技有限公司 | 路径生成方法、装置、电子设备和计算机可读存储介质 |
CN111257915A (zh) * | 2020-03-18 | 2020-06-09 | 江西省农业科学院农业工程研究所 | 一种手扶式农机具智能导航***及方法 |
CN111693049A (zh) * | 2020-05-20 | 2020-09-22 | 五邑大学 | 一种无人船覆盖投食的动态路径规划方法及设备 |
CN111693049B (zh) * | 2020-05-20 | 2022-02-11 | 五邑大学 | 一种无人船覆盖投食的动态路径规划方法及设备 |
CN114326796A (zh) * | 2021-12-15 | 2022-04-12 | 中国航空工业集团公司成都飞机设计研究所 | 一种适用于航空巡逻反潜的矩形搜索方法 |
CN114326796B (zh) * | 2021-12-15 | 2023-07-21 | 中国航空工业集团公司成都飞机设计研究所 | 一种适用于航空巡逻反潜的矩形搜索方法 |
CN114711051A (zh) * | 2022-04-20 | 2022-07-08 | 中交上海航道勘察设计研究院有限公司 | 基于北斗坐标定位的沉水植物种植装置及投放方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105466429B (zh) | 2018-06-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105466429A (zh) | 一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法 | |
CN107197806B (zh) | 基于无人艇的弹性栅格式定点自动投饵方法 | |
CN103699135B (zh) | 无人直升机农药喷洒农田作业区域的航迹自动规划方法 | |
CN104503464B (zh) | 基于计算机的凸多边形农田无人机喷洒作业航迹规划方法 | |
CN105116885B (zh) | 一种基于人工标识的自动投饵作业船视觉导航方法 | |
CN107328419A (zh) | 一种清扫机器人的清扫路径的规划方法及清扫机器人 | |
CN107688318A (zh) | 一种基于Android智能手机的全自动水产养殖作业船APP***设计方法 | |
CN109886384A (zh) | 一种基于鼠脑海马网格细胞重构的仿生导航方法 | |
CN108564202A (zh) | 一种基于环境预报信息的无人艇航线优化方法 | |
CN103918596A (zh) | 一种基于gps导航的智能投料施药***及装置 | |
CN111522336B (zh) | 一种池塘水草自动清理船的作业路径规划及控制方法 | |
CN106305564A (zh) | 一种自主导航河蟹养殖投饵装置及均匀投饵方法 | |
CN109163726B (zh) | 一种回状的全覆盖轨迹规划方法 | |
CN105045260A (zh) | 一种未知动态环境下的移动机器人路径规划方法 | |
CN110097212A (zh) | 一种无人艇高能效协同区域探测方法 | |
CN111348161A (zh) | 一种应用于海洋牧场的资源环境监测***及其操作方法 | |
CN111506062B (zh) | 一种全自动施药船及均匀洒药方法 | |
CN106998592A (zh) | 一种基于无线传感网络的渔业智能施药方法 | |
CN111972337A (zh) | 一种基于北斗定位的自动补充饲料的养殖投饵*** | |
CN102440212B (zh) | 一种可自动巡塘的虾料投放装置及虾料投放方法 | |
Chen et al. | Design and implementation of a novel precision irrigation robot based on an intelligent path planning algorithm | |
Chen et al. | 2D multi-area coverage path planning using L-SHADE in simulated ocean survey | |
CN117008610A (zh) | 一种基于地图定位的养殖智能无人船巡航方法及*** | |
Bechtsis et al. | Scheduling and Control of Unmanned Ground Vehicles for Precision Farming: A Real-time Navigation Tool. | |
CN107703509A (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 |