CN111596257B - 一种机器人启动定位方法、装置、电子设备和存储介质 - Google Patents

一种机器人启动定位方法、装置、电子设备和存储介质 Download PDF

Info

Publication number
CN111596257B
CN111596257B CN202010707955.6A CN202010707955A CN111596257B CN 111596257 B CN111596257 B CN 111596257B CN 202010707955 A CN202010707955 A CN 202010707955A CN 111596257 B CN111596257 B CN 111596257B
Authority
CN
China
Prior art keywords
positioning
robot
transmitting unit
rotation
receiving unit
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.)
Active
Application number
CN202010707955.6A
Other languages
English (en)
Other versions
CN111596257A (zh
Inventor
马帅
赵文飞
白雪
郦颖烜
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.)
Shanghai Keenlon Intelligent Technology Co Ltd
Original Assignee
Shanghai Keenlon Intelligent Technology Co Ltd
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 Shanghai Keenlon Intelligent Technology Co Ltd filed Critical Shanghai Keenlon Intelligent Technology Co Ltd
Priority to CN202010707955.6A priority Critical patent/CN111596257B/zh
Publication of CN111596257A publication Critical patent/CN111596257A/zh
Application granted granted Critical
Publication of CN111596257B publication Critical patent/CN111596257B/zh
Priority to US17/233,117 priority patent/US11579613B2/en
Priority to JP2021077777A priority patent/JP7098267B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • 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/0261—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using magnetic plots
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/0247—Determining attitude
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/06—Position of source determined by co-ordinating a plurality of position lines defined by path-difference measurements
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02—Services making use of location information
    • H04W4/023—Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02—Services making use of location information
    • H04W4/025—Services making use of location information using location based information parameters
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S2205/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S2205/01—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations specially adapted for specific applications
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/0284—Relative positioning
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/14—Determining absolute distances from a plurality of spaced points of known location
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
    • G01S5/30—Determining absolute distances from a plurality of spaced points of known location

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Electromagnetism (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种机器人启动定位方法、装置、电子设备和存储介质。其中，该方法包括：机器人启动时，控制机器人在启动定位区域按照预设的转动；根据在自转过程中确定的所述定位发射单元与设置在不同固定位置处的两个所述定位接收单元之间的至少三个不同位置距离集合，以及所述预设的自转方向，确定所述定位发射单元的自转路径位置信息；将由所述自转路径的中心位置延伸到所述机器人停止自转时定位发射单元位置的方向作为所述机器人的朝向信息；将所述自转路径的中心位置和所述机器人的朝向信息作为机器人的启动定位信息。本实施例提供的技术方案，与现有技术相比，避免了外界动态环境中障碍物的干扰和影响，提高了启动定位信息的准确性。

Description

一种机器人启动定位方法、装置、电子设备和存储介质
技术领域
本发明实施例涉及机器人定位技术领域，尤其涉及一种机器人启动定位方法、装置、电子设备和存储介质。
背景技术
随着定位技术的发展，当前的机器人能够基于自身的定位***实现自主定位和导航。当机器人进行开机启动操作时，机器人会丢失自身的定位信息，从而失去自主导航的能力。
现有技术中，机器人通常通过视觉信息构建地图，来重新获取自身的位置信息，该方法需要基于获取的位姿数据和图像数据构建机器人的开机重定位数据库，并获取机器人处于开机位置时的开机图像，根据开机图像从开机重定位数据库中匹配出多个相似图像，再基于相似图像确定机器人处于开机位置对应的开机位姿。
但是，上述方法受环境影响的程度较大，在机器人周围环境出现了一定的变动之后，会极大的影响机器人启动定位的精度。
发明内容
本发明提供一种机器人启动定位方法、装置、电子设备和存储介质，以提高机器人启动定位的准确性。
第一方面，本发明实施例提供了一种机器人启动定位方法，由机器人启动定位***中的控制器执行，所述机器人启动定位***包括设置在固定位置的超宽带定位接收单元，以及设置在机器人上的超宽带定位发射单元，所述定位发射单元与所述定位接收单元通信连接，用于接收所述定位接收单元返回的定位信号，所述方法包括：
机器人启动时，控制机器人在启动定位区域按照预设的自转方向转动；
根据在自转过程中确定的所述定位发射单元与设置在不同固定位置处的两个所述定位接收单元之间的至少三个不同位置距离集合，以及所述预设的自转方向，确定所述定位发射单元的自转路径位置信息；
根据所述定位发射单元的自转路径位置信息，确定所述自转路径的中心位置；
将由所述自转路径的中心位置延伸到所述机器人停止自转时定位发射单元位置的方向作为所述机器人的朝向信息；
将所述自转路径的中心位置和所述机器人的朝向信息作为机器人的启动定位信息。
第二方面，本发明实施例还提供了一种机器人启动定位装置，配置于机器人启动定位***的控制器中，所述机器人启动定位***包括设置在固定位置的定位接收单元，以及设置在机器人上的定位发射单元，所述定位发射单元与所述定位接收单元通信连接，用于向所述定位接收单元发射定位信号，所述装置包括：
自转模块，用于机器人启动时，控制机器人在启动定位区域按照预设的自转方向转动；
路径信息确定模块，用于根据在自转过程中确定的所述定位发射单元与设置在不同固定位置处的两个所述定位接收单元之间的至少三个不同位置距离集合，以及所述预设的自转方向，确定所述定位发射单元的自转路径位置信息；
中心位置确定模块，用于根据所述定位发射单元的自转路径位置信息，确定所述自转路径的中心位置；
朝向信息确定模块，用于将由所述自转路径的中心位置延伸到所述机器人停止自转时定位发射单元位置的方向作为所述机器人的朝向信息；
定位信息确定模块，用于将所述自转路径的中心位置和所述机器人的朝向信息作为机器人的启动定位信息。第三方面，本发明实施例还提供了一种电子设备，所述电子设备包括：
一个或多个处理器；
存储装置，用于存储一个或多个程序，
当所述一个或多个程序被所述一个或多个处理器执行，使得所述一个或多个处理器实现如本发明实施例中任一所述的一种机器人启动定位方法。
第四方面，本发明实施例还提供了一种计算机可读存储介质，其上存储有计算机程序，该程序被处理器执行时实现如本发明实施例中任一所述的一种机器人启动定位方法。
本发明实施例提供的机器人启动定位方法，通过在机器人启动时，控制机器人在启动定位区域按照预设的自转方向转动，进而根据在自转过程中确定的定位发射单元与设置在不同固定位置处的两个定位接收单元之间的距离集合，以及预设的自转方向，确定定位发射单元的自传路径位置信息，将自转路径的中心位置延伸到机器人停止自转时定位发射单元位置的方向作为机器人的朝向信息，将所述自转路径的中心位置和所述机器人的朝向信息作为机器人的启动定位信息，本实施例提供的技术方案，与现有技术相比，避免了外界动态环境中障碍物的干扰和影响，提高了启动定位信息的准确性。
附图说明
图1为本发明实施例一提供的一种机器人启动定位方法的的流程图；
图2是本发明实施例一提供的一种定位发射单元的安装位置示意图；
图3为本发明实施例一提供一种定位接收单元的安装位置示意图；
图4a-4c为本发明实施例一提供的一种机器人启动定位方法的示意图；
图5为本发明实施例一提供的一种机器人自转过程中各相对距离的变化趋势；
图6为本发明实施例一提供的一种机器人自转路径位置确定示意图；
图7为本发明实施例二提供的一种机器人启动定位装置的结构示意图；
图8为本发明实施例三提供的一种电子设备的结构示意图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是，此处所描述的具体实施例仅仅用于解释本发明，而非对本发明的限定。另外还需要说明的是，为了便于描述，附图中仅示出了与本发明相关的部分而非全部结构。
实施例一
图1为本发明实施例一提供的一种机器人启动定位方法的的流程图，本实施例可适用于机器人开机启动时，进行启动定位的情况，该方法可以由机器人启动定位***中的控制器执行，所述机器人启动定位***包括设置在固定位置的定位接收单元，以及设置在机器人上的定位发射单元，所述定位发射单元与所述定位接收单元通信连接，用于向所述定位接收单元发送定位信号。
其中，定位接收单元和定位发射单元所采取的定位手段可以包括但不限于无线局域网（Wireless Fidelity，WiFi）、蓝牙、红外线、超宽带（Ultra Wide Band，UWB），射频识别（ Radio Frequency Identification ，RFID）以及超声波等方式实现。本实施例中，设置在机器人上的定位发射单元按照一定的频率发射定位信号，设置在固定位置的定位接收单元不断的接收到定位发射单元发射的定位信号，因此，根据定位接收单元返回的定位信号可以计算出定位发射单元与定位接收单元之间的相对距离信息。
上述定位发射单元可以设置在机器人身上，作为一种可选的实施方式，上述定位发射单元可以设置在机器人的正前方，如图2所示，图2中的20为定位发射单元；上述定位接收单元可以设置在任意已知位置信息的固定位置处，作为一种可选的实施方式，定位接收单元可以设置在充电桩上，具体的设置方式参见图3，图3中的30为定位接收单元。
进一步的，该方法具体包括如下步骤：
S110、机器人启动时，控制机器人在启动定位区域按照预设的自转方向转动。
本实施例中，当机器人开机启动时，机器人会丢失自身的定位信息，需要借助外界的启动定位***来重新确定自身的位置信息，在进启动位置定位时，需要用户将机器人放置在启动定位区域内。
其中，上述启动定位区域与所述定位接收单元距离小于预设距离阈值，该预设距离阈值小于定位接收单元信号的发射距离，以保障在启动定位区域内机器人上的定位发射单元能接收到定位接收单元发送的定位信号。
其中，预设的自转方向可以包括顺时针自转和逆时针自转。
本实施例中，当机器人重新启动或者重新开机时，将机器人放置在启动定位区域并且按照预设的自转方向转动。本实施例中机器人自转时围绕自身进行转动且保持自身不移动。机器人在自转的过程中，设置在机器人身上的定位发射单元不断的向设置在固定位置处的定位接收单元发射脉冲信号进行测距，在机器人的自转过程中，可以得到由多组定位发射单元和定位接收单元之间的相对位置距离组成的相对位置距离集合。
S120、根据在自转过程中确定的所述定位发射单元与设置在不同固定位置处的两个所述定位接收单元之间的至少三个不同位置距离集合，以及所述预设的自转方向，确定所述定位发射单元的自转路径位置信息。
本实施例中，由于定位接收单元是设置在固定位置的，因此定位接收单元的位置信息是已知的。机器人在自转的过程中，根据计算得到的定位发射单元和定位接收单元之间的相对距离集合，能够确定定位发射单元在运动过程中与定位接收单元之间的相对距离以及运动轨迹，其中，定位发射单元的运动轨迹为圆形，该运动轨迹的圆心与定位接收单元之间的距离为机器人与定位接收单元之间的相对距离，由圆心延伸到机器人停止自转时定位发射单元位置的方向为机器人的朝向信息，根据机器人与定位发射单元之间的相对距离以及机器人的朝向信息，可以得到得到机器人的启动定位信息。其中，机器人的启动定位信息是随机的，由机器人在启动定位区域中的放置位置确定。
本实施例中，以设置在充电桩上的两个定位接收单元30为例，具体参见图4a-4c，其中，图下方的矩形区域为充电桩，圆形区域为机器人的底盘，其中，充电桩的位置是已知的，因此两个定位接收单元30的位置也是已知的。本实施例中，以定位发射单元20设置在机器人正前方的底盘上为例，定位发射单元20按照一定的频率发定位信息，不断对2个已知位置的定位接收单元30进行测距，会得到距离L1和L2，两个定位接收单元30之间的距离为确定的L3，因此可以确定一个已知三边长度的三角形，进一步可以求出机器人的携带的定位发射单元20的相对位置。
进一步的，由于三个不共线的点可以确定一个圆的方程，因此在本实施例中可以 通过选取机器人自转过程中确定的定位发射单元20与定位接收单元30之间的至少三个不 同位置的距离集合，来得到机器人的自转轨迹方程。其中，上述三个不同位置为定位发射单 元20运动轨迹上的三点。假设（a,b）为圆心坐标，r为自转形成的圆的半径，可以得到机器人 的自转轨迹方程为
Figure DEST_PATH_IMAGE001
。
进一步的，令机器人在原地自转一周，在这个过程中定位发射单元20不断发射脉冲，可以得到定位发射单元20与两个定位接收单元30之间的相对距离集合，该距离集合表示定位发射单元20在机器人自转过程中的运动轨迹，根据该运动轨迹可以确定机器人与定位接收单元30之间的相对位置关系，即该运动轨迹可以在充电桩的两侧，呈镜像的位置关系。进一步的，当机器人的自转方向不同时，对上述相对距离集合中L1和L2大小的变化趋势也不同，本实施例中根据机器人预设的自转方向，来进一步滤除定位发射单元20的镜像运动轨迹，以确定定位发射单元20的运动轨迹位置信息。
具体的，根据自转过程中获取的所述定位发射单元20与设置在不同固定位置处的两个所述定位接收单元30之间的相对距离集合，以及所述预设的自转方向，确定所述定位发射单元20的自转路径位置信息，包括：确定所述定位发射单元20与设置在不同固定位置处的两个所述定位接收单元30之间的相对距离集合中各相对距离的变化趋势；根据所述各相对距离的变化趋势以及预设的自转方向，确定所述定位发射单元20的自转路径位置信息。
具体的，根据所述各相对距离的变化趋势以及预设的自转方向，确定所述定位发射单元20的自转路径位置信息，包括：
若机器人按照顺时针进行自转，在所述定位发射单元20与第一定位接收单元之间的相对距离从最大值变化至最小值的过程中，所述定位发射单元20与第二定位接收单元之间的相对距离有最小值，则所述定位发射单元20的自转路径位于从所述第二定位接收单元延伸至所述第一定位接收单元方向的右侧；其中，所述第一定位接收单元位于所述第二定位接收单元的左侧。
进一步参见图5，其中A位置处为第一定位接收单元，B位置处为第二定位接收单元，C-D以及H-K分别为定位发射单元20在机器人自转过程中处于的不同位置，四条直线分别经过两个圆的圆心，由此可得，AC的距离为机器人自转过程中第一定位单元与定位发射单元20的相对距离最小值L1min，AD的距离为机器人自转过程中第一定位单元与定位发射单元20的相对距离最大值L1max；BE的距离为机器人自转过程中第二定位单元到定位发射单元20的相对距离最小值L2min，BF的距离为机器人自转过程中第二定位单元到定位发射单元20的相对距离最大值L2max；当机器人按照顺时针方向进行自转时，当定位发射单元20从D移动到C的过程中，定位发射单元20与第一定位接收单元之间的相对距离从最大值变化至最小值，在这个过程中，当定位发射单元20经过E点时，定位发射单元20和第二定位接收单元之间的相对距离会取得最小值，只有定位发射单元20在第一定位接收单元延伸至第二定位接收单元方向的右侧时，才满足上述各相对距离的变化趋势，因此，根据上述变化趋势，可以得出定位发射单元20的运动轨迹位于从第一定位接收单元延伸至第二定位接收单元方向的右侧。其中，所述第一定位接收单元位于所述第二定位接收单元的左侧。
相应的，若机器人按照顺时针进行自转，在所述定位发射单元20与第一定位接收单元之间的相对距离从最大值变化至最小值的过程中，所述定位发射单元20与第二定位接收单元之间的相对距离有最大值，则所述定位发射单元20的自转路径位于从第二定位接收单元延伸至第一定位接收单元方向的左侧。
若机器人按照逆时针进行自转，在所述定位发射单元20与第一定位接收单元之间的相对距离从最大值变化至最小值的过程中，所述定位发射单元20与第二定位接收单元之间的相对距离有最大值，则所述定位发射单元20的自转路径位于从所述第二定位接收单元延伸至所述第一定位接收单元方向的右侧。
若机器人按照逆时针进行自转，在所述定位发射单元20与第一定位接收单元之间的相对距离从最大值变化至最小值的过程中，所述定位发射单元20与第二定位接收单元之间的相对距离有最小值，则所述定位发射单元20的自转路径位于从所述第二定位接收单元延伸至所述第一定位接收单元方向的左侧。
S130、根据所述定位发射单元的自转路径位置信息，确定所述自转路径的中心位置。
作为另一种可选的实时方式，确定所述定位发射单元20的自转路径位置信息，包括：
按照自转顺序获取所述自转路径上不共线的三个点的位置坐标；
确定各所述自转路径上不共线的三个点构成的面积量，根据所述面积量的数值计算得到机器人计算自转方向；根据所述面积量的数值以及预设的自转方向确定所述定位发射单元的自转路径位置信息。
进一步的，根据所述面积量的数值以及预设的自转方向确定所述定位发射单元20的自转路径位置信息，包括：
若机器人按照顺时针进行自转，按照自转的先后顺序分别获取各所述自转路径上不共线的三个点的位置坐标；确定各所述自转路径上不共线的三个点构成的面积量，将面积量为负数时的三个点所属的自转路径作为所述定位发射单元20的自转路径位置信息。
具体参见图6，根据在自转过程中确定的所述定位发射单元20与设置在不同固定位置处的两个所述定位接收单元30之间的相对距离集合，可以得到定位发射单元20两个镜像的自转路径。若机器人按照顺时针进行自转，按照自转的先后顺序在两个镜像的自转路径上分别确定三个点的位置坐标，设P1（x1，y1）、P2（x2，y2）、P3（x3，y3）以及P1’（x1’，y1’）、P2’（x2’，y2’）和P3’（x3’，y3’）。三个点的连线可以组成一个平面三角形，根据三点的坐标，可以求得由P1、P2以及P3三个点构成的三角形的面积量：
Figure DEST_PATH_IMAGE003
由P1’、P2’以及P3’三个点构成的三角形的面积量：
Figure 453259DEST_PATH_IMAGE005
根据上面两个面积量计算公式，可以分别求得两个自转路径上对应的三个点的所形成的三角形的面积量。本实施例中，当机器人按照顺时针进行旋转时，旋转路径上顺序选取的三个不共线的点所形成的三角形的面积量为负值，因此，根据上述面积量计算公式，将计算得到的面积量为负数时的三个点所属的自转路径为定位发射单元20的自转路径位置信息，从而可以从两个镜像的自转路径中确定机器人的实际自转路径位置，进而根据三个点的坐标以自转路径的半径可以确定自转路径的方程。
相应的，若机器人按照逆时针进行自转，按照自转顺序获取各所述自转路径上不共线的三个点的位置坐标；
确定各所述自转路径上不共线的三个点构成的面积量，将面积量为正数时的三个点所属的自转路径作为所述定位发射单元20的自转路径位置信息。具体地，根据按照顺序获得的三个不同位置坐标计算的面积量，根据面积量的值的正负，可以得到机器人计算自转方向，即，当面积量为正时，通过计算得到机器人的自转方向为逆时针；当面积量为负时，计算得到机器人的自转方向为顺时针。由于机器人自转方向已经预设，根据预设的机器人自转方向，和面积量比较，可以获得相同自转方向的面积量对应的位置坐标，从而准确获取机器人定位信息。
本实施例中，定位发射单元的运动轨迹为圆形，根据自转路径可以确定出自转路径的中心位置，即圆心位置，该圆心位置为机器人在启动定位区域的具***置信息。
S140、将由所述自转路径的中心位置延伸到所述机器人停止自转时定位发射单元位置的方向作为所述机器人的朝向信息。
继续参见图4a-4c，本实施例中以定位发射单元20设置在机器人的正前方为例，在运动轨迹的中心位置确定之后，当机器人自转一周停止时，机器人自转路径的中心位置延伸到所述机器人停止自转时定位发射单元20位置的方向为机器人的朝向信息。
S150、将所述自转路径的中心位置和所述机器人的朝向信息作为机器人的启动定位信息。
本实施例中，上述自转路径的中心位置为机器人在启动定位区域的位置信息，因此根据上述自转路径的中心位置和机器人的朝向信息可以确定机器人的启动定位信息。机器人根据该启动定位信息进行路径规划和自主导航。
本实施例的技术方案，通过根据自转过程中确定的定位发射单元与两个定位接收单元之间的相对距离集合，以及预设的自转方向，确定定位发射单元的自转路径位置信息，并将自转路径的中心位置延伸到机器人停止自转时定位发射单元位置的方向作为机器人的朝向信息，进而将自转路径的中心位置和机器人的朝向信息作为机器人的启动定位信息。仅通过两个定位接收单元即可实现机器人的启动定位，节约了启动定位***的成本；并且该方法弱化了障碍区对环境干扰的影响，提高了启动定位成功的准确性。
实施例二
图7为本发明实施例二提供的一种机器人启动定位装置的结构示意图，本发明实施例提供的一种启动定位装置可以执行本发明上述任一实施例提供的一种机器人启动定位方法。该装置配置于机器人启动定位***的控制器中，所述机器人启动定位***包括设置在固定位置的定位接收单元，以及设置在机器人上的定位发射单元，所述定位发射单元与所述定位接收单元通信连接，用于向所述定位接收单元发送定位信号。
参见图7，该装置包括自转模块210、路径信息确定模块220、中心位置确定模块230、朝向信息确定模块240和定位信息确定模块250。
自转模块210，用于机器人启动时，控制机器人在启动定位区域按照预设的自转方向转动；
路径信息确定模块220，用于根据在自转过程中确定的所述定位发射单元与设置在不同固定位置处的两个所述定位接收单元之间的至少三个不同位置距离集合，以及所述预设的自转方向，确定所述定位发射单元的自转路径位置信息；
中心位置确定模块230，用于根据所述定位发射单元的自转路径位置信息，确定所述自转路径的中心位置；
朝向信息确定模块240，用于将由所述自转路径的中心位置延伸到所述机器人停止自转时定位发射单元位置的方向作为所述机器人的朝向信息；
定位信息确定模块250，用于将所述自转路径的中心位置和所述机器人的朝向信息作为机器人的启动定位信息。可选的，路径信息确定模块220具体用于：按照自转顺序获取所述自转路径上不共线的三个点的位置坐标；
确定各所述自转路径上不共线的三个点构成的面积量，根据所述面积量的数值计算得到机器人计算自转方向；根据所述面积量的数值以及预设的自转方向确定所述定位发射单元的自转路径位置信息。
路径信息确定模块220还具体用于：若机器人按照顺时针进行自转，按照自转的先后顺序分别获取各所述自转路径上不共线的三个点的位置坐标；确定各所述自转路径上不共线的三个点构成的面积量，将面积量为负数时的三个点所属的自转路径作为所述定位发射单元的自转路径位置信息；
若机器人按照逆时针进行自转，按照自转的先后顺序分别获取各所述自转路径上不共线的三个点的位置坐标；确定各所述自转路径上不共线的三个点构成的面积量，将面积量为正数时的三个点所属的自转路径作为所述定位发射单元的自转路径位置信息。
可选的，路径信息确定模块220具体用于：确定所述定位发射单元与设置在不同固定位置处的至少三个不同位置两个所述定位接收单元之间的相对距离集合中各相对距离的变化趋势；
根据所述各相对距离的变化趋势以及预设的自转方向，确定所述定位发射单元的自转路径位置信息。
进一步的，上述路径信息确定模块220还具体用于：若机器人按照顺时针进行自转，在所述定位发射单元与第一定位接收单元之间的相对距离从最大值变化至最小值的过程中，所述定位发射单元与第二定位接收单元之间的相对距离有最小值，则所述定位发射单元的自转路径位于从所述第二定位接收单元延伸至所述第一定位接收单元方向的右侧；
其中，所述第一定位接收单元位于所述第二定位接收单元的左侧。
上述路径信息确定模块220还具体用于：若机器人按照顺时针进行自转，在所述定位发射单元与第一定位接收单元之间的相对距离从最大值变化至最小值的过程中，所述定位发射单元与第二定位接收单元之间的相对距离有最大值，则所述定位发射单元的自转路径位于从所述第二定位接收单元延伸至所述第一定位接收单元方向的左侧；其中，所述第一定位接收单元位于所述第二定位接收单元的左侧。
上述路径信息确定模块220还具体用于：若机器人按照逆时针进行自转，在所述定位发射单元与第一定位接收单元之间的相对距离从最大值变化至最小值的过程中，所述定位发射单元与第二定位接收单元之间的相对距离有最大值，则所述定位发射单元的自转路径位于从所述第二定位接收单元延伸至所述第一定位接收单元方向的右侧；
其中，所述第一定位接收单元位于所述第二定位接收单元的左侧。
上述路径信息确定模块220还具体用于：若机器人按照逆时针进行自转，在所述定位发射单元与第一定位接收单元之间的相对距离从最大值变化至最小值的过程中，所述定位发射单元与第二定位接收单元之间的相对距离有最小值，则所述定位发射单元的自转路径位于从所述第二定位接收单元延伸至所述第一定位接收单元方向的左侧；
其中，所述第一定位接收单元位于所述第二定位接收单元的左侧。
本发明实施例所提供的一种启动定位装置可执行本发明任意实施例所提供的一种启动定位方法，具备执行方法相应的功能模块和有益效果，再此不再进行赘述。
实施例三
图8为本发明实施例四提供的一种电子设备的结构示意图，如图8所示，该电子设备包括处理器310、存储器320、输入装置330和输出装置340；电子设备中处理器310的数量可以是一个或多个，图8中以一个处理器310为例；电子设备中的处理器310、存储器320、输入装置330和输出装置340可以通过总线或其他方式连接，图8中以通过总线连接为例。
存储器320作为一种计算机可读存储介质，可用于存储软件程序、计算机可执行程序以及模块，如本发明实施例中的启动定位方法对应的程序指令/模块（例如，启动定位装置中的自转模块310和确定模块320）。处理器310通过运行存储在存储器320中的软件程序、指令以及模块，从而执行电子设备的各种功能应用以及数据处理，即实现上述的启动定位方法。
存储器320可主要包括存储程序区和存储数据区，其中，存储程序区可存储操作***、一个功能所需的应用程序；存储数据区可存储根据终端的使用所创建的数据等。此外，存储器320可以包括高速随机存取存储器，还可以包括非易失性存储器，例如一个磁盘存储器件、闪存器件、或其他非易失性固态存储器件。在一些实例中，存储器320可进一步包括相对于处理器310远程设置的存储器，这些远程存储器可以通过网络连接至电子设备。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
输入装置330可用于接收输入的数字或字符信息，以及产生与电子设备的用户设置以及功能控制有关的键信号输入。输出装置340可包括显示屏等显示设备。
实施例四
本发明实施例四还提供一种包含计算机可执行指令的存储介质，所述计算机可执行指令在由计算机处理器执行时用于执行一种启动定位方法，该方法由机器人启动定位***中的控制器执行，所述机器人启动定位***包括设置在固定位置的定位接收单元，以及设置在机器人上的定位发射单元，所述定位发射单元与所述定位接收单元通信连接，用于向所述定位接收单元发送定位信号，所述方法包括：
机器人启动时，控制机器人在启动定位区域按照预设的自转方向转动；
根据在自转过程中确定的所述定位发射单元与设置在不同固定位置处的两个所述定位接收单元之间的至少三个不同位置距离集合，以及所述预设的自转方向，确定所述定位发射单元的自转路径位置信息；
根据所述定位发射单元的自转路径位置信息，确定所述自转路径的中心位置；
将由所述自转路径的中心位置延伸到所述机器人停止自转时定位发射单元位置的方向作为所述机器人的朝向信息；
将所述自转路径的中心位置和所述机器人的朝向信息作为机器人的启动定位信息。
当然,本发明实施例所提供的一种包含计算机可执行指令的存储介质,其计算机可执行指令不限于如上所述的方法操作,还可以执行本发明任意实施例所提供的启动定位方法中的相关操作.
通过以上关于实施方式的描述，所属领域的技术人员可以清楚地了解到，本发明可借助软件及必需的通用硬件来实现，当然也可以通过硬件实现，但很多情况下前者是更佳的实施方式。基于这样的理解，本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来，该计算机软件产品可以存储在计算机可读存储介质中，如计算机的软盘、只读存储器（Read-Only Memory, ROM）、随机存取存储器（RandomAccess Memory, RAM）、闪存（FLASH）、硬盘或光盘等，包括若干指令用以使得一台计算机设备（可以是个人计算机，服务器，或者网络设备等）执行本发明各个实施例所述的方法。
值得注意的是，上述启动定位装置的实施例中，所包括的各个单元和模块只是按照功能逻辑进行划分的，但并不局限于上述的划分，只要能够实现相应的功能即可；另外，各功能单元的具体名称也只是为了便于相互区分，并不用于限制本发明的保护范围。
注意，上述仅为本发明的较佳实施例及所运用技术原理。本领域技术人员会理解，本发明不限于这里所述的特定实施例，对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本发明的保护范围。因此，虽然通过以上实施例对本发明进行了较为详细的说明，但是本发明不仅仅限于以上实施例，在不脱离本发明构思的情况下，还可以包括更多其他等效实施例，而本发明的范围由所附的权利要求范围决定。

Claims (9)

1.一种机器人启动定位方法，其特征在于，由机器人启动定位***中的控制器执行，所述机器人启动定位***包括设置在固定位置的定位接收单元，以及设置在机器人上的定位发射单元，所述定位发射单元与所述定位接收单元通信连接，用于向所述定位接收单元发送定位信号，所述方法包括：
机器人启动时，控制机器人在启动定位区域按照预设的自转方向转动；
根据在自转过程中确定的所述定位发射单元与设置在不同固定位置处的两个所述定位接收单元之间的至少三个不同位置距离集合，以及所述预设的自转方向，确定所述定位发射单元的自转路径位置信息；
根据所述定位发射单元的自转路径位置信息，确定所述自转路径的中心位置；
将由所述自转路径的中心位置延伸到所述机器人停止自转时定位发射单元位置的方向作为所述机器人的朝向信息；
将所述自转路径的中心位置和所述机器人的朝向信息作为机器人的启动定位信息；
确定所述定位发射单元的自转路径位置信息，包括：
按照自转顺序获取所述自转路径上不共线的三个点的位置坐标；
确定各所述自转路径上不共线的三个点构成的面积量，根据所述面积量的数值计算得到机器人计算自转方向；
根据所述面积量的数值以及预设的自转方向确定所述定位发射单元的自转路径位置信息。
2.根据权利要求1所述的方法，其特征在于，所述启动定位区域与所述定位接收单元的距离小于预设距离阈值。
3.根据权利要求1所述的方法，其特征在于，根据所述面积量的数值以及预设的自转方向确定所述定位发射单元的自转路径位置信息，包括：
若机器人按照顺时针进行自转，按照自转的先后顺序分别获取各所述自转路径上不共线的三个点的位置坐标；确定各所述自转路径上不共线的三个点构成的面积量，将面积量为负数时的三个点所属的自转路径作为所述定位发射单元的自转路径位置信息；
若机器人按照逆时针进行自转，按照自转的先后顺序分别获取各所述自转路径上不共线的三个点的位置坐标；确定各所述自转路径上不共线的三个点构成的面积量，将面积量为正数时的三个点所属的自转路径作为所述定位发射单元的自转路径位置信息。
4.根据权利要求1所述的方法，其特征在于，根据在自转过程中确定的所述定位发射单元与设置在不同固定位置处的两个所述定位接收单元之间的至少三个不同位置距离集合，以及所述预设的自转方向，确定所述定位发射单元的自转路径位置信息，包括：
确定所述定位发射单元与设置在不同固定位置处的两个所述定位接收单元之间的至少三个不同位置距离集合中各距离的变化趋势；
根据所述各距离的变化趋势以及预设的自转方向，确定所述定位发射单元的自转路径位置信息。
5.根据权利要求4所述的方法，其特征在于，根据所述各距离的变化趋势以及预设的自转方向，确定所述定位发射单元的自转路径位置信息，包括：
若机器人按照顺时针进行自转，在所述定位发射单元与第一定位接收单元之间的相对距离从最大值变化至最小值的过程中，所述定位发射单元与第二定位接收单元之间的相对距离有最小值，则所述定位发射单元的自转路径位于从所述第二定位接收单元延伸至所述第一定位接收单元方向的右侧；
若机器人按照顺时针进行自转，在所述定位发射单元与第一定位接收单元之间的相对距离从最大值变化至最小值的过程中，所述定位发射单元与第二定位接收单元之间的相对距离有最大值，则所述定位发射单元的自转路径位于从所述第二定位接收单元延伸至所述第一定位接收单元方向的左侧；
其中，所述第一定位接收单元位于所述第二定位接收单元的左侧。
6.根据权利要求4所述的方法，其特征在于，根据所述各距离的变化趋势以及预设的自转方向，确定所述定位发射单元的自转路径位置信息，包括：
若机器人按照逆时针进行自转，在所述定位发射单元与第一定位接收单元之间的相对距离从最大值变化至最小值的过程中，所述定位发射单元与第二定位接收单元之间的相对距离有最大值，则所述定位发射单元的自转路径位于从所述第二定位接收单元延伸至所述第一定位接收单元方向的右侧；
若机器人按照逆时针进行自转，在所述定位发射单元与第一定位接收单元之间的相对距离从最大值变化至最小值的过程中，所述定位发射单元与第二定位接收单元之间的相对距离有最小值，则所述定位发射单元的自转路径位于从所述第二定位接收单元延伸至所述第一定位接收单元方向的左侧；
其中，所述第一定位接收单元位于所述第二定位接收单元的左侧。
7.一种机器人启动定位装置，其特征在于，配置于机器人启动定位***的控制器中，所述机器人启动定位***包括设置在固定位置的定位接收单元，以及设置在机器人上的定位发射单元，所述定位发射单元与所述定位接收单元通信连接，用于向所述定位接收单元发送定位信号，所述装置包括：
自转模块，用于机器人启动时，控制机器人在启动定位区域按照预设的自转方向转动；
路径信息确定模块，用于根据在自转过程中确定的所述定位发射单元与设置在不同固定位置处的两个所述定位接收单元之间的至少三个不同位置距离集合，以及所述预设的自转方向，确定所述定位发射单元的自转路径位置信息；
中心位置确定模块，用于根据所述定位发射单元的自转路径位置信息，确定所述自转路径的中心位置；
朝向信息确定模块，用于将由所述自转路径的中心位置延伸到所述机器人停止自转时定位发射单元位置的方向作为所述机器人的朝向信息；
定位信息确定模块，用于将所述自转路径的中心位置和所述机器人的朝向信息作为机器人的启动定位信息；
路径信息确定模块具体用于：按照自转顺序获取所述自转路径上不共线的三个点的位置坐标；
确定各所述自转路径上不共线的三个点构成的面积量，根据所述面积量的数值计算得到机器人计算自转方向；根据所述面积量的数值以及预设的自转方向确定所述定位发射单元的自转路径位置信息。
8.一种电子设备，其特征在于，所述电子设备包括：
一个或多个处理器；
存储装置，用于存储一个或多个程序，
当所述一个或多个程序被所述一个或多个处理器执行，使得所述一个或多个处理器实现如权利要求1-6中任一所述的一种机器人启动定位方法。
9.一种计算机可读存储介质，其上存储有计算机程序，其特征在于，该程序被处理器执行时实现如权利要求1-6中任一所述的一种机器人启动定位方法。
CN202010707955.6A 2020-07-22 2020-07-22 一种机器人启动定位方法、装置、电子设备和存储介质 Active CN111596257B (zh)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN202010707955.6A CN111596257B (zh) 2020-07-22 2020-07-22 一种机器人启动定位方法、装置、电子设备和存储介质
US17/233,117 US11579613B2 (en) 2020-07-22 2021-04-16 Method and apparatus for positioning a robot at start-up, electronic device and storage medium
JP2021077777A JP7098267B2 (ja) 2020-07-22 2021-04-30 ロボット起動測位方法、デバイス、電子装置及び記憶媒体

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010707955.6A CN111596257B (zh) 2020-07-22 2020-07-22 一种机器人启动定位方法、装置、电子设备和存储介质

Publications (2)

Publication Number Publication Date
CN111596257A CN111596257A (zh) 2020-08-28
CN111596257B true CN111596257B (zh) 2020-11-03

Family

ID=72190253

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010707955.6A Active CN111596257B (zh) 2020-07-22 2020-07-22 一种机器人启动定位方法、装置、电子设备和存储介质

Country Status (3)

Country Link
US (1) US11579613B2 (zh)
JP (1) JP7098267B2 (zh)
CN (1) CN111596257B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117368844A (zh) * 2023-09-28 2024-01-09 河北振创电子科技有限公司 爬壁机器人定位方法、装置、电子设备及存储介质

Family Cites Families (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
SE514791C2 (sv) 1994-06-06 2001-04-23 Electrolux Ab Förbättrat förfarande för lokalisering av fyrar vid självgående anordning
JP2003515210A (ja) 1999-11-18 2003-04-22 ザ プロクター アンド ギャンブル カンパニー 家庭用清掃ロボット
JP6289268B2 (ja) 2014-05-29 2018-03-07 シャープ株式会社 自走式電子機器
CN104267725B (zh) * 2014-09-23 2017-04-19 无锡华普微电子有限公司 扫地机器人自主充电用的室内导航定位***
CN105116378B (zh) * 2015-09-30 2018-11-30 长沙开山斧智能科技有限公司 一种无线、超声波复合定位***及其定位方法
CN205049151U (zh) 2015-09-30 2016-02-24 长沙开山斧智能科技有限公司 一种机器人定位导航***
CN106227214B (zh) * 2016-08-30 2019-08-13 北京小米移动软件有限公司 自主机器人、检测故障的装置和方法
CN106530352B (zh) * 2016-10-26 2019-04-23 重庆大学 智能扫雪机器人定位***及方法
CN106990776B (zh) * 2017-02-27 2020-08-11 广东省智能制造研究所 机器人归航定位方法与***
US11435759B2 (en) * 2018-05-04 2022-09-06 Lg Electronics Inc. Plurality of autonomous mobile robots and controlling method for the same
CN109031205B (zh) * 2018-07-18 2020-11-03 北京进化者机器人科技有限公司 机器人定位装置、方法以及机器人
JP6633152B2 (ja) 2018-08-20 2020-01-22 東芝ライフスタイル株式会社 自走式機器
CN109307857B (zh) * 2018-11-12 2020-06-09 湖北工业大学 一种基于多传感器的自主跟随定位装置及方法
CN109480715A (zh) * 2018-12-29 2019-03-19 肇庆学院 基于激光雷达地图构建与角度传感器自动回充***及方法

Also Published As

Publication number Publication date
US11579613B2 (en) 2023-02-14
JP7098267B2 (ja) 2022-07-11
US20220026908A1 (en) 2022-01-27
JP2022022092A (ja) 2022-02-03
CN111596257A (zh) 2020-08-28

Similar Documents

Publication Publication Date Title
EP3689215B1 (en) Region attribute determination
CN107837044B (zh) 清洁机器人的分区清洁方法、装置及机器人
CN109974727B (zh) 一种机器人充电方法、装置及机器人
US20180321055A1 (en) Navigation apparatus and navigation method
CN112171665A (zh) 运动控制方法、装置、终端设备及存储介质
CN111805535B (zh) 一种定位导航方法、装置以及计算机存储介质
CN112232330B (zh) 车道连接线生成方法、装置、电子设备和存储介质
CN111152266B (zh) 一种清洁机器人的控制方法及***
CN111596257B (zh) 一种机器人启动定位方法、装置、电子设备和存储介质
CN109062948A (zh) 目标点确定、目标路径确定方法和***
CN111766870B (zh) 过渡路径和作业路径的规划方法及相关装置
CN114255252B (zh) 障碍物轮廓获取方法、装置、设备及计算机可读存储介质
CN107525516A (zh) 用于导航的车道线显示方法和装置
WO2018157309A1 (zh) 航线修正的方法、设备和无人机
CN111487972A (zh) 一种踢球的步态规划方法、装置、可读存储介质及机器人
CN113359705A (zh) 一种路径规划方法、编队协同作业方法及其设备
WO2022110853A1 (zh) 可通行区域的探索方法、装置、存储介质及电子装置
CN112991527B (zh) 目标对象的躲避方法及装置、存储介质、电子装置
CN112729349B (zh) 里程计在线标定的方法、装置、电子设备及存储介质
CN113467452A (zh) 移动机器人的避让方法及装置、存储介质及电子装置
CN110244710B (zh) 自动寻迹方法、装置、存储介质及电子设备
CN112097762A (zh) 路径规划方法、装置、机器人及存储介质
JP2021165875A (ja) 制御プラットフォーム及び制御方法
CN112781580B (zh) 家庭设备的定位方法、智能家居设备及存储介质
CN113448338B (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