CN109460029A - 畜禽养殖场所巡检移动平台及其控制方法 - Google Patents
畜禽养殖场所巡检移动平台及其控制方法 Download PDFInfo
- Publication number
- CN109460029A CN109460029A CN201811442426.7A CN201811442426A CN109460029A CN 109460029 A CN109460029 A CN 109460029A CN 201811442426 A CN201811442426 A CN 201811442426A CN 109460029 A CN109460029 A CN 109460029A
- Authority
- CN
- China
- Prior art keywords
- locomotive
- information
- controller
- correcting code
- livestock
- 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.)
- Pending
Links
- 244000144972 livestock Species 0.000 title claims abstract description 38
- 244000144977 poultry Species 0.000 title claims abstract description 38
- 238000007689 inspection Methods 0.000 title claims abstract description 37
- 238000000034 method Methods 0.000 title claims abstract description 35
- 230000003137 locomotive effect Effects 0.000 claims abstract description 83
- 230000000007 visual effect Effects 0.000 claims abstract description 15
- 230000007613 environmental effect Effects 0.000 claims description 22
- 239000011159 matrix material Substances 0.000 claims description 21
- QGZKDVFQNNGYKY-UHFFFAOYSA-N Ammonia Chemical compound N QGZKDVFQNNGYKY-UHFFFAOYSA-N 0.000 claims description 14
- 238000012544 monitoring process Methods 0.000 claims description 13
- 238000005259 measurement Methods 0.000 claims description 12
- 230000008569 process Effects 0.000 claims description 12
- 229910021529 ammonia Inorganic materials 0.000 claims description 7
- 238000012545 processing Methods 0.000 claims description 7
- 238000004891 communication Methods 0.000 claims description 6
- 238000005530 etching Methods 0.000 claims description 6
- 239000000284 extract Substances 0.000 claims description 6
- 238000001914 filtration Methods 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000000877 morphologic effect Effects 0.000 claims description 3
- 230000009897 systematic effect Effects 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 238000001514 detection method Methods 0.000 description 12
- 230000015556 catabolic process Effects 0.000 description 5
- 238000006731 degradation reaction Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 238000005286 illumination Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 238000012937 correction Methods 0.000 description 3
- 230000033001 locomotion Effects 0.000 description 3
- 238000009395 breeding Methods 0.000 description 2
- 230000001488 breeding effect Effects 0.000 description 2
- 238000000605 extraction Methods 0.000 description 2
- 238000007726 management method Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 241000707825 Argyrosomus regius Species 0.000 description 1
- 241001465754 Metazoa Species 0.000 description 1
- 230000005856 abnormality Effects 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 210000004556 brain Anatomy 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000009499 grossing Methods 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 229910000069 nitrogen hydride Inorganic materials 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000011897 real-time detection Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
- G05D1/0253—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 extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Abstract
本发明公开了一种畜禽养殖场所巡检移动平台,该平台包括移动车、控制器,移动车上装有激光雷达和视觉传感器,在养殖场所固定的位置处设有定位校正码,定位校正码中含有当前位置的信息;在移动车巡检过程中,视觉传感器拍摄定位校正码图像,并将图像上传到控制器,控制器识别图像信息,得到当前移动车准确位置,控制移动车按照一定的路径继续行进。本发明控制方法是通过激光雷达可以给出移动车当前行进的大致位置,通过视觉传感器和控制器对定位校正码的识别,可以得到移动车的精确位置,从而实现准确的导航。
Description
技术领域
本发明涉及畜禽养殖场智能化检测研究领域,特别涉及一种畜禽养殖场所巡检移动平台及其控制方法。
背景技术
目前,大多数国家的畜禽养殖业仍以小规模、大群体为主,仍然采用传统的饲养模式,养殖环节机械化、自动化水平较低,畜牧业自动控制水平相对较低。在养殖环节需要投入大量的人工劳力进行管理,从而导致生产效率低,生产成本居高不下进而影响到整体的养殖效益,制约了产业的快速发展。因此,如果想向规模化、现代化养殖阶段转型,则需要投入大量的资金。但目前畜禽养殖业的经济效益趋于微薄,从而导致大量畜禽养殖场所不愿进行大规模的技术改造。
传统的畜禽养殖场所巡检主要是人工巡检,这使得需要投入大量的人力于其中,且人工巡检不能做到实时检测到畜禽场所的反常与障碍情况,使得巡检存在漏检和低效率的问题。因此,提供一种不需要在原有的畜禽养殖环境下的大规模改造,且能很好的替代大量的人工劳力进行管理的监测系统是十分有意义的,并具有重要的应用价值。
目前,已有研究人员提出采用移动式巡检机器人对禽舍环境进行巡检,但当前的巡检机器人大多采用GPS、超声测距等方式进行机器人定位,存在定位不准确的缺点,因此尚不能满足实际应用的需求。
发明内容
本发明的一个目的在于克服现有技术的缺点与不足,提供一种畜禽养殖场所巡检移动平台,该平台以激光SLAM(同步定位与建图)为主要定位手段,并通过视觉传感器进行位姿修正,进而消除因长廊环境而引发的环境退化问题,具有导航定位精度高的优点。
本发明的另一个目的在于提供一种基于上述畜禽养殖场所巡检移动平台的控制方法,通过该方法可以对巡检移动平台进行不断的修正,实现精确定位。
本发明的目的通过以下的技术方案实现:畜禽养殖场所巡检移动平台,包括移动车、控制器,移动车上装有激光雷达和视觉传感器,在养殖场所固定的位置处设有定位校正码,定位校正码中含有当前位置的信息;在移动车巡检过程中,视觉传感器拍摄定位校正码图像,并将图像上传到控制器,控制器识别图像信息,得到当前移动车准确位置,然后更新调整当前移动车的巡航轨迹,控制移动车按照更新后的轨迹继续行进。本发明通过激光雷达可以给出移动车当前行进的大致位置,通过视觉传感器和控制器对定位校正码的识别,可以得到移动车的精确位置,从而实现准确的导航。
优选的,所述控制器包括底层控制器和上层控制器,底层控制器采用ARM内核嵌入式微控制器,上层控制器采用工控机,上层控制器通过UART串行通信方式对底层控制器进行控制。底层控制器用于控制移动车的运行、各种传感器信息的采集等,上层控制器用于激光雷达、视觉传感器的控制,并将底层控制器信息传递到上位机。
优选的,所述移动车车轮由自带编码器的无刷直流电机独立驱动。采用这种类型车,行走稳定,转弯半径小,符合畜禽养殖场所的环境。电机自带编码器,可以精确测量移动车行进的距离。
优选的,所述移动车上设有用于测量移动车行进过程中旋转角度的IMU惯性测量单元。采用IMU测量的旋转角度更为精确,便于得到当前移动车更准确的位姿信息。
优选的,所述移动车上设有环境监测模块,环境监测模块包括下列传感器的若干种:温湿度传感器、氨气监测传感器、CO2传感器、H2S传感器、光照度传感器;上述传感器通过UART串口通信方式和/或无线方式将数据传递到控制器。通过上述传感器可获取畜禽养殖场所的温度、湿度、氨气浓度,CO2浓度、H2S浓度、光照强度等主要环境指标信息。
更进一步的,所述环境监测模块中各类型传感器均成阵列分布。从而使采集的数据更为准确。
优选的,所述定位校正码采用条形码或二维码。
一种基于上述畜禽养殖场所巡检移动平台的控制方法,包括步骤:
预置畜禽养殖场所的全局地图;
激光雷达扫描周围环境信息,获取局部地图,与全局地图信息作特征匹配,得到当前移动车初步位置信息;
视觉传感器拍摄定位校正码图像;
控制器提取定位校正码图像中包括的位置信息,根据该位置信息与上面预置的全局地图的信息进行比对,得出准确位置,然后更新调整当前移动车的巡航轨迹,控制移动车按照更新后的轨迹继续行进。
优选的,在巡检过程中,激光雷达扫描周围环境信息,并根据信息更新全局地图,步骤是:通过激光雷达得到当前位置的环境信息,提取环境信息中的环境特征,对全局地图添加新的环境特征或更新旧环境特征,从而得到一个不断更新的全局地图。由于畜禽养殖场所存在大量的长廊环境,二维激光雷达关于外部环境的数据量较小,容易出现错误的特征匹配,导致所建的地图比实际地图长度偏小。结合畜禽养殖场的环境为固定环境,且环境特征较为简单,故选择采用人为绘制的地图作为导航过程中的初始全局地图。在移动车行进过程中,通过激光雷达扫描周围环境信息,可以更新现实世界中的障碍物的信息,进而更新全局地图,便于后续移动车自主巡航轨迹的设定。
优选的,在移动车自动巡航的过程中,移动车通过二维激光雷达得到当前位置一定范围内的障碍物信息,并通过DWA局部路径规划算法在速度(υ,ω)空间中采样多组速度,并模拟机器人在这些速度下一定时间内的轨迹;在得到的多组轨迹后,对这些轨迹进行评价,选取最优轨迹所对应的速度来驱动移动车运动。从而实现移动车的实时避障。
优选的,巡检移动平台巡检过程中采集环境监测数据,环境监测数据先经过均值滤波。可以提高信息测量的准确性。
优选的,所述控制器中设有定位校正码数据库,将当前采集的定位校正码与定位校正码数据库中定位校正码进行一一比对,实现解码和识别。
由于在移动平台移动过程中,存在噪声,本发明通过卡尔曼滤波将定位校正码表示的位置信息与激光雷达得到的位置信息融合,得到一个关于移动平台位置估计。从而实现对移动车位置的修正,消除移动车在长廊环境下引发的环境退化问题。其具体过程如下:
1、预测:
2、更新:先计算卡尔曼增益K
然后计算后验概率的分布:
上述所得到的即是修正之后的位置信息。
其中:为k时刻系统的状态变量,uk为k时刻系统的控制变量;
B为系统输入控制矩阵,为系统k-1时刻估计状态;
Ak和Ck分别为系统状态转移矩阵和测量矩阵;
R和Qk分别为过程噪声矩阵和测量噪声矩阵;
表示上一次协方差矩阵,为当前状态协方差矩阵;
zk为k时刻传感器的测量向量,为系统k时刻估计状态。
优选的,在巡检过程中,当检测到移动车电池电压低于某一设定的值时,记录当前所在位置,然后向控制器发送电池电压过低的信息,并触发报警器;当电池更换后,移动车将自动行驶至上次记录的位置,继续开始自动巡航。
优选的,所述定位校正码采用条形码或二维码,从定位校正码图像中提取条形码的方法是:
图像灰度化处理后,进行滤波;
对滤波后图像,计算水平和垂直方向的梯度差,对梯度图像二值化;
对二值化后的图像进行形态学处理,然后根据定位校正码特征定位出条形码或二维码。
本发明与现有技术相比,具有如下优点和有益效果:
1、本发明畜禽养殖场所巡检移动平台以激光雷达为主要定位传感器,以视觉传感器为辅助定位传感器,激光雷达可实现初步定位,视觉传感器通过拍摄定位校正码可实现准确定位,可修正激光雷达在长廊环境因环境退化而引发的定位精度差的问题,从而大大提高移动平台的导航定位精度。
2、本发明使移动车在不需人为干预下实现在畜禽养殖场所的自主巡航技术。移动车通过激光雷达数据更新全局地图与局部地图信息,利用当前环境特征与地图环境特征的对比,从而定位移动车所在方位,并按照一定的路径行驶。在移动车自主巡航的过程中,移动车能实现实时避障功能。
附图说明
图1是本实施例巡检移动平台的结构框图。
图2是本发明装置的自主巡航框架示意图。
图3是本实施例控制方法中定位校正码识别、解码和匹配的流程图。
图4是本实施例控制方法的流程图。
具体实施方式
下面结合实施例及附图对本发明作进一步详细的描述,但本发明的实施方式不限于此。
实施例
如图1所示,本实施例公开了一种畜禽养殖场所巡检移动平台,该移动车基于Ros机器人结构框架,控制器包括底层控制器和上层控制器,底层控制器为ARM内核嵌入式微控制器,上层控制器为工控机,上层控制器主要通过UART串行通信方式来实现对底层控制器的控制,工控机通过CAN接口与上位机连接。
本实施例中,移动车为轮式移动车,每个车轮分别由一个自带编码器的无刷直流电机独立驱动,并使用差速驱动算法进行转向。底层控制器主要通过向直流驱动器发送PWM控制信号通过直流电机驱动器实现对移动车速度的控制。同时移动车自带的编码器将移动车的速度信息反馈给底层控制器,从而实现对移动车的闭环控制。移动车上设有用于测量移动车行进过程中旋转角度的IMU惯性测量单元,在底层控制器的控制下可调整移动车的方向。
参见图2,本实施例中,底层控制器型号为STM32F103ZE。底层控制器根据外部输入的转向信号和速度信号进行里程数的解算。上层控制器为工控机,主要通过激光雷达的输入数据以及底层控制器的里程计信息进行自主导航。并结合单目视觉所得的位置信息进行位置修正。其中全局地图初始为人工绘制畜禽养殖场地图,局部地图为二维激光雷达所获得的局部障碍信息和区域信息,局部规划器为移动车在局部地图中通过DWA算法得到最优行进路径。全局规划器为移动车在全局地图中所得到的最优行进路径。
本实施例中,移动车上设有环境监测模块,可包括温湿度传感器、氨气检测传感器、CO2传感器、H2S传感器、光照强度检测传感器等。其中温湿度传感器为DHT11数字温湿度传感器,其是一款含有已校准数字信号输出的温湿度复合传感器。氨气检测传感器型号为AP-M-NH3,该模块检测精度高,响应速度快且可实现多信号输出选择等特点。CO2检测传感器型号为MG811。H2S检测采用电阻式H2S检测传感器。光照强度检测传感器型号为OPT101。传感器分布采用空间阵列式分布,以便于检测畜禽养殖场所的空间环境信息。通过给不同传感器编号,来区分不同高度位置的环境信息。
本实施例中,在移动车上还设有AD电压采集模块,从而实现对移动车电池电压的检测。
一种基于上述畜禽养殖场所巡检移动平台的控制方法,包括步骤:预置人工绘制的畜禽养殖场所的全局地图,通过激光雷达扫描周围环境信息,获取局部地图,并与全局地图信息作特征匹配,得到当前移动车初步位置信息;视觉传感器拍摄定位校正码图像;控制器提取定位校正码图像中包括的位置信息,根据该位置信息与上面预置的全局地图的信息进行比对,得出准确位置,然后更新调整当前移动车的巡航轨迹,控制移动车按照更新后的轨迹继续行进。
本实例控制方法主要包括地图构建、自主巡航、定位校正码识别、位置修正、环境监测与电池电量管理等6个部分。
(1)地图构建:由于移动车在地图构建的过程中因长廊环境而容易出现环境退化的问题,使得移动车对长廊环境的建图信息与实际的地图信息相差甚远。因此,结合畜禽养殖场所环境的不变性,本移动车的初始全局地图信息采用人为绘制,从而得到精确的畜禽养殖场所的地图信息。
(2)自主巡航:利用激光雷达以及slam技术,通过结合IMU数据以及编码器数据,使移动车在不需人为干预下实现在畜禽养殖场所的自主巡航。移动车巡航过程中,通过激光雷达得到当前位置的环境信息,提取环境信息中的环境特征,对全局地图添加新的环境特征或更新旧环境特征,从而得到一个不断更新的全局地图和局部地图。
在移动车自主巡航的过程中,移动车通过二维激光雷达得到当前位置一定范围内的障碍物信息,并通过DWA局部路径规划算法在速度(υ,ω)空间中采样多组速度,并模拟机器人在这些速度下一定时间内的轨迹;在得到的多组轨迹后,对这些轨迹进行评价,选取最优轨迹所对应的速度来驱动移动车运动。
移动车自主巡航流程如图2所示。移动车使用navigation栈进行导航,move_base这一模块负责整个navigation行为的调度,包括初始化costmap与planner,监视导航状态适时更换导航策略等,并控制移动车的运行行为。move_base是基于有限状态机算法来实现,具体的逻辑流程如下:
1、首先利用move_base功能包启动全局路径规划和局部路径规划两个规划器,负责全局路径规划和局部路径规划,通过costmap组件生成自己的代价地图(global_costmap和local_costmap)。
2、通过全局路径规划,计算出机器人到目标位置的全局路线,实现的方法是基于栅格地图的cost搜索找最优。
3、然后通过局部规划,负责做局部避障的规划,具体navigation中实现的算法是Dynamic Windows Approach,具体流程是:
a.由移动底盘的运动学模型得到速度的采样空间。
b.在采样空间中,计算每个样本的目标函数。
c.得到期望速度,插值成轨迹输出。
(3)定位校正码识别:在控制器中设置定位校正码数据库,用于存储各个定位校正码的图像。在进行巡检过程中,利用单目机器视觉传感器,拍摄定位校正码(例如条形码)的图像,然后通过图3所示的方法,对拍摄的图像进行识别,具体步骤是:
1、将采集的原始图像进行尺寸调整,将其归一化到数据库中图像的尺寸大小,便于后续的识别。
2、对图像进行灰度化处理,然后进行高斯平滑滤波。
3、根据定位校正码的特征进行提取,以条形码为例,条形码具有在X方向上梯度明显,而在Y方向上的梯度基本不变的特点,利用该特点,利用Sobel算子计算水平和垂直方向的梯度差,从而保留图像在X方向的特征并消除Y方向的干扰。对梯度图像二值化。
4、对二值化后的图像采用闭运算、腐蚀、膨胀等形态学处理。并通过使用轮廓提取函数findContours将可能是定位校正码的部分使用矩形边框框选出来。
5、在处理后的图像中通过定位校正码的相应特征,如条形码的长宽比,轮廓面积以及形状等定位出条形码的位置。
6、将定位出的定位校正码与数据库中的各个定位校正码进行匹配,匹配成功后,解码该定位校正码代表的位置信息,进而得到当前移动车的准确定位信息。
(4)位置修正:通过对定位校正码信息的识别与解码,从而得到机器人具体的位置信息,并通过卡尔曼滤波将定位校正码表示的位置信息与激光SLAM得到的位置信息相互融合,从而实现对小车位置的修正,消除小车在长廊环境下引发的环境退化问题。具体方法是:
1、预测:
2、更新:先计算卡尔曼增益K
然后计算后验概率的分布:
上述所得到的即是修正之后的位置信息;
其中:为k时刻系统的状态变量,uk为k时刻系统的控制变量;
B为系统输入控制矩阵,为系统k-1时刻估计状态;
Ak和Ck分别为系统状态转移矩阵和测量矩阵;
R和Qk分别为过程噪声矩阵和测量噪声矩阵;
表示上一次协方差矩阵,为当前状态协方差矩阵;
zk为k时刻传感器的测量向量,为系统k时刻估计状态。
(5)环境监测:在移动平台自主巡航过程中,利用阵列分布的温湿度传感器、氨气监测传感器、CO2传感器、H2S传感器、光照度传感器。分别获取畜禽养殖场所的温度、湿度、氨气浓度,CO2浓度、H2S浓度、光照强度等主要环境指标信息。利用均值滤波等滤波算法克服信息测量的不准确性。并通过UART串口通信技术和Wifi模块将经过滤波处理的信息上传至电脑终端,从而利于工作人员的实时查看。
(6)电池电量管理:移动车在自主巡航的过程中,当检测到电池电压值低于某一设定的值时,移动车将会记录当前所在位置。然后通过UART串口技术以及wifi模块向电脑终端发送电池电压过低的信息,并通过触发报警器通知工作人员及时进行电池更换。当电池更换后,移动车将自动行驶至上次记录的位置,继续开始自动巡航。
参见图4,本实施例移动平台巡检过程中,其整体的工作流程如下:先导入地图信息,然后激光雷达探测当前移动车附近是否有待识别的定位校正码信息,如果有,则采集当前位置的定位校正码信息,进行识别定位、将其与传感器的信息进行融合,然后控制移动车继续自主巡航;
在巡航过程中,不断检测当前电池电量是否过低,如果过低,则记录当前位置,通知操作人员更换电池,否则继续自主巡航;
在巡航过程中,实时判断采集的环境信息是否超标,是的话就及时报警。
上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。
Claims (10)
1.畜禽养殖场所巡检移动平台,其特征在于,包括移动车、控制器,移动车上装有激光雷达和视觉传感器,在养殖场所固定的位置处设有定位校正码,定位校正码中含有当前位置的信息;在移动车巡检过程中,视觉传感器拍摄定位校正码图像,并将图像上传到控制器,控制器识别图像信息,得到当前移动车准确位置,然后更新调整当前移动车的巡航轨迹,控制移动车按照更新后的轨迹继续行进。
2.根据权利要求1所述的畜禽养殖场所巡检移动平台,其特征在于,所述控制器包括底层控制器和上层控制器,底层控制器采用ARM内核嵌入式微控制器,上层控制器采用工控机,上层控制器通过UART串行通信方式对底层控制器进行控制。
3.根据权利要求1所述的畜禽养殖场所巡检移动平台,其特征在于,所述移动车车轮由自带编码器的无刷直流电机独立驱动;
所述移动车上设有用于测量移动车行进过程中旋转角度的IMU惯性测量单元。
4.根据权利要求1所述的畜禽养殖场所巡检移动平台,其特征在于,所述移动车上设有环境监测模块,环境监测模块包括下列传感器的若干种:温湿度传感器、氨气监测传感器、CO2传感器、H2S传感器、光照度传感器;上述传感器通过UART串口通信方式和/或无线方式将数据传递到控制器。
5.根据权利要求1所述的畜禽养殖场所巡检移动平台,其特征在于,所述环境监测模块中各类型传感器均成阵列分布;
所述定位校正码采用条形码或二维码。
6.基于权利要求1-5任一项所述的畜禽养殖场所巡检移动平台的控制方法,其特征在于,包括步骤:
预置畜禽养殖场所的全局地图;
激光雷达扫描周围环境信息,获取局部地图,与全局地图信息作特征匹配,得到当前移动车初步位置信息;
视觉传感器拍摄定位校正码图像;
控制器提取定位校正码图像中包括的位置信息,根据该位置信息与上面预置的全局地图的信息进行比对,得出准确位置,然后更新调整当前移动车的巡航轨迹,控制移动车按照更新后的轨迹继续行进。
7.根据权利要求6所述的控制方法,其特征在于,在巡检过程中,激光雷达扫描周围环境信息,并根据信息更新全局地图,步骤是:通过激光雷达得到当前位置的环境信息,提取环境信息中的环境特征,对全局地图添加新的环境特征或更新旧环境特征,从而得到一个不断更新的全局地图。
8.根据权利要求6所述的控制方法,其特征在于,在移动车自动巡航的过程中,移动车通过二维激光雷达得到当前位置一定范围内的障碍物信息,并通过DWA局部路径规划算法在速度(υ,ω)空间中采样多组速度,并模拟机器人在这些速度下一定时间内的轨迹;在得到的多组轨迹后,对这些轨迹进行评价,选取最优轨迹所对应的速度来驱动移动车运动,从而实现移动车的实时避障。
9.根据权利要求6所述的控制方法,其特征在于,通过卡尔曼滤波将定位校正码表示的位置信息与激光雷达得到的位置信息融合,确定移动平台的位置,其具体过程如下:
(1)预测:
(2)更新:先计算卡尔曼增益K
然后计算后验概率的分布:
上述所得到的即是修正之后的位置信息;
其中:为k时刻系统的状态变量,uk为k时刻系统的控制变量;
B为系统输入控制矩阵,为系统k-1时刻估计状态;
Ak和Ck分别为系统状态转移矩阵和测量矩阵;
R和Qk分别为过程噪声矩阵和测量噪声矩阵;
表示上一次协方差矩阵,为当前状态协方差矩阵;
Zk为k时刻传感器的测量向量,为系统k时刻估计状态。
10.根据权利要求6所述的控制方法,其特征在于,
在巡检过程中,当检测到移动车电池电压低于某一设定的值时,记录当前所在位置,然后向控制器发送电池电压过低的信息,并触发报警器;当电池更换后,移动车将自动行驶至上次记录的位置,继续开始自动巡航;
所述定位校正码采用条形码或二维码,从定位校正码图像中提取条形码的方法是:
图像灰度化处理后,进行滤波;
对滤波后图像,计算水平和垂直方向的梯度差,对梯度图像二值化;
对二值化后的图像进行形态学处理,然后根据定位校正码特征定位出条形码或二维码。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811442426.7A CN109460029A (zh) | 2018-11-29 | 2018-11-29 | 畜禽养殖场所巡检移动平台及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811442426.7A CN109460029A (zh) | 2018-11-29 | 2018-11-29 | 畜禽养殖场所巡检移动平台及其控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109460029A true CN109460029A (zh) | 2019-03-12 |
Family
ID=65612000
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811442426.7A Pending CN109460029A (zh) | 2018-11-29 | 2018-11-29 | 畜禽养殖场所巡检移动平台及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109460029A (zh) |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109900280A (zh) * | 2019-03-27 | 2019-06-18 | 浙江大学 | 一种基于自主导航的畜禽信息感知机器人与地图构建方法 |
CN110942514A (zh) * | 2019-11-26 | 2020-03-31 | 三一重工股份有限公司 | 一种生成点云数据和全景图像的方法、系统及装置 |
CN111007855A (zh) * | 2019-12-19 | 2020-04-14 | 厦门理工学院 | 一种agv车导航控制方法 |
CN111308490A (zh) * | 2020-02-05 | 2020-06-19 | 浙江工业大学 | 基于单线激光雷达的平衡车室内定位与导航系统 |
CN111903547A (zh) * | 2020-08-19 | 2020-11-10 | 浙大城市学院 | 移动式环境监控自动饲喂系统及装置 |
CN112052702A (zh) * | 2020-08-10 | 2020-12-08 | 北京智通云联科技有限公司 | 一种识别二维码的方法和装置 |
CN112113568A (zh) * | 2020-08-21 | 2020-12-22 | 华南农业大学 | 一种畜禽养殖场巡检机器人的位姿校正方法 |
CN112212917A (zh) * | 2020-09-28 | 2021-01-12 | 华南农业大学 | 一种应用在畜禽养殖场的自动移动巡检系统和方法 |
CN112306058A (zh) * | 2020-10-15 | 2021-02-02 | 华南农业大学 | 清粪机器人智能导航方法、装置、系统、介质和设备 |
CN112363495A (zh) * | 2020-09-28 | 2021-02-12 | 华南农业大学 | 一种畜禽养殖场巡检机器人的导航方法 |
CN112766121A (zh) * | 2021-01-11 | 2021-05-07 | 牧原食品股份有限公司 | 一种用于养殖场巡检的机器人及养殖场巡检系统 |
CN112862272A (zh) * | 2021-01-21 | 2021-05-28 | 华中科技大学 | 精准农业管理及分析系统、定位方法、终端及存储介质 |
CN112904863A (zh) * | 2021-01-27 | 2021-06-04 | 北京农业智能装备技术研究中心 | 基于激光与图像信息融合的行走控制方法及装置 |
CN113282042A (zh) * | 2021-05-28 | 2021-08-20 | 广东广兴牧业机械设备有限公司 | 一种养猪舍内智能清粪机器人的控制系统及其控制方法 |
CN114043493A (zh) * | 2021-11-10 | 2022-02-15 | 华南农业大学 | 笼养鸡舍巡检机器人及巡检方法 |
TWI766746B (zh) * | 2021-06-30 | 2022-06-01 | 國立宜蘭大學 | 禽舍巡航機器人 |
CN115250950A (zh) * | 2022-08-02 | 2022-11-01 | 苏州数智赋农信息科技有限公司 | 一种基于人工智能的畜禽养猪场巡检方法及系统 |
CN116700297A (zh) * | 2023-07-31 | 2023-09-05 | 北京市农林科学院智能装备技术研究中心 | 基于畜舍作业机器人的自主导航控制系统和控制方法 |
CN116687386A (zh) * | 2023-08-07 | 2023-09-05 | 青岛市畜牧工作站(青岛市畜牧兽医研究所) | 牛体形数据综合校准的雷达探测系统及方法 |
CN117075614A (zh) * | 2023-09-25 | 2023-11-17 | 中国农业科学院北京畜牧兽医研究所 | 一种养殖巡检机器人万能通用底盘系统 |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103995534A (zh) * | 2014-05-13 | 2014-08-20 | 北京艾科尔明国际科技发展有限公司 | 巡检机器人的移动路线控制系统及控制方法 |
CN103995509A (zh) * | 2014-05-13 | 2014-08-20 | 北京华科数能科技发展有限公司 | 用于禽舍环境监测的机器人及其监测方法和系统 |
CN104663483A (zh) * | 2013-11-27 | 2015-06-03 | 丹斯克敏克帕佩尔股份有限公司 | 机动给料车、改装套件、动物养殖系统及其运行方法 |
CN105403222A (zh) * | 2015-12-08 | 2016-03-16 | 江苏科技大学 | 基于ros的多导盲机器人及在未知环境中的地图创建方法 |
CN106525025A (zh) * | 2016-10-28 | 2017-03-22 | 武汉大学 | 一种变电站巡检机器人路线规划导航方法 |
CN107066970A (zh) * | 2017-04-13 | 2017-08-18 | 深圳力子机器人有限公司 | 用于无轨导航agv的视觉定位方法以及装置和系统 |
CN107209517A (zh) * | 2014-12-19 | 2017-09-26 | 康普乐克思创新有限责任公司 | 用于为自动引导带轮车辆记录和预测位置数据的方法 |
CN107422735A (zh) * | 2017-07-29 | 2017-12-01 | 深圳力子机器人有限公司 | 一种无轨导航agv激光与视觉特征混合导航方法 |
WO2018015519A1 (en) * | 2016-07-20 | 2018-01-25 | Farm Robotics And Automation Sl | Robot assisted surveillance of livestock |
CN107643752A (zh) * | 2017-05-09 | 2018-01-30 | 清研华宇智能机器人(天津)有限责任公司 | 基于行人轨迹预测的全向移动机器人路径规划算法 |
CN107741745A (zh) * | 2017-09-19 | 2018-02-27 | 浙江大学 | 一种实现移动机器人自主定位与地图构建的方法 |
CN108189043A (zh) * | 2018-01-10 | 2018-06-22 | 北京飞鸿云际科技有限公司 | 一种应用于高铁机房的巡检方法及巡检机器人系统 |
CN108363386A (zh) * | 2017-12-30 | 2018-08-03 | 杭州南江机器人股份有限公司 | 基于二维码和激光的室内机器人定位方法、装置及系统 |
CN108733062A (zh) * | 2018-06-25 | 2018-11-02 | 山东大学 | 家庭陪护机器人自主充电系统及方法 |
-
2018
- 2018-11-29 CN CN201811442426.7A patent/CN109460029A/zh active Pending
Patent Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104663483A (zh) * | 2013-11-27 | 2015-06-03 | 丹斯克敏克帕佩尔股份有限公司 | 机动给料车、改装套件、动物养殖系统及其运行方法 |
CN103995509A (zh) * | 2014-05-13 | 2014-08-20 | 北京华科数能科技发展有限公司 | 用于禽舍环境监测的机器人及其监测方法和系统 |
CN103995534A (zh) * | 2014-05-13 | 2014-08-20 | 北京艾科尔明国际科技发展有限公司 | 巡检机器人的移动路线控制系统及控制方法 |
CN107209517A (zh) * | 2014-12-19 | 2017-09-26 | 康普乐克思创新有限责任公司 | 用于为自动引导带轮车辆记录和预测位置数据的方法 |
CN105403222A (zh) * | 2015-12-08 | 2016-03-16 | 江苏科技大学 | 基于ros的多导盲机器人及在未知环境中的地图创建方法 |
WO2018015519A1 (en) * | 2016-07-20 | 2018-01-25 | Farm Robotics And Automation Sl | Robot assisted surveillance of livestock |
CN106525025A (zh) * | 2016-10-28 | 2017-03-22 | 武汉大学 | 一种变电站巡检机器人路线规划导航方法 |
CN107066970A (zh) * | 2017-04-13 | 2017-08-18 | 深圳力子机器人有限公司 | 用于无轨导航agv的视觉定位方法以及装置和系统 |
CN107643752A (zh) * | 2017-05-09 | 2018-01-30 | 清研华宇智能机器人(天津)有限责任公司 | 基于行人轨迹预测的全向移动机器人路径规划算法 |
CN107422735A (zh) * | 2017-07-29 | 2017-12-01 | 深圳力子机器人有限公司 | 一种无轨导航agv激光与视觉特征混合导航方法 |
CN107741745A (zh) * | 2017-09-19 | 2018-02-27 | 浙江大学 | 一种实现移动机器人自主定位与地图构建的方法 |
CN108363386A (zh) * | 2017-12-30 | 2018-08-03 | 杭州南江机器人股份有限公司 | 基于二维码和激光的室内机器人定位方法、装置及系统 |
CN108189043A (zh) * | 2018-01-10 | 2018-06-22 | 北京飞鸿云际科技有限公司 | 一种应用于高铁机房的巡检方法及巡检机器人系统 |
CN108733062A (zh) * | 2018-06-25 | 2018-11-02 | 山东大学 | 家庭陪护机器人自主充电系统及方法 |
Non-Patent Citations (6)
Title |
---|
刘洞波 等: "《移动机器人粒子滤波定位与地图创建》", 30 September 2016, 湘潭大学出版社 * |
刘阳春 等: "畜禽养殖环境远程监控系统研究", 《技术应用》 * |
张毅 等: "《移动机器人技术基础与制作》", 31 January 2013, 哈尔滨工业大学出版社 * |
曲丽萍 等: "《未知环境下智能机器人自主导航定位与应用》", 30 June 2017, 曲丽萍 等 * |
曹其新 等: "《轮式自主移动机器人》", 31 December 2012, 上海交通大学出版社 * |
漆海霞 等: "现代化生猪养殖环境测控技术现状与发展趋势", 《家畜生态学报》 * |
Cited By (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109900280A (zh) * | 2019-03-27 | 2019-06-18 | 浙江大学 | 一种基于自主导航的畜禽信息感知机器人与地图构建方法 |
WO2020192000A1 (zh) * | 2019-03-27 | 2020-10-01 | 浙江大学 | 一种基于自主导航的畜禽信息感知机器人与地图构建方法 |
US20220147053A1 (en) * | 2019-03-27 | 2022-05-12 | Zhejiang University | Robot with perception capability of livestock and poultry information and mapping approach based on autonomous navigation |
US11892855B2 (en) * | 2019-03-27 | 2024-02-06 | Zhejiang University | Robot with perception capability of livestock and poultry information and mapping approach based on autonomous navigation |
CN110942514A (zh) * | 2019-11-26 | 2020-03-31 | 三一重工股份有限公司 | 一种生成点云数据和全景图像的方法、系统及装置 |
CN111007855A (zh) * | 2019-12-19 | 2020-04-14 | 厦门理工学院 | 一种agv车导航控制方法 |
CN111308490A (zh) * | 2020-02-05 | 2020-06-19 | 浙江工业大学 | 基于单线激光雷达的平衡车室内定位与导航系统 |
CN111308490B (zh) * | 2020-02-05 | 2021-11-19 | 浙江工业大学 | 基于单线激光雷达的平衡车室内定位与导航系统 |
CN112052702A (zh) * | 2020-08-10 | 2020-12-08 | 北京智通云联科技有限公司 | 一种识别二维码的方法和装置 |
CN112052702B (zh) * | 2020-08-10 | 2023-12-19 | 北京智通云联科技有限公司 | 一种识别二维码的方法和装置 |
CN111903547A (zh) * | 2020-08-19 | 2020-11-10 | 浙大城市学院 | 移动式环境监控自动饲喂系统及装置 |
CN112113568A (zh) * | 2020-08-21 | 2020-12-22 | 华南农业大学 | 一种畜禽养殖场巡检机器人的位姿校正方法 |
CN112212917A (zh) * | 2020-09-28 | 2021-01-12 | 华南农业大学 | 一种应用在畜禽养殖场的自动移动巡检系统和方法 |
CN112363495A (zh) * | 2020-09-28 | 2021-02-12 | 华南农业大学 | 一种畜禽养殖场巡检机器人的导航方法 |
CN112306058A (zh) * | 2020-10-15 | 2021-02-02 | 华南农业大学 | 清粪机器人智能导航方法、装置、系统、介质和设备 |
CN112766121A (zh) * | 2021-01-11 | 2021-05-07 | 牧原食品股份有限公司 | 一种用于养殖场巡检的机器人及养殖场巡检系统 |
CN112862272A (zh) * | 2021-01-21 | 2021-05-28 | 华中科技大学 | 精准农业管理及分析系统、定位方法、终端及存储介质 |
CN112904863A (zh) * | 2021-01-27 | 2021-06-04 | 北京农业智能装备技术研究中心 | 基于激光与图像信息融合的行走控制方法及装置 |
CN112904863B (zh) * | 2021-01-27 | 2023-10-20 | 北京农业智能装备技术研究中心 | 基于激光与图像信息融合的行走控制方法及装置 |
CN113282042A (zh) * | 2021-05-28 | 2021-08-20 | 广东广兴牧业机械设备有限公司 | 一种养猪舍内智能清粪机器人的控制系统及其控制方法 |
TWI766746B (zh) * | 2021-06-30 | 2022-06-01 | 國立宜蘭大學 | 禽舍巡航機器人 |
CN114043493A (zh) * | 2021-11-10 | 2022-02-15 | 华南农业大学 | 笼养鸡舍巡检机器人及巡检方法 |
CN115250950A (zh) * | 2022-08-02 | 2022-11-01 | 苏州数智赋农信息科技有限公司 | 一种基于人工智能的畜禽养猪场巡检方法及系统 |
CN115250950B (zh) * | 2022-08-02 | 2024-01-19 | 苏州数智赋农信息科技有限公司 | 一种基于人工智能的畜禽养猪场巡检方法及系统 |
CN116700297A (zh) * | 2023-07-31 | 2023-09-05 | 北京市农林科学院智能装备技术研究中心 | 基于畜舍作业机器人的自主导航控制系统和控制方法 |
CN116700297B (zh) * | 2023-07-31 | 2023-10-27 | 北京市农林科学院智能装备技术研究中心 | 基于畜舍作业机器人的自主导航控制系统和控制方法 |
CN116687386A (zh) * | 2023-08-07 | 2023-09-05 | 青岛市畜牧工作站(青岛市畜牧兽医研究所) | 牛体形数据综合校准的雷达探测系统及方法 |
CN116687386B (zh) * | 2023-08-07 | 2023-10-31 | 青岛市畜牧工作站(青岛市畜牧兽医研究所) | 牛体形数据综合校准的雷达探测系统及方法 |
CN117075614A (zh) * | 2023-09-25 | 2023-11-17 | 中国农业科学院北京畜牧兽医研究所 | 一种养殖巡检机器人万能通用底盘系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109460029A (zh) | 畜禽养殖场所巡检移动平台及其控制方法 | |
CN109900280B (zh) | 一种基于自主导航的畜禽信息感知机器人与地图构建方法 | |
EP4009131B1 (en) | Method of navigating a vehicle and system thereof | |
CN102368158B (zh) | 一种果园机械导航定位方法 | |
CN108955667A (zh) | 一种融合激光雷达与二维码的复合导航方法、装置及系统 | |
CN104520732B (zh) | 定位传感器的方法以及相关设备 | |
CN109599945A (zh) | 一种智慧电厂自主巡检机器人巡检系统及方法 | |
CN107144285A (zh) | 位姿信息确定方法、装置和可移动设备 | |
CN110361027A (zh) | 基于单线激光雷达与双目相机数据融合的机器人路径规划方法 | |
CN107807652A (zh) | 物流机器人、用于其的方法和控制器及计算机可读介质 | |
CN106289285A (zh) | 一种关联场景的机器人侦察地图及构建方法 | |
CN108303103A (zh) | 目标车道的确定方法和装置 | |
CN106199626A (zh) | 基于摆动激光雷达的室内三维点云地图生成系统及方法 | |
CN104714547A (zh) | 带有相机的自主园林车辆 | |
WO2015180021A1 (zh) | 剪枝机器人系统 | |
CN108364466A (zh) | 一种基于无人机交通视频的车流量统计方法 | |
Zou et al. | Real-time full-stack traffic scene perception for autonomous driving with roadside cameras | |
CN113189613B (zh) | 一种基于粒子滤波的机器人定位方法 | |
CN101574586A (zh) | 毽球机器人及控制方法 | |
CN110058594A (zh) | 基于示教的多传感器的移动机器人定位导航系统及方法 | |
JP2019008431A (ja) | 経路探索装置および経路探索方法 | |
CN114114367A (zh) | Agv室外定位切换方法、计算机装置及程序产品 | |
CN107272037A (zh) | 一种道路设施位置、图像信息采集装置及采集信息的方法 | |
CN113296501A (zh) | 温室巡检机器人、温室环境立体监测系统及方法 | |
CN109729835B (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190312 |
|
RJ01 | Rejection of invention patent application after publication |