CN103542800A - 用于机器人割草机的边界传感器组件、机器人割草机和机器人割草机系统 - Google Patents

用于机器人割草机的边界传感器组件、机器人割草机和机器人割草机系统 Download PDF

Info

Publication number
CN103542800A
CN103542800A CN201310283815.0A CN201310283815A CN103542800A CN 103542800 A CN103542800 A CN 103542800A CN 201310283815 A CN201310283815 A CN 201310283815A CN 103542800 A CN103542800 A CN 103542800A
Authority
CN
China
Prior art keywords
axis
mower
axle
border
induction pick
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
Application number
CN201310283815.0A
Other languages
English (en)
Other versions
CN103542800B (zh
Inventor
大卫·A·约翰逊
帕特里克·W·科洛斯
达斯·E·科林
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Deere and Co
Original Assignee
Deere and Co
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Deere and Co filed Critical Deere and Co
Publication of CN103542800A publication Critical patent/CN103542800A/zh
Application granted granted Critical
Publication of CN103542800B publication Critical patent/CN103542800B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • A01D34/00—Mowers; Mowing apparatus of harvesters
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/0003—Home robots, i.e. small robots for domestic use
    • 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/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • G05D1/0265—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using buried wires
    • A—HUMAN NECESSITIES
    • A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
    • A47L2201/04—Automatic control of the travelling movement; Automatic obstacle detection

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Environmental Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Remote Sensing (AREA)
  • Electromagnetism (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Guiding Agricultural Machines (AREA)

Abstract

本发明公开一种用于检测边界导线的信号的传感器组件。传感器组件包括多个模拟感应传感器，具有沿着第一轴线定向的第一感应传感器，和沿着不同的第二轴线定向的第二感应传感器。每个感应传感器被配置为产生表示机器人割草机离边界导线的距离的信号。与传感器组件通信的控制单元被配置为响应于来自传感器组件的、表示机器人割草机离边界导线的距离的信号操作机器人割草机。

Description

用于机器人割草机的边界传感器组件、机器人割草机和机器人割草机系统
技术领域
本发明涉及机器人割草机，更具体地，涉及用于机器人割草机的边界传感器组件、具有边界传感器的机器人割草机、以及包括边界导线和具有边界传感器的机器人割草机的机器人割草机系统。
背景技术
机器人割草机可以包括具有传感器组件的边界传感系统，以使割草机能够检测标记要被割草的区域的边界的边界导线信号。边界传感系统可以检测机器人割草机已经达到边界导线的时间。当机器人割草机到达边界导线时，车辆控制单元可以，例如，提示割草机的驱动系统停止并转弯。需要一种能够考虑如下情况的可靠的边界传感系统：修剪表面的导致机器人割草机摇摆或倾斜的斜坡，或者机器人割草机在倾斜角度处接近边界导线时的偏航。
发明内容
为了解决这个需要，在本文中公开用于检测边界导线的信号的边界传感器组件。传感器组件包括至少两个感应传感器，具有沿着第一轴线定向的第一感应传感器，和沿着不同的第二轴线定向的第二感应传感器。
因而，在本发明的一个方面，用于检测边界导线的信号的传感器组件包括多个感应传感器，所述多个感应传感器包括至少第一感应传感器和第二感应传感器，第一感应传感器沿着第一轴线定向，第二感应传感器沿着第二轴线定向，第一轴线和第二轴线相对于彼此以非零角度布置。
在本发明的另一个方面，所述多个感应传感器中的每个感应传感器是被配置为产生表示传感器组件离所述边界导线的距离的信号的模拟传感器。
在本发明的又一个方面，第一轴线至少具有垂直分量，并且第二轴线至少具有水平分量。
在本发明的又一个方面，第一轴线和第二轴线相互垂直。
在本发明的还另一个方面，所述多个感应传感器包括沿着第三轴线定向的第三传感器，第三轴线与第一轴线和第二轴线两者形成非零角度。
在本发明的另一个方面，第一轴线、第二轴线和第三轴线中的不超过两个轴线共面。
在本发明的还又一个方面，第一轴线、第二轴线和第三轴线全部大致彼此垂直。
在本发明的又一个方面，所述多个感应传感器还包括沿着第四轴线定向的第四传感器，第四轴线与第一轴线、第二轴线和第三轴线中的每一个形成非零角度。
在本发明的再一个方面，其中第一轴线、第二轴线、第三轴线和第四轴线中的不超过三个轴线共面。
在本发明的进一步方面，第一轴线、第二轴线、第三轴线和第四轴线中的不超过二个轴线共面。
在本发明的还另一个方面，如通过笛卡尔坐标系中的单位向量[1，0，0]、[0，1，0]和[0，0，1]表示的第一轴线、第二轴线和第三轴线全部彼此垂直，并且如通过向量[1，1，1]表示的第四轴线对角地延伸。
在本发明的又一个方面，所述多个感应传感器中的每个感应传感器包括拾波线圈。
在本发明的另一个方面，本发明包括一种用于相对于边界导线对一区域进行割草的机器人割草机，所述机器人割草机包括：切割系统，包括用于割草的元件；推进系统，包括用于推动机器人割草机的马达；传感器组件，被配置为检测离所述边界导线的距离，传感器组件具有多个感应传感器，所述多个感应传感器至少包括第一感应传感器和第二感应传感器，第一感应传感器沿着第一轴线定向，第二感应传感器沿着第二轴线定向，第一轴线和第二轴线相对于彼此以非零角度布置；和与切割系统、推进系统和传感器组件通信的控制单元，其中控制单元被配置为响应于从传感器组件接收到的表示机器人割草机离所述边界导线的距离的信号，操作切割系统和推进系统。
在本发明的另一个方面，第一轴线至少具有垂直分量，并且第二轴线至少具有水平分量，并且第一轴线和第二轴线相互垂直。
在本发明的又一个方面，所述多个感应传感器包括沿着第三轴线定向的第三传感器，第三轴线与第一轴线和第二轴线两者形成非零角度。
在本发明的又一个方面，第一轴线、第二轴线和第三轴线中的不超过两个轴线共面，并且第一轴线、第二轴线和第三轴线全部大致彼此垂直。
在又一个方面，本发明包括一种机器人割草机系统，包括：边界导线；边界导线驱动电路，被配置为在边界导线上传输信号；切割系统，包括用于割草的元件；推进系统，包括用于推动机器人割草机的马达；传感器组件，被配置为检测边界导线上的信号，传感器组件具有多个感应传感器，所述多个感应传感器至少包括第一感应传感器和第二感应传感器，第一感应传感器沿着第一轴线定向，第二感应传感器沿着第二轴线定向，第一轴线和第二轴线相对于彼此以非零角度布置；和与切割系统、推进系统和传感器组件通信的控制单元，其中控制单元被配置为响应于从传感器组件接收到信号，确定机器人割草机离边界导线的距离，并且基于所确定的距离操作切割系统和推进系统。
在本发明的又一个方面，第一轴线至少具有垂直分量，并且第二轴线至少具有水平分量，并且第一轴线和第二轴线相互垂直。
在本发明的又一个方面，所述多个感应传感器包括沿着第三轴线定向的第三传感器，第三轴线与第一轴线和第二轴线两者形成非零角度。
在本发明的又一个方面，第一轴线、第二轴线和第三轴线中的不超过两个轴线共面，并且第一轴线、第二轴线和第三轴线全部大致彼此垂直。
在回顾接下来参照附在后面并构成本说明书的一部分的附图和权利要求的描述之后，本发明的其它目的、特征和优点对本技术领域的技术人员来说将变得明显。
附图说明
图1是机器人割草机系统的示意图，包括根据本发明的优选实施例的主边界导线内的机器人割草机。
图2是边界传感系统的示意图，具有用于根据本发明的一个方面的机器人割草机的边界传感器组件。
图3是示出表示根据图1的边界传感系统的拾波线圈信号曲线的示意图。
图4是图2的边界传感系统的示意图，具有在相对于边界导线的不同高度处的边界传感器组件。
图5是具有根据本发明的另一个方面的边界传感器组件的边界传感系统的示意图。
图6是具有包括图2和5的边界传感器的两者的边界传感器组件的边界传感系统的示意图。
图7是具有图6的边界传感系统的机器人割草机的示意图。
图8是具有根据本发明的另一优选实施例的边界传感器组件的边界传感系统的示意图。
图9是表示根据图8的边界传感系统的拾波线圈信号的曲线图的示意图。
图10是根据本发明的另一个方面的具有根据图8的边界传感系统的机器人割草机的示意性框图。
图11是配备有根据图8的边界传感系统的机器人割草机的根据实验绘制的自动航路校正的视图。
图12是具有根据本发明的另一优选实施例的边界传感器组件的边界传感系统的示意图。
图13是根据本发明的又一个方面的用于配备有至少在两个水平方向上对边界导线的磁场敏感的边界传感器组件的割草机的车辆控制单元(VCU)的一部分的示意性框图。
图14是图13的VCU的细节的方框图，图示导航控制器。
图15是图14的导航控制器的细节的方框图，涉及将测量的传感器信号转换成相对于边界导线和相对于要修剪的指定区域的距离和方向。
图16是在线边界坐标中偏航角范围的图示。
图17是图14的进一步细节的方框图，涉及基于两种传播模式中的所选择的一个产生目标值。
图18是根据导航规则的一个示例的割草图案的鸟瞰视图。
具体实施方式
在本发明的一个优选的实施例中，如图1所示，机器人割草机100由在充电站105周期性充电的电池组109供电。车辆控制单元101控制机器人割草机的全部电子功能。例如，车辆控制单元101可以指挥一个或多个牵引马达110和111以驱动牵引轮、刀片马达112以转动切割刀片或多个刀片、电池组109、用户界面模块107和各种传感器。
车辆控制单元(VCU)101可以是作为用于机器人割草机100的主控板的印刷电路板组件。车辆控制单元101可以解释和处理来自各种传感器的信息，并使用该信息来控制和操作一对牵引马达110和111，以在庭院上驱动机械人割草机100来维护草坪，并且驱动刀片马达112。传感器本身包括一个或多个边界传感器组件119，并且还可以包括一个或多个障碍物传感器或加速度计。车辆控制单元101可以与电池组通信，以监测电池组109的状态，并且保持电池组109中的一个或多个电池(例如锂离子电池)的充电。车辆控制单元101也可以连接到用户界面模块107，所述用户界面模块107可以包括液晶显示器(LCD)以及一些指示器灯和用于操作员输入的按钮。车辆控制单元101可以包括微控制器和使用数据总线连接到微控制器的外部静态随机存取存储器(SRAM)。
车辆控制单元101可以连接和控制刀片马达控制器，刀片马达控制器控制驱动机器人割草机100的切割刀片的刀片马达112。车辆控制单元101可以具有用于接收来自霍尔效应转子位置传感器的输入，以使用来自霍尔效应传感器的反馈信号检测刀片马达112的速度，并且可以检测通过刀片马达112的相位的电流。
为了移动机器人割草机100，车辆控制单元101优选地连接到用于左和右牵引马达110和111的牵引马达控制器。车辆控制单元101可以具有用于接收来自包含在牵引马达110和111中的霍尔效应转子位置传感器的信号的输入，并且以这种方式，车辆控制单元101可以使用来自霍尔效应传感器的反馈检测每个牵引马达110和111的速度，并且可以检测通过牵引马达的相位的电流。
仍参考图1，机器人割草机100在指定区域102中操作，指定区域102由形成定位在地面或草皮表面处或低于地面或草皮表面的环的主或外边界导线103围绕而成。此外，内线104可以是设置在充电站105定位在其中的主边界导线的区域内的较短的环。主边界导线103和内线104可以被连接到充电站105。
在一个实施例中，边界驱动电路106可以被包含在充电站105中，并且可以驱动信号通过主边界导线103和内线104。在主边界导线上的波形的基频优选为约2kHz，并且机器人割草机100具有至少一个边界导线传感器组件119，所述至少一个边界导线传感器组件119检测波形并且提供信号到车辆控制单元101，以指示传感器组件119到主边界导线103的距离。
图1还示出了所选择的用于说明固定和非固定笛卡尔坐标系的命名法。在随后的附图的描述中，大写字母名称X，Y和Z表示根据固定边界导线103的随后将被机器人割草机100接近的部分的固定笛卡尔坐标系。Z指定垂直轴线，该垂直轴线由在中心具有x的圆圈表示，x表示进入图像平面指向的方位，因此，一般而言，沿图1的自上而下的图示中的重力方向。Y表示沿边界导线103的水平方向。如果直流电流流过边界导线103，则Y对应于电流I的方向。交流电流以正弦振荡变换其方向，并且从而周期性地改变其相对于Y坐标的方向。X指定垂直于边界导线103的水平轴线，并且如果Y坐标围绕指定区域102顺时针方向定向，大致从要被割草的指定区域102向外指向。相反地，如果Y坐标逆时针定向，根据用于正笛卡尔坐标系统的右手定则，水平轴线X指向指定区域102。
以类似方式，选择小写字母名称x，y和z用于相对于给定边界传感器组件119的坐标。当机械人割草机100在水平表面上以直角接近边界导线103时，坐标x，y和z指向与坐标X，Y和Z相同的方向。坐标x指向机器人割草机100的向前运动的方向，并且限定机器人割草机100的纵向轴线。当机器人割草机100在斜坡上或相对于边界导线103以其中机器人割草机100的纵向轴线x不垂直于边界导线103的角度定位时，坐标x，y和z指向与坐标X，Y和Z不同的方向。从固定坐标X，Y和Z测量的任何角度由诸如Θ之类的大写希腊字母表示，并且从传感器组件坐标x，y和z测量的任何角度由诸如Ψ，和θ之类的小写希腊字母表示。坐标x，y和z以及X，Y和Z已被选择用于图示各种实施例的物理的几何形状，并且不是为了以限制的方式进行解释。此外，如下几何因素图示载送直流电流I的边界导线，但是在考虑到电流的振荡相位时适用于载送交流电流的边界导线。
如图2所示，边界导线103载送大致沿从绘图的底部朝向绘图的顶部的方向的直流电流I。电流I产生大致围绕边界导线103在顺时针方向上转动的转动磁场H。边界传感器组件119包括至少一个拾波线圈120，所述拾波线圈120定向成对于磁场H的垂直分量Hz特别敏感。边界传感器组件119包括多于一个的拾波线圈(下面将进一步讨论)，但为简单起见，在图2中只表示拾波线圈120。当边界传感器组件119从指定区域102内接近边界导线103时，拾波线圈120检测磁场H的垂直分量Hz的增加强度。磁场强度的幅值表示拾波线圈120到边界导线103的水平距离。
但是，磁场H的垂直分量Hz的幅值不仅依赖于到边界导线103的水平距离，而且还依赖于在拾波线圈120和边界导线103之间的垂直高度差。图3的垂直轴线表示由拾波线圈120拾取的磁场强度的垂直分量HZ，并且水平轴线表示拾波线圈120和边界导线103之间的水平距离。两个轴线都以相对的而不是绝对的单位显示。绝对测量值依赖于电流I的大小和拾波线圈120的灵敏度。
如图3所示，各种绘制图表示拾波线圈120和边界导线103之间的不同的垂直高度差ΔZ。当拾波线圈120越过边界导线103时，在全部图形中共有的是磁场强度分量Hz的符号变化。边界导线103处的磁场强度分量Hz的符号的变化因此提供了极好的过境信息。在所选择的坐标系中，磁场强度分量Hz在指定区域102内为正，在在指定区域102外为负。磁场强度分量HZ的这种符号的反向可以用作表明传感器组件119已经越过边界导线103的数字输入。
仍参考图3，当拾波线圈120接近边界导线时，磁场强度分量HZ的绝对值的幅值稳步增加，直到磁场强度分量HZ迅速减小，以改变其符号。当拾波线圈120与边界导线103在相同的相对高度时，这是最明显的。但是，磁场强度分量HZ的绝对幅值随着在拾波线圈120与边界导线103之间的高度差ΔZ增加而显著降低。在拾波线圈120的高度增加的情况下，垂直磁场强度分量HZ的幅值趋近于零，并且在穿越边界导线103时，不能可靠地表示该符号的变化，如在图中特别地图示，表示高度ΔZ＝10。
图4更详细地说明了这种现象。边界传感器组件119在边界导线103上方升高ΔZ，并且具有远离边界导线103的水平距离ΔX。如在图2中所示，在边界传感器组件119的位置中的磁场H不是完全垂直的，但具有水平分量Hx。因此，如果边界传感器组件距离边界导线103具有相同的水平距离ΔX，则垂直分量Hz较小，但是垂直距离ΔZ等于零。在更大的高度差ΔZ处，边界传感器组件119可以仅仅足够接近边界导线103，用于在非常近的水平距离ΔX处能够检测的磁场强度H，其中垂直分量Hz本身是几乎没有的或不能够被检测到。
根据图5中所示实施例，假设边界传感器组件119的坐标x与边界导线103的坐标X彼此平行，增加被定向为对于边界传感器组件119的x轴敏感的拾波线圈122可以在磁场H的水平分量HX上提供补充信息。如图5示出，分量HZ达到最大值，其中分量HZ改变符号，即，其中边界传感器组件定位在等于零的水平距离ΔX处的边界导线103的正上方。
如图6和7所示，边界传感器组件119图示，具有垂直敏感拾波线圈120和水平敏感拾波线圈122两者。如图7所示，磁场H在与水平面形成角度Θ的方向上流动。磁场H垂直于连接边界导线103和边界传感器组件119的径向线130，径向线130表示从边界导线103到传感器组件119的总距离D。因此，角度Θ还表示径向线130和垂直轴Z之间的角度，如图7所示。因此，以下等式适用：
ΔX＝ΔZ·tanΘ             (1)
因为由线性线产生的磁场强度H一般与距离D的倒数成比例，水平分量HX和垂直分量HZ之间的关系允许近似计算角度Θ：
Θ＝atan(HZ/HX)             (2)
因为根据割草机100的几何形状和边界导线103的安装知道边界导线103和边界传感器组件119之间的垂直距离ΔZ，可以基于Θ和ΔZ根据等式01)确定边界传感器组件119到边界导线103的水平距离ΔX。
到当前为止，已经讨论边界传感器组件119的坐标x和边界导线103的坐标X彼此平行时发生的传感器信号。然而，草坪割草机100可以以倾斜或偏航角Ψ接近边界导线103。偏航角Ψ限定边界传感器组件119围绕垂直轴线z的水平转动。
在图8中显示的另一个实施例中，在边界传感器组件119中包括第二水平拾波线圈124。图8以俯视图示出边界导线103和两个相同的边界传感器组件119。仅仅磁场H的地上部分由不同重量的箭头表示。在图9的顶部处显示的边界传感器组件119以等于零的偏航角Ψ相对于边界导线103定向，在该偏航角Ψ处坐标z和Z相互平行。在图9的底部处显示的边界传感器组件119以不为零的偏航角Ψ相对于边界导线103定向。在边界传感器组件从顶部处的方位向底部处的方位转动时，对垂直分量HZ敏感的拾波线圈120检测到大致恒定信号，因为拾波线圈120不改变它相对于其敏感的轴线的方位。然而，其他两个拾音线圈122和124不与固定轴线X和Y成一条直线地移动。
图9示出由大致沿着边界传感器组件119的三个笛卡儿坐标x，y和z配置的拾波线圈拾取的信号强度的视图。各个图形表示偏航角Ψ(度)和沿边界传感器组件119的坐标x，y和z的各个磁场强度分量HX、Hy和HZ(任意单位)与时间的关系。在偏航运动期间，在传感器组件的坐标系中的垂直分量Hz与边界导线坐标的垂直分量HZ一般是相同的，并且从而保持大致恒定。
但是，Hx和Hy在传感器组件坐标系中的x和y分量显示出彼此之间的正弦-余弦关系，因为它们相对于相应的边界导线坐标系的角度Ψ在偏航转动期间变化。在图9中，边界传感器组件119首先在约15秒和35秒之间的时间间隔内在一个方向上转动360°，并且然后在35秒至55秒的时间间隔内反向转动返回到原来的方向，如由偏航角Ψ的曲线图所表示。
通过在边界传感器组件119中安装两个水平的(优选垂直的)的拾波线圈122和124，可以根据勾股定理计算边界传感器组件离边界导线103的水平距离：
ΔX2＝Δx2+Δy2             (3)
等式(3)假定指定区域102在边界导线103附近是大致水平的。为了考虑可能导致传感器组件坐标x和水平XY平面之间的非零倾斜角Θ或传感器组件坐标y和水平XY平面之间的非零横摇角Φ的斜坡，基于等式(1)和(2)考虑的几何计算可以补偿斜坡，其中已知边界导线103被埋没处的深度。
可选地，在边界导线103沿已知路径安装在已知深度处的情况下，通过机械人割草机100在指定区域102上测试运行，可以在已知条件下校准用于单个拾波线圈120、122和124的信号的调整因素。
现在参考图10，用于机器人割草机100的控制系统利用一个或多个边界传感器119，用于检测由边界导线103发射的磁场H的分量Hx、Hy和Hz的幅值。表示磁场H的箭头只是象征性的，并不表示实际的磁力线。所述多个边界传感器119中的一个将表示分量Hx、Hy和Hz的幅值的信号发送到VCU101。
VCU101可以根据分量Hx、Hy和Hz的测量到的幅值确定当前坐标。例如，在等式(2)证实偏航角Ψ时，可以根据分量Hx、Hy和Hz的幅值的比率计算偏航角Ψ、横摇角Φ和倾斜角Θ。另外，分量Hx、Hy和Hz的绝对幅值允许VCU101确定距离边界导线的水平距离ΔX。
一旦已经确定这些数参量，VCU随后可以应用控制算法，用于生成到牵引马达110和111的指令以使割草机100遵循所期望的运动。所期望的运动被至少部分地预编程在VCU101中，但是还可以通过经由示于图1中的用户界面模块107进行的用户输入被改变。控制算法基于所计算出的坐标将所期望的运动转变成用于在割草机100的左侧的牵引马达110的角速度ω1，和用于在割草机100的右侧的牵引马达111的角速度ωr。角速度ω1和角速度ωr可以为正、负或零，并且取决于所期望的运动，符号和幅值可能彼此不同。VCU101将引起左牵引马达110以角速度ω1运转的信号发送到左侧牵引马达110，将引起右牵引马达111以角速度ωr运转的信号发送到右侧牵引马达111。值得注意的是，由VCU发送到牵引马达110和111的信号也可以表示转矩或与造成所期望的运动的车轮转动相关的任何其他参量。
图11图示由具有边界传感器组件的机器人割草机进行自动航向校正的一个示例，该边界传感器组件包括三个拾波线圈，例如拾波线圈120、122和124，以及类似于图10的控制系统。VCU101接收来自拾波线圈120、122和124的表示分量Hx、Hy和Hz的信号。机器人割草机具有将边界传感器组件保持在距离边界导线103恒定距离ΔX＝10米处的目标。基于来自拾波线圈120、122和124的信号，VCU101计算确定相对于边界导线103的偏航角Ψ的校正转动数。偏航角Ψ表示坐标x和坐标X之间的角度，或坐标y和坐标Y之间的同样的角度。校正动作被转变成发送到左和右牵引马达110和111的控制信号。牵引马达110和111作为刹车调整系统操作，其中两个牵引马达110和111之间的相对速度差导致偏航运动。因此，VCU指示机器人剪草机不断调整偏航角Ψ。如为离边界导线103的水平距离ΔX绘制的图形所示，由VCU101基于来自边界传感器组件119的信号进行的校正计算足够精确，用于在离目标距离相当小的偏差内引导草坪割草机100。
从前面的描述中明白的是，使用沿不同方向布置的至少两个拾波线圈120和122从边界传感器组件119获得信号导致指定区域102的边界的计算得到显著改善。另外，评价磁场的模拟幅值，而不是记录磁场H的符号的纯粹的数字变化，允许计算边界传感器组件119和边界导线103之间的水平距离。因此，机器人割草机100的VCU101可以被编程，从而在距离边界导线103的、在可检测磁场H的范围内，甚至在指定区域102外的任何距离ΔX处转弯。例如，具有边界导线103的路径的虚拟地图可以被存储在VCU中，并且操作者可以选择局部地改变机器人割草机转弯的位置离边界导线的距离。此外，因为机器人割草机100由于模拟信号及早认识到它接近边界导线103，机器人割草机100可以以较高的平均速度操作，因为机器人割草机100不依赖于磁场H的符号的突然改变。基于牵引马达110和111的转动速度，如果机器人割草机100相对于边界导线103以比由牵引马达110和111表示的速度低的速度移动，则VCU101可以检测低牵引力条件。
虽然所描述的实施例包括具有对应于正交坐标系的坐标的敏感轴线的拾波线圈布置，但拾波线圈方向的其中任意两个敏感轴线彼此之间形成非零角度的任意组合是合适的。如果存在第三拾波线圈，如果第三拾波线圈被布置为沿着与其他两个轴线的方向所限定的平面相交的轴线是敏感的，则第三拾波线圈可以占用第三维。但是第三拾波线圈也可以沿着由前两个拾波线圈的方向限定的平面布置以建立冗余。
根据一个实施例，为了检测一个拾波线圈的任何故障，在如图12中示意性示出在边界传感器组件119可以包括额外的冗余拾波线圈126。三个拾波线圈120、122和124的敏感轴线可以沿着立方体或平行六面体(也称为菱形)的边缘x，y和z延伸。在共享前三个拾波线圈120、122和124中的每一个共享分量的方向xyz上安装用于冗余的额外的第四拾波线圈126。在前三个拾波线圈120、122和124表示独立矢量时，可以从前三个拾波线圈120、122和124的信号Hx、Hy和Hz计算第四拾波线圈126的信号Hxyz。当第四拾波线圈126的测量信号与计算出的信号一致时，VCU101可以假设全部拾音线圈正常运行。如果第四拾波线圈的信号Hxyz与所计算出的信号偏差超过预定的误差范围，则VCU可以证实边界传感器组件有缺陷，并且需要维修或更换。误差数值取决于所测量的信号的整体精度，并且可以通过经验测量预先确定，并且存储在VCU101的存储器中。
图12示出相互垂直的前三个拾波线圈120、122和124的方向。这仅是方向的一个示例。形成边界传感器组件119的四个拾波线圈可以相对于彼此布置在任何方向处，其中在一个共同的平面中存在不超过两个敏感轴线。例如，全部四个敏感轴线的方向可以相对于彼此形成相同角度，如可以通过具有从四面体的中心指向四个角中的每一个的轴线的四面体的形状被直观化。
为了改善传感器信号的信噪比，在信号被送入VCU101之前，有限增益可以应用于各个拾取器线圈120、122、124和126的信号。
现在参照图13，割草机VCU101可以包括执行不同任务的逻辑模块。值得注意的是，所有的逻辑模块表示逻辑步骤，不必然是物理布置。因此，逻辑模块可以彼此共享处理和存储资源，或者包括单独的处理和存储能力。在图13的实施例中，显示四个逻辑模块，即传感器模块140、导航模块142、致动器模块144和定位模块146。
传感器模块140生成输出信息，输出信息表示测量的磁场矢量磁场矢量至少包含由边界导线103产生的磁场H的水平Y分量和水平X分量上的信息，其中为简单起见，假设在此上下文中，在彼此垂直的割草机坐标中输出X分量和Y分量。磁场H可以使用如在前面附图所介绍的传感器组件119或者使用输出表示由边界导线103产生的磁场H的水平分量的幅值和方向的模拟信号的任何其他传感器组件测量。传感器模块140还产生估计的割草机速度矢量
Figure BDA00003477387600123
的输出，估计的割草机速度矢量
Figure BDA00003477387600124
可以被表示为边界导线坐标中的估计的幅值Vest和估计的偏航角Ψest。估计上文速度矢量例如可以是基于自从估计的速度矢量的最后一次计算以后执行的动作先前地建立的数据的推断。
在从传感器模块140到导航模块142的信息路径中的时钟符号148指示实时处理，其中传感器模块140基于一个控制周期产生信息，并且该信息被馈送到导航模块142用于后续控制周期，从而建立由于因传感反馈引起的闭环控制。
导航模块142接收由传感器模块产生的数据输出，并且基于割草机100的位置和方向计算目标路径。将结合后续的图14、15和17被更详细地说明导航模块。
导航模块142产生表示目标速度矢量的输出信息，目标速度矢量可以表示为目标幅值Vdes和目标偏航角Ψdes。取决于期望的导航运动，导航模块142还可以产生关于切割刀片组件的转动速度的输出信息。例如，切割刀片组件的转动速度可以降低，而割草机与直线相比以弧线传播。
目标速度矢量
Figure BDA00003477387600133
的信息期望被传递至致动器模块144。致动器模块144还接收估计的速度矢量的信息。致动器模块比较目标速度矢量
Figure BDA00003477387600135
与估计的速度矢量
Figure BDA00003477387600136
并且将差值转化成矢量差
Figure BDA00003477387600137
矢量差
Figure BDA00003477387600138
可以表示为幅值差ΔVact和偏航角差ΔΨact。以幅值差ΔVact和偏航角差ΔΨact表示结果的好处在于，差值是一样的，与坐标系无关。因此，在边界导线坐标系中计算的差值ΔVact和ΔΨact可以在没有任何进一步转变的情况下用在基于割草机的坐标系。偏航角的差值ΔΨact直接转换成割草机100的左和右牵引马达110和111之间的转矩差值。直接将幅值差ΔVact转换成两个牵引马达的转矩平均值的变化。因此，基于所计算出的差值，致动器模块144产生到左牵引马达110和右牵引马达111的转矩指令。另外，致动器模块144提供所计算出的差值ΔVact和ΔΨact的信息到定位模块146和传感器模块140。
定位模块146处理差值ΔVact和ΔΨact以及先前存储的定位信息，并且计算割草机100的全球方位Ψglob和实际位置(X，Y)act。全球方位Ψglob和实际位置(X，Y)act指定割草机相对于指定区域102而不是边界导线103或割草机100的位置和方向。因为边界导线103绘制了一环路，边界导线103的坐标系统的绝对坐标根据边界导线的该坐标所基于的部分变化。全球方位Ψglob和实际位置(X，Y)act基于地球边界坐标，并且因此甚至在不能检测到磁场时，也能给出割草机位于哪里和在指定区域102内在哪个方向上的信息。定位模块例如可以在时间域内对速度矢量求积分以得到当前位置，和平均偏航角差值以得到当前方向。定位模块提供全球方位Ψglob和实际位置(X，Y)act信息到传感器模块140，用于进一步处理。
传感器模块140还从致动器模块144接收全球方位Ψglob和实际位置(X，Y)act信息。使用这种计算出的信息和来自物理传感器组件的测量的磁场H，传感器模块140如上所述计算估计的速度矢量
图14显示导航模块，其可以表示被指定为在图13中的块A的导航模块142。导航模块接收估计的速度矢量
Figure BDA00003477387600142
的输入信息，估计的速度矢量例如在边界导线坐标中由估计的幅值Vact和估计的偏航角Ψact表示。导航模块进一步接收测量到的磁场矢量
Figure BDA00003477387600144
的信息。速度矢量信息
Figure BDA00003477387600145
被任选地处理，以计算估计位置(X，Y)est和全球偏航比率Ψglob。代替地，类似的信息可以从以在先前周期中计算全球偏航比率Ψglob和实际位置(X，Y)act的定位模块为代表的定位模块146获得。
在方块B中，测量的磁场矢量
Figure BDA00003477387600146
的传感器信号被处理以计算割草机100和边界导线103之间的距离D，以及割草机100在边界导线坐标中的当前偏航角Ψact。将结合图15更详细地说明方块B内的过程。
以下参量然后被提供给方块C，表示导航仲裁：估计的速度矢量
Figure BDA00003477387600147
信息、估计位置(X，Y)est信息、割草机100和边界导线103之间的距离D信息、在边界导线坐标中的当前偏航角Ψact信息、和在指定区域102的绝对坐标中的全球偏航角Ψglob信息。在块C中的仲裁导航处理这些输入参量，并输出目标速度矢量
Figure BDA00003477387600148
的目标值，目标速度矢量
Figure BDA00003477387600149
例如由边界导线坐标中的目标速度幅值Vdes和目标偏航角Ψdes表示。正如上文所述，也可以提供涉及割草机刀片的目标转动速度的信息。将参照图17在下文中更详细地描述块C内的处理的进一步详情。
现在参照图15，表示由传感器组件测量的磁场矢量的信号
Figure BDA000034773876001410
可以被调整用于进一步处理(如果需要的话)。为了改善信噪比和平滑处理，可以应用在本领域中是已知的公知过滤器和转换。所得到的磁场矢量的调整信息，或不存在任何过滤器下测量的传感器信号
Figure BDA000034773876001411
然后被处理以获得在边界导线坐标系中的实际原始偏航角ΔΨact-raw。原始偏航角ΔΨact-raw表示沿割草机当前正面向的方向的单位矢量的示例。该单位矢量通过分别地归一化磁场矢量
Figure BDA000034773876001412
或
Figure BDA000034773876001413
并且将这个单位矢量变换成边界导线坐标获得的。
原始实际偏航角ΔΨact-raw可以经过包绕模(wrapping modulo)360°以由在(-180°)＜Ψact＜180°的范围内的值表示。在图16中示出适合基于边界导线的偏航角Ψ的坐标约定。在所选择的约定中，从指定的区域102向外朝向边界导线103的方向由具有负符号的偏航角Ψ表示。从边界导线103向内移动进入指定的区域102被指定具有正符号。因此，原始实际偏航角ΔΨact-raw可以被包绕(wrapped)以获得在此范围内的值。
现在参照图17，块C的导航仲裁接收估计的速度矢量
Figure BDA00003477387600151
信息、割草机的估计的绝对位置(X，Y)est信息、割草机100和边界导线103之间的距离D信息、在边界导线坐标中de当前偏航角Ψact信息/和在指定区域102的绝对坐标中的全球偏航角Ψglob信息。
导航仲裁在步骤150中作出是否进入直线模式152或弧线模式154的决定。一般地，如果自动割草机100接近线103，为了不离开指定区域102，自动割草机100优选地具有用于改变其路程的合适控制装置。边界导线103指示割草机100优选不离开的指定区域102的边界。因此，割草机100优选在割草机到达边界导线之前开始在离边界导线的指定转弯距离处转弯。在步骤150中，割草机开始转弯的这个距离被指示为距离d。距离d可以是，例如，由目标转弯半径加上刀片半径组成，使得割草机刀片在转弯时切线地达到边界导线103。代替地，边界导线103可以被布置在离指定区域的边界一距离处，该距离对应于指定转弯距离。然后，割草机可以在到达边界导线103时开始转弯。然而，在后的原则类似于在前的原则之处在于，割草机100到达指定区域102的边界之前开始转弯。
在图17所示的示例中，导航仲裁考虑两个条件：割草机100和边界导线103之间的当前距离D是否至多等于指定转弯距离d，以及割草机100是否接近边界导线。如果距离D大于指定转弯距离d，或割草机100正在远离或平行于边界导线(Ψact≥0)移动，导航仲裁选择直线模式152。相反地，如果距离D等于或小于指定转向距离d，选择弧线模式154。
在直线模式152中，割草机100保持在直线路径上。因此，在边界导线坐标中的当前实际偏航角Ψact被设置为目标偏航角Ψdes。在割草机方向坐标中，目标偏航角Ψdes也保持与当前偏航角Ψact相同。因为割草机100不需要采取任何转动，目标速度的幅值Vdes可以被设置到最大可持续割草机速度Vmax，最大可持续割草机速度Vmax在致动器模块144中被转换成由两个牵引马达110和111所产生的相等最大转矩。
在所述实施例中，基于割草机的偏航角Ψact是割草机100的方向偏离割草机的原始方向的角度偏差，例如在割草机从充电站105出发的时间处。因此，沿着割草机100随着时间的推移行进的整个路径，割草机偏航角Ψact从全球偏航角Ψglobl偏移恒定角度。基于割草机的偏航角Ψact偏离边界导线坐标中的偏航角Ψact的偏移量取决于边界导线103的、传感器组件当前正检测其磁场的对应部分的方向。在没有边界导线103的磁场H能够由传感器组件检测的区域中不存在基于边界导线的坐标。
在满足用于进入弧线模式的上述条件时，导航仲裁退出直线模式152并且进入弧线模式154。在弧线模式下，边界导线坐标中的目标偏航角Ψdes被设置为正值，即被设置到指向区域102的方位。
选择目标偏航角Ψdes的一个示例包括使实际的偏航角的符号反向(Ψdes＝-Ψact)。这个设置产生实际偏航角Ψact在边界导线103处的镜像，如图18所示。由此产生的割草图案随机出现，并且可以覆盖凸起的或凹的指定区域102，因为割草机将最终达到指定区域102内的每个位置。
选择目标偏航角Ψdes的另一种选择可能在于180°到实际偏航角Ψact以及顺时针和逆时针之间交替转弯方向。这样的设置将产生系统地覆盖指定区域102的平行轨迹。对于后者设置，充电站105或指定点优选地定位在指定区域的角落中，其中初始方向平行于边界导线的一部分延伸。用于在平行轨迹中割草的指定区域102的形状优选为凸状。
由于割草机不得不进行弧线导航，目标速度Vdes可以被设置为低于在直线模式中的速度。目标速度Vdes可以是预设值或依赖于距离边界导线的距离D和其他因素，如从在边界导线坐标中的实际偏航角Ψact和从基于割草机轮的平均转速Vwheels的当前速度幅值计算出的当前的速度矢量
Figure BDA00003477387600161
在所描绘的实施例中，只有该速度的垂直于边界导线的目标x分量
Figure BDA00003477387600162
基于距离D变化、基于在边界导线坐标系中的实际偏航角Ψact变化、基于实际速度
Figure BDA00003477387600163
的相对于边界导线103的X分量的幅值变化。平行于边界导线的Y分量
Figure BDA00003477387600164
可以保持不变，产生如在图17中所示可变的整体速度Vdes。代替地，整体速度Vdes可以是恒定的，导致可变的Y分量
Figure BDA00003477387600165
这些概念的许多变化在本发明的范围内，包括影响割草机100的转弯动作的以上考虑因素和额外变量的组合。
当在割草机100位于离边界导线103距离d处时启动弧线模式时，轮滑可以防止立即转弯。湿或高大的草是相当湿滑的，使得割草机100的惯性可能会在割草机100实际转弯之前保持在短的距离内将割草机100在其轨迹上。由于从边界导线获得的两维信息，这样的意外运动被检测到并且可以得到补偿。如果割草机100比期望更靠近边界导线，该速度的较小X分量可以被选择以允许割草机在指定区域102内完成转弯。代替地，通过在保持车轮之间的导致割草机转弯的转动速度差或转矩差的同时降低车轮的平均转动速度或转矩，可以减小该速度的大小以及因而弧的半径。
弧线模式保持在原位，直至割草机已经采纳目标偏航角Ψdes。如果割草机在指定转动距离d处进入边界导线103的不同部分的附近，则它重新计算相对于边界导线103的最近接近的部分的目标偏航角Ψdes。
图18用草坪割草机100的模拟的割草模式的俯视图示这个原理。任意开始位置156被选定用于割草机100。割草机100沿直线出发，直到到达在离边界导线103的距离d内的位置158。由于割草机100接近边界导线103并且在边界导线103的距离d内，割草机进入弧线模式154。根据结合图17描述的实施例，实际偏航率Ψact的符号是相反的，用于设置目标偏航率Ψdes。因此，割草机100相对于边界导线103进行镜面反射，其中进入角(由Ψact所定义)与离去角(由Ψdes定义)相同，仅具有相反的符号。一旦割草机已完成转弯，并且达到目标偏航角Ψdes时，则割草机恢复到直线模式152。有时候，割草机可以在边界导线103的不同部分(如，边界区域的角落)的指定转弯距离d内移动时处于弧线模式中。这种情况显示在位置160处。当割草机从图形的顶部朝向位置160沿直线传播时，它进入离边界导线103的下水平部的距离d内。因此，目标偏航角Ψdes被计算，以沿着由虚线表示的路径162引导割草机100。然而，在弧线完成之前，割草机100到达边界导线103的左侧部分的距离d内。因此，设置新的目标偏航角，该新的目标偏航角对应于割草机在它定位在离边界导线的左侧部分的距离d处的位置中的反向偏航角。因此，割草机在弧线模式中继续，并且描述部分圆形，直到割草机达到新的目标偏航角Ψdes。
此外，其中，由于车轮的滑移，割草机100已经移动比距离d更靠近边界导线，例如，在位置164中的割草机路径描绘平行于边界导线103的、具有比在距离d处的弧形(例如，在位置166中)大的宽度的弧形。对于弧形164，割草机速度的X分量已经被降低以使割草机在指定区域102内转弯。由于该速度的Y分量没有减小，弧形显得比在位置166中更宽和更浅。
根据各个优选实施例的前面的描述，明显地，在不脱离本发明的如在所附权利要求中限定的范围的情况下，可以进行各种修改。

Claims (27)

1.一种用于检测边界导线的信号的传感器组件，所述传感器组件包括：
多个感应传感器，所述多个感应传感器至少包括第一感应传感器和第二感应传感器，第一感应传感器沿着第一轴线定向，第二感应传感器沿着第二轴线定向，第一轴线和第二轴线相对于彼此以非零角度布置。
2.根据权利要求1所述的传感器组件，其中所述多个感应传感器中的每个感应传感器是被配置为产生表示传感器组件离所述边界导线的距离的信号的模拟传感器。
3.根据权利要求2所述的传感器组件，其中由所述多个感应传感器产生的信号具有幅值，所述幅值相对于彼此具有表示传感器组件相对于所述边界导线的角位置的比率。
4.根据权利要求1所述的传感器组件，其中第一轴线至少具有垂直分量，并且第二轴线至少具有水平分量。
5.根据权利要求1所述的传感器组件，其中第一轴线和第二轴线相互垂直。
6.根据权利要求1所述的传感器组件，其中所述多个感应传感器包括沿着第三轴线定向的第三传感器，第三轴线与第一轴线和第二轴线两者形成非零角度。
7.根据权利要求6所述的传感器组件，其中第一轴线、第二轴线和第三轴线中的不超过两个轴线共面。
8.根据权利要求7所述的传感器组件，其中第一轴线、第二轴线和第三轴线全部大致彼此垂直。
9.根据权利要求6所述的传感器组件，其中所述多个感应传感器还包括沿着第四轴线定向的第四传感器，第四轴线与第一轴线、第二轴线和第三轴线中的每一个形成非零角度。
10.根据权利要求9所述的传感器组件，其中第一轴线、第二轴线、第三轴线和第四轴线中的不超过三个轴线共面。
11.根据权利要求10所述的传感器组件，其中第一轴线、第二轴线、第三轴线和第四轴线中的不超过二个轴线共面。
12.根据权利要求11所述的传感器组件，其中如通过笛卡尔坐标系中的单位向量[1，0，0]、[0，1，0]和[0，0，1]表示的第一轴线、第二轴线和第三轴线全部彼此垂直，并且如通过向量[1，1，1]表示的第四轴线对角地延伸。
13.根据权利要求1所述的传感器组件，其中所述多个感应传感器中的每个感应传感器包括拾波线圈。
14.一种用于相对于边界导线对一区域进行割草的机器人割草机，所述机器人割草机包括：
切割系统，包括用于割草的元件；
推进系统，包括用于推动机器人割草机的马达；
传感器组件，被配置为检测离所述边界导线的距离，传感器组件具有多个感应传感器，所述多个感应传感器至少包括第一感应传感器和第二感应传感器，第一感应传感器沿着第一轴线定向，第二感应传感器沿着第二轴线定向，第一轴线和第二轴线相对于彼此以非零角度布置；和
与切割系统、推进系统和传感器组件通信的控制单元，其中控制单元被配置为响应于从传感器组件接收到的表示机器人割草机离所述边界导线的距离的信号，操作切割系统和推进系统。
15.根据权利要求14所述的机器人割草机，其中第一轴线至少具有垂直分量，并且第二轴线至少具有水平分量，并且第一轴线和第二轴线相互垂直。
16.根据权利要求14所述的机器人割草机，其中所述多个感应传感器包括沿着第三轴线定向的第三传感器，第三轴线与第一轴线和第二轴线两者形成非零角度。
17.根据权利要求16所述的机器人割草机，其中第一轴线、第二轴线和第三轴线中的不超过两个轴线共面，并且第一轴线、第二轴线和第三轴线全部大致彼此垂直。
18.根据权利要求16所述的机器人割草机，其中控制单元被配置为根据来自传感器组件的信号计算角位置。
19.根据权利要求14所述的机器人割草机，其中控制单元包括被配置为仲裁至少第一传播模式和第二传播模式之间的选择的导航仲裁逻辑电路，所述第一传播模式是割草机的直线传播模式，第二传播模式是割草机的弧线传播模式，导航仲裁模块被配置为在接收到指示割草机接近指定区域的边界并且离所述边界的距离等于或小于指定的转弯距离的传感器信息时选择第二传播模式。
20.一种机器人割草机系统，包括：
边界导线；
边界导线驱动电路，被配置为在边界导线上传输信号；
切割系统，包括用于割草的元件；
推进系统，包括用于推动机器人割草机的马达；
传感器组件，被配置为检测边界导线上的信号，传感器组件具有多个感应传感器，所述多个感应传感器至少包括第一感应传感器和第二感应传感器，第一感应传感器沿着第一轴线定向，第二感应传感器沿着第二轴线定向，第一轴线和第二轴线相对于彼此以非零角度布置；和
与切割系统、推进系统和传感器组件通信的控制单元，其中控制单元被配置为响应于从传感器组件接收到信号，确定机器人割草机离边界导线的距离，并且基于所确定的距离操作切割系统和推进系统。
21.根据权利要求20所述的机器人割草机系统，其中第一轴线至少具有垂直分量，并且第二轴线至少具有水平分量，并且第一轴线和第二轴线相互垂直。
22.根据权利要求20所述的机器人割草机系统，其中所述多个感应传感器包括沿着第三轴线定向的第三传感器，第三轴线与第一轴线和第二轴线两者形成非零角度。
23.根据权利要求22所述的机器人割草机系统，其中第一轴线、第二轴线和第三轴线中的不超过两个轴线共面，并且第一轴线、第二轴线和第三轴线全部大致彼此垂直。
24.一种用于控制机器人割草机的控制单元，该控制单元配置被为响应于从传感器组件接收到至少一个信号操作切割系统和推进系统，该传感器组件具有多个传感器，所述多个传感器沿着相对于彼此以非零角度布置的至少两个轴线布置，所述至少一个信号表示机器人割草机离边界导线的距离。
25.根据权利要求24所述的控制单元，其中控制单元被配置为根据所述至少一个信号计算角位置。
26.根据权利要求24所述的控制单元，其中控制单元被配置为产生用于推进系统的输入量，以基于根据所述至少一个信号计算出的计算坐标引起所希望的运动。
27.根据权利要求24所述的控制单元，还包括被配置为仲裁至少第一传播模式和第二传播模式之间的选择的导航仲裁逻辑电路，所述第一传播模式是割草机的直线传播模式，第二传播模式是割草机的弧线传播模式，导航仲裁模块被配置为在接收到指示割草机接近指定区域的边界并且离所述边界的距离等于或小于指定的转弯距离的传感器信息时选择第二传播模式。
CN201310283815.0A 2012-07-09 2013-07-08 用于机器人割草机的边界传感器组件、机器人割草机和机器人割草机系统 Active CN103542800B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
US13/544,270 US9072218B2 (en) 2012-07-09 2012-07-09 Boundary sensor assembly for a robotic lawn mower, robotic lawn mower and robotic lawn mower system
US13/544,270 2012-07-09

Publications (2)

Publication Number Publication Date
CN103542800A true CN103542800A (zh) 2014-01-29
CN103542800B CN103542800B (zh) 2019-06-21

Family

ID=48782827

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310283815.0A Active CN103542800B (zh) 2012-07-09 2013-07-08 用于机器人割草机的边界传感器组件、机器人割草机和机器人割草机系统

Country Status (3)

Country Link
US (1) US9072218B2 (zh)
EP (1) EP2684438B1 (zh)
CN (1) CN103542800B (zh)

Cited By (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104699101A (zh) * 2015-01-30 2015-06-10 深圳拓邦股份有限公司 可定制割草区域的机器人割草系统及其控制方法
CN105785988A (zh) * 2015-01-14 2016-07-20 Varram系统有限公司 移动机器人和用于将移动机器人与充电站对接的方法
CN105794499A (zh) * 2016-03-30 2016-07-27 苏州亚思科精密数控有限公司 一种绿化带修剪机的修剪方法
CN105979767A (zh) * 2014-02-03 2016-09-28 胡斯华纳有限公司 所要求保护的发明涉及用于保持工具的板簧、工具、工具保持件、机器人工作工具以及机器人工作工具系统
WO2016169381A1 (zh) * 2015-04-23 2016-10-27 常州格力博有限公司 一种割草机的控制板监测系统及其监测方法
CN106105446A (zh) * 2016-07-08 2016-11-16 黄光瑜 一种庄稼耕作打印机
CN106225812A (zh) * 2015-06-02 2016-12-14 美国iRobot公司 用于移动机器人的接触传感器
WO2017080408A1 (zh) * 2015-11-10 2017-05-18 苏州宝时得电动工具有限公司 自动工作系统及其控制方法及自动行走设备
CN107111318A (zh) * 2014-12-23 2017-08-29 胡斯华纳有限公司 通过机器人作业工具实现的3d地图生成
CN107509443A (zh) * 2017-09-05 2017-12-26 惠州市蓝微电子有限公司 一种智能割草机的坡地行驶控制方法及系统
CN108536136A (zh) * 2017-03-06 2018-09-14 苏州宝时得电动工具有限公司 自动行走设备以及边界距离检测方法、装置和系统
CN109690436A (zh) * 2018-02-07 2019-04-26 常州格力博有限公司 用于将机器人割草机与充电站对接的系统和系统执行方法
CN109871012A (zh) * 2019-01-29 2019-06-11 宁波大叶园林设备股份有限公司 一种智能割草机在边界处的转向方法
CN110667695A (zh) * 2019-10-21 2020-01-10 张桂芹 一种自动确定田块边界的插秧机
CN110991944A (zh) * 2019-12-31 2020-04-10 周浩 一种区域化草坪维护管理系统及方法
CN111164534A (zh) * 2018-05-28 2020-05-15 常州格力博有限公司 自适应边界线发射机
CN111273666A (zh) * 2014-03-31 2020-06-12 美国iRobot公司 机器人草坪割草机及割草系统及用于其的方法
WO2020186405A1 (zh) * 2019-03-15 2020-09-24 深圳拓邦股份有限公司 一种越界返回方法、系统及装置
CN111867355A (zh) * 2018-03-30 2020-10-30 格力博(江苏)股份有限公司 自动割草机和控制自动割草机的方法
WO2021047602A1 (zh) * 2019-09-10 2021-03-18 宝时得科技（中国）有限公司 自移动设备及其自动工作系统
WO2021103804A1 (zh) * 2019-11-27 2021-06-03 苏州宝时得电动工具有限公司 自动割草机
WO2022021299A1 (en) * 2020-07-31 2022-02-03 Globe (jiangsu) Co., Ltd. Navigating a robotic mower along a guide wire
WO2022134006A1 (en) * 2020-12-25 2022-06-30 Globe (jiangsu) Co., Ltd. Navigating a robotic mower along a wire
US11518254B1 (en) 2021-09-10 2022-12-06 Adata Technology Co., Ltd. Power adjustment system and power adjustment method of autonomous mobile device

Families Citing this family (42)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2939508B1 (en) 2012-12-28 2021-05-19 Positec Power Tools (Suzhou) Co., Ltd Automatic mowing system
US10149430B2 (en) * 2013-02-20 2018-12-11 Husqvarna Ab Robotic work tool configured for improved turning in a slope, a robotic work tool system, and a method for use in the robot work tool
CN105009014B (zh) * 2013-02-21 2017-09-01 胡斯华纳有限公司 改进的机器人作业工具
JP6424200B2 (ja) 2013-03-15 2018-11-14 エムティーディー プロダクツ インコーポレイテッド 可変反射ベースステーションを含む自律移動作業システム
GB201306437D0 (en) 2013-04-09 2013-05-22 F Robotics Acquisitions Ltd Domestic robotic system and robot therfor
KR101537623B1 (ko) * 2014-01-29 2015-07-17 엘지전자 주식회사 잔디 깎기 로봇 및 그 제어 방법
US9740210B2 (en) 2014-01-30 2017-08-22 Husqvarna Ab Robotic working tool system with a boundary wire
EP3942912B1 (en) * 2014-04-30 2023-11-22 LG Electronics Inc. Lawn mower robot
US10609862B2 (en) 2014-09-23 2020-04-07 Positec Technology (China) Co., Ltd. Self-moving robot
US9804594B2 (en) * 2014-11-07 2017-10-31 Clearpath Robotics, Inc. Self-calibrating sensors and actuators for unmanned vehicles
US9538702B2 (en) * 2014-12-22 2017-01-10 Irobot Corporation Robotic mowing of separated lawn areas
WO2016205592A1 (en) * 2015-06-19 2016-12-22 Omg, Inc Installation system and method for mapping components of a structure
JP6285979B2 (ja) * 2016-03-31 2018-02-28 本田技研工業株式会社 充電ステーションおよび自律走行作業車の充電ステーション誘導装置
US10698417B2 (en) 2016-05-06 2020-06-30 Mtd Products Inc Autonomous mower navigation system and method
US11172608B2 (en) 2016-06-30 2021-11-16 Tti (Macao Commercial Offshore) Limited Autonomous lawn mower and a system for navigating thereof
CN109874487B (zh) 2016-06-30 2022-11-04 创科（澳门离岸商业服务）有限公司 一种自主式割草机及其导航系统
GB2560868B (en) * 2016-09-29 2023-02-15 Mtd Products Inc Demarcating system
JP6635909B2 (ja) * 2016-12-28 2020-01-29 本田技研工業株式会社 作業機、制御装置及び制御用プログラム
SE543987C2 (en) * 2017-04-25 2021-10-19 Husqvarna Ab Improved reception of frequency spectra on the receiver side
EP3413155B1 (de) 2017-06-09 2020-02-26 Andreas Stihl AG & Co. KG Verfahren zum erfassen mindestens eines abschnitts eines begrenzungsrands einer zu bearbeitenden fläche, verfahren zum betreiben eines autonomen mobilen grünflächenbearbeitungsroboters, erfassungssystem und grünflächenbearbeitungssystem
US11439057B2 (en) * 2017-06-09 2022-09-13 Andreas Stihl Ag & Co. Kg Green area maintenance system, method for sensing at least one section of a delimiting border of an area to be maintained, and method for operating an autonomous mobile green area maintenance robot
EP3413156A1 (de) * 2017-06-09 2018-12-12 Andreas Stihl AG & Co. KG Verfahren zum ermitteln einer position eines autonomen mobilen grünflächenbearbeitungsroboters und grünflächenbearbeitungssystem
DE102018121335A1 (de) * 2017-08-31 2019-02-28 Neato Robotics, Inc. Robotergestützte virtuelle grenzen
US10583561B2 (en) 2017-08-31 2020-03-10 Neato Robotics, Inc. Robotic virtual boundaries
CN109557909B (zh) * 2017-09-27 2022-08-12 苏州宝时得电动工具有限公司 自行走设备系统、边界线系统及其控制方法
FR3073297B1 (fr) * 2017-11-09 2022-04-22 Institut National De Recherche En Sciences Et Tech Pour Lenvironnement Et Lagriculture Systeme de securite electronique pour robots mobiles
SE1751546A1 (en) 2017-12-14 2019-05-14 Husqvarna Ab A robotic working tool and work area boundary sensing method
KR102106100B1 (ko) * 2018-02-02 2020-05-06 엘지전자 주식회사 이동 로봇
KR20190109609A (ko) * 2018-02-23 2019-09-26 엘지전자 주식회사 이동로봇과 도킹기기 이들을 포함하는 이동로봇 시스템
CN108582074B (zh) * 2018-05-09 2021-11-30 算丰科技（北京）有限公司 机器人、机器人控制方法及装置
US20210204473A1 (en) * 2018-05-22 2021-07-08 Positec Power Tools (Suzhou) Co., Ltd. Autonomous lawnmower and steering method thereof
WO2020041985A1 (en) * 2018-08-28 2020-03-05 Tti (Macao Commercial Offshore) Limited An autonomous lawn mower and a system for navigating thereof
US11272823B2 (en) 2018-08-31 2022-03-15 Neato Robotics, Inc. Zone cleaning apparatus and method
CA3111467A1 (en) * 2018-09-28 2020-04-02 Techtronic Cordless Gp A docking station for use with an autonomous tool, an autonomous lawn mower and a method of guiding an autonomous tool towards a docking station
CN111403989B (zh) * 2018-12-27 2022-04-19 深圳创想未来机器人有限公司 一种充电方法、机器人、机器人充电系统及存储介质
CN112230636A (zh) * 2019-06-27 2021-01-15 深圳拓邦股份有限公司 一种割草机系统边界信号的自适应方法及割草机系统
KR102315678B1 (ko) * 2019-07-05 2021-10-21 엘지전자 주식회사 잔디 깎기 로봇 및 그 제어 방법
CN113064419B (zh) * 2019-12-30 2024-06-21 南京泉峰科技有限公司 智能割草系统及其通道识别方法
KR20220050667A (ko) * 2020-10-16 2022-04-25 엘지전자 주식회사 이동 로봇 및 그 제어방법
JP2022142377A (ja) * 2021-03-16 2022-09-30 本田技研工業株式会社 自律作業機
CN115373375B (zh) * 2021-05-18 2023-08-18 未岚大陆(北京)科技有限公司 机器人的返回充电桩的方法、装置、机器人及存储介质
EP4368003A1 (en) * 2022-04-27 2024-05-15 Techtronic Cordless GP Robotic tool with boundary wire sensors

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3009525A (en) * 1955-12-08 1961-11-21 Liban Robert De Guidance systems
US3550714A (en) * 1964-10-20 1970-12-29 Mowbot Inc Lawn mower
US4919224A (en) * 1988-05-16 1990-04-24 Industrial Technology Research Institute Automatic working vehicular system
DE102007007992A1 (de) * 2007-02-17 2008-08-21 Blank, Jürgen, Dipl.-Ing. Arbeitsgerät
US20090254218A1 (en) * 2006-03-17 2009-10-08 Sandin Paul E Robot confinement
CN101960443A (zh) * 2008-03-20 2011-01-26 迪尔公司 用于产生工作区的内边界的系统和方法

Family Cites Families (29)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
IL113913A (en) * 1995-05-30 2000-02-29 Friendly Machines Ltd Navigation method and system
AU6387898A (en) 1997-03-18 1998-10-12 Solar And Robotics S.A. Improvements to self-propelled lawn mower
SE510524C2 (sv) 1997-09-19 1999-05-31 Electrolux Ab Elektroniskt avgränsningssystem
SE523080C2 (sv) 1998-01-08 2004-03-23 Electrolux Ab Dockningssystem för självgående arbetsredskap
IL124413A (en) * 1998-05-11 2001-05-20 Friendly Robotics Ltd System and method for area coverage with an autonomous robot
US6339735B1 (en) * 1998-12-29 2002-01-15 Friendly Robotics Ltd. Method for operating a robot
US6611738B2 (en) * 1999-07-12 2003-08-26 Bryan J. Ruffner Multifunctional mobile appliance
US7117660B1 (en) * 2000-04-12 2006-10-10 Colens Andre Self-propelled lawn mower
US7429843B2 (en) * 2001-06-12 2008-09-30 Irobot Corporation Method and system for multi-mode coverage for an autonomous robot
SE0201739D0 (sv) 2002-06-07 2002-06-07 Electrolux Ab Elektroniskt avgränsningssystem
ITFI20070116A1 (it) * 2007-05-17 2008-11-18 Fabrizio Bernini Tagliaerba
WO2010077198A1 (en) 2008-12-30 2010-07-08 Husqvarna Ab An autonomous robotic lawn mower and a method for establishing a wireless communication link between the lawn mower and a user
US8706297B2 (en) * 2009-06-18 2014-04-22 Michael Todd Letsky Method for establishing a desired area of confinement for an autonomous robot and autonomous robot implementing a control system for executing the same
US8224516B2 (en) 2009-12-17 2012-07-17 Deere & Company System and method for area coverage using sector decomposition
US8295979B2 (en) 2010-01-06 2012-10-23 Deere & Company Adaptive scheduling of a service robot
US8996171B2 (en) 2010-02-02 2015-03-31 Deere & Company Pheromone for robotic boundary
WO2011115534A1 (en) 2010-03-17 2011-09-22 Husqvarna Ab Method and system for navigating a robotic garden tool
EP2547191B1 (en) 2010-03-17 2018-09-19 Husqvarna AB Method and system for guiding a robotic garden tool to a predetermined position
EP3346348B1 (en) 2010-04-14 2019-11-27 Husqvarna AB Robotic garden tool following wires at a distance using multiple signals
EP2590495B1 (en) 2010-07-07 2020-04-15 Husqvarna AB Communication and safety device for boundary aided systems
US8234848B2 (en) 2010-07-28 2012-08-07 Deere & Company Robotic mower height of cut adjustment assembly
US8336282B2 (en) 2010-07-28 2012-12-25 Deere & Company Robotic mower housing
US8352113B2 (en) 2010-07-28 2013-01-08 Deere & Company Robotic mower boundary coverage system
US9807925B2 (en) 2010-07-28 2017-11-07 Deere & Company Robotic mower area coverage system
US20120029752A1 (en) 2010-07-28 2012-02-02 Johnson David A Robotic Mower Stuck Detection System
US8433468B2 (en) 2010-07-28 2013-04-30 Deere & Company Robotic mower home finding system
US8392044B2 (en) 2010-07-28 2013-03-05 Deere & Company Robotic mower boundary sensing system
EP2622425B1 (en) 2010-10-01 2018-06-20 Husqvarna AB Method and system for guiding a robotic garden tool
US20120101679A1 (en) 2010-10-26 2012-04-26 Noel Wayne Anderson Method and system for enhancing operating performance of an autonomic mobile robotic device

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3009525A (en) * 1955-12-08 1961-11-21 Liban Robert De Guidance systems
US3550714A (en) * 1964-10-20 1970-12-29 Mowbot Inc Lawn mower
US4919224A (en) * 1988-05-16 1990-04-24 Industrial Technology Research Institute Automatic working vehicular system
US20090254218A1 (en) * 2006-03-17 2009-10-08 Sandin Paul E Robot confinement
DE102007007992A1 (de) * 2007-02-17 2008-08-21 Blank, Jürgen, Dipl.-Ing. Arbeitsgerät
CN101960443A (zh) * 2008-03-20 2011-01-26 迪尔公司 用于产生工作区的内边界的系统和方法

Cited By (40)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105979767A (zh) * 2014-02-03 2016-09-28 胡斯华纳有限公司 所要求保护的发明涉及用于保持工具的板簧、工具、工具保持件、机器人工作工具以及机器人工作工具系统
CN111273666B (zh) * 2014-03-31 2023-10-24 美国iRobot公司 一种用于机器人草坪割草的操作者反馈单元及方法
CN111273666A (zh) * 2014-03-31 2020-06-12 美国iRobot公司 机器人草坪割草机及割草系统及用于其的方法
CN107111318B (zh) * 2014-12-23 2020-10-30 胡斯华纳有限公司 通过机器人作业工具实现的3d地图生成
CN107111318A (zh) * 2014-12-23 2017-08-29 胡斯华纳有限公司 通过机器人作业工具实现的3d地图生成
US10606279B2 (en) 2014-12-23 2020-03-31 Husqvarna Ab 3D map generation by a robotic work tool
CN105785988A (zh) * 2015-01-14 2016-07-20 Varram系统有限公司 移动机器人和用于将移动机器人与充电站对接的方法
CN104699101A (zh) * 2015-01-30 2015-06-10 深圳拓邦股份有限公司 可定制割草区域的机器人割草系统及其控制方法
WO2016169381A1 (zh) * 2015-04-23 2016-10-27 常州格力博有限公司 一种割草机的控制板监测系统及其监测方法
CN106225812A (zh) * 2015-06-02 2016-12-14 美国iRobot公司 用于移动机器人的接触传感器
CN106225812B (zh) * 2015-06-02 2020-02-28 美国iRobot公司 用于移动机器人的接触传感器
US11003192B2 (en) 2015-11-10 2021-05-11 Positec Power Tools (Suzhou) Co., Ltd. Automatic working system and control method thereof and automatic moving device
WO2017080408A1 (zh) * 2015-11-10 2017-05-18 苏州宝时得电动工具有限公司 自动工作系统及其控制方法及自动行走设备
CN105794499A (zh) * 2016-03-30 2016-07-27 苏州亚思科精密数控有限公司 一种绿化带修剪机的修剪方法
CN106105446A (zh) * 2016-07-08 2016-11-16 黄光瑜 一种庄稼耕作打印机
CN108536136A (zh) * 2017-03-06 2018-09-14 苏州宝时得电动工具有限公司 自动行走设备以及边界距离检测方法、装置和系统
CN108536136B (zh) * 2017-03-06 2021-03-16 苏州宝时得电动工具有限公司 自动行走设备以及边界距离检测方法、装置和系统
CN107509443A (zh) * 2017-09-05 2017-12-26 惠州市蓝微电子有限公司 一种智能割草机的坡地行驶控制方法及系统
CN109690436B (zh) * 2018-02-07 2021-12-17 格力博(江苏)股份有限公司 用于将机器人割草机与充电站对接的系统和系统执行方法
WO2019153133A1 (en) * 2018-02-07 2019-08-15 Changzhou Globe Co., Ltd. System and method docketing a robotic mower
CN109690436A (zh) * 2018-02-07 2019-04-26 常州格力博有限公司 用于将机器人割草机与充电站对接的系统和系统执行方法
US11415998B2 (en) 2018-02-07 2022-08-16 Globe (jiangsu) Co., Ltd. System and method for docking a robotic mower
CN111867355A (zh) * 2018-03-30 2020-10-30 格力博(江苏)股份有限公司 自动割草机和控制自动割草机的方法
CN111867355B (zh) * 2018-03-30 2022-06-07 格力博(江苏)股份有限公司 自动割草机和控制自动割草机的方法
CN111164534A (zh) * 2018-05-28 2020-05-15 常州格力博有限公司 自适应边界线发射机
CN109871012B (zh) * 2019-01-29 2022-04-12 宁波大叶园林设备股份有限公司 一种智能割草机在边界处的转向方法
CN109871012A (zh) * 2019-01-29 2019-06-11 宁波大叶园林设备股份有限公司 一种智能割草机在边界处的转向方法
WO2020186405A1 (zh) * 2019-03-15 2020-09-24 深圳拓邦股份有限公司 一种越界返回方法、系统及装置
CN112558597A (zh) * 2019-09-10 2021-03-26 宝时得科技（中国）有限公司 自移动设备
WO2021047602A1 (zh) * 2019-09-10 2021-03-18 宝时得科技（中国）有限公司 自移动设备及其自动工作系统
CN112558597B (zh) * 2019-09-10 2023-01-24 宝时得科技（中国）有限公司 自移动设备
CN110667695B (zh) * 2019-10-21 2021-01-12 张桂芹 一种自动确定田块边界的插秧机
CN110667695A (zh) * 2019-10-21 2020-01-10 张桂芹 一种自动确定田块边界的插秧机
WO2021103804A1 (zh) * 2019-11-27 2021-06-03 苏州宝时得电动工具有限公司 自动割草机
CN110991944A (zh) * 2019-12-31 2020-04-10 周浩 一种区域化草坪维护管理系统及方法
CN110991944B (zh) * 2019-12-31 2023-04-18 周浩 一种区域化草坪维护管理系统及方法
WO2022021299A1 (en) * 2020-07-31 2022-02-03 Globe (jiangsu) Co., Ltd. Navigating a robotic mower along a guide wire
WO2022134006A1 (en) * 2020-12-25 2022-06-30 Globe (jiangsu) Co., Ltd. Navigating a robotic mower along a wire
US11518254B1 (en) 2021-09-10 2022-12-06 Adata Technology Co., Ltd. Power adjustment system and power adjustment method of autonomous mobile device
TWI789899B (zh) * 2021-09-10 2023-01-11 威剛科技股份有限公司 自主移動裝置的動力調整系統及其方法

Also Published As

Publication number Publication date
US9072218B2 (en) 2015-07-07
US20140012418A1 (en) 2014-01-09
CN103542800B (zh) 2019-06-21
EP2684438A1 (en) 2014-01-15
EP2684438B1 (en) 2018-04-04

Similar Documents

Publication Publication Date Title
CN103542800A (zh) 用于机器人割草机的边界传感器组件、机器人割草机和机器人割草机系统
CN103543746A (zh) 用于自动割草机的导航系统和方法
US9740204B2 (en) Control apparatus for autonomously navigating utility vehicle
US9817398B2 (en) Control apparatus for autonomously navigating utility vehicle
US9888625B2 (en) Control apparatus for autonomously navigating utility vehicle
US8712623B2 (en) Control apparatus for autonomous operating vehicle
US9876370B2 (en) Charging station and charging station guide for autonomously navigating utility vehicle
US8532864B2 (en) Control apparatus for autonomous operating vehicle
KR20140108821A (ko) 이동 로봇 및 이동 로봇의 위치 추정 및 맵핑 방법
US11927964B2 (en) Autonomous work machine, method of controlling the same, and storage medium
CN106325287A (zh) 一种基于惯性/磁传感器marg姿态检测的智能割草机直线行走控制系统
JP2022524310A (ja) ロータリエンコーダ校正のためのデバイスおよび方法
CN113848940A (zh) 一种agv自主导航控制方法及系统
JP2016048415A (ja) 自律走行作業車の制御装置
CN206258581U (zh) 避障装置及应用该避障装置的承载装置
JP2010262461A (ja) 移動体
TWI789899B (zh) 自主移動裝置的動力調整系統及其方法
US20220295697A1 (en) Working system and charge station
JP2983527B1 (ja) 車両の計測装置
CN115793627A (zh) 自主移动装置的动力调整系统及其方法
JP2022014976A (ja) 制御システムおよび走行体
Lobo Control and supervision of an AGV with energy consumption optimization
JP2022068643A (ja) 自律作業システム

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
EXSB Decision made by sipo to initiate substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant