CN109964629B - 一种基于英伟达开发板的智能水草清理机器人及控制方法 - Google Patents
一种基于英伟达开发板的智能水草清理机器人及控制方法 Download PDFInfo
- Publication number
- CN109964629B CN109964629B CN201910237350.2A CN201910237350A CN109964629B CN 109964629 B CN109964629 B CN 109964629B CN 201910237350 A CN201910237350 A CN 201910237350A CN 109964629 B CN109964629 B CN 109964629B
- Authority
- CN
- China
- Prior art keywords
- paddle wheel
- cleaning robot
- robot
- cutting device
- intelligent
- 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.)
- Expired - Fee Related
Links
- 238000004140 cleaning Methods 0.000 title claims abstract description 83
- 241000196324 Embryophyta Species 0.000 title claims abstract description 71
- 238000011161 development Methods 0.000 title claims abstract description 24
- 238000000034 method Methods 0.000 title description 12
- 229910000838 Al alloy Inorganic materials 0.000 claims abstract description 31
- 230000005540 biological transmission Effects 0.000 claims abstract description 23
- 238000007667 floating Methods 0.000 claims abstract description 13
- 238000004891 communication Methods 0.000 claims abstract description 11
- 241001113556 Elodea Species 0.000 claims description 15
- 239000003638 chemical reducing agent Substances 0.000 claims description 7
- 230000000694 effects Effects 0.000 claims description 4
- 238000005516 engineering process Methods 0.000 claims description 4
- 239000013598 vector Substances 0.000 claims description 3
- 230000008878 coupling Effects 0.000 claims 2
- 238000010168 coupling process Methods 0.000 claims 2
- 238000005859 coupling reaction Methods 0.000 claims 2
- 208000034699 Vitreous floaters Diseases 0.000 description 31
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 8
- 238000010586 diagram Methods 0.000 description 3
- IJGRMHOSHXDMSA-UHFFFAOYSA-N Atomic nitrogen Chemical compound N#N IJGRMHOSHXDMSA-UHFFFAOYSA-N 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 2
- 238000012851 eutrophication Methods 0.000 description 2
- 244000025254 Cannabis sativa Species 0.000 description 1
- OAICVXFJPJFONN-UHFFFAOYSA-N Phosphorus Chemical compound [P] OAICVXFJPJFONN-UHFFFAOYSA-N 0.000 description 1
- 240000007651 Rubus glaucus Species 0.000 description 1
- 235000011034 Rubus glaucus Nutrition 0.000 description 1
- 235000009122 Rubus idaeus Nutrition 0.000 description 1
- 238000009360 aquaculture Methods 0.000 description 1
- 244000144974 aquaculture Species 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 239000003651 drinking water Substances 0.000 description 1
- 235000020188 drinking water Nutrition 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 239000013505 freshwater Substances 0.000 description 1
- 238000012806 monitoring device Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 229910052757 nitrogen Inorganic materials 0.000 description 1
- 229910052698 phosphorus Inorganic materials 0.000 description 1
- 239000011574 phosphorus Substances 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 238000003911 water pollution Methods 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D34/00—Mowers; Mowing apparatus of harvesters
- A01D34/006—Control or measuring arrangements
- A01D34/008—Control or measuring arrangements for automated or remotely controlled operation
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D44/00—Harvesting of underwater plants, e.g. harvesting of seaweed
-
- 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/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- 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/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Environmental Sciences (AREA)
- Electromagnetism (AREA)
- Multimedia (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Marine Sciences & Fisheries (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种基于英伟达开发板的智能水草清理机器人,其中,机器人铝合金支架两侧并排设置有浮箱,并在位于浮箱上方的机器人铝合金支架上设置有与明轮驱动电机主动轴连接的明轮传动轴,明轮安装在明轮传动轴上;控制箱箱体设置在机器人铝合金支架后端,总控制器设置在控制箱箱体上;在机器人铝合金支架前端设置有CCD摄像头与切割装置,切割装置传动轴一端安装有切割装置往复式刀片,切割装置传动轴中部通过切割装置固定架固定在机器人铝合金支架上,切割装置传动轴另一端与切割装置电机连接;机器人按照预定路径航行有效提高清理漂浮物的效率;同时通过商用WiFi通讯模块与岸边服务器进行数据通讯,以实时监控机器人状况,实时性强。
Description
技术领域
本发明涉及机器人技术领域,尤其涉及一种基于英伟达开发板的智能水草清理机器人及控制方法。
背景技术
在中国共有七大水系,其中有42%的水质超过了3类标准(不能做饮用水源),目前全国一共约有36%的城市河段为劣5类水质,进而丧失了河道的基本使用功能。然而现有的大型淡水湖泊(水库)和城市湖泊一般水质普遍较差,大概有75%以上的湖泊具有富营养化加剧的现象,富营养化现象的原因主要由氮、磷污染引起,其中水草污染是在水污染中最难以防治的一类。因此,用于水草清理的智能机器人具有重要的实用价值,智能水草清理机器人导航控制系统中,机器人的路径跟踪控制与机器人速度控制方法是其中的关键环节,能否控制机器人按照预定路径航行将直接地影响到水草清理的效率。
目前已公开有用于控制机器人的自动导航路径跟踪方法,如专利申请号为201610095261.5的“一种水产养殖作业船自动导航路径跟踪方法”,其未设置视觉系统,对水面状况监视少;专利申请号为201710576344.0的“一种基于树莓派的智能混动水面清理和水质监测装置及方法”,其图像识别方法需远程服务器处理后再给机器控制指令,耗时高,实时性不强,均存在不足。
发明内容
本发明所解决的技术问题在于提供一种基于英伟达开发板的智能水草清理机器人及控制方法,以解决上述背景技术中的缺点。
本发明所解决的技术问题采用以下技术方案来实现:
一种基于英伟达开发板的智能水草清理机器人,包括控制箱箱体、浮箱顶板、明轮、CCD摄像头、明轮驱动电机、总控制器、机器人铝合金支架及切割装置,其中,机器人铝合金支架两侧并排设置有浮箱,并在位于浮箱上方的机器人铝合金支架上设置有与明轮驱动电机主动轴连接的明轮传动轴,明轮安装在明轮传动轴上;控制箱箱体设置在机器人铝合金支架后端,采用英伟达开发板的总控制器设置在控制箱箱体上,总控制器内设置有用于控制电机转速与智能水草清理机器人位置的控制系统;机器人铝合金支架前端设置有CCD摄像头与用于切割漂浮物的切割装置,切割装置传动轴一端安装有切割装置往复式刀片,切割装置传动轴中部通过切割装置固定架固定在机器人铝合金支架上,切割装置传动轴另一端与切割装置电机连接;且CCD摄像头、明轮驱动电机、切割装置电机分别与总控制器连接。
在本发明中,英伟达开发板上设置有机器人视觉模块、GPS定位模块及IMU惯性导航模块,IMU惯性导航模块用于实时获取机器人航向和加速度等信息,为总控制器提供导航信息,GPS定位模块用于实时获取机器人位置信息,机器视觉模块用于实时检测水面水草以及漂浮物种类,并将标记出来,为总控制器提供水草位置图像信息,CCD摄像头通过图像传输数据线与机器人视觉模块连接。
在本发明中,明轮驱动电机主动轴与明轮驱动电机减速器连接,明轮驱动电机减速器与联轴器连接,联轴器通过主链条与明轮传动轴连接。
在本发明中,机器人铝合金支架设置有两个明轮驱动电机,分别用于驱动机器人铝合金支架两侧的明轮。
在本发明中,英伟达开发板上设置有电机驱动板,用于对明轮驱动电机发送和接收速度控制信号,直接驱动明轮驱动电机转速。
在本发明中,总控制器内设置有商用WiFi通讯模块,用于机器人与岸边服务器进行数据通讯。
在本发明中,控制箱箱体上设置有蓄电池,蓄电池与总控制器连接。
在本发明中,在机器人铝合金支架下方安装有用于收集漂浮物的收集网。
基于英伟达开发板的智能水草清理机器人控制方法,具体步骤如下:
使用时,通过总控制器将CCD摄像头与明轮驱动电机开启,CCD摄像头将采集的漂浮物图像传输至总控制器,总控制器通过分析CCD摄像头采集的漂浮物图像,配合GPS定位模块与IMU惯性导航模块,从而得到漂浮物的位置信息,并标记出漂浮物方位信息,为智能水草清理机器人前进速度与航向提供图像数据支撑,而后总控制器利用改进型A*算法规划出机器人行进路线,通过控制明轮驱动电机与明轮以实时调整智能水草清理机器人的行驶路线和行进速度,A*算法使用如下的估价函数:
F(n)=G(n)+H(n),其中,F(n)为从起始点移动到第n个节点的估价值;G(n)为从起始点沿着产生的路径移动到第n个节点的代价值;H(n)为启发函数,用于估计从第n个节点移动到目标点的代价值;使用Open表和Closed表,Open表用于存放已生成而未访问的节点,Closed表用于保存已经访问过的节点;
智能水草清理机器人运动时,智能水草清理机器人在笛卡尔坐标系下的速度V和角速度ω,经笛卡尔直角坐标系中的位置(x,y)由下式转换为广义坐标向量,公式如下:
式(1)~(3)中,k表示明轮转速转化为实际船速系数(0<k<1),ω表示智能水草清理机器人左右旋转移动的角速度,r表示明轮半径,L表示智能水草清理机器人上两个明轮中心点的距离,ωL,ωR分别表示智能水草清理机器人左侧与右侧的明轮角速度,VL,VR分别表示智能水草清理机器人左侧与右侧的明轮线速度,a表示智能水草清理机器人相对偏移角度;
总控制器中设置有控制系统,用于控制电机转速与智能水草清理机器人位置,该控制系统由速度反馈回路和位置反馈回路两个独立反馈回路组成,使用时,先输入智能水草清理机器人标定出的漂浮物位置(x,y,a)、航向信息a、线速度V、左侧与右侧的明轮角速度ωL、ωR,按照规划路线进行速度与航向控制,给两侧明轮转速设置阈值,并将两侧明轮实际转速与设定值的变化量ΔωL、ΔωR输入至总控制器,总控制器分别对两侧的明轮驱动电机发出转速控制指令,利用PWM脉宽调制技术配合电机驱动板实现电机调压控制转速;
在明轮驱动电机上输入不同电压时,利用IMU惯性导航模块实时检测智能水草清理机器人的线速度,并将实时线速度输入至总控制器,与设定的阈值进行校核,若检测到误差则进入速度反馈调节循环环节;
若智能水草清理机器人速度控制效果正常,则进一步利用公式(1)计算位置信息,并与规划路线的位置坐标信息进行校核,若与规划路线吻合则结束,如果与规划路线有偏差,则将位置偏差反馈至总控制器,总控制器通过控制两侧的明轮转速间接修正智能水草清理机器人航向;
明轮驱动电机输入电压V(s)与明轮角速度ω(s)之间关系如下:
其中,J表示明轮转动惯量,B表示明轮转动粘滞阻力与明轮角速度比例系数,L表示电机电枢电感,R表示电机内阻,KT表示明轮转矩与电枢电流比例系数,KF表示反馈系数;
当CCD摄像头内无漂浮物,机器人视觉模块给总控制器发送无漂浮物信息,电机驱动板发送向右转向指令,直至CCD摄像头传输的图像有漂浮物并标记,此时智能水草清理机器人停止转向,朝漂浮物前进,待行进至标记位置时,总控制器开启切割装置电机,切割装置往复式刀片在切割装置电机驱动下对漂浮物进行切割。
有益效果:本发明中总控制器通过分析CCD摄像头采集的漂浮物图像,配合GPS定位模块与IMU惯性导航模块,从而得到漂浮物的位置信息,利用改进型A*算法规划出机器人行进路线,通过控制明轮驱动电机与明轮以实时调整智能水草清理机器人的行驶路线和行进速度,待行进至标记位置时,总控制器开启切割装置电机,切割装置往复式刀片在切割装置电机驱动下对漂浮物进行切割,从而控制机器人按照预定路径航行有效提高清理漂浮物的效率;同时通过商用WiFi通讯模块与岸边服务器进行数据通讯,以实时监控智能水草清理机器人各项指标及工作状况,耗时低,实时性强。
附图说明
图1为本发明的较佳实施例的结构示意图。
图2为本发明的较佳实施例的控制流程示意图。
图3为本发明的较佳实施例中智能水草清理机器人运动模型在坐标系XOY(笛卡尔坐标系)下示意图。
具体实施方式
为了使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解,下面结合具体图示,进一步阐述本发明。
参见图1~3的一种基于英伟达开发板的智能水草清理机器人,包括控制箱箱体1、主链条2、联轴器3、浮箱顶板4、明轮5、CCD摄像头6、明轮驱动电机减速器7、明轮驱动电机8、蓄电池9、总控制器10、明轮传动轴11、切割装置电机12、切割装置固定架13、切割装置传动轴14、切割装置往复式刀片15、机器人铝合金支架16、明轮驱动电机主动轴17,其中,机器人铝合金支架16两侧并排设置有浮箱,浮箱上设置有浮箱顶板4,并在位于浮箱上方的机器人铝合金支架16上设置有通过主链条2与联轴器3连接的明轮传动轴11,联轴器3与明轮驱动电机减速器7连接,明轮驱动电机8上设置有明轮驱动电机主动轴17,明轮驱动电机减速器7与明轮驱动电机主动轴17连接,明轮5安装在明轮传动轴11上;控制箱箱体1设置在机器人铝合金支架16后端,蓄电池9与总控制器10设置在控制箱箱体1上;在机器人铝合金支架16前端设置有CCD摄像头6与用于切割漂浮物的切割装置,切割装置传动轴14一端安装有切割装置往复式刀片15,切割装置传动轴14中部通过切割装置固定架13固定在机器人铝合金支架16上,切割装置传动轴14另一端与切割装置电机12连接;且CCD摄像头6、明轮驱动电机8、切割装置电机12分别与总控制器10连接,蓄电池9与总控制器10连接;同时在机器人铝合金支架16下方安装有用于收集漂浮物的收集网;
总控制器10采用英伟达开发板,用于机器人总控,英伟达开发板上设置有机器人视觉模块、GPS定位模块及IMU惯性导航模块,IMU惯性导航模块用于实时获取机器人航向和加速度等信息,为总控制器10提供导航信息,GPS定位模块用于实时获取机器人位置信息,机器视觉模块用于实时检测水面水草以及漂浮物种类,并将标记出来,为总控制器10提供水草位置图像信息,CCD摄像头6通过图像传输数据线与机器人视觉模块连接,总控制器10通过分析CCD摄像头6采集的漂浮物图像,配合GPS定位模块与IMU惯性导航模块,从而得到漂浮物的位置信息,利用改进型A*算法规划出机器人行进路线,通过控制明轮驱动电机8与明轮5以实时调整船体的行驶路线和行进速度。
在本实施例中,机器人铝合金支架16设置有两个明轮驱动电机8,分别用于驱动机器人铝合金支架16两侧的明轮5。
在本实施例中,英伟达开发板上设置有电机驱动板,用于对明轮驱动电机8发送和接收速度控制信号,直接驱动明轮驱动电机8转速。
在本实施例中,总控制器10内设置有商用WiFi通讯模块,用于机器人与岸边服务器进行数据通讯。
在本实施例中,使用时,通过总控制器10将CCD摄像头6与明轮驱动电机8开启,CCD摄像头6将采集的漂浮物图像传输至总控制器10,总控制器10通过分析CCD摄像头6采集的漂浮物图像,配合GPS定位模块与IMU惯性导航模块,从而得到漂浮物的位置信息,并标记出漂浮物方位信息,为智能水草清理机器人前进速度与航向提供图像数据支撑,而后利用改进型A*算法规划出机器人行进路线,通过控制明轮驱动电机8与明轮5以实时调整智能水草清理机器人的行驶路线和行进速度,A*算法使用如下的估价函数:
F(n)=G(n)+H(n),其中,F(n)为从起始点移动到第n个节点的估价值;G(n)为从起始点沿着产生的路径移动到第n个节点的代价值;H(n)为启发函数,用于估计从第n个节点移动到目标点的代价值;使用Open表和Closed表,Open表用于存放已生成而未访问的节点,Closed表用于保存已经访问过的节点;
智能水草清理机器人运动时,智能水草清理机器人在笛卡尔坐标系下的速度V和角速度ω,经笛卡尔直角坐标系中的位置(x,y)由下式转换为广义坐标向量,公式如下:
式(1)~(3)中,k表示明轮5转速转化为实际船速系数(0<k<1),ω表示智能水草清理机器人左右旋转移动的角速度,r表示明轮5半径,L表示智能水草清理机器人上两个明轮5中心点的距离,ωL,ωR分别表示智能水草清理机器人左侧与右侧的明轮5角速度,VL,VR分别表示智能水草清理机器人左侧与右侧的明轮5线速度,a表示智能水草清理机器人相对偏移角度;
总控制器10中设置有控制系统,用于控制电机转速与智能水草清理机器人位置,该控制系统由速度反馈回路和位置反馈回路两个独立反馈回路组成,整个控制系统的流程如图2所示:
输入智能水草清理机器人标定出的漂浮物位置(x,y,a)、航向信息a、线速度V、左侧与右侧的明轮5角速度ωL、ωR,按照规划路线进行速度与航向控制,预先给两侧明轮5转速设置阈值,并将两侧明轮5实际转速与设定值的变化量ΔωL、ΔωR输入至总控制器10,总控制器10分别对两侧的明轮驱动电机8发出转速控制指令,利用PWM脉宽调制技术配合电机驱动板实现电机调压控制转速;
在明轮驱动电机8上输入不同电压时,利用IMU惯性导航模块实时检测智能水草清理机器人的线速度,并将实时线速度输入至总控制器10,与设定值进行校核,若检测到误差则进入速度反馈调节循环环节;
若智能水草清理机器人速度控制效果正常,则进一步利用公式(1)计算位置信息,并与规划路线的位置坐标信息进行校核,若与规划路线吻合则结束,如果与规划路线有偏差,则将位置偏差反馈至总控制器10,总控制器10通过控制两侧的明轮5不同转速间接修正智能水草清理机器人航向;
明轮驱动电机8输入电压V(s)与明轮5角速度ω(s)之间关系如下:
其中,J表示明轮转动惯量,B表示明轮转动粘滞阻力与明轮角速度比例系数,L表示电机电枢电感,R表示电机内阻,KT表示明轮转矩与电枢电流比例系数,KF表示反馈系数;
可根据实际需要建立增量式PID控制传递函数:
当CCD摄像头6内无漂浮物,机器人视觉模块给总控制器10发送无漂浮物信息,电机驱动板发送向右转向指令,直至CCD摄像头6传输的图像有漂浮物并标记,此时智能水草清理机器人停止转向,朝漂浮物前进,待行进至标记位置时,总控制器10开启切割装置电机12,切割装置往复式刀片15在切割装置电机12驱动下对漂浮物进行切割,并收集至收集网;同时可通过商用WiFi通讯模块与岸边服务器进行数据通讯,以实时监控智能水草清理机器人各项指标及工作状况。
Claims (7)
1.一种基于英伟达开发板的智能水草清理机器人,包括控制箱箱体、浮箱顶板、明轮、CCD摄像头、明轮驱动电机、总控制器、机器人铝合金支架及切割装置,其特征在于,机器人铝合金支架两侧并排设置有浮箱,并在位于浮箱上方的机器人铝合金支架上设置有与明轮驱动电机主动轴连接的明轮传动轴,明轮安装在明轮传动轴上;控制箱箱体设置在机器人铝合金支架后端,采用英伟达开发板的总控制器设置在控制箱箱体上,总控制器内设置有用于控制电机转速与智能水草清理机器人位置的控制系统,控制系统由速度反馈回路和位置反馈回路两个独立反馈回路组成;机器人铝合金支架前端设置有CCD摄像头与用于切割漂浮物的切割装置,切割装置传动轴一端安装有切割装置往复式刀片,切割装置传动轴中部通过切割装置固定架固定在机器人铝合金支架上,切割装置传动轴另一端与切割装置电机连接;且CCD摄像头、明轮驱动电机、切割装置电机分别与总控制器连接;
并在英伟达开发板上设置有机器人视觉模块、GPS定位模块及IMU惯性导航模块,CCD摄像头通过图像传输数据线与机器人视觉模块连接;
使用时,通过总控制器将CCD摄像头与明轮驱动电机开启,CCD摄像头将采集的漂浮物图像传输至总控制器,总控制器通过分析CCD摄像头采集的漂浮物图像,配合GPS定位模块与IMU惯性导航模块,从而得到漂浮物的位置信息,并标记出漂浮物方位信息,为智能水草清理机器人前进速度与航向提供图像数据支撑,而后总控制器利用改进型A*算法规划出智能水草清理机器人行进路线,通过控制明轮驱动电机与明轮以实时调整智能水草清理机器人的行驶路线和行进速度;智能水草清理机器人运动时,智能水草清理机器人在笛卡尔坐标系下的速度V和角速度ω,经笛卡尔直角坐标系中的位置(x,y)由下式转换为广义坐标向量,公式如下:
式(1)~(3)中,k表示明轮转速转化为实际船速系数(0<k<1),ω表示智能水草清理机器人左右旋转移动的角速度,r表示明轮半径,L表示智能水草清理机器人上两个明轮中心点的距离,ωL,ωR分别表示智能水草清理机器人左侧与右侧的明轮角速度,VL,VR分别表示智能水草清理机器人左侧与右侧的明轮线速度,a表示智能水草清理机器人相对偏移角度;
控制系统由速度反馈回路和位置反馈回路两个独立反馈回路组成,使用时,先输入智能水草清理机器人标定出的漂浮物位置(x,y,a)、航向信息a、线速度V、左侧与右侧的明轮角速度ωL、ωR,再按照规划路线进行速度与航向控制,给两侧明轮转速设置阈值,并将两侧明轮实际转速与设定值的变化量ΔωL、ΔωR输入至总控制器,总控制器分别对两侧的明轮驱动电机发出转速控制指令,利用PWM脉宽调制技术配合电机驱动板实现电机调压控制转速;
在明轮驱动电机上输入不同电压时,利用IMU惯性导航模块实时检测智能水草清理机器人的线速度,并将实时线速度输入至总控制器,与设定的阈值进行校核,若检测到误差则进入速度反馈调节循环环节;
若智能水草清理机器人速度控制效果正常,则进一步利用公式(1)计算位置信息,并与规划路线的位置坐标信息进行校核,若与规划路线吻合则结束,如果与规划路线有偏差,则将位置偏差反馈至总控制器,总控制器通过控制两侧的明轮转速间接修正智能水草清理机器人航向;
明轮驱动电机输入电压V(s)与明轮角速度ω(s)之间关系如下:
其中,J表示明轮转动惯量,B表示明轮转动粘滞阻力与明轮角速度比例系数,L表示电机电枢电感,R表示电机内阻,KT表示明轮转矩与电枢电流比例系数,KF表示反馈系数;
当CCD摄像头内无漂浮物,机器人视觉模块给总控制器发送无漂浮物信息,电机驱动板向明轮驱动电机发送向右转向指令,直至CCD摄像头传输的图像有漂浮物并标记,此时智能水草清理机器人停止转向,朝漂浮物前进,待行进至标记位置时,总控制器开启切割装置电机,切割装置往复式刀片在切割装置电机驱动下对漂浮物进行切割。
2.根据权利要求1所述的一种基于英伟达开发板的智能水草清理机器人,其特征在于,明轮驱动电机主动轴与明轮驱动电机减速器连接,明轮驱动电机减速器与联轴器连接,联轴器通过主链条与明轮传动轴连接。
3.根据权利要求1所述的一种基于英伟达开发板的智能水草清理机器人,其特征在于,机器人铝合金支架设置有两个明轮驱动电机。
4.根据权利要求1所述的一种基于英伟达开发板的智能水草清理机器人,其特征在于,英伟达开发板上设置有电机驱动板。
5.根据权利要求1所述的一种基于英伟达开发板的智能水草清理机器人,其特征在于,总控制器内设置有商用WiFi通讯模块。
6.根据权利要求1所述的一种基于英伟达开发板的智能水草清理机器人,其特征在于,控制箱箱体上设置有蓄电池,蓄电池与总控制器连接。
7.根据权利要求1所述的一种基于英伟达开发板的智能水草清理机器人,其特征在于,在机器人铝合金支架下方安装有用于收集漂浮物的收集网。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910237350.2A CN109964629B (zh) | 2019-03-27 | 2019-03-27 | 一种基于英伟达开发板的智能水草清理机器人及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910237350.2A CN109964629B (zh) | 2019-03-27 | 2019-03-27 | 一种基于英伟达开发板的智能水草清理机器人及控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109964629A CN109964629A (zh) | 2019-07-05 |
CN109964629B true CN109964629B (zh) | 2021-11-16 |
Family
ID=67080906
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910237350.2A Expired - Fee Related CN109964629B (zh) | 2019-03-27 | 2019-03-27 | 一种基于英伟达开发板的智能水草清理机器人及控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109964629B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110989601B (zh) * | 2019-12-11 | 2023-05-02 | 许昌学院 | 一种基于图像识别的道路绿化带修剪机 |
CN115349350B (zh) * | 2022-08-30 | 2024-03-15 | 中国科学院南京地理与湖泊研究所 | 一种具有自适应刀具的割草船 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
IN180110B (zh) * | 1990-08-03 | 1998-01-10 | Frish Pty | |
CN201758562U (zh) * | 2010-09-07 | 2011-03-16 | 张连斌 | 水上割草机 |
CN207652986U (zh) * | 2017-09-21 | 2018-07-27 | 宋加龙 | 遥控式挖藕机器人 |
CN107972824B (zh) * | 2017-11-21 | 2019-05-07 | 中国科学院海洋研究所 | 一种机械化收割海带的船只和方法 |
CN108811704A (zh) * | 2018-07-11 | 2018-11-16 | 南昌工程学院 | 一种漂浮式水草切割收集除污装置 |
-
2019
- 2019-03-27 CN CN201910237350.2A patent/CN109964629B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN109964629A (zh) | 2019-07-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102589531B (zh) | 水下地形测量系统及制作方法和测量方法 | |
CN102171095B (zh) | 操纵杆控制的船用操纵系统 | |
CN109964629B (zh) | 一种基于英伟达开发板的智能水草清理机器人及控制方法 | |
CN109508022B (zh) | 基于分层制导与拖曳力补偿的双无人艇协同溢油围捕方法 | |
CN108427416A (zh) | 一种无人船差速自动转向控制系统及控制方法 | |
CN109606188B (zh) | 一种充电船、无人船协同充电系统及协同充电方法 | |
CN103176451B (zh) | 一种舰船辅助航行及编队指挥的方法 | |
CN101866181A (zh) | 农用机械的导航方法、导航装置和农用机械 | |
WO2021230356A1 (ja) | 船舶の自動誘導方法、船舶の自動誘導プログラム、船舶の自動誘導システム、及び船舶 | |
CN111877290A (zh) | 一种智能水面清洁机器人 | |
CN108153311A (zh) | 面向无人艇编队的智能控制系统及控制方法 | |
CN105629976A (zh) | 一种水产养殖作业船自动导航路径跟踪方法 | |
CN203593143U (zh) | 一种风光互补型无人海洋监测艇 | |
CN110001840B (zh) | 一种基于视觉传感器的多种路况下的两轮自平衡车运动控制方法 | |
CN109933074B (zh) | 一种有领导者的多无人船群集运动控制器结构的设计方法 | |
Koay et al. | Starfish–a small team of autonomous robotic fish | |
CN112960078B (zh) | 一种无人帆船自动驾驶系统及其方法 | |
CN114281083B (zh) | 一种基于混合路径规划自主导航的无人船水质监测物联网控制系统及方法 | |
CN114355914B (zh) | 用于无人船的自主巡航系统及控制方法 | |
CN110696979A (zh) | 一种基于双目视觉的太阳能智能清洁艇 | |
CN108438048A (zh) | 一种新型的履带式拖拉机自动转向控制系统及控制方法 | |
CN110471416A (zh) | 基于rtk高精度定位的无人船控制系统 | |
CN108646766A (zh) | 一种基于协同控制的无人船安全跟踪方法及跟踪系统 | |
CN115903800A (zh) | 一种基于领导者协同的多无人船编队的严格安全控制方法 | |
CN112051845A (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20211116 |
|
CF01 | Termination of patent right due to non-payment of annual fee |