CN110754219A - 一种视觉定位的仿生蛇嘴采摘机构、无人机采收装置及其采收方法 - Google Patents
一种视觉定位的仿生蛇嘴采摘机构、无人机采收装置及其采收方法 Download PDFInfo
- Publication number
- CN110754219A CN110754219A CN201911085095.0A CN201911085095A CN110754219A CN 110754219 A CN110754219 A CN 110754219A CN 201911085095 A CN201911085095 A CN 201911085095A CN 110754219 A CN110754219 A CN 110754219A
- Authority
- CN
- China
- Prior art keywords
- snake
- snake mouth
- mouth
- fruit
- distance
- 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.)
- Withdrawn
Links
- 241000270295 Serpentes Species 0.000 title claims abstract description 204
- 230000007246 mechanism Effects 0.000 title claims abstract description 51
- 239000011664 nicotinic acid Substances 0.000 title claims abstract description 49
- 238000000034 method Methods 0.000 title claims abstract description 17
- 238000003306 harvesting Methods 0.000 title claims abstract description 16
- 235000013399 edible fruits Nutrition 0.000 claims abstract description 117
- 210000003739 neck Anatomy 0.000 claims description 32
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical group [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 claims description 16
- 239000004677 Nylon Substances 0.000 claims description 12
- 229920001778 nylon Polymers 0.000 claims description 12
- 230000000007 visual effect Effects 0.000 claims description 9
- 239000011159 matrix material Substances 0.000 claims description 6
- 230000007704 transition Effects 0.000 claims description 6
- 238000012545 processing Methods 0.000 claims description 5
- 238000012216 screening Methods 0.000 claims description 5
- 238000012937 correction Methods 0.000 claims description 4
- 238000001179 sorption measurement Methods 0.000 claims description 3
- 241000566145 Otus Species 0.000 claims description 2
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 238000001514 detection method Methods 0.000 claims description 2
- 238000001914 filtration Methods 0.000 claims description 2
- 238000009499 grossing Methods 0.000 claims description 2
- 230000000877 morphologic effect Effects 0.000 claims description 2
- 230000011218 segmentation Effects 0.000 claims description 2
- 230000003592 biomimetic effect Effects 0.000 claims 7
- 230000009471 action Effects 0.000 abstract description 7
- 230000008569 process Effects 0.000 abstract description 7
- 230000006378 damage Effects 0.000 abstract description 4
- 238000000926 separation method Methods 0.000 abstract description 4
- 230000000694 effects Effects 0.000 abstract description 3
- 230000004044 response Effects 0.000 abstract description 3
- 208000027418 Wounds and injury Diseases 0.000 abstract description 2
- 208000014674 injury Diseases 0.000 abstract description 2
- 230000010485 coping Effects 0.000 abstract 2
- 241001122767 Theaceae Species 0.000 description 3
- 241000196324 Embryophyta Species 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 241000526900 Camellia oleifera Species 0.000 description 1
- 241001465754 Metazoa Species 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000009194 climbing Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 210000005069 ears Anatomy 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 239000002699 waste material Substances 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D46/00—Picking of fruits, vegetables, hops, or the like; Devices for shaking trees or shrubs
- A01D46/30—Robotic devices for individually picking crops
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U10/00—Type of UAV
- B64U10/10—Rotorcrafts
-
- 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/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- 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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U2101/00—UAVs specially adapted for particular uses or applications
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental Sciences (AREA)
- Mechanical Engineering (AREA)
- Harvesting Machines For Specific Crops (AREA)
Abstract
本发明公开了一种视觉定位的仿生蛇嘴采摘机构、无人机采收装置及其采收方法。仿生蛇嘴采摘机构包括蛇嘴上部、蛇嘴下部和蛇颈，蛇嘴上部与蛇嘴下部主要用于采摘，蛇颈主要用于收获；仿生蛇嘴采摘机构通过支架安装在无人机主体上。本发明具有很好的仿生效果，在采摘过程中，蛇嘴上部和蛇嘴下部的仿生形状可以很好地适用于果实采摘，刀片的设置模仿了牙齿的作用，加上电磁铁与旋转电机的快速响应，可以迅速促进果实和植株的分离，而且在果实定位采摘出现偏差时以及应对障碍环境等方面，本发明都有很好的容错率和相应的应对措施，人工劳动强度小，在采摘过程中可以有效避免果实的损伤和人员的受伤。
Description
技术领域
本发明涉及采摘机械领域，特别涉及一种视觉定位的仿生蛇嘴采摘机构、无人机采收装置及其采收方法。
背景技术
油茶果、苹果等果实是我国最主要的作物。以油茶果为例，采摘具有以下特点：多数果树种植在山区，特别是南方的山路道路不平，大型化的机械无法上山作业；油茶果采收时要求动作轻，不能损伤树枝和新开的花苞，否则会严重影响来年的产量。目前，油茶果的采摘基本上依靠手工采摘来完成，通过外力作用使果实与果树分离，再将果实放入框中；这种采摘方式的人工强度较大，采摘效率较低。现有的采摘机器人，大多为小车加机械手的组合，小车可通过人工或者导航的方式到达目标点，而采摘工作大多给机械手进行作业，在机械手工作时，当要采摘高度较高的果实时，还需要配备升降台；当采摘位置错误，即使是较小的位置偏移，都可能导致采摘不成功，需要重新对准果实，重复之前的动作进行采摘，这势必造成时间的浪费和效率的降低。基于此，本发明为了克服采摘过程中采摘点目标过高造成的采摘不便，配备无人机视觉定位进行采摘；为了克服由于定位精度不足导致与采摘点偏移过大，设计仿生蛇嘴采摘机构，增大容错率，提高采摘效率。
发明内容
本发明的目的在于克服现有技术中存在的缺点，提供一种采摘效率高、容错率高、人工劳动强度低的视觉定位的仿生蛇嘴采摘机构。
本发明的另一目的在于提供一种无人机采收装置及其采收方法，所述无人机采收装置安装有上述视觉定位的仿生蛇嘴采摘机构。
本发明的目的通过下述技术方案实现：
一种视觉定位的仿生蛇嘴采摘机构2，包括蛇嘴上部3、蛇嘴下部4和蛇颈5；所述蛇嘴上部3包括上圆形帽7、蛇嘴上沿8和双目相机9，蛇嘴上部3的前方为蛇嘴上沿8，蛇嘴上沿8与上圆形帽7固定连接，蛇嘴上沿8的上方装有双目相机9；蛇嘴上沿8的两侧装有距离传感器10，用于检测果实与仿生蛇嘴采摘机构的初步距离，进行辅助初步定位，再通过双目相机采集图像，结合算法实现二次定位；蛇嘴下部4的前方为蛇嘴下沿11，蛇嘴下部4的底部设有圆形倾斜轨道，角度范围为15～30°；蛇嘴上部3与蛇嘴下部4都装有刀片19；光杆16与蛇嘴上部3固连，蛇嘴下部4设有光杆孔，光杆16通过光杆孔竖直穿过蛇嘴下部4，光杆16的底部装有节环18，光杆的中部套有弹簧17，蛇嘴下部4与蛇嘴上部3之间通过光杆16进行相对移动；蛇颈5位于上圆形帽7的下方。
所述蛇颈5包括下圆形帽13和尼龙网14，下圆形帽13的内部设有圆形倾斜轨道，角度范围为45～65°，下圆形帽13的圆形倾斜轨道与蛇嘴下部4的圆形倾斜轨道相连通，果实被采摘下来之后先通过蛇嘴下部4的圆形倾斜轨道下滑，接着通过下圆形帽13的圆形倾斜轨道下滑；下圆形帽的外部套接有尼龙网14；尼龙网14的底部设置有铁圈15，防止大风等外界因素影响果实的正常摘取。
所述刀片19分别安装在蛇嘴上沿8的底部边缘和蛇嘴下沿11的上部边缘，刀片19的安装呈上下对称。蛇嘴上沿8安装有7块刀片，包括前方安装有一块刀片、左方安装有两块刀片、右方安装有两块刀片、前方刀片和左方刀片之间有一块过渡刀片、前方刀片和右方刀片之间有一块过渡刀片；蛇嘴下沿11在相对应的位置也安装有7块刀片。左方刀片和右方刀片对称，可以在定位出现偏差而导致仿生蛇嘴采摘机构的位置与果实位置出现偏移时，采用左方刀片或者右方刀片进行果实分离，即在没有正对果实的情况下进行倾斜采摘。
蛇颈5通过齿轮齿条20与蛇嘴上部3相连接，齿轮通过旋转电机提供动力。
蛇嘴上沿8的外侧呈圆斜坡状，角度范围为15～30°；蛇嘴下沿11的外侧也呈圆斜坡状，角度范围为10～15°；这种形状使得仿生蛇嘴采摘机构的导向性好，可以对树枝进行导向，减少碰撞，防止干扰。
仿生蛇嘴采摘机构上安装有电磁铁12和旋转电机；光杆孔的周围布置有环形铁环，蛇嘴上部对应环形铁环所在的竖直方向上设置有电磁铁12，通过电磁铁12的通电和断电，实现环形铁环的吸附与释放，从而带动蛇嘴下部4的上下移动；旋转电机安装在齿轮齿条20的上方，当旋转电机通电时，使齿轮齿条20运动，通过旋转电机的正反转，带动蛇颈5的上下移动。
一种视觉定位的无人机采收装置，包括无人机主体1，所述视觉定位的仿生蛇嘴采摘机构2；仿生蛇嘴采摘机构2通过支架6安装在无人机主体1上，支架6的内部设有线路，线路用于给电磁铁、旋转电机、双目相机、距离传感器等需要用电的设备供电。
一种视觉定位的无人机采收方法，是采用上述视觉定位的无人机采收装置，包括下述步骤：
(1)双目相机标定：先进行单目标定，得到相机的内参数矩阵与畸变系数矩阵；然后进行双目标定，得到双目校正的重投影矩阵，以及相机像素距离和真实距离的转换关系；
(2)图像采集与校正：无人机通过双目相机获取果实图像，然后进行双目校正，得到校正后的果实图像；
(3)图像处理：对校正后的果实图像先进行灰度化、平滑处理，然后采用Otus法来确定分割阈值，将校正后的果实图像中的果实分割出来，得到分割后的图像，并依次对果实进行编号，计算每个果实的位置；
(4)形态学处理：通过数学形态学滤波的开运算对分割后的图像进一步处理，平滑果实轮廓、断开较窄的狭颈并消除细的突起物；
(5)轮廓检测与筛选：通过调用OpenCV函数库中的函数，辅助提取图像中所有可能是果实轮廓的信息，并进行轮廓的筛选，得到目标果实的位置；
(6)视觉跟踪：采用CamShift算法对目标果实特征标志进行跟踪，达到实时动态锁定果实，进行跟随；
(7)驱动无人机靠近：在获取目标果实位置后，返回果实O1的位置，计算仿生蛇嘴采摘机构与目标果实位置的距离，将O1投影到相机坐标系平面上得到投影O1’；计算投影O1’到相机坐标系原点O的实际物理距离
在仿生蛇嘴采摘机构靠近目标果实的时候，如果
(w为安全距离，w的取值范围30cm～40cm)，打开旋转电机，让蛇颈下移；如果
(e为采摘距离，e的取值范围为10cm～15cm)，表示可以准备摘取果实，让电磁铁失电，蛇嘴下部下移；若
无人机根据距离值和方向
调整无人机的位置，直至
(8)距离传感器返回实时距离：距离传感器10返回实时直线距离，将实时直线距离与双目相机计算的
的距离进行对比，由于距离传感器在近距离测算时，所测距离为直线距离，故其测得距离更加精确，所以当相机与距离传感器所测距离都小于e时，则可以只通过距离传感器所测距离进行判断，当距离传感器返回实时直线距离为0时，表示可以进行采摘；
(9)采摘果实：通过控制电磁铁通电和断电，进而控制仿生蛇嘴采摘机构的蛇嘴上部3与蛇嘴下部4进行张开与闭合的动作以咬住果实，然后采用刀片19对果实进行多角度采摘，咬断果枝或拧下果实；
(10)收集果实：采摘到果实后，通过旋转电机控制齿轮齿条，使得果实从圆形倾斜轨道进入蛇颈，最后从铁圈滑入收集筐中。
本发明与现有技术相比具有如下优点和效果：
(1)本发明具有很好的仿生效果，在采摘过程中，蛇嘴上部和蛇嘴下部的仿生形状可以很好地适用于果实采摘，刀片的设置模仿了牙齿的作用，加上电磁铁与旋转电机的快速响应，可以迅速促进果实和植株的分离。
(2)本发明在视觉等方面的定位装置也采用了仿生，比如距离传感器类似于耳朵，双目相机类似于眼睛，分别起到了初步和二次定位，而且在很接近果实时，通过距离传感器进行测算距离更加精确，更加有效地定位目标的位置，使得无人机能够在准确的位置进行采摘。
(3)本发明的仿生蛇嘴采摘机构通过旋转电机和齿轮齿条的作用，实现蛇颈与蛇嘴之间稳定的运动和牢固的连接；当开始采摘前，电机正转，蛇颈渐渐稳定下移；当采摘时，由于蛇颈较长，可能受到环境影响，齿条的牢固连接可以为其提供保障，保证采摘的正常进行；当采摘结束，电机反转，蛇颈逐渐收回，完成采摘。
(4)本发明的蛇嘴上沿和蛇嘴下沿呈圆尖状，既可以导向树枝，防止影响采摘，又不易发生碰撞，进一步提高了仿生蛇嘴采摘机构的安全性。
(5)蛇嘴上下部的刀片设计是呈前、左、右分布，这样的设计类似动物齿，可以在果实定位出现偏差的时候，使得仿生蛇嘴采摘机构不能够正对果实的时候，可以通过左右的蛇齿进行分离果实；或者当果实之间非常靠近或者存在很密集的树枝时，可通过调整进行倾斜式靠近果实，进行采摘。
(7)本发明借助电磁铁与弹簧的快速响应特性以及齿轮齿条稳定牢固的运动，有效提高采摘效率，缩短采摘时间，而且在果实定位采摘出现偏差时以及应对障碍环境等方面，本发明的装置都有很好的容错率和相应的应对措施，人工劳动强度小，在采摘过程中可以有效避免果实的损伤和人员的受伤。
附图说明
图1为本发明视觉定位的无人机采收装置的结构示意图。
图2为仿生蛇嘴采摘机构的结构示意图。
图3为仿生蛇嘴采摘机构的局部结构示意图。
图4为正常采摘示意图。
图5为多果实采摘情况示意图。
图6为多障碍物采摘情况示意图。
图7为果实定位偏差或果颈歪斜采摘情况示意图。
图中，1、无人机主体；2、仿生蛇嘴采摘机构；3、蛇嘴上部；4、蛇嘴下部；5、蛇颈；6、支架；7、上圆形帽；8、蛇嘴上沿；9、双目相机；10、距离传感器；11、蛇嘴下沿；12、电磁铁；13、下圆形帽；14、尼龙网；15、铁圈；16、光杆；17、弹簧；18、节环；19、刀片；20、齿轮齿条。
具体实施方式
下面结合实施例对本发明做进一步详细的描述，但本发明的实施方式不限于此。
实施例1
如图1、图2、图3所示，一种视觉定位的无人机采收装置，包括无人机主体1和视觉定位的仿生蛇嘴采摘机构2；仿生蛇嘴采摘机构2通过支架6安装在无人机主体1上，支架6的内部设有线路，线路用于给电磁铁、旋转电机、双目相机、距离传感器等需要用电的设备供电。支架6的安装方式为可插拔式，即支架内部布置有线路，支架末端类似电源插头，通过插装在无人机上获取电源。
视觉定位的仿生蛇嘴采摘机构2，包括蛇嘴上部3、蛇嘴下部4和蛇颈5。所述蛇嘴上部3包括上圆形帽7、蛇嘴上沿8和双目相机9，蛇嘴上部3的前方为蛇嘴上沿8，蛇嘴上沿8与上圆形帽7固定连接，蛇嘴上沿8的上方装有双目相机9；蛇嘴上沿8的两侧装有距离传感器10，用于检测果实与仿生蛇嘴采摘机构的初步距离，进行辅助初步定位，再通过双目相机采集图像，结合算法实现二次定位；蛇嘴下部4的前方为蛇嘴下沿11，蛇嘴下部4的底部设有圆形倾斜轨道，角度范围为15～30°。蛇嘴上沿8的外侧呈圆斜坡状，角度范围为15～30°；蛇嘴下沿11的外侧也呈圆斜坡状，角度范围为10～15°；这种形状使得仿生蛇嘴采摘机构的导向性好，可以对树枝进行导向，减少碰撞，防止干扰。
蛇嘴上部3与蛇嘴下部4都装有刀片19。所述刀片19分别安装在蛇嘴上沿8的底部边缘和蛇嘴下沿11的上部边缘，刀片19的安装呈上下对称。蛇嘴上沿8安装有7块刀片，包括前方安装有一块刀片、左方安装有两块刀片、右方安装有两块刀片、前方刀片和左方刀片之间有一块过渡刀片、前方刀片和右方刀片之间有一块过渡刀片；蛇嘴下沿11在相对应的位置也安装有7块刀片。左方刀片和右方刀片对称，可以在定位出现偏差而导致仿生蛇嘴采摘机构的位置与果实位置出现偏移时，采用左方刀片或者右方刀片进行果实分离，即在没有正对果实的情况下进行倾斜采摘。
所述蛇颈5包括下圆形帽13和尼龙网14，下圆形帽13的内部设有圆形倾斜轨道，角度范围为45～65°，下圆形帽13的圆形倾斜轨道与蛇嘴下部4的圆形倾斜轨道相连通，两个轨道呈小阶梯状，下圆形帽的轨道略低。果实被采摘下来之后先通过蛇嘴下部4的圆形倾斜轨道下滑，接着通过下圆形帽13的圆形倾斜轨道下滑；下圆形帽的外部套接有尼龙网14；尼龙网14的底部设置有铁圈15，防止大风等外界因素影响果实的正常摘取。蛇颈5通过齿轮齿条20与蛇嘴上部3相连接，齿轮通过旋转电机提供动力。
光杆16与蛇嘴上部3固连，蛇嘴下部4设有光杆孔，光杆16通过光杆孔竖直穿过蛇嘴下部4，光杆16的底部装有节环18，光杆的中部套有弹簧17，蛇嘴下部4与蛇嘴上部3之间通过光杆16可以进行相对移动。仿生蛇嘴采摘机构上安装有电磁铁12和旋转电机；光杆孔的周围布置有环形铁环，蛇嘴上部对应环形铁环所在的竖直方向上设置有电磁铁12，通过电磁铁12的通电和断电，实现环形铁环的吸附与释放，从而带动蛇嘴下部4的上下移动；旋转电机安装在齿轮齿条20的上方，当旋转电机通电时，使齿轮齿条20运动，通过旋转电机的正反转，带动蛇颈5的上下移动。
如图4所示，一种视觉定位的无人机采收方法，是采用上述视觉定位的无人机采收装置，在采摘过程中，首先无人机通过安装在蛇嘴上沿两侧的距离传感器10初步获得果实与无人机的距离，此时蛇嘴上沿的电磁铁12通电，弹簧17被蛇嘴下部4压紧，蛇嘴上下部为闭合状态。然后，控制无人机飞行至预设高度(视果树高度决定)，进行双目相机9的标定和图像采集、处理、筛选并获得目标的位置，当无人机获得果实位置后，通过CamShift算法进行动态追踪果实位置，无人机慢慢靠近果实，期间距离传感器不断获取无人机与果实之间的距离，同时无人机通过双目相机动态捕捉果实位置后，与距离传感器获得的距离进行对比，达到开口距离w后(w为安全距离，w范围在30cm～40cm左右)，此时，以距离传感器所测数据为依据，打开旋转电机，齿轮齿条20相互移动，蛇颈5开始逐渐下移，等蛇颈5下移到合适的位置，使得上圆形帽7与下圆形帽13之间的空间足以容纳果实，此时关闭旋转电机，下移完毕；接着在与采摘点的距离到达e时(e范围在10cm～15cm左右)，让电磁铁立刻失电，由于弹簧的作用力，蛇嘴上下部马上分离至最大行程，呈开口状，由于光杆16的底部设有节环18，可以阻止蛇嘴下部继续下移，接着无人机慢慢靠近果实，通过距离传感器不断检测距离，直到果实到达蛇嘴的采摘范围，开始摄入果实，此时让电磁体得电，蛇嘴下部快速上移，借助快速上移的速度和刀片19的作用，果实与植株顺利分离，由于蛇嘴内部设有圆形倾斜轨道，果实顺利进入尼龙网14，由于尼龙网质量较轻，所以对果实不会产生损伤，网底套有铁圈15，可以降低大风等外界因素的影响，果实顺着尼龙网便会到达收获小车内，等采摘完成后，即可控制无人机返程，期间控制旋转电机反转，齿轮齿条20反向相对移动，蛇颈5逐渐上移，最终与上部重合，关闭旋转电机，完成采摘过程。
实施例2
如图5所示，当图像定位的果实位置处含有多个果实时，仿生蛇嘴采摘机构靠近果实时，由于蛇嘴外形呈圆锥状，利用其导向性，可以使目标果实旁边的果实顺着外侧轮廓，移动到旁边位置，这样便使得目标果实处于正确的采摘位置，其中主要的采摘执行步骤与实施例1相同。
实施例3
如图6所示，当目标果实上下方存在许多障碍树枝，当仿生蛇嘴采摘机构靠近果实时，由于蛇嘴上下沿外侧设计的圆斜坡，可以很好地将树枝导向上方和下方，而不影响采摘，其中主要的采摘执行步骤与实施例1相同。
实施例4
如图7所示，当果实定位出现误差时，使得果实没有正对仿生蛇嘴采摘机构的正中央，且果颈倾向一侧，此时，无人机仍可以靠近进行采摘，由于蛇嘴空间足够大，无人机移动，使得果实被包裹在内，即可通过左方或者右方的刀片将果颈切断，其中主要的采摘执行步骤与实施例1相同。
以上所述仅为本发明的实施例，但本发明的实施方式并不受上述实施例的限制，其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化，均为等效的置换方式，都包含在本发明的保护范围之内。
Claims (10)
1.一种视觉定位的仿生蛇嘴采摘机构，其特征在于：包括蛇嘴上部、蛇嘴下部和蛇颈；所述蛇嘴上部包括上圆形帽、蛇嘴上沿和双目相机，蛇嘴上部的前方为蛇嘴上沿，蛇嘴上沿与上圆形帽固定连接，蛇嘴上沿的上方装有双目相机；蛇嘴上沿的两侧装有距离传感器；蛇嘴下部的前方为蛇嘴下沿，蛇嘴下部的底部设有圆形倾斜轨道；蛇嘴上部与蛇嘴下部都装有刀片；光杆与蛇嘴上部固连，蛇嘴下部设有光杆孔，光杆通过光杆孔竖直穿过蛇嘴下部，光杆的底部装有节环，光杆的中部套有弹簧，蛇嘴下部与蛇嘴上部之间通过光杆进行相对移动；蛇颈位于上圆形帽的下方。
2.根据权利要求1所述的仿生蛇嘴采摘机构，其特征在于：所述蛇颈包括下圆形帽和尼龙网，下圆形帽的内部设有圆形倾斜轨道，下圆形帽的圆形倾斜轨道与蛇嘴下部的圆形倾斜轨道相连通；下圆形帽的外部套接有尼龙网；尼龙网的底部设置有铁圈。
3.根据权利要求1所述的仿生蛇嘴采摘机构，其特征在于：所述刀片分别安装在蛇嘴上沿的底部边缘和蛇嘴下沿的上部边缘，刀片的安装呈上下对称。
4.根据权利要求3所述的仿生蛇嘴采摘机构，其特征在于：蛇嘴上沿安装有7块刀片，包括前方安装有一块刀片、左方安装有两块刀片、右方安装有两块刀片、前方刀片和左方刀片之间有一块过渡刀片、前方刀片和右方刀片之间有一块过渡刀片；蛇嘴下沿在相对应的位置也安装有7块刀片。
5.根据权利要求1所述的仿生蛇嘴采摘机构，其特征在于：蛇颈通过齿轮齿条与蛇嘴上部相连接。
6.根据权利要求1所述的仿生蛇嘴采摘机构，其特征在于：蛇嘴上沿的外侧呈圆斜坡状，角度范围为15～30°；蛇嘴下沿的外侧也呈圆斜坡状，角度范围为10～15°。
7.根据权利要求1所述的仿生蛇嘴采摘机构，其特征在于：光杆孔的周围布置有环形铁环，蛇嘴上部对应环形铁环所在的竖直方向上设置有电磁铁，通过电磁铁的通电和断电，实现环形铁环的吸附与释放，从而带动蛇嘴下部的上下移动；旋转电机安装在齿轮齿条的上方，当旋转电机通电时，使齿轮齿条运动，通过旋转电机的正反转，带动蛇颈的上下移动。
8.根据权利要求2所述的仿生蛇嘴采摘机构，其特征在于：蛇嘴下部的圆形倾斜轨道的角度范围为15～30°；下圆形帽的圆形倾斜轨道的角度范围为45～65°。
9.一种视觉定位的无人机采收装置，其特征在于：包括无人机主体，权利要求1～8中任一项所述的仿生蛇嘴采摘机构；仿生蛇嘴采摘机构通过支架安装在无人机主体上。
10.一种视觉定位的无人机采收方法，其特征在于：是采用权利要求9所述的视觉定位的无人机采收装置，包括下述步骤：
(1)双目相机标定：先进行单目标定，得到相机的内参数矩阵与畸变系数矩阵；然后进行双目标定，得到双目校正的重投影矩阵，以及相机像素距离和真实距离的转换关系；
(2)图像采集与校正：无人机通过双目相机获取果实图像，然后进行双目校正，得到校正后的果实图像；
(3)图像处理：对校正后的果实图像先进行灰度化、平滑处理，然后采用Otus法来确定分割阈值，将校正后的果实图像中的果实分割出来，得到分割后的图像，并依次对果实进行编号，计算每个果实的位置；
(4)形态学处理：通过数学形态学滤波的开运算对分割后的图像进一步处理，平滑果实轮廓、断开较窄的狭颈并消除细的突起物；
(5)轮廓检测与筛选：通过调用OpenCV函数库中的函数，辅助提取图像中所有可能是果实轮廓的信息，并进行轮廓的筛选，得到目标果实的位置；
(6)视觉跟踪：采用CamShift算法对目标果实特征标志进行跟踪，达到实时动态锁定果实，进行跟随；
(7)驱动无人机靠近：在获取目标果实位置后，返回果实O1的位置，计算仿生蛇嘴采摘机构与目标果实位置的距离，将O1投影到相机坐标系平面上得到投影O1’；计算投影O1’到相机坐标系原点O的实际物理距离
在仿生蛇嘴采摘机构靠近目标果实的时候，如果
(w为安全距离，w的取值范围30cm～40cm)，打开旋转电机，让蛇颈下移；如果
(e为采摘距离，e的取值范围为10cm～15cm)，表示可以准备摘取果实，让电磁铁失电，蛇嘴下部下移；若
无人机根据距离值
和方向
调整无人机的位置，直至
(8)距离传感器返回实时距离：距离传感器返回实时直线距离，将实时直线距离与双目相机计算的
的距离进行对比，由于距离传感器在近距离测算时，所测距离为直线距离，故其测得距离更加精确，所以当相机与距离传感器所测距离都小于e时，可以只通过距离传感器所测距离进行判断，当距离传感器返回实时直线距离为0时，表示可以进行采摘；
(9)采摘果实：通过控制电磁铁通电和断电，进而控制仿生蛇嘴采摘机构的蛇嘴上部与蛇嘴下部进行张开与闭合的动作以咬住果实，然后采用刀片对果实进行多角度采摘，咬断果枝或拧下果实；
(10)收集果实：采摘到果实后，通过旋转电机控制齿轮齿条，使得果实从圆形倾斜轨道进入蛇颈，最后从铁圈滑入收集筐中。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911085095.0A CN110754219A (zh) | 2019-11-08 | 2019-11-08 | 一种视觉定位的仿生蛇嘴采摘机构、无人机采收装置及其采收方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911085095.0A CN110754219A (zh) | 2019-11-08 | 2019-11-08 | 一种视觉定位的仿生蛇嘴采摘机构、无人机采收装置及其采收方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN110754219A true CN110754219A (zh) | 2020-02-07 |
Family
ID=69336909
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911085095.0A Withdrawn CN110754219A (zh) | 2019-11-08 | 2019-11-08 | 一种视觉定位的仿生蛇嘴采摘机构、无人机采收装置及其采收方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110754219A (zh) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111418349A (zh) * | 2020-03-19 | 2020-07-17 | 南京赫曼机器人自动化有限公司 | 一种水果采摘智能机器人及其实现水果采摘的方法 |
| CN113277101A (zh) * | 2021-03-09 | 2021-08-20 | 温州市勘察测绘研究院 | 基于智能航拍影像识别技术的无人机采集系统 |
| CN114916318A (zh) * | 2022-05-30 | 2022-08-19 | 华南农业大学 | 一种搭载在无人机上的水果自动采收装置及其控制方法 |
-
2019
- 2019-11-08 CN CN201911085095.0A patent/CN110754219A/zh not_active Withdrawn
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111418349A (zh) * | 2020-03-19 | 2020-07-17 | 南京赫曼机器人自动化有限公司 | 一种水果采摘智能机器人及其实现水果采摘的方法 |
| CN113277101A (zh) * | 2021-03-09 | 2021-08-20 | 温州市勘察测绘研究院 | 基于智能航拍影像识别技术的无人机采集系统 |
| CN113277101B (zh) * | 2021-03-09 | 2022-06-03 | 温州市勘察测绘研究院有限公司 | 基于智能航拍影像识别技术的无人机采集系统 |
| CN114916318A (zh) * | 2022-05-30 | 2022-08-19 | 华南农业大学 | 一种搭载在无人机上的水果自动采收装置及其控制方法 |
| CN114916318B (zh) * | 2022-05-30 | 2023-05-02 | 华南农业大学 | 一种搭载在无人机上的水果自动采收装置及其控制方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110754219A (zh) | 一种视觉定位的仿生蛇嘴采摘机构、无人机采收装置及其采收方法 | |
| CN101356877B (zh) | 一种温室环境下黄瓜采摘机器人系统及采摘方法 | |
| CN201600330U (zh) | 成熟菠萝识别与定位系统 | |
| CN211240896U (zh) | 一种视觉定位的仿生蛇嘴采摘机构和无人机采收装置 | |
| CN107479554A (zh) | 机器人系统及其户外建图导航方法 | |
| WO2023050783A1 (zh) | 除草机器人及其除草路径的规划方法、装置和介质 | |
| CN109729829B (zh) | 一种基于双目识别的智能山楂采摘机器人 | |
| CN107756414A (zh) | 草莓采摘机器人 | |
| CN107439143B (zh) | 一种温室串番茄采收机及采收方法 | |
| CN108633482A (zh) | 一种水果采摘飞行器 | |
| CN109954254B (zh) | 基于全向来福轮的羽毛球场智能捡球机器人 | |
| CN104584779A (zh) | 一种基于双目视觉的苹果成熟度自动检测及采摘机器人 | |
| CN109220227A (zh) | 一种名优茶采摘机器人 | |
| CN111587665B (zh) | 一种四自由度的多目视觉旋飞式采摘机器人及其采摘方法 | |
| CN216058333U (zh) | 一种智能移动水果采摘机器人 | |
| CN112715162A (zh) | 一种智能化采摘串型水果的系统 | |
| CN108470165B (zh) | 一种采摘机器人果实视觉协同搜索方法 | |
| CN107745756A (zh) | 六足草莓采摘机器人的行走方法 | |
| CN110352702A (zh) | 一种菠萝采收机器人系统及实现方法 | |
| Almendral et al. | Autonomous fruit harvester with machine vision | |
| CN115553132A (zh) | 一种基于视觉算法的荔枝识别方法和仿生荔枝采摘机器人 | |
| CN115560754A (zh) | 一种基于杂草去除的视觉导航方法 | |
| CN209787899U (zh) | 一种园林式水果采摘机器人 | |
| Du et al. | A low-cost robot with autonomous recharge and navigation for weed control in fields with narrow row spacing | |
| Chatzimichali et al. | Design of an advanced prototype robot for white asparagus harvesting |
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 | ||
| WW01 | Invention patent application withdrawn after publication |
Application publication date: 20200207 |
|
| WW01 | Invention patent application withdrawn after publication |