CN114217543A - 一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法 - Google Patents
一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法 Download PDFInfo
- Publication number
- CN114217543A CN114217543A CN202111180271.6A CN202111180271A CN114217543A CN 114217543 A CN114217543 A CN 114217543A CN 202111180271 A CN202111180271 A CN 202111180271A CN 114217543 A CN114217543 A CN 114217543A
- Authority
- CN
- China
- Prior art keywords
- bait
- path
- bait casting
- point
- feeding
- 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
- 238000005266 casting Methods 0.000 title claims abstract description 98
- 238000000034 method Methods 0.000 title claims abstract description 75
- 238000002474 experimental method Methods 0.000 claims description 10
- 230000001133 acceleration Effects 0.000 claims description 7
- PCTMTFRHKVHKIS-BMFZQQSSSA-N (1s,3r,4e,6e,8e,10e,12e,14e,16e,18s,19r,20r,21s,25r,27r,30r,31r,33s,35r,37s,38r)-3-[(2r,3s,4s,5s,6r)-4-amino-3,5-dihydroxy-6-methyloxan-2-yl]oxy-19,25,27,30,31,33,35,37-octahydroxy-18,20,21-trimethyl-23-oxo-22,39-dioxabicyclo[33.3.1]nonatriaconta-4,6,8,10 Chemical compound C1C=C2C[C@@H](OS(O)(=O)=O)CC[C@]2(C)[C@@H]2[C@@H]1[C@@H]1CC[C@H]([C@H](C)CCCC(C)C)[C@@]1(C)CC2.O[C@H]1[C@@H](N)[C@H](O)[C@@H](C)O[C@H]1O[C@H]1/C=C/C=C/C=C/C=C/C=C/C=C/C=C/[C@H](C)[C@@H](O)[C@@H](C)[C@H](C)OC(=O)C[C@H](O)C[C@H](O)CC[C@@H](O)[C@H](O)C[C@H](O)C[C@](O)(C[C@H](O)[C@H]2C(O)=O)O[C@H]2C1 PCTMTFRHKVHKIS-BMFZQQSSSA-N 0.000 claims description 6
- 230000007423 decrease Effects 0.000 claims description 4
- 230000007246 mechanism Effects 0.000 claims description 4
- 230000000694 effects Effects 0.000 claims description 3
- 238000005303 weighing Methods 0.000 claims description 3
- 238000009360 aquaculture Methods 0.000 abstract description 9
- 244000144974 aquaculture Species 0.000 abstract description 9
- 238000003780 insertion Methods 0.000 abstract description 2
- 230000037431 insertion Effects 0.000 abstract description 2
- 230000001788 irregular Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 5
- 230000007547 defect Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012840 feeding operation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000001737 promoting effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0423—Input/output
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01K—ANIMAL HUSBANDRY; AVICULTURE; APICULTURE; PISCICULTURE; FISHING; REARING OR BREEDING ANIMALS, NOT OTHERWISE PROVIDED FOR; NEW BREEDS OF ANIMALS
- A01K61/00—Culture of aquatic animals
- A01K61/80—Feeding devices
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/25—Pc structure of the system
- G05B2219/25257—Microcontroller
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A40/00—Adaptation technologies in agriculture, forestry, livestock or agroalimentary production
- Y02A40/80—Adaptation technologies in agriculture, forestry, livestock or agroalimentary production in fisheries management
- Y02A40/81—Aquaculture, e.g. of fish
Landscapes
- Life Sciences & Earth Sciences (AREA)
- Environmental Sciences (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Marine Sciences & Fisheries (AREA)
- Zoology (AREA)
- Animal Husbandry (AREA)
- Biodiversity & Conservation Biology (AREA)
- Farming Of Fish And Shellfish (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法。该方法针对水产养殖池塘轮廓不规则、大小不确定,单抛盘投饵存在投饵密度分布不均匀、不对称、纵向饵量密度分布中心偏移等问题,使用GPS/BD导航***确定投饵区域,结合单抛盘投饵饵料分布模型,规划正逆回字形投饵船作业路径。通过采用实时动态插点路径跟踪控制算法进行作业路径导航控制,结合控制船速、抛盘抛幅、饵料下料流量,实现在给定投饵区域内均匀投饵。本发明具有成本低、控制简单、均匀投饵精度高等优点,可以有效提高水产养殖投饵质量。
Description
技术领域
本发明涉及路径规划及自动导航路径跟踪控制领域,特别是自动投饵船的路径规划及其 自动导航控制。
背景技术
我国的水产养殖产业居世界首位,在许多养殖环境中需要在特定区域内均匀投饵,但是 现存的均匀投饵技术存在诸如成本较高、均匀投饵精度低、实用性较差等缺陷,因此研究一 套成本低、控制简单、均匀投饵精度高的均匀投饵方法十分必要。
当前单抛盘投饵应用地比较广泛,其具有投饵成本低、控制简单等优点,应用在投饵船 上十分简便,但是单抛盘投饵具有饵料密度分布不均匀、不对称、纵向饵量密度分布中心偏 移等问题,不易实现高质量的均匀投饵。因此,研究一套基于单抛盘模型的高精度的均匀投 饵方法十分重要。
发明内容
本发明在基于常规的回字形作业路径规划方法上,结合单抛盘投饵存在投饵密度分布不 均匀、不对称、纵向饵量密度分布中心偏移等问题,提出一种多行程饵料叠加的投饵方法, 从而解决投饵密度分布不均匀的问题。通过GPS/BD导航***和单抛盘模型规划投饵路径, 通过检测投饵区域和剩余饵量计算单位区域内投饵量进而调整船速和下料流量实现投饵饵 料均匀,采用实时动态插点路径跟踪控制算法,提高投饵船的直线路径跟踪的精度,航迹切 换时,通过设置线性减速区和线性加速区,采用低速过弯的方法实现平滑转弯,避免出现过 冲问题。
本发明的目的是为了解决现有的基于单抛盘投饵不均匀问题,以及弥补投饵船路径跟踪 精度不高的不足。本发明的投饵方法方法及路径跟踪控制方法可以在给定投饵区域内实现均 匀投饵。
本发明为解决上述问题,采用的技术方案包含以下步骤:
Step1:通过多次实验计算单抛盘在不同转速nk时所对应的抛盘纵中线两侧的纵向密度 峰值1/2点与纵中线的横向距离|x1(k)|、|x2(k)|,以此计算所需投饵船作业路径之间距离d1(k)、 d2(k)。测得饵料密度中心Mk在纵中线上的正投影点Pk距抛盘的距离Lk。将上述多次实验建 立的nk、d1(k)、d2(k)和Lk按条目存表待查。
Step2:使用船载GPS/BD导航***测得目标作业区边界处各个角点经纬度坐标并将其转 化为平面坐标,确定投饵作业边界,并计算需均匀投饵区域的面积S,使用称重传感器测取 饵量总重量Q,计算单位区域内投饵量。
Step3:根据Step2确定的投饵区域,结合Step1中建立的作业路径之间的距离d1(k)、d2(k)条目表,选取合适的抛盘转速nk,规划正逆回字形投饵船作业路径。
Step4:从Step3中确定的抛盘转速nk所对应的条目中找到Lk,确定正投影点Pk与GPS/BD 天线G点之间的关系,将Pk作为跟踪作业路径的当前位置。
Step5:通过实时动态插点路径跟踪控制算法跟踪已规划的投饵船作业路径进行投饵作 业,并适时调整船速、下料流量和抛盘转速。
进一步,所述单抛盘投饵模型中下料口位于抛盘的单侧,旋转叶片以使下料口处饵料能 向外抛出的方向单向旋转,该投饵模型控制简单,投饵效率高。但由此导致实际投饵区域中 心Mk较抛盘中轴线偏离抛盘下料口侧,且投饵密度由中心点Mk向两侧递减,且饵料呈非对 称、不均匀分布,密度中心侧纵向饵量密度递减平缓,另一侧纵向饵量密度递减迅速。
进一步,所述投饵抛盘由直流电机驱动,饵料下料流量由下料机构控制,饵料下料流量 与船速呈正比例关系,通过实时检测船速控制下料机构调整下料流量。船载GPS/BD导航系 统的天线水平安装在船体纵中线上,投饵抛盘倾斜向上安装在船体纵中线的正后下方。
进一步,所述Step1中计算所需投饵船作业路径之间距离的方法如下,实验、拟合得到 单抛盘在转速nk时所对应的纵向饵量密度曲线Ω=fk(x),确定密度为密度峰值1/2时对应的 两个横坐标x1(k)和x2(k),由下式确定d1(k)、d2(k)。
进一步,当单向回字形投饵船作业路径保持d1(k)+d2(k)距离,且正逆回字形路径之间 保持d2(k)距离,所投饵料密度将叠加至在密度峰值附近波动,实现均匀投饵。
进一步,确定Pk(x,y)与GPS/BD天线G(x0,y0)之间的关系的方法如下:
进一步,所述Step3中规划正逆回字形投饵船作业路径的方法如下:
(a):通过GPS/BD导航***确定矩形作业区域四个顶点,顺时针依次为A(x1,y1)、 B(x2,y2)、C(x3,y3)、D(x4,y4);
(b):从ABCD边界向内确定有效均匀投饵边界A1B1C1D1,其与ABCD的距离等于抛盘最 大转速时纵向密度峰值1/2处距饵料外边界的距离;
(c):首先,从Step1建立的条目表中选取单向最大作业路径间距d1(k)+d2(k),向上取整计算单向回字形作业路径的圈数(假设有效均匀投饵区域A1B1C1D1的窄边长为X)。然后,由确定实际所需的单向作业路径间距d1(k)+d2(k)。最后,根据所确定 的d1(k)+d2(k),从Step1建立的条目表中选取实际需要的d1(k)、d2(k)及其对应的抛盘转速nk;
(d):从距A1B1C1D1的长边处开始规划作业路径,正逆回字形路径最外圈距A1B1C1D1边界距离,同圈正逆作业路径之间的距离为d1,以此得到作业路径T0→T1→ T2→…→Tk→Tk+1…→Tn-1→Tn,其中T0为起始点,Tn为投饵路径终点,Tk+1为正逆回 字形路径的转换点。
进一步,所述直线路径跟踪的实时动态插点路径跟踪控制算法如下:
(a):由投饵船的当前位置Pk获得其在当前所跟踪直线路径上的正投影点H。
(b):将H点沿当前跟踪路径向前延伸x长度记为点E,将E作为实时跟踪目标点,对点E进 行实时跟踪。
(c):不停重复上述(a)和(b),以达到实时动态地跟踪当前规划直线路径的效果。
上述实时跟踪目标点的方法如下,通过GPS/BD测取当前船速v,计算实时跟踪目标点E 的延伸距离x=C1-C2l+C3v,其中C1为常量与投饵船的船体尺寸和明轮驱动力有关,C2为当前船位置的横向偏移距离l的比例系数,C3为船速v的比例系数,计算延伸距离x时通过引入横向偏移距离l和当前船优化路径跟踪修正轨迹。
进一步,所述路径切换时转弯控制方法如下:
以当前路径的终点Tk+1(即下一路径的起点)为圆心,做2个同心圆O1、O2,半径分别为R1、R2,其中R1<R2,R1、R2与投饵船的船体尺寸和明轮驱动力有关。
当当前位置Pk在当前跟踪直线路径上的正投影点H进入圆O2时,投饵船开始线性减速; 当点H进入圆O2时,开始使用跟踪圆弧控制方法跟踪圆弧段路径,并切换当前直线路径;当 点H出圆O1时,转弯结束,切换直线路径跟踪方法,并投饵船开始线性加速;当点H出圆O2结 束线性加速。当船速改变时,改变下料流量保证均匀投饵。
进一步,所述跟踪圆弧控制方法如下:
转弯时作业路径为1/4圆弧,其半径为R1,与两直线路径相切。当投饵船的当前位置Pk偏 离圆弧路径时,连接圆弧圆心O与当前位置Pk并向前延伸至圆弧上点N,从点N沿圆弧向 前延伸一段距离(该距离与船体尺寸和明轮驱动力有关)记为点K,将点K作为实时跟踪目标点进行实时动态跟踪。
本发明的有益效果为:针对水产养殖池塘轮廓不规则、大小不确定,以及单抛盘投饵饵 料密度不均匀、密度中心偏移以及投饵船路径跟踪精度不高等问题,使用本发明能有效自适 应水产养殖池塘轮廓和大小,调整投饵范围。通过控制船速、下料速度以及采用实时动态插 点路径跟踪控制算法跟踪规划的正逆回字形作业路径可以实现在给定投饵区域内实现均匀 投饵。
附图说明
图1单抛盘机械机构图
图2饵料分布示意图
图3纵向饵料密度曲线示意图
图4投饵船后视图
图5当前位置Pk与GPS/BD关系图
图6饵量叠加示意图
图7作业路径规划示意图
图8实时动态插点路径跟踪控制算法示意图
具体实施方式
下面结合附图对本发明的具体实施方式做进一步描述,本实施方式以本发明技术方案为 前提进行实施,给出了详细的实施方式和具体的操作过程,但本发明的保护范围不限于下述 的实施方式。
本实施方式采用的投饵船的结构如图4、图5所示,船上包括船体、明轮单抛盘、以及 GPS/BD导航***。
具体实施步骤如下:
Step1:通过实验、拟合得到单抛盘投饵时纵向饵量密度曲线Ω=f(x),计算所需物理 量,存表待查。
(a):通过多次实验,拟合得到单抛盘在不同转速nk时所对应的纵向饵量密度曲线Ω=fk(x)。
(b):由密度曲线fk(x)确定密度为密度峰值1/2时对应的两个横坐标x1(k)和x2(k),由下 式计算所需投饵船作业路径之间距离d1(k)、d2(k)。
(c):测得饵料密度中心Mk在纵中线上的正投影点Pk距抛盘的距离Lk。
(d):将上述多次实验建立的nk、d1(k)、d2(k)和Lk按条目存表待查。
Step2:计算单位区域内投饵量。
使用船载GPS/BD导航***测得目标作业区边界处各个角点经纬度坐标并将其转化为 平面坐标,确定投饵作业边界,并计算需均匀投饵区域的面积S,使用称重传感器测取饵量 总重量Q,计算单位区域内投饵量。
Step3:规划正逆回字形投饵船作业路径。
(a):通过GPS/BD导航***确定矩形作业区域四个顶点,顺时针依次为A(x1,y1)、B(x2,y2)、C(x3,y3)、D(x4,y4);
(b):从ABCD边界向内确定有效均匀投饵边界A1B1C1D1,其与ABCD的距离等于抛盘最 大转速时纵向密度峰值1/2处距饵料外边界的距离;
(c):首先,从Step1建立的条目表中选取单向最大作业路径间距d1(k)+d2(k),向上取整计算单向回字形作业路径的圈数(假设有效均匀投饵区域A1B1C1D1的窄边长为X)。然后,由确定实际所需的单向作业路径间距d1(k)+d2(k)。最后,根据所确定 的d1(k)+d2(k),从Step1建立的条目表中选取实际需要的d1(k)、d2(k)及其对应的抛盘转速nk;
(d):从距A1B1C1D1的长边处开始规划作业路径,正逆回字形路径最外圈距A1B1C1D1边界距离,同圈正逆作业路径之间的距离为d1,以此得到作业路径T0→T1→ T2→…→Tk→Tk+1…→Tn-1→Tn,其中T0为起始点,Tn为投饵路径终点,Tk+1为正逆回 字形路径的转换点。
Step4:确定当前位置Pk(x,y)与GPS/BD天线G(x0,y0)之间的关系。
Step5:通过如图7所示实时动态插点路径跟踪控制算法跟踪正逆回字形作业路径投饵 作业。
当跟踪直线路径时,使用如下方法:
(a):由投饵船的当前位置Pk获得其在当前所跟踪直线路径上的正投影点H。
(b):将H点沿当前跟踪路径向前延伸x长度记为点E,将E作为实时跟踪目标点,对点E进 行实时跟踪。
(c):不停重复上述(a)和(b),以达到实时动态地跟踪当前规划直线路径的效果。
上述实时跟踪目标点的方法如下,通过GPS/BD测取当前船速v,计算实时跟踪目标点E 的延伸距离x=C1-C2l+C3v,其中C1为常量与投饵船的船体尺寸和明轮驱动力有关,C2为当前船位置的横向偏移距离l的比例系数,C3为船速v的比例系数,计算延伸距离x时通过引入横向偏移距离l和当前船优化路径跟踪修正轨迹。
当路径切换时,使用如下转弯控制方法:
以当前路径的终点Tk+1(即下一路径的起点)为圆心,做2个同心圆O1、O2,半径分别为R1、R2,其中R1<R2,R1、R2与投饵船的船体尺寸和明轮驱动力有关。
当当前位置Pk在当前跟踪直线路径上的正投影点H进入圆O2时,投饵船开始线性减速; 当点H进入圆O2时,开始使用跟踪圆弧控制方法跟踪圆弧段路径,并切换当前直线路径;当 点H出圆O1时,转弯结束,切换直线路径跟踪方法,并投饵船开始线性加速;当点H出圆O2结 束线性加速。当船速改变时,改变下料流量保证均匀投饵。
其中跟踪圆弧控制方法如下:
转弯时作业路径为1/4圆弧,其半径为R1,与两直线路径相切。当投饵船的当前位置Pk偏 离圆弧路径时,连接圆弧圆心O与当前位置Pk并向前延伸至圆弧上点N,从点N沿圆弧向 前延伸一段距离(该距离与船体尺寸和明轮驱动力有关)记为点K,将点K作为实时跟踪目标点进行实时动态跟踪。
综上,本发明的一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法,用于实现水 产养殖的均匀投饵。首先,通过实验、拟合得到单抛盘投饵时纵向饵量密度曲线,计算路径 规划所需物理量,按条目存表待查。其次,计算单位区域内投饵量。接着,规划正逆回字形 投饵船作业路径。然后,确定GPS/BD天线和当前位置Pk之间的关系。最后,使用实时动态 插点路径跟踪控制算法跟踪作业路径进行投饵作业。本发明操作简单,可有效解决单抛盘投 饵不均匀问题,进而提高水产养殖质量,促进水产养殖业的智能化发展。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示意性实施例”、“示 例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、 材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意 性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可 以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管已经示出和描述了本发明的实施例,本领域的普通技术人员可以理解:在不脱离本 发明的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的 范围由权利要求及其等同物限定。
Claims (10)
1.一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法,其特征在于,主要包括以下步骤:
Step1:通过多次实验计算单抛盘在不同转速nk时所对应的抛盘纵中线两侧的纵向密度峰值1/2点与纵中线的横向距离|x1(k)|、|x2(k)|,以此计算所需投饵船作业路径之间距离d1(k)、d2(k);测得饵料密度中心Mk在纵中线上的正投影点Pk距抛盘的距离Lk,将上述多次实验建立的nk、d1(k)、d2(k)和Lk按条目存表待查;
Step2:使用船载GPS/BD导航***测得目标作业区边界处各个角点经纬度坐标并将其转化为平面坐标,确定投饵作业边界,并计算需均匀投饵区域的面积S,使用称重传感器测取饵量总重量Q,计算单位区域内投饵量;
Step3:根据Step2确定的投饵区域,结合Step1中建立的作业路径之间的距离d1(k)、d2(k)条目表,选取合适的抛盘转速nk,规划正逆回字形投饵船作业路径;
Step4:从Step3中确定的抛盘转速nk所对应的条目中找到Lk,确定正投影点Pk(x,y)与GPS/BD天线G(x0,y0)点之间的关系,将Pk作为跟踪作业路径的当前位置;
Step5:通过实时动态插点路径跟踪控制算法跟踪已规划的投饵船作业路径进行投饵作业,并适时调整船速、下料流量和抛盘转速。
2.根据权利要求1所述的一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法,其特征在于,Step1中,在单抛盘投饵模型中下料口位于抛盘的单侧,旋转叶片以使下料口处饵料能向外抛出的方向单向旋转,但由此导致实际投饵区域中心Mk较抛盘中轴线偏离抛盘下料口侧,且投饵密度由中心点Mk向两侧递减,且饵料呈非对称、不均匀分布,密度中心侧纵向饵量密度递减平缓,另一侧纵向饵量密度递减迅速。
3.根据权利要求1所述的一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法,其特征在于,所述抛盘由直流电机驱动,饵料下料流量由下料机构控制,饵料下料流量与船速呈正比例关系,通过实时检测船速控制下料机构调整下料流量,船载GPS/BD导航***的天线水平安装在船体纵中线上,投饵抛盘倾斜向上安装在船体纵中线的正后下方。
5.根据权利要求1所述的一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法,其特征在于,当单向回字形投饵船作业路径保持d1(k)+d2(k)距离,且正逆回字形路径之间保持d2(k)距离,所投饵料密度将叠加至在密度峰值附近波动,实现均匀投饵。
7.根据权利要求1所述的一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法,其特征在于,所述Step3中,规划正逆回字形投饵船作业路径的方法如下:
(a):通过GPS/BD导航***确定矩形作业区域四个顶点,顺时针依次为A(x1,y1)、B(x2,y2)、C(x3,y3)、D(x4,y4);
(b):从ABCD边界向内确定有效均匀投饵边界A1B1C1D1,其与ABCD的距离等于抛盘最大转速时纵向密度峰值1/2处距饵料外边界的距离;
(c):首先,从Step1建立的条目表中选取单向最大作业路径间距d1(k)+d2(k),向上取整计算单向回字形作业路径的圈数(假设有效均匀投饵区域A1B1C1D1的窄边长为X);然后,由确定实际所需的单向作业路径间距d1(k)+d2(k);最后,根据所确定的d1(k)+d2(k),从Step1建立的条目表中选取实际需要的d1(k)、d2(k)及其对应的抛盘转速nk;
8.根据权利要求1所述的一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法,其特征在于,实时动态插点路径跟踪控制算法如下:
(a):由投饵船的当前位置Pk获得其在当前所跟踪直线路径上的正投影点H;
(b):将H点沿当前跟踪路径向前延伸x长度记为点E,将E作为实时跟踪目标点,对点E进行实时跟踪;
(c):不停重复上述(a)和(b),以达到实时动态地跟踪当前规划直线路径的效果;
上述实时跟踪目标点的方法如下,通过GPS/BD测取当前船速v,计算实时跟踪目标点E的延伸距离x=C1-C2l+C3v,其中C1为常量与投饵船的船体尺寸和明轮驱动力有关,C2为当前船位置的横向偏移距离l的比例系数,C3为船速v的比例系数,计算延伸距离x时通过引入横向偏移距离l和当前船优化路径跟踪修正轨迹。
9.根据权利要求8所述的一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法,其特征在于,还包括路径切换时转弯控制方法:
以当前路径的终点Tk+1(即下一路径的起点)为圆心,做2个同心圆O1、O2,半径分别为R1、R2,其中R1<R2,R1、R2与投饵船的船体尺寸和明轮驱动力有关;
当当前位置Pk在当前跟踪直线路径上的正投影点H进入圆O2时,投饵船开始线性减速;当点H进入圆O2时,开始使用跟踪圆弧控制方法跟踪圆弧段路径,并切换当前直线路径;当点H出圆O1时,转弯结束,切换直线路径跟踪方法,并投饵船开始线性加速;当点H出圆O2结束线性加速。当船速改变时,改变下料流量保证均匀投饵。
10.根据权利要求9所述的一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法,其特征在于,还包括跟踪圆弧控制方法:
转弯时作业路径为1/4圆弧,其半径为R1,与两直线路径相切。当投饵船的当前位置Pk偏离圆弧路径时,连接圆弧圆心O与当前位置Pk并向前延伸至圆弧上点N,从点N沿圆弧向前延伸一段距离(该距离与船体尺寸和明轮驱动力有关)记为点K,将点K作为实时跟踪目标点进行实时动态跟踪。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111180271.6A CN114217543B (zh) | 2021-10-11 | 2021-10-11 | 一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111180271.6A CN114217543B (zh) | 2021-10-11 | 2021-10-11 | 一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114217543A true CN114217543A (zh) | 2022-03-22 |
CN114217543B CN114217543B (zh) | 2024-07-12 |
Family
ID=80696021
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111180271.6A Active CN114217543B (zh) | 2021-10-11 | 2021-10-11 | 一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114217543B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115344054A (zh) * | 2022-10-18 | 2022-11-15 | 常州慧而达智能装备有限公司 | 基于gps/北斗和绞龙转角反馈的自动投饵船投饵方法 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103988801A (zh) * | 2014-06-04 | 2014-08-20 | 江苏大学 | 一种风力驱动自动投饵***及均匀投饵方法 |
CN106305564A (zh) * | 2016-08-23 | 2017-01-11 | 江苏大学 | 一种自主导航河蟹养殖投饵装置及均匀投饵方法 |
CN106547276A (zh) * | 2016-10-19 | 2017-03-29 | 上海圣尧智能科技有限公司 | 自动喷洒回字形路径规划方法及植保机喷洒作业方法 |
WO2017143631A1 (zh) * | 2016-02-22 | 2017-08-31 | 江苏大学 | 一种水产养殖作业船自动导航路径跟踪方法 |
CN107688318A (zh) * | 2017-08-31 | 2018-02-13 | 江苏大学 | 一种基于Android智能手机的全自动水产养殖作业船APP***设计方法 |
CN109163726A (zh) * | 2018-09-21 | 2019-01-08 | 江苏大学 | 一种回状的全覆盖轨迹规划方法 |
CN110250069A (zh) * | 2019-06-19 | 2019-09-20 | 江苏大学 | 一种河蟹养殖自动精细投饵的实现方法 |
CN110908376A (zh) * | 2019-11-26 | 2020-03-24 | 江苏大学 | 一种抗风力的自动投饵船精准投饵方法 |
CN111506062A (zh) * | 2020-03-30 | 2020-08-07 | 江苏大学 | 一种全自动施药船及均匀洒药方法 |
CN111522336A (zh) * | 2020-03-26 | 2020-08-11 | 江苏大学 | 一种池塘水草自动清理船的作业路径规划及控制方法 |
CN112229415A (zh) * | 2020-11-03 | 2021-01-15 | 上海华测导航技术股份有限公司 | 路径规划方法、装置、电子设备和存储介质 |
-
2021
- 2021-10-11 CN CN202111180271.6A patent/CN114217543B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103988801A (zh) * | 2014-06-04 | 2014-08-20 | 江苏大学 | 一种风力驱动自动投饵***及均匀投饵方法 |
WO2017143631A1 (zh) * | 2016-02-22 | 2017-08-31 | 江苏大学 | 一种水产养殖作业船自动导航路径跟踪方法 |
CN106305564A (zh) * | 2016-08-23 | 2017-01-11 | 江苏大学 | 一种自主导航河蟹养殖投饵装置及均匀投饵方法 |
CN106547276A (zh) * | 2016-10-19 | 2017-03-29 | 上海圣尧智能科技有限公司 | 自动喷洒回字形路径规划方法及植保机喷洒作业方法 |
CN107688318A (zh) * | 2017-08-31 | 2018-02-13 | 江苏大学 | 一种基于Android智能手机的全自动水产养殖作业船APP***设计方法 |
CN109163726A (zh) * | 2018-09-21 | 2019-01-08 | 江苏大学 | 一种回状的全覆盖轨迹规划方法 |
CN110250069A (zh) * | 2019-06-19 | 2019-09-20 | 江苏大学 | 一种河蟹养殖自动精细投饵的实现方法 |
CN110908376A (zh) * | 2019-11-26 | 2020-03-24 | 江苏大学 | 一种抗风力的自动投饵船精准投饵方法 |
CN111522336A (zh) * | 2020-03-26 | 2020-08-11 | 江苏大学 | 一种池塘水草自动清理船的作业路径规划及控制方法 |
CN111506062A (zh) * | 2020-03-30 | 2020-08-07 | 江苏大学 | 一种全自动施药船及均匀洒药方法 |
CN112229415A (zh) * | 2020-11-03 | 2021-01-15 | 上海华测导航技术股份有限公司 | 路径规划方法、装置、电子设备和存储介质 |
Non-Patent Citations (3)
Title |
---|
侍厅厅: "全自动水产养殖船的远程实时智能监控***设计", 《硕士电子期刊》, no. 12 * |
孙月平等: "河蟹养殖船载自动均匀投饵***设计及效果试验", 《农业工程学报》, vol. 31, no. 11 * |
郭子淳等: "智能投饵船研究现状与展望", 《农业机械学报》, vol. 51 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115344054A (zh) * | 2022-10-18 | 2022-11-15 | 常州慧而达智能装备有限公司 | 基于gps/北斗和绞龙转角反馈的自动投饵船投饵方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114217543B (zh) | 2024-07-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105629976B (zh) | 一种水产养殖作业船自动导航路径跟踪方法 | |
CN114217543A (zh) | 一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法 | |
CN108640040A (zh) | 一种智能叉车的位姿调整路径规划方法 | |
CN111522336B (zh) | 一种池塘水草自动清理船的作业路径规划及控制方法 | |
US11284561B2 (en) | Agricultural aircraft for spreading granular fertilizer and spreading method thereof | |
WO2022053041A1 (zh) | 一种电弧熔丝增材制造路径生成方法 | |
CN109163726B (zh) | 一种回状的全覆盖轨迹规划方法 | |
CN110096063B (zh) | 一种基于测距仪的水下清洗机器人自主倒立着落船底控制方法 | |
CN111506062B (zh) | 一种全自动施药船及均匀洒药方法 | |
CN108674614A (zh) | 一种四螺旋桨水下航行器及其控制方法 | |
SE447083B (sv) | Styranordning for styrning av korriktning och korhastighet hos fordon | |
CN103205746A (zh) | 半球体零件表面的激光熔覆方法 | |
CN110789530B (zh) | 一种四轮独立转向-独立驱动车辆轨迹跟踪方法和*** | |
CN108801262B (zh) | 一种船舶自动航行控制器航路规划与纠偏修正方法 | |
CN113862624B (zh) | 溅射沉积设备及溅射沉积方法 | |
CN113862625A (zh) | 高通量薄膜沉积设备及薄膜沉积方法 | |
CN112958915A (zh) | 基于多轴联动的钛合金螺旋桨电弧激光复合增材制造方法及应用 | |
CN111974617B (zh) | 一种双阀点胶机的主副阀校正方法 | |
JP3911085B2 (ja) | リクレーマ運行制御装置および制御方法 | |
CN115268474A (zh) | 一种基于改进Dubins曲线的水下航行器编队方法 | |
CN107283818B (zh) | 一种用于3d打印补料的二次定位方法及结构 | |
CN115344054B (zh) | 基于gps/北斗和绞龙转角反馈的自动投饵船投饵方法 | |
CN202276731U (zh) | 一种可自动巡塘的虾料投放装置 | |
CN108388272B (zh) | 一种基于时间最优的无人机前飞速度计算方法 | |
CN111251164B (zh) | 一种基于cad建模的保温杯抛光方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant |