CN107340770A - 一种割草机转向方法 - Google Patents
一种割草机转向方法 Download PDFInfo
- Publication number
- CN107340770A CN107340770A CN201710450870.2A CN201710450870A CN107340770A CN 107340770 A CN107340770 A CN 107340770A CN 201710450870 A CN201710450870 A CN 201710450870A CN 107340770 A CN107340770 A CN 107340770A
- Authority
- CN
- China
- Prior art keywords
- hay mover
- driving wheel
- rotation center
- hand rotation
- gravity
- 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
- 238000000034 method Methods 0.000 title claims abstract description 21
- 230000005484 gravity Effects 0.000 claims abstract description 44
- 230000005012 migration Effects 0.000 claims abstract description 41
- 238000013508 migration Methods 0.000 claims abstract description 41
- 230000005611 electricity Effects 0.000 claims description 12
- 238000001514 detection method Methods 0.000 claims description 3
- 230000003252 repetitive effect Effects 0.000 abstract description 4
- 230000004888 barrier function Effects 0.000 abstract 1
- 241001269238 Data Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 238000005516 engineering process Methods 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, 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
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)
- Guiding Agricultural Machines (AREA)
- Harvester Elements (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明为一种割草机转向方法,主要为割草机到达边界或碰撞障碍物后,割草机启动左转重心向右偏移算法或右转重心向左偏移算法;本割草机转向方法不仅可以保证割草机在边界或碰障碍物转向有规律,而且,还可以保证割草的路径有规律,降低整体的割草重复率。
Description
技术领域
本发明涉及割草机领域,尤其是一种割草机转向方法。
背景技术
目前,割草机在国内使用的越来越多,但是,目前市场上的割草机在使用过程中存在割草机到达边界后转向比较随意,不能始终如一,这样会导致割草的路径很杂乱无章,没有顺序性,增大了割草的重复率。
发明内容
为了解决上述问题,本发明的目的是提供一种割草机转向方法,本割草机转向方法不仅可以保证割草机在边界或碰撞障碍物转向有规律,而且,还可以保证割草的路径有规律,降低整体的割草重复率。
本发明的技术方案如下:
一种割草机转向方法,包括以下步骤:
S1:启动割草机;
S2:割草机获取并记录当前位置数据信息、整个割草区域边界位置数据信息和充电站的位置数据信息;
S3:割草机直行并割草,直到到达边界或碰撞障碍物;
S4:割草机到达边界或碰撞障碍物后,以割草机的机头方向作为参考方向,并记录割草机的机头方向的位置数据信息,同时,还记录割草机到达边界与碰撞障碍物的次数N,N为大于等于1的正整数;
S5:割草机根据步骤S4记录的机头方向的位置数据信息和步骤S2记录的边界位置数据信息,割草机启动左转重心向右偏移算法或右转重心向左偏移算法,如果启动右转重心向左偏移算法,则记录N为奇数,如果启动左转重心向右偏移算法,则记录N为偶数;
S6:割草机直行并割草,割草机再次达边界或碰撞障碍物时,如果此时N为奇数,则启动右转重心向左偏移算法,如果此时N为偶数,则启动左转重心向右偏移算法,如此循环,直到整个割草区域被割草完成。
优先的,所述步骤S5中,如果割草机开始时处于割草区域的边缘地带,若割草机相对于割草机机头方向,只有左边有割草区域,则割草机启动右转重心向左偏移算法,若割草机相对于割草机机头方向,只有右边有割草区域,则割草机启动左转重心向右偏移算法;如果割草机开始时处于割草区域的非边缘地带,即相对于割草机机头方向,左、右两边都有割草区域,则割草机随机启动右转重心向左偏移算法或左转重心向右偏移算法。
优先的,所述右转重心向左偏移算法包括以下步骤:
S7:割草机机头到达边界或碰撞障碍物后,割草机的左驱动轮前进,割草机的右驱动轮后退,且左驱动轮的速度小于右驱动轮的速度;
S8:割草机在左驱动轮和右驱动轮的作用下向右转动,当割草机的机头相对步骤S7完成反向且平行转向时,割草机的左驱动轮和右驱动轮停止运动。
优先的,所述左转重心向右偏移算法包括以下步骤:
S9:割草机机头到达边界或碰撞障碍物后,割草机的右驱动轮前进,割草机的左驱动轮后退,且右驱动轮的速度小于左驱动轮的速度;
S10:割草机在左驱动轮和右驱动轮的作用下向左转动,当割草机的机头相对步骤S9完成反向且平行转向时,割草机的左驱动轮和右驱动轮停止运动。
优先的,在所述步骤S1至步骤S10任一步骤,割草机都会自动检测所剩电量,如果割草机电量所剩不多,则割草机会停止割草,并记录下割草机当前位置数据信息和割草机的机头方向的位置数据信息,然后,割草机根据步骤S2记录的充电站的位置数据信息,直接去最近的充电站进行充电;充电完成后,割草机再返回至电量所剩不多时记录的位置,并调整割草机的机头方向和电量所剩不多时记录的一致,然后,割草机启动割草。
采用以上技术方案的有益效果如下:
1.相比现有的割草机转向方法,本割草机转向方法不仅保证割草机在边界或碰撞障碍物转向有规律,而且,还可以保证割草的路径有规律,降低整体的割草重复率。
2.本割草机转向方法设立了左转重心向右偏移算法和右转重心向左偏移算法,这两种算法保证了割草机在边界时可以完成向左或向右的转向,而且,转向完成后割草机能够沿与转弯前的路线相平行的路线割草,保证了割草的规律性。
附图说明
图1为本发明割草机转向方法的流程图。
图2为本发明割草机转向方法割草机在边界使用右转重心向左偏移算法转向的示意图。
图3为本发明割草机转向方法割草机在边界使用左转重心向右偏移算法转向的示意图。
具体实施方式
为了便于本领域技术人员理解,下面将结合附图以及实施例对本发明进行进一步详细描述。
实施例一
如附图所示,割草机转向方法,包括以下步骤:
S1:启动割草机;
S2:割草机获取并记录当前位置数据信息、整个割草区域边界位置数据信息和充电站的位置数据信息;
S3:割草机直行并割草,直到到达边界或碰撞障碍物;
S4:割草机到达边界或碰撞障碍物后,以割草机的机头方向作为参考方向,并记录割草机的机头方向的位置数据信息,同时,还记录割草机到达边界的次数N,N为大于等于1的正整数,本实施例N从1开始计算;
S5:割草机根据步骤S4记录的机头方向的位置数据信息和步骤S2记录的边界位置数据信息,割草机启动左转重心向右偏移算法或右转重心向左偏移算法,如果割草机开始时处于割草区域的边缘地带,若割草机相对于割草机机头方向,只有左边有割草区域,则割草机启动右转重心向左偏移算法,若割草机相对于割草机机头方向,只有右边有割草区域,则割草机启动左转重心向右偏移算法;如果割草机开始时处于割草区域的非边缘地带,即相对于割草机机头方向,左、右两边都有割草区域,则割草机随机启动左转重心向右偏移算法或右转重心向左偏移算法;如果启动右转重心向左偏移算法,则记录N为奇数,如果启动左转重心向右偏移算法,则记录N为偶数;本实施例割草机开始时处于割草区域的边缘地带,且割草机相对于割草机机头方向,只有左边有割草区域。
S6:割草机直行并割草,割草机达边界或碰撞障碍物时,如果此时N为奇数,则启动右转重心向左偏移算法,如果此时N为偶数,则左转重心向右偏移算法,如此循环,直到整个割草区域被割草完成。
具体的,右转重心向左偏移算法包括以下步骤:
S7:割草机机头到达边界或碰撞障碍物后,割草机的左驱动轮前进,割草机的右驱动轮后退,且左驱动轮的速度小于右驱动轮的速度;
S8:割草机在左驱动轮和右驱动轮的作用下向右转动,当割草机的机头相对步骤S7完成反向且平行转向时,割草机的左驱动轮和右驱动轮停止运动。
具体的,在步骤S1至步骤S8任一步骤,割草机都会自动检测所剩电量,如果割草机电量所剩不多,则割草机会停止割草,并记录下割草机当前位置数据信息和割草机的机头方向的位置数据信息,然后,割草机根据步骤S2记录的充电站的位置数据信息,直接去最近的充电站进行充电;充电完成后,割草机再返回至电量所剩不多时记录的位置,并调整割草机的机头方向和电量所剩不多时记录的一致,然后,割草机启动割草。
实施例二
本实施例二中的割草机转向方法在步骤S5中,割草机开始时处于割草区域的边缘地带,且割草机相对于割草机机头方向,只有右边有割草区域,左转重心向右偏移算法包括以下步骤:
S9:割草机机头到达边界或碰撞障碍物后,割草机的右驱动轮前进,割草机的左驱动轮后退,且右驱动轮的速度小于左驱动轮的速度;
S10:割草机在左驱动轮和右驱动轮的作用下向左转动,当割草机的机头相对步骤S9完成反向且平行转向时,割草机的左驱动轮和右驱动轮停止运动。
其他步骤与实施例一相同。
实施例三
本实施例三中的割草机转向方法在步骤S5中,割草机开始时处于割草区域的非边缘地带,相对于割草机机头方向,左、右两边都有割草区域,本实施例三割草机启动右转重心向左偏移算法。其他步骤与实施例一相同。
以上是结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
Claims (5)
1.一种割草机转向方法,其特征在于,包括以下步骤:
S1:启动割草机;
S2:割草机获取并记录当前位置数据信息、整个割草区域边界位置数据信息和充电站的位置数据信息;
S3:割草机直行并割草,直到到达边界或碰撞障碍物;
S4:割草机到达边界或碰撞障碍物后,以割草机的机头方向作为参考方向,并记录割草机的机头方向的位置数据信息,同时,还记录割草机到达边界与碰撞障碍物的次数N,N为大于等于1的正整数;
S5:割草机根据步骤S4记录的机头方向的位置数据信息和步骤S2记录的边界位置数据信息,割草机启动左转重心向右偏移算法或右转重心向左偏移算法,如果启动右转重心向左偏移算法,则记录N为奇数,如果启动左转重心向右偏移算法,则记录N为偶数;
S6:割草机直行并割草,割草机再次达边界或碰撞障碍物时,如果此时N为奇数,则启动右转重心向左偏移算法,如果此时N为偶数,则启动左转重心向右偏移算法,如此循环,直到整个割草区域被割草完成。
2.根据权利要求1所述的割草机转向方法,其特征在于,所述步骤S5中,如果割草机开始时处于割草区域的边缘地带,若割草机相对于割草机机头方向,只有左边有割草区域,则割草机启动右转重心向左偏移算法,若割草机相对于割草机机头方向,只有右边有割草区域,则割草机启动左转重心向右偏移算法;如果割草机开始时处于割草区域的非边缘地带,即相对于割草机机头方向,左、右两边都有割草区域,则割草机随机启动左转重心向右偏移算法或右转重心向左偏移算法。
3.根据权利要求2所述的割草机转向方法,其特征在于,所述右转重心向左偏移算法包括以下步骤:
S7:割草机机头到达边界后,割草机先停止,若碰撞障碍物,割草机先停止再直行后退,再停止;然后左驱动轮前进,割草机的右驱动轮后退,且左驱动轮的速度小于右驱动轮的速度;
S8:割草机在左驱动轮和右驱动轮的作用下向右转动,当割草机的机头相对步骤S7完成方向相反且平行转向时,割草机的左驱动轮和右驱动轮停止运动。
4.根据权利要求2所述的割草机左转重心向右偏移,其特征在于,所述左转重心向右偏移算法包括以下步骤:
S9:割草机机头到达边界后,割草机先停止,若碰撞障碍物,割草机先停止再直行后退,再停止;割草机的右驱动轮前进,割草机的左驱动轮后退,且右驱动轮的速度小于左驱动轮的速度;
S10:割草机在左驱动轮和右驱动轮的作用下向左转动,当割草机的机头相对步骤S9完成方向相反且平行转向时,割草机的左驱动轮和右驱动轮停止运动。
5.根据权利要求1-4任一项所述的割草机转向方法,其特征在于,在所述步骤S1至步骤S10任一步骤,割草机都会自动检测所剩电量,如果割草机电量所剩不多,则割草机会停止割草,并记录下割草机当前位置数据信息和割草机的机头方向的位置数据信息,然后,割草机根据步骤S2记录的充电站的位置数据信息,直接去最近的充电站进行充电;充电完成后,割草机再返回至电量所剩不多时记录的位置,并调整割草机的机头方向和电量所剩不多时记录的一致,然后,割草机启动割草。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710450870.2A CN107340770B (zh) | 2017-06-15 | 2017-06-15 | 一种割草机转向方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710450870.2A CN107340770B (zh) | 2017-06-15 | 2017-06-15 | 一种割草机转向方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107340770A true CN107340770A (zh) | 2017-11-10 |
CN107340770B CN107340770B (zh) | 2020-09-15 |
Family
ID=60220621
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710450870.2A Active CN107340770B (zh) | 2017-06-15 | 2017-06-15 | 一种割草机转向方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107340770B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109588100A (zh) * | 2018-10-31 | 2019-04-09 | 浙江亚特电器有限公司 | 用于智能割草机的原路径返回方法 |
CN109871012A (zh) * | 2019-01-29 | 2019-06-11 | 宁波大叶园林设备股份有限公司 | 一种智能割草机在边界处的转向方法 |
CN110393168A (zh) * | 2019-08-26 | 2019-11-01 | 重庆工业职业技术学院 | 用于水产养殖的可自动巡航的水车式增氧机及其巡航方法 |
CN112293038A (zh) * | 2020-09-28 | 2021-02-02 | 深圳拓邦股份有限公司 | 一种防止定点割草磨损草地的方法及自动割草机 |
CN113064408A (zh) * | 2019-12-13 | 2021-07-02 | 苏州宝时得电动工具有限公司 | 自主机器人及其控制方法、计算机存储介质 |
Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4515221A (en) * | 1978-01-19 | 1985-05-07 | Lely Cornelis V D | Tractor having guidance system |
JPH0787809A (ja) * | 1993-09-24 | 1995-04-04 | Yanmar Agricult Equip Co Ltd | 移動農機の操向制御装置 |
US20090118904A1 (en) * | 2006-02-27 | 2009-05-07 | Denis Allan Birnie | Method and system for planning the path of an agricultural vehicle |
JP2011254704A (ja) * | 2010-06-04 | 2011-12-22 | Chugoku Electric Power Co Inc:The | 自動耕作方法、及び自動耕作システム |
CN102662400A (zh) * | 2012-05-10 | 2012-09-12 | 慈溪思达电子科技有限公司 | 割草机器人的路径规划算法 |
CN102759924A (zh) * | 2011-04-28 | 2012-10-31 | 苏州宝时得电动工具有限公司 | 自动工作***、自动行走设备及其转向方法 |
CN102771246A (zh) * | 2012-07-05 | 2012-11-14 | 芜湖鸿宇智能科技有限公司 | 一种智能割草机***及其智能割草方法 |
US20130276314A1 (en) * | 2012-04-18 | 2013-10-24 | Makita Corporation | Work apparatus |
EP2626760B1 (en) * | 2012-02-10 | 2014-12-17 | Honda Motor Co., Ltd. | Control apparatus of unmanned autonomous operating vehicle |
WO2015119263A1 (ja) * | 2014-02-06 | 2015-08-13 | ヤンマー株式会社 | 自律走行作業車両の走行経路の設定方法 |
EP2959351A1 (en) * | 2013-02-21 | 2015-12-30 | Husqvarna AB | Improved robotic working tool |
JP2016195545A (ja) * | 2013-09-27 | 2016-11-24 | 日立工機株式会社 | 自走式草刈機 |
CN106171248A (zh) * | 2012-08-31 | 2016-12-07 | 苏州宝时得电动工具有限公司 | 智能割草机及其控制方法 |
EP3126921A1 (en) * | 2014-03-31 | 2017-02-08 | iRobot Corporation | Autonomous mobile robot |
CN106818062A (zh) * | 2016-12-25 | 2017-06-13 | 惠州市蓝微电子有限公司 | 一种割草机区域划定方法 |
-
2017
- 2017-06-15 CN CN201710450870.2A patent/CN107340770B/zh active Active
Patent Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4515221A (en) * | 1978-01-19 | 1985-05-07 | Lely Cornelis V D | Tractor having guidance system |
JPH0787809A (ja) * | 1993-09-24 | 1995-04-04 | Yanmar Agricult Equip Co Ltd | 移動農機の操向制御装置 |
US20090118904A1 (en) * | 2006-02-27 | 2009-05-07 | Denis Allan Birnie | Method and system for planning the path of an agricultural vehicle |
JP2011254704A (ja) * | 2010-06-04 | 2011-12-22 | Chugoku Electric Power Co Inc:The | 自動耕作方法、及び自動耕作システム |
CN102759924A (zh) * | 2011-04-28 | 2012-10-31 | 苏州宝时得电动工具有限公司 | 自动工作***、自动行走设备及其转向方法 |
EP2626760B1 (en) * | 2012-02-10 | 2014-12-17 | Honda Motor Co., Ltd. | Control apparatus of unmanned autonomous operating vehicle |
US20130276314A1 (en) * | 2012-04-18 | 2013-10-24 | Makita Corporation | Work apparatus |
CN102662400A (zh) * | 2012-05-10 | 2012-09-12 | 慈溪思达电子科技有限公司 | 割草机器人的路径规划算法 |
CN102771246A (zh) * | 2012-07-05 | 2012-11-14 | 芜湖鸿宇智能科技有限公司 | 一种智能割草机***及其智能割草方法 |
CN106171248A (zh) * | 2012-08-31 | 2016-12-07 | 苏州宝时得电动工具有限公司 | 智能割草机及其控制方法 |
EP2959351A1 (en) * | 2013-02-21 | 2015-12-30 | Husqvarna AB | Improved robotic working tool |
JP2016195545A (ja) * | 2013-09-27 | 2016-11-24 | 日立工機株式会社 | 自走式草刈機 |
WO2015119263A1 (ja) * | 2014-02-06 | 2015-08-13 | ヤンマー株式会社 | 自律走行作業車両の走行経路の設定方法 |
EP3126921A1 (en) * | 2014-03-31 | 2017-02-08 | iRobot Corporation | Autonomous mobile robot |
CN106818062A (zh) * | 2016-12-25 | 2017-06-13 | 惠州市蓝微电子有限公司 | 一种割草机区域划定方法 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109588100A (zh) * | 2018-10-31 | 2019-04-09 | 浙江亚特电器有限公司 | 用于智能割草机的原路径返回方法 |
CN109871012A (zh) * | 2019-01-29 | 2019-06-11 | 宁波大叶园林设备股份有限公司 | 一种智能割草机在边界处的转向方法 |
CN110393168A (zh) * | 2019-08-26 | 2019-11-01 | 重庆工业职业技术学院 | 用于水产养殖的可自动巡航的水车式增氧机及其巡航方法 |
CN113064408A (zh) * | 2019-12-13 | 2021-07-02 | 苏州宝时得电动工具有限公司 | 自主机器人及其控制方法、计算机存储介质 |
CN113064408B (zh) * | 2019-12-13 | 2023-03-10 | 苏州宝时得电动工具有限公司 | 自主机器人及其控制方法、计算机存储介质 |
CN112293038A (zh) * | 2020-09-28 | 2021-02-02 | 深圳拓邦股份有限公司 | 一种防止定点割草磨损草地的方法及自动割草机 |
CN112293038B (zh) * | 2020-09-28 | 2021-09-10 | 深圳拓邦股份有限公司 | 一种防止定点割草磨损草地的方法及自动割草机 |
Also Published As
Publication number | Publication date |
---|---|
CN107340770B (zh) | 2020-09-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107340770A (zh) | 一种割草机转向方法 | |
CN107247457A (zh) | 一种割草机割草重复率算法 | |
EP3571912A1 (en) | Method and system for planning a turn path of a vehicle | |
US9179596B2 (en) | End of cut speed control system | |
CN106416587A (zh) | 割草机的定位误差消除方法、装置及*** | |
CN113064408B (zh) | 自主机器人及其控制方法、计算机存储介质 | |
US10155632B2 (en) | Removing sod from a stacking conveyor | |
CN114600622A (zh) | 行进路径规划方法、控制装置、割草机、自移动*** | |
CN107966983A (zh) | 一种割草机路径规划算法 | |
CN108628316A (zh) | 建立吸尘机器人栅格地图的方法 | |
CN106982585B (zh) | 履带式割草机及其转向方法 | |
EP4083737A1 (en) | Traversal method and system, robot, and readable storage medium | |
WO2021175331A1 (zh) | 自移动园艺机器人及其工作方法 | |
CN205232803U (zh) | 割草机 | |
CA3167396C (en) | Dynamically calculating a stacking head's path during a stacking operation | |
CN112840828A (zh) | 自动割草机 | |
CN211531846U (zh) | 智能割草机 | |
US20240122100A1 (en) | Transversal Method and System, Robot and Readable Storage Medium | |
CN114545948A (zh) | 一种割草机器人控制方法、芯片及割草机器人 | |
CN105680738A (zh) | 一种永磁同步磁阻电机的电流控制方法及*** | |
CN103891465A (zh) | 拢草装置及割草机 | |
WO2021103804A1 (zh) | 自动割草机 | |
US20130160413A1 (en) | Reel gang mower having different width front and rear cutting units | |
CN111190209A (zh) | 一种割草机平行切割的方法、装置及割草机 | |
CN205489586U (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 |