CN114489072A - 一种基于无人艇的喷水辅助垃圾回收的方法与系统 - Google Patents
一种基于无人艇的喷水辅助垃圾回收的方法与系统 Download PDFInfo
- Publication number
- CN114489072A CN114489072A CN202210085884.XA CN202210085884A CN114489072A CN 114489072 A CN114489072 A CN 114489072A CN 202210085884 A CN202210085884 A CN 202210085884A CN 114489072 A CN114489072 A CN 114489072A
- Authority
- CN
- China
- Prior art keywords
- theoretical
- garbage
- module
- recovery
- angle
- 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
- 239000010813 municipal solid waste Substances 0.000 title claims abstract description 120
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 title claims abstract description 75
- 239000007921 spray Substances 0.000 title claims abstract description 28
- 238000000034 method Methods 0.000 title claims abstract description 23
- 238000004064 recycling Methods 0.000 title claims description 17
- 238000011084 recovery Methods 0.000 claims abstract description 96
- 238000005507 spraying Methods 0.000 claims description 58
- 238000013528 artificial neural network Methods 0.000 claims description 31
- 238000002347 injection Methods 0.000 claims description 17
- 239000007924 injection Substances 0.000 claims description 17
- 238000010276 construction Methods 0.000 claims description 12
- 230000003213 activating effect Effects 0.000 claims 1
- 230000006698 induction Effects 0.000 abstract description 3
- 230000004044 response Effects 0.000 abstract description 2
- 238000004364 calculation method Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000004888 barrier function Effects 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 239000002699 waste material Substances 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 238000005094 computer simulation Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 239000000243 solution Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
-
- 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
- Y02A20/00—Water conservation; Efficient water supply; Efficient water use
- Y02A20/20—Controlling water pollution; Waste water treatment
- Y02A20/204—Keeping clear the surface of open water from oil spills
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Spray Control Apparatus (AREA)
Abstract
一种基于无人艇的喷水辅助垃圾回收的方法与系统,所述方法包括以下步骤:步骤S1:规划无人艇巡线路径,无人艇按照巡线路径在水面行驶;步骤S2:无人艇在开始行驶时,一同开启感应装置,感应无人艇前方是否存在有垃圾;步骤S3:若感应装置感应无人艇前方存在垃圾,则无人艇展开回收臂,并判断垃圾是否能够进入到回收臂的回收范围内,若垃圾能落入到回收臂的回收范围内,则无人艇朝向垃圾的方向行驶,若垃圾不能落入到回收臂的回收范围内,则重新规划无人艇的巡线路经。本申请可控制无人艇以最佳巡线路径对垃圾进行回收,减少无人艇行驶的距离。同时本申请还能精准控制喷嘴的喷射角度以及喷水量,减少无人艇的运行成本以及提高回收的精准度。
Description
技术领域
本发明涉及无人设备水面清洁技术领域,特别是一种基于无人艇的喷水辅助垃圾回收的方法与系统。
背景技术
在无人艇领域,垃圾回收一直是其中一个重点方向。对比传统的人工打捞和有人驾驶相关机械回收两种方式。垃圾回收无人艇有着人力消耗小、作业时间长、成本低、便于检测和减少人员事故的优点。
然而,现有主流的无人艇大多有回收范围窄、回收效率低的问题。因为其大多采用单独的内置传送带回收结构,仅能回收无人艇正前方的垃圾。针对这种情况,部分改进型垃圾回收无人艇拥有外伸的阻拦网或者机械臂进行辅助。但是采用机械臂等机械外伸结构又造成了结构复杂、重量大、成本高、控制困难等问题。单纯使用外伸阻拦网的垃圾回收无人艇面临阻拦网角度限定,角度过大会导致垃圾无法回收的问题。
因此,需要一种即有较大回收范围和效率,又能有效降低结构的复杂程度、重量和成本的方法。
发明内容
针对上述缺陷,本发明的目的在于提出一种基于无人艇的喷水辅助垃圾回收的方法与系统。
为达此目的,本发明采用以下技术方案:一种基于无人艇的喷水辅助垃圾回收的方法,包括以下步骤:
步骤S1:规划无人艇巡线路径,无人艇按照巡线路径在水面行驶;
步骤S2:无人艇在开始行驶时,一同开启感应装置,感应无人艇前方是否存在有垃圾;
步骤S3:若所述感应装置感应无人艇前方存在垃圾,则无人艇展开回收臂,并判断垃圾是否能够进入到回收臂的回收范围内,若垃圾能落入到回收臂的回收范围内,则无人艇朝向垃圾的方向行驶,若垃圾不能落入到回收臂的回收范围内,则重新规划无人艇的巡线路经,使垃圾能够落入到回收臂的回收范围内;
步骤S4:当垃圾进入到回收臂的喷射区域内时,根据垃圾与回收臂上喷嘴的位置,获取回收臂上喷嘴的理论喷射角度以及喷嘴的理论喷水量,将理论喷射角度传递至神经网络,神经网络确定步进电机的执行旋转角度,启动步进电机根据执行旋转角度旋转所述喷嘴;将理论喷水量传递至神经网络,神经网络确定阀门的开合度实现喷水量控制;通过喷嘴喷出的水流将垃圾回收到无人艇内。
优选的,所述步骤S4中获取回收臂上喷嘴的理论喷射角度包括以下步骤:
以感应装置为原点构建,为坐标原点建立直角坐标系,感应装置输出垃圾相对于原点的极坐标(L,θ),并将极坐标转化为直角坐标(x,y);
以回收臂的转轴为中心坐标(x0,y0),根据喷嘴离回收臂的转轴的距离以及回收臂在直角坐标系中与X轴的夹角,得到喷嘴的直角坐标(x1,y1),再通过直角坐标(x,y)与直角坐标(x1,y1)获取得到喷嘴的理论喷射角度α;
其中理论喷射角度α的获取公式如下:
其中x1=x0+lcosψ-lcosθ,y1=y0+lsinψ-lsinθ--公式二;
经过公式一与公式二的合并,得到公式三:
ψ为回收臂在直角坐标系中与X轴的夹角,l为喷嘴离回收臂的转轴的距离,θ为垃圾在直角坐标系中与X轴的夹角。
优选的,所述步骤S4中获取回收臂上喷嘴的理论喷水量U如公式四所表示:
U=Kb2--公式四,其中b为喷嘴与垃圾的距离,K为理论喷水量与距离的关系系数,其中b的获取公式五如下所示:
b=(x0+lcosψ-lcosθ)2+(y0+lsinψ-lsinθ)2。
优选的,所述步骤S4中启动步进电机旋转所述喷嘴,其中所述步进电机的理论旋转角度控制表达式如下公式六所表示:
其中a1(t)为步进电机的理论的旋转,a1(t)的取值为喷嘴的理论喷射角度α,Kp、Ki、Kd为神经网络的增益,t为时间,e1为旋转角度误差值;
对步进电机的理论旋转角度进行离散化处理,获得步进电机的执行旋转角度,其中步进电机的执行旋转角度如下公式七所表示:
其中,a1(k)为步进电机的执行旋转角度,e1(k)为第k个旋转角度误差值的离散值,n的取值范围为整数;
通过步进电机的执行旋转角度与步进电机的理论旋转角度之间的差值对旋转角度误差值e1进行更新,更新后的e1代入到下次的步进电机的执行旋转角度与步进电机的理论旋转角度中。
优选的,所述步骤S4中神经网络确定阀门的开合度包括以下步骤:
将理论喷水量转化为理论阀门开合度,其中理论阀门开合度如下公式八:
其中Uk(t)为理论阀门开合度,Kp、Ki、Kd为神经网络的增益,t为时间,e2为开合度误差值;
对理论阀门开合度进行离散化处理,获得阀门的执行开合度,其中阀门的执行开合度如下公式九所表示:
其中,Uk(k)为阀门的执行开合度,e2(k)为第k个开合度误差值的离散值,n的取值范围为整数;
通过阀门的执行开合度与理论阀门开合度之间的差值对旋转角度误差值e2进行更新,更新后的e2代入到下次阀门的执行开合度与理论阀门开合度中。
一种基于无人艇的喷水辅助垃圾回收的系统,使用上述一种基于无人艇的喷水辅助垃圾回收的方法,包括线路策划模块、感应模块、神经网络模块、喷水模块、转动模块;
所述线路策划模块用于规划无人艇巡线路径,无人艇按照巡线路径在水面行驶;
所述感应模块用于感应无人艇前方是否存在有垃圾;
所述神经网络模块包括回收范围模块以及喷射区域模块,所述回收范围模块用于判断垃圾是否能够进入到回收臂的回收范围内,所述喷射区域模块用于判断垃圾是否进入到回收臂的喷射区域内;
所述喷水模块用于控制阀门的开合度;
所述转动模块用于驱动步进电机旋转。
优选的,还包括坐标构建模块、理论喷射角度获取模块以及理论喷水量获取模块;
所述坐标构建模块用于根据感应装置与垃圾的位置构建直角坐标,并获取垃圾与喷嘴之间的位置关系;
所述喷射角度获取模块用于根据坐标构建模块的信息获取喷嘴的理论喷射角度;
所述喷水量获取模块用于根据坐标构建模块的信息获取喷嘴的理论喷水量。
优选的,还包括步进电机旋转角度模块和阀门开合度模块;
所述进电机旋转角度模块用于根据理论喷射角度获取步进电机的执行旋转角度,并将执行旋转角度发生给转动模块;
所述阀门开合度模块用于根据理论喷水量获取执行开合度,并将执行开合度发送给喷水模块。
上述技术方案中的一个技术方案具有如下优点或有益效果:与现有技术相比,本申请可控制无人艇以最佳巡线路径对垃圾进行回收,减少无人艇行驶的距离。同时本申请还能精准控制喷嘴的喷射角度以及喷水量,减少无人艇的运行成本以及提高回收的精准度。
附图说明
图1是本发明方法的一个实施例的流程示意图。
图2是本发明系统的一个实施例的结构示意图。
图3是本发明方法的一个实施例的直角坐标系示意图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。
在本发明的描述中,需要理解的是,术语“中心”、“纵向”、“横向”、“长度”、“宽度”、“厚度”、“上”、“下”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”、“轴向”、“径向”、“周向”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
此外,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括一个或者更多个该特征。在本发明的描述中,除非另有说明,“多个”的含义是两个或两个以上。
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
如图1~3所示,一种基于无人艇的喷水辅助垃圾回收的方法,包括以下步骤:
步骤S1:规划无人艇巡线路径,无人艇按照巡线路径在水面行驶;
步骤S2:无人艇在开始行驶时,一同开启感应装置,感应无人艇前方是否存在有垃圾;
步骤S3:若所述感应装置感应无人艇前方存在垃圾,则无人艇展开回收臂,并判断垃圾是否能够进入到回收臂的回收范围内,若垃圾能落入到回收臂的回收范围内,则无人艇朝向垃圾的方向行驶,若垃圾不能落入到回收臂的回收范围内,则重新规划无人艇的巡线路经,使垃圾能够落入到回收臂的回收范围内;
步骤S4:当垃圾进入到回收臂的喷射区域内时,根据垃圾与回收臂上喷嘴的位置,获取回收臂上喷嘴的理论喷射角度以及喷嘴的理论喷水量,将理论喷射角度传递至神经网络,神经网络确定步进电机的执行旋转角度,启动步进电机根据执行旋转角度旋转所述喷嘴;将理论喷水量传递至神经网络,神经网络确定阀门的开合度实现喷水量控制;通过喷嘴喷出的水流将垃圾回收到无人艇内。
在步骤S2中,所述无人艇通过感应装置,感应前方是否存在垃圾,其中所述感应装置可以为摄像头以及激光雷达,通过激光雷达对水面上的异物进行获取,同时摄像头对异物进行拍摄,再通过神经网络对拍摄的图片进行识别,判断水面上的异物是否为垃圾。在步骤S3中,当无人艇发现到有垃圾后,无人艇会旋转展开回收臂,在旋转展开的过程中,感应装置中的激光雷达会同时将回收臂的位置信息发给无人艇的处理内存,处理内存会判断垃圾是否会落入到回收臂的回收范围了。其中回收范围的确定过程大致如下:当处理内存接收到回收臂的位置后,会以回收臂的端部向无人艇移动的方向做直线,当垃圾位于两个回收臂所作出的直线内,则说明垃圾位于回收区域内,无人艇可对垃圾进行回收。另外由于回收臂的展开角度限制,当垃圾不能位于回收臂展开最大角度时所作出的直线内,则说明垃圾不能被当前巡线路径的无人艇所回收,需要重新规划巡线路径。重新规划巡线路径大致方法如下,获取垃圾的方位,并将无人艇逐渐转向垃圾,在转向垃圾的过程中,检测垃圾是否落入到回收区域内,当垃圾落入到回收区域内时,停止无人艇旋转。无人艇向前行驶,当回收完该垃圾后,沿原有的巡线路径进行行驶。当垃圾进入到回收臂的喷射区域内,无人艇将会计算回收臂上喷嘴的喷射角度以及喷水量,以最合理的角度以及最低的喷水量,将垃圾到无人艇内进行回收。与现有技术相比,本申请可控制无人艇以最佳巡线路径对垃圾进行回收,减少无人艇行驶的距离。同时本申请还能精准控制喷嘴的喷射角度以及喷水量,减少无人艇的运行成本以及提高回收的精准度。
优选的,所述步骤S4中获取回收臂上喷嘴的理论喷射角度包括以下步骤:
以感应装置为原点构建,为坐标原点建立直角坐标系,感应装置输出垃圾相对于原点的极坐标(L,θ),并将极坐标转化为直角坐标(x,y);
以回收臂的转轴为中心坐标(x0,y0),根据喷嘴离回收臂的转轴的距离以及回收臂在直角坐标系中与X轴的夹角,得到喷嘴的直角坐标(x1,y1),再通过直角坐标(x,y)与直角坐标(x1,y1)获取得到喷嘴的理论喷射角度α;
其中理论喷射角度α的获取公式如下:
其中x1=x0+lcosψ-lcosθ,y1=y0+lsinψ-lsinθ--公式二;
经过公式一与公式二的合并,得到公式三:
ψ为回收臂在直角坐标系中与X轴的夹角,l为喷嘴离回收臂的转轴的距离,θ为垃圾在直角坐标系中与X轴的夹角。
优选的,所述步骤S4中获取回收臂上喷嘴的理论喷水量U如公式四所表示:
U=Kb2--公式四,其中b为喷嘴与垃圾的距离,K为理论喷水量与距离的关系系数,其中b的获取公式五如下所示:
b=(x0+lcosψ-lcosθ)2+(y0+lsinψ-lsinθ)2。
在无人挺朝向垃圾行驶的过程中,所述感应设备会实时获取垃圾与感应设置之间的距离,当距离小于阈值范围内,则说明垃圾可以被展开回收臂的喷嘴通过喷水的方式将垃圾喷向无人艇内。如图3所示为本申请中直角坐标系图,本身通过先通过垃圾的极坐标确定在直角坐标系中X轴坐标与Y轴坐标的单位关系,再以同样的方式确认回收臂上喷嘴的直角坐标,通过垃圾的直角坐标(x,y)与喷嘴的直角坐标(x1,y1)即可确定喷嘴与垃圾之间的距离以及垃圾与回收臂之间的角度。另外由于回收臂的转轴为中心坐标(x0,y0)与原点之间的距离是保持不变的,此时只需要获取到回收臂在直角坐标系中与X轴的夹角既可以获得直角坐标(x1,y1)。通过本申请的放置获取喷嘴与垃圾之间的位置关系,能够极大地提高喷嘴与垃圾位置关系的速度与精准度。在公式四中,K值为通过电脑模拟环境的测试中获取到的理论数据,该K值会根据所述感应设备获取到垃圾的种类的不同,而取不同的数值。
优选的,所述步骤S4中启动步进电机旋转所述喷嘴,其中所述步进电机的理论旋转角度控制表达式如下公式六所表示:
其中a1(t)为步进电机的理论的旋转,a1(t)的取值为喷嘴的理论喷射角度α,Kp、Ki、Kd为神经网络的增益,t为时间,e1为旋转角度误差值;
对步进电机的理论旋转角度进行离散化处理,获得步进电机的执行旋转角度,其中步进电机的执行旋转角度如下公式七所表示:
其中,a1(k)为步进电机的执行旋转角度,e1(k)为第k个旋转角度误差值的离散值,n的取值范围为整数;
通过步进电机的执行旋转角度与步进电机的理论旋转角度之间的差值对旋转角度误差值e1进行更新,更新后的e1代入到下次的步进电机的执行旋转角度与步进电机的理论旋转角度中。
优选的,所述步骤S4中神经网络确定阀门的开合度包括以下步骤:
将理论喷水量转化为理论阀门开合度,其中理论阀门开合度如下公式八:
其中Uk(t)为理论阀门开合度,Kp、Ki、Kd为神经网络的增益,t为时间,e2为开合度误差值;
对理论阀门开合度进行离散化处理,获得阀门的执行开合度,其中阀门的执行开合度如下公式九所表示:
其中,Uk(k)为阀门的执行开合度,e2(k)为第k个开合度误差值的离散值,n的取值范围为整数;
通过阀门的执行开合度与理论阀门开合度之间的差值对旋转角度误差值e2进行更新,更新后的e2代入到下次阀门的执行开合度与理论阀门开合度中。
当获取到喷嘴相对垃圾的理论喷射角度预计理论喷水量后,将会将该数值发生给神经网络,神经网络作为具体实施零件的控制端,会将理论喷射角度传递给步进电机,通过步进电机的执行旋转角度,带动喷嘴旋转到相应的角度;同时神经网络还会将理论喷水量发生给阀门,通过控制阀门的开合度实现喷水量的控制。
在此过程中,在实际的运作步进电机对于喷嘴的旋转以及阀门开合后喷水量会与理论值有所偏差,导致喷嘴在该喷射角度以及喷水量的配合下无法回收垃圾。为此本申请在每次计算时执行旋转角度与阀门执行开合度时,会代入上次计算获取的误差值e1与误差值e2分别对执行旋转角度与阀门执行开合度进行补偿。在多次计算后,误差值e1与误差值e2会越来越小,而回收垃圾的精准度会越来越高。进而提高回收垃圾的效率。
另外,本申请中通过将理论喷水量转化为理论阀门开合度是可通过虚拟环境中构建无人艇模型测试得出。
一种基于无人艇的喷水辅助垃圾回收的系统,使用上述一种基于无人艇的喷水辅助垃圾回收的方法,包括线路策划模块、感应模块、神经网络模块、喷水模块、转动模块;
所述线路策划模块用于规划无人艇巡线路径,无人艇按照巡线路径在水面行驶;
所述感应模块用于感应无人艇前方是否存在有垃圾;
所述神经网络模块包括回收范围模块以及喷射区域模块,所述回收范围模块用于判断垃圾是否能够进入到回收臂的回收范围内,所述喷射区域模块用于判断垃圾是否进入到回收臂的喷射区域内;
所述喷水模块用于控制阀门的开合度;
所述转动模块用于驱动步进电机旋转。
优选的,还包括坐标构建模块、理论喷射角度获取模块以及理论喷水量获取模块;
所述坐标构建模块用于根据感应装置与垃圾的位置构建直角坐标,并获取垃圾与喷嘴之间的位置关系;
所述喷射角度获取模块用于根据坐标构建模块的信息获取喷嘴的理论喷射角度;
所述喷水量获取模块用于根据坐标构建模块的信息获取喷嘴的理论喷水量。
优选的,还包括步进电机旋转角度模块和阀门开合度模块;
所述进电机旋转角度模块用于根据理论喷射角度获取步进电机的执行旋转角度,并将执行旋转角度发生给转动模块;
所述阀门开合度模块用于根据理论喷水量获取执行开合度,并将执行开合度发送给喷水模块。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示意性实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管已经示出和描述了本发明的实施例,本领域的普通技术人员可以理解:在不脱离本发明的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由权利要求及其等同物限定。
Claims (8)
1.一种基于无人艇的喷水辅助垃圾回收的方法,其特征在于,包括以下步骤:
步骤S1:规划无人艇巡线路径,无人艇按照巡线路径在水面行驶;
步骤S2:无人艇在开始行驶时,一同开启感应装置,感应无人艇前方是否存在有垃圾;
步骤S3:若所述感应装置感应无人艇前方存在垃圾,则无人艇展开回收臂,并判断垃圾是否能够进入到回收臂的回收范围内,若垃圾能落入到回收臂的回收范围内,则无人艇朝向垃圾的方向行驶,若垃圾不能落入到回收臂的回收范围内,则重新规划无人艇的巡线路经,使垃圾能够落入到回收臂的回收范围内;
步骤S4:当垃圾进入到回收臂的喷射区域内时,根据垃圾与回收臂上喷嘴的位置,获取回收臂上喷嘴的理论喷射角度以及喷嘴的理论喷水量,将理论喷射角度传递至神经网络,神经网络确定步进电机的执行旋转角度,启动步进电机根据执行旋转角度旋转所述喷嘴;将理论喷水量传递至神经网络,神经网络确定阀门的开合度实现喷水量控制;通过喷嘴喷出的水流将垃圾回收到无人艇内。
2.根据权利要求1所述的一种基于无人艇的喷水辅助垃圾回收的方法,其特征在于,所述步骤S4中获取回收臂上喷嘴的理论喷射角度包括以下步骤:
以感应装置为原点构建,为坐标原点建立直角坐标系,感应装置输出垃圾相对于原点的极坐标(L,θ),并将极坐标转化为直角坐标(x,y);
以回收臂的转轴为中心坐标(x0,y0),根据喷嘴离回收臂的转轴的距离以及回收臂在直角坐标系中与X轴的夹角,得到喷嘴的直角坐标(x1,y1),再通过直角坐标(x,y)与直角坐标(x1,y1)获取得到喷嘴的理论喷射角度α;
其中理论喷射角度α的获取公式如下:
其中x1=x0+lcosψ-lcosθ,y1=y0+lsinψ-lsinθ--公式二;
经过公式一与公式二的合并,得到公式三:
ψ为回收臂在直角坐标系中与X轴的夹角,l为喷嘴离回收臂的转轴的距离,θ为垃圾在直角坐标系中与X轴的夹角。
3.根据权利要求2所述的一种基于无人艇的喷水辅助垃圾回收的方法,其特征在于,所述步骤S4中获取回收臂上喷嘴的理论喷水量U如公式四所表示:
U=Kb2--公式四,其中b为喷嘴与垃圾的距离,K为理论喷水量与距离的关系系数,其中b的获取公式五如下所示:
b=(x0+lcosψ-lcosθ)2+(y0+lsinψ-lsinθ)2。
4.根据权利要求3所述的一种基于无人艇的喷水辅助垃圾回收的方法,其特征在于,所述步骤S4中启动步进电机旋转所述喷嘴,其中所述步进电机的理论旋转角度表达式如下公式六所表示:
其中a1(t)为步进电机的理论旋转角度,a1(t)的取值为喷嘴的理论喷射角度α,Kp、Ki、Kd为神经网络的增益,t为时间,e1为旋转角度误差值;
对步进电机的理论旋转进行离散化处理,获得步进电机的执行旋转角度,其中步进电机的执行旋转角度如下公式七所表示:
其中,a1(k)为步进电机的执行旋转角度,e1(k)为第k个旋转角度误差值的离散值,n的取值范围为整数;
通过步进电机的执行旋转角度与步进电机的理论旋转角度之间的差值对旋转角度误差值e1进行更新,更新后的e1代入到下次的步进电机的执行旋转角度与步进电机的理论旋转角度中。
5.根据权利要求3所述的一种基于无人艇的喷水辅助垃圾回收的方法,其特征在于,
所述步骤S4中神经网络确定阀门的开合度包括以下步骤:
将理论喷水量转化为理论阀门开合度,其中理论阀门开合度如下公式八:
其中Uk(t)为理论阀门开合度,Kp、Ki、Kd为神经网络的增益,t为时间,e2为开合度误差值;
对理论阀门开合度进行离散化处理,获得阀门的执行开合度,其中阀门的执行开合度如下公式九所表示:
其中,Uk(k)为阀门的执行开合度,e2(k)为第k个开合度误差值的离散值,n的取值范围为整数;
通过阀门的执行开合度与理论阀门开合度之间的差值对旋转角度误差值e2进行更新,更新后的e2代入到下次阀门的执行开合度与理论阀门开合度中。
6.一种基于无人艇的喷水辅助垃圾回收的系统,使用权利要求1-5任一项所述一种基于无人艇的喷水辅助垃圾回收的方法,其特征在于,包括线路策划模块、感应模块、神经网络模块、喷水模块和转动模块;
所述线路策划模块用于规划无人艇巡线路径,无人艇按照巡线路径在水面行驶;
所述感应模块用于感应无人艇前方是否存在有垃圾;
所述神经网络模块包括回收范围模块以及喷射区域模块,所述回收范围模块用于判断垃圾是否能够进入到回收臂的回收范围内,所述喷射区域模块用于判断垃圾是否进入到回收臂的喷射区域内;
所述喷水模块用于控制阀门的开合度;
所述转动模块用于驱动步进电机旋转。
7.根据权利要求6所述的一种基于无人艇的喷水辅助垃圾回收的系统,其特征在于,还包括坐标构建模块、理论喷射角度获取模块以及理论喷水量获取模块;
所述坐标构建模块用于根据感应装置与垃圾的位置构建直角坐标,并获取垃圾与喷嘴之间的位置关系;
所述喷射角度获取模块用于根据坐标构建模块的信息获取喷嘴的理论喷射角度;
所述喷水量获取模块用于根据坐标构建模块的信息获取喷嘴的理论喷水量。
8.根据权利要求7所述的一种基于无人艇的喷水辅助垃圾回收的系统,其特征在于,还包括步进电机旋转角度模块和阀门开合度模块;
所述进电机旋转角度模块用于根据理论喷射角度获取步进电机的执行旋转角度,并将执行旋转角度发生给转动模块;
所述阀门开合度模块用于根据理论喷水量获取执行开合度,并将执行开合度发送给喷水模块。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210085884.XA CN114489072B (zh) | 2022-01-25 | 2022-01-25 | 一种基于无人艇的喷水辅助垃圾回收的方法与系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210085884.XA CN114489072B (zh) | 2022-01-25 | 2022-01-25 | 一种基于无人艇的喷水辅助垃圾回收的方法与系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114489072A true CN114489072A (zh) | 2022-05-13 |
CN114489072B CN114489072B (zh) | 2022-08-12 |
Family
ID=81473726
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210085884.XA Active CN114489072B (zh) | 2022-01-25 | 2022-01-25 | 一种基于无人艇的喷水辅助垃圾回收的方法与系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114489072B (zh) |
Citations (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10119880A (ja) * | 1996-10-17 | 1998-05-12 | Kure Dia:Kk | 集塵籠制御装置を用いる表層水流利用の水面清掃船 |
US20030168087A1 (en) * | 2000-02-14 | 2003-09-11 | Hiroaki Inui | Washing machine |
CN102020004A (zh) * | 2010-07-09 | 2011-04-20 | 华南理工大学 | 水面垃圾清理船 |
CN102582797A (zh) * | 2012-03-07 | 2012-07-18 | 青岛科技大学 | 一种水上三体清污船及清理方法 |
US20140052422A1 (en) * | 2011-02-14 | 2014-02-20 | Jinquan Wan | Method and system for wastewater treatment based on dissolved oxygen control by fuzzy neural network |
US20150014143A1 (en) * | 2012-03-05 | 2015-01-15 | Sung Tae Hong | Apparatus for heat-treating waste matters |
CN107062379A (zh) * | 2016-12-28 | 2017-08-18 | 广东工业大学 | 一种基于神经网络的智能自适应温控出水方法及装置 |
CN206623966U (zh) * | 2017-04-11 | 2017-11-10 | 上海水域环境发展有限公司 | 喷水推进水面保洁船 |
CN108563242A (zh) * | 2018-03-30 | 2018-09-21 | 武汉理工大学 | 一种海空自主协同搜救m3u平台 |
CN208715433U (zh) * | 2018-08-01 | 2019-04-09 | 南华大学 | 水面垃圾清理船 |
CN109811832A (zh) * | 2019-03-18 | 2019-05-28 | 哈尔滨理工大学 | 一种基于模糊神经网络pid控制的分层注水流量控制方法 |
WO2019125440A1 (en) * | 2017-12-20 | 2019-06-27 | Halliburton Energy Services, Inc. | Wastewater and effluent separation and treatment systems |
CN110200537A (zh) * | 2019-05-05 | 2019-09-06 | 安徽海螺信息技术工程有限责任公司 | 垃圾坑擦窗机智能控制装置 |
CN110946515A (zh) * | 2018-09-27 | 2020-04-03 | 欧姆龙株式会社 | 自主行驶型清扫装置 |
CN210354577U (zh) * | 2019-06-10 | 2020-04-21 | 广东工业大学 | 一种扫地机器人垃圾回收系统 |
US20200310432A1 (en) * | 2016-11-22 | 2020-10-01 | Left Hand Robotics, Inc. | Autonomous path treatment systems and methods |
CN112068418A (zh) * | 2020-09-01 | 2020-12-11 | 江苏高凯精密流体技术股份有限公司 | 一种基于电流传感器的压电陶瓷喷射阀调节方法 |
CN213134218U (zh) * | 2020-08-11 | 2021-05-07 | 江苏寰宇智能消防科技有限公司 | 一种基于环保智能机器人的超高压水射流发生装置 |
US20210201155A1 (en) * | 2019-12-30 | 2021-07-01 | Dalian University Of Technology | Intelligent control method for dynamic neural network-based variable cycle engine |
CN113071622A (zh) * | 2021-05-08 | 2021-07-06 | 陕西欧卡电子智能科技有限公司 | 一种沿岸垃圾清洁方法 |
CN113213635A (zh) * | 2021-04-15 | 2021-08-06 | 程旭 | 一种高效漂浮式水污染收集处理装置 |
CN113290565A (zh) * | 2020-02-21 | 2021-08-24 | 西门子股份公司 | 一种消毒机器人和消毒机器人控制系统 |
CN113389233A (zh) * | 2021-07-23 | 2021-09-14 | 绍兴柏莉建设有限公司 | 一种河道清淤设备 |
CN113581388A (zh) * | 2021-08-30 | 2021-11-02 | 广东工业大学 | 一种环保作业的无人艇控制方法及应用其的无人艇系统 |
CN215236055U (zh) * | 2021-04-08 | 2021-12-21 | 山东未来机器人有限公司 | 水下清洁机器人 |
-
2022
- 2022-01-25 CN CN202210085884.XA patent/CN114489072B/zh active Active
Patent Citations (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10119880A (ja) * | 1996-10-17 | 1998-05-12 | Kure Dia:Kk | 集塵籠制御装置を用いる表層水流利用の水面清掃船 |
US20030168087A1 (en) * | 2000-02-14 | 2003-09-11 | Hiroaki Inui | Washing machine |
CN102020004A (zh) * | 2010-07-09 | 2011-04-20 | 华南理工大学 | 水面垃圾清理船 |
US20140052422A1 (en) * | 2011-02-14 | 2014-02-20 | Jinquan Wan | Method and system for wastewater treatment based on dissolved oxygen control by fuzzy neural network |
US20150014143A1 (en) * | 2012-03-05 | 2015-01-15 | Sung Tae Hong | Apparatus for heat-treating waste matters |
CN102582797A (zh) * | 2012-03-07 | 2012-07-18 | 青岛科技大学 | 一种水上三体清污船及清理方法 |
US20200310432A1 (en) * | 2016-11-22 | 2020-10-01 | Left Hand Robotics, Inc. | Autonomous path treatment systems and methods |
CN107062379A (zh) * | 2016-12-28 | 2017-08-18 | 广东工业大学 | 一种基于神经网络的智能自适应温控出水方法及装置 |
CN206623966U (zh) * | 2017-04-11 | 2017-11-10 | 上海水域环境发展有限公司 | 喷水推进水面保洁船 |
WO2019125440A1 (en) * | 2017-12-20 | 2019-06-27 | Halliburton Energy Services, Inc. | Wastewater and effluent separation and treatment systems |
CN108563242A (zh) * | 2018-03-30 | 2018-09-21 | 武汉理工大学 | 一种海空自主协同搜救m3u平台 |
CN208715433U (zh) * | 2018-08-01 | 2019-04-09 | 南华大学 | 水面垃圾清理船 |
CN110946515A (zh) * | 2018-09-27 | 2020-04-03 | 欧姆龙株式会社 | 自主行驶型清扫装置 |
CN109811832A (zh) * | 2019-03-18 | 2019-05-28 | 哈尔滨理工大学 | 一种基于模糊神经网络pid控制的分层注水流量控制方法 |
CN110200537A (zh) * | 2019-05-05 | 2019-09-06 | 安徽海螺信息技术工程有限责任公司 | 垃圾坑擦窗机智能控制装置 |
CN210354577U (zh) * | 2019-06-10 | 2020-04-21 | 广东工业大学 | 一种扫地机器人垃圾回收系统 |
US20210201155A1 (en) * | 2019-12-30 | 2021-07-01 | Dalian University Of Technology | Intelligent control method for dynamic neural network-based variable cycle engine |
CN113290565A (zh) * | 2020-02-21 | 2021-08-24 | 西门子股份公司 | 一种消毒机器人和消毒机器人控制系统 |
CN213134218U (zh) * | 2020-08-11 | 2021-05-07 | 江苏寰宇智能消防科技有限公司 | 一种基于环保智能机器人的超高压水射流发生装置 |
CN112068418A (zh) * | 2020-09-01 | 2020-12-11 | 江苏高凯精密流体技术股份有限公司 | 一种基于电流传感器的压电陶瓷喷射阀调节方法 |
CN112965367A (zh) * | 2020-09-01 | 2021-06-15 | 江苏高凯精密流体技术股份有限公司 | 一种基于电流传感器的压电陶瓷喷射阀调节方法 |
CN215236055U (zh) * | 2021-04-08 | 2021-12-21 | 山东未来机器人有限公司 | 水下清洁机器人 |
CN113213635A (zh) * | 2021-04-15 | 2021-08-06 | 程旭 | 一种高效漂浮式水污染收集处理装置 |
CN113071622A (zh) * | 2021-05-08 | 2021-07-06 | 陕西欧卡电子智能科技有限公司 | 一种沿岸垃圾清洁方法 |
CN113389233A (zh) * | 2021-07-23 | 2021-09-14 | 绍兴柏莉建设有限公司 | 一种河道清淤设备 |
CN113581388A (zh) * | 2021-08-30 | 2021-11-02 | 广东工业大学 | 一种环保作业的无人艇控制方法及应用其的无人艇系统 |
Non-Patent Citations (5)
Title |
---|
LI, Q等: "Design of the security alarm control system for LNG-fueled vessels", 《2017 4TH INTERNATIONAL CONFERENCE ON TRANSPORTATION INFORMATION AND SAFETY》 * |
ZHOU, YZ等: "Path Planning for Spray Painting Robot of Horns Surfaces in Ship Manufacturing", 《2019 3RD INTERNATIONAL CONFERENCE ON MANUFACTURING TECHNOLOGIES》 * |
刘畅等: "智能型垃圾收集船的应用研究", 《科技创新与应用》 * |
王学志: "近海垃圾自动收集船主体结构的设计与研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
金金: "芦苇收割船关键部件的设计与研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
Also Published As
Publication number | Publication date |
---|---|
CN114489072B (zh) | 2022-08-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114384920B (zh) | 一种基于局部栅格地图实时构建的动态避障方法 | |
CN106054900B (zh) | 基于深度摄像头的机器人临时避障方法 | |
CN104914865B (zh) | 变电站巡检机器人定位导航系统及方法 | |
CN114474061B (zh) | 基于云服务的机器人多传感器融合定位导航系统及方法 | |
CN109733384A (zh) | 泊车路径设置方法及系统 | |
CN107618396A (zh) | 自动充电系统及方法 | |
CN110189315B (zh) | 一种风电机组叶片无人机自动定位方法 | |
CN107831776A (zh) | 基于九轴惯性传感器的无人机自主返航方法 | |
CN111746728B (zh) | 一种基于强化学习的新型水上清洁机器人及控制方法 | |
CN109213204A (zh) | 基于数据驱动的auv海底目标搜寻航行系统及方法 | |
CN105059190A (zh) | 基于视觉的汽车开门碰撞预警装置及方法 | |
CN113408510A (zh) | 基于深度学习与one-hot编码的输电线路目标纠偏方法和系统 | |
CN110675453A (zh) | 一种已知场景中运动目标的自定位方法 | |
WO2024046390A1 (zh) | 基于视觉和imu融合的海洋装备水下损伤三维重建方法 | |
CN114489072B (zh) | 一种基于无人艇的喷水辅助垃圾回收的方法与系统 | |
CN116360492B (zh) | 一种扑翼飞行机器人目标跟踪方法及系统 | |
CN112215131A (zh) | 一种自动垃圾拾取系统及其手动操作和自动拾取方法 | |
CN114895711A (zh) | 一种面向风机叶片巡检的无人机自动航迹线规划方法 | |
Milford et al. | RatSLAM on the edge: revealing a coherent representation from an overloaded rat brain | |
Zhao et al. | Vision-based autonomous landing control of a multi-rotor aerial vehicle on a moving platform with experimental validations | |
CN116188470B (zh) | 一种基于无人机航拍识别的故障定位方法和系统 | |
CN108933407A (zh) | 多分裂式高压电线巡检用无人机嵌入式机器人装置和方法 | |
Akremi et al. | Visual navigation of uavs in indoor corridor environments using deep learning | |
Betge-Brezetz et al. | Object-based modelling and localization in natural environments | |
CN117333783A (zh) | 多无人机协同风机叶片定位和缺陷检测方法和装置 |
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 | ||
GR01 | Patent grant |