CN110385719A - 机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人 - Google Patents
机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人 Download PDFInfo
- Publication number
- CN110385719A CN110385719A CN201910664399.6A CN201910664399A CN110385719A CN 110385719 A CN110385719 A CN 110385719A CN 201910664399 A CN201910664399 A CN 201910664399A CN 110385719 A CN110385719 A CN 110385719A
- Authority
- CN
- China
- Prior art keywords
- robot
- virtual wall
- point
- control point
- linear 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 31
- 238000013519 translation Methods 0.000 claims description 16
- 230000007613 environmental effect Effects 0.000 abstract description 5
- 238000010586 diagram Methods 0.000 description 5
- 238000004458 analytical method Methods 0.000 description 4
- 239000011800 void material Substances 0.000 description 3
- PCTMTFRHKVHKIS-BMFZQQSSSA-N (1s,3r,4e,6e,8e,10e,12e,14e,16e,18s,19r,20r,21s,25r,27r,30r,31r,33s,35r,37s,38r)-3-[(2r,3s,4s,5s,6r)-4-amino-3,5-dihydroxy-6-methyloxan-2-yl]oxy-19,25,27,30,31,33,35,37-octahydroxy-18,20,21-trimethyl-23-oxo-22,39-dioxabicyclo[33.3.1]nonatriaconta-4,6,8,10 Chemical compound C1C=C2C[C@@H](OS(O)(=O)=O)CC[C@]2(C)[C@@H]2[C@@H]1[C@@H]1CC[C@H]([C@H](C)CCCC(C)C)[C@@]1(C)CC2.O[C@H]1[C@@H](N)[C@H](O)[C@@H](C)O[C@H]1O[C@H]1/C=C/C=C/C=C/C=C/C=C/C=C/C=C/[C@H](C)[C@@H](O)[C@@H](C)[C@H](C)OC(=O)C[C@H](O)C[C@H](O)CC[C@@H](O)[C@H](O)C[C@H](O)C[C@](O)(C[C@H](O)[C@H]2C(O)=O)O[C@H]2C1 PCTMTFRHKVHKIS-BMFZQQSSSA-N 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000010408 sweeping Methods 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 239000004020 conductor Substances 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011897 real-time detection Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000005406 washing 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
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- 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/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- 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
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4011—Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/06—Control stands, e.g. consoles, switchboards
-
- 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/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- 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/0011—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots associated with a remote control arrangement
- G05D1/0044—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots associated with a remote control arrangement by providing the operator with a computer generated representation of the environment of the vehicle, e.g. virtual reality, maps
-
- 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/20—Control system inputs
- G05D1/22—Command input arrangements
- G05D1/221—Remote-control arrangements
- G05D1/225—Remote-control arrangements operated by off-board computers
-
- 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/20—Control system inputs
- G05D1/24—Arrangements for determining position or orientation
- G05D1/246—Arrangements for determining position or orientation using environment maps, e.g. simultaneous localisation and mapping [SLAM]
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F3/00—Input arrangements for transferring data to be processed into a form capable of being handled by the computer; Output arrangements for transferring data from processing unit to output unit, e.g. interface arrangements
- G06F3/01—Input arrangements or combined input and output arrangements for interaction between user and computer
- G06F3/048—Interaction techniques based on graphical user interfaces [GUI]
- G06F3/0487—Interaction techniques based on graphical user interfaces [GUI] using specific features provided by the input device, e.g. functions controlled by the rotation of a mouse with dual sensing arrangements, or of the nature of the input device, e.g. tap gestures based on pressure sensed by a digitiser
- G06F3/0488—Interaction techniques based on graphical user interfaces [GUI] using specific features provided by the input device, e.g. functions controlled by the rotation of a mouse with dual sensing arrangements, or of the nature of the input device, e.g. tap gestures based on pressure sensed by a digitiser using a touch-screen or digitiser, e.g. input of commands through traced gestures
-
- 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)
- Radar, Positioning & Navigation (AREA)
- General Physics & Mathematics (AREA)
- Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- General Engineering & Computer Science (AREA)
- Theoretical Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人，通过在虚拟墙两侧设置预判区，使机器人在进入预判区时，结合机器人的当前方向，以及机器人与对照点之间的直线距离和对照点与虚拟墙的中心点之间的直线距离的关系，可以准确判断出机器人是否碰撞虚拟墙，不易受外界环境干扰，不会出现误判的情况，准确性非常高。
Description
技术领域
本发明涉及智能机器人领域，具体涉及一种机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人。
背景技术
现有的扫地机器人，为了避免其误入一些不需要清扫的区域，一般会在该区域的入口处设置一个虚拟墙发射器，该虚拟墙发射器会发生红外信号，当机器人检测到该红外信号时，就停止继续向前，从而阻隔机器人进入该区域。这种方式需要提供额外的虚拟墙发射器，使得硬件成本增加。目前，有的厂家采用设置虚拟墙的方式，在机器人所构建的地图中所对应的不需要清扫的区域入口处划设一条虚拟线，机器人再依照虚拟线所对应的地图中的坐标位置，设定相应的位置为虚拟墙，机器人移动到该虚拟墙对应的坐标位置时，就停止前进或者调头转向，从而实现阻隔的效果。这种方式相对虚拟墙发射器，节省了硬件成本，但是，由于行走误差等原因，会导致机器人不能准确地检测到虚拟墙，影响了虚拟墙的阻隔效果。
发明内容
本发明提供了一种机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人，可以提高机器人判断是否碰撞到虚拟墙的准确性。本发明所述的具体技术方案如下：
一种机器人判断是否碰撞虚拟墙的方法，包括如下步骤：基于机器人所构建的地图，设置虚拟墙；以虚拟墙为中心线，在虚拟墙两侧设置预判区；判断机器人当前位置是否处于所述预判区；在机器人处于所述预判区时，判断机器人的当前方向是否朝向所述虚拟墙，且机器人与对照点之间的直线距离是否大于或等于对照点与虚拟墙的中心点之间的直线距离，如果都是，则确定机器人碰撞到虚拟墙，否则，确定机器人没有碰撞到虚拟墙；其中，所述对照点是与机器人位于虚拟墙同一侧的，距虚拟墙的中心点的垂直距离为预设长度的坐标位置点。
进一步地，所述基于机器人所构建的地图，设置虚拟墙，具体包括如下步骤：智能移动终端接收机器人所构建的地图信息，并通过屏幕显示所述地图信息；所述智能移动终端检测到设置虚拟墙的信号，并将屏幕上的触控信号转换成虚拟墙显示在屏幕所示的地图中；所述智能移动终端将设置了虚拟墙的地图信息传输给机器人。
进一步地，所述以虚拟墙为中心线，在虚拟墙两侧设置预判区，具体包括如下步骤：确定虚拟墙的斜率角度和虚拟墙的中心点的坐标；把虚拟墙以其中心点为参考点平移到坐标系的原点，并旋转所述斜率角度，使虚拟墙置于坐标系的X轴上；以X轴上的虚拟墙为中线，以预设高度框定一个矩形区域作为预判区。
进一步地，所述判断机器人当前位置是否处于所述预判区，具体包括如下步骤：确定机器人当前位置的坐标点；将当前位置的坐标点进行与虚拟墙相应的平移和旋转；判断平移和旋转后的坐标点的X值是否大于所述预判区的最小X值，且小于所述预判区的最大X值，同时，判断平移和旋转后的坐标点的Y值是否大于所述预判区的最小Y值，且小于所述预判区的最大Y值；如果都是，则确定机器人当前位置处于所述预判区，否则，确定机器人当前位置不处于所述预判区。
进一步地，所述在机器人处于所述预判区时，判断机器人的当前方向是否朝向所述虚拟墙，具体包括如下步骤：机器人确定当前处于所述预判区；机器人判断其平移和旋转后的前进方向是否与平移和旋转后的虚拟墙相交，如果是，则确定机器人的当前方向朝向虚拟墙，否则确定机器人的当前方向不朝向虚拟墙。
进一步地，所述判断机器人与对照点之间的直线距离是否大于或等于对照点与虚拟墙的中心点之间的直线距离，具体包括如下步骤：确定机器人位于虚拟墙的一侧为参考侧；确定位于虚拟墙的参考侧，且距离虚拟墙的中心点的垂直距离为预设长度的坐标位置点为对照点；确定机器人与对照点之间的直线距离为第一距离；确定对照点与虚拟墙的中心点之间的直线距离为第二距离；判断所述第一距离是否大于或等于所述第二距离，如果是，则确定机器人与对照点之间的直线距离大于或等于对照点与虚拟墙的中心点之间的直线距离，否则确定机器人与对照点之间的直线距离不大于或等于对照点与虚拟墙的中心点之间的直线距离。
一种芯片，用于存储程序指令，所述程序指令用于控制机器人执行上述的机器人判断是否碰撞虚拟墙的方法。
一种智能机器人，包括主控芯片，所述主控芯片为上述的芯片。
所述机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人，通过在虚拟墙两侧设置预判区，使机器人在进入预判区时，结合机器人的当前方向，以及机器人与对照点之间的直线距离和对照点与虚拟墙的中心点之间的直线距离的关系，可以准确判断出机器人是否碰撞虚拟墙，不易受外界环境干扰，不会出现误判的情况，准确性非常高。
附图说明
图1为本发明实施例所述的机器人判断是否碰撞虚拟墙的方法的流程示意图。
图2为本发明实施例所述的机器人会碰撞到虚拟墙的分析示意图。
图3为本发明实施例所述的机器人不会碰撞到虚拟墙的分析示意图。
图4为本发明实施例所述虚拟墙进行平移和旋转的分析示意图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行详细描述。应当理解，下面所描述的具体实施例仅用于解释本发明，并不用于限定本发明。在下面的描述中，给出具体细节以提供对实施例的透彻理解。然而，本领域的普通技术人员将理解，可以在没有这些具体细节的情况下实施实施例。例如，电路可以在框图中显示，避免在不必要的细节中使实施例模糊。在其他情况下，为了不混淆实施例，可以不详细显示公知的电路、结构和技术。
如图1所示的机器人判断是否碰撞虚拟墙的方法，该方法的执行主体是机器人的处理器或者控制芯片，为便于描述，直接描述为机器人。所述机器人可以是扫地机器人、洗地机器人、空气净化机器人、物流机器人、除草机器人、商业服务机器人等。所述方法具体包括如下步骤：首先，机器人基于自身行走时所构建的地图，设置虚拟墙。所构建的地图可以栅格地图、点阵地图、色块地图或者其它类型的地图，所构建的地图可以反映出机器人当前所处的环境情况。本发明各实施例都是以栅格地图为例进行说明。设置虚拟墙可以采用不同的方式，比如控制机器人在需要设置虚拟墙的位置行走一遍，记录行走时的坐标位置和方向，把这些坐标位置标示为虚拟障碍单元，这些虚拟障碍单元组成所述虚拟墙。所述虚拟障碍单元是指机器人实际可以正常行走通过，但是根据地图导航行走时，却不能行走通过的栅格单元。或者用户直接在地图的显示终端上操作，通过鼠标或者触控的方式在相应的位置划线，划线的位置所对应的栅格单元，就是标示为虚拟墙的栅格单元。所述栅格单元是构成栅格地图的最小单元格。然后，机器人以虚拟墙为中心线，在虚拟墙两侧设置预判区，即在虚拟墙的周围圈定一个区域，用于预先判断机器人是否可能碰撞到虚拟墙，只有进入该预判区，机器人才有可能碰撞到虚拟墙，不在该预判区范围内，机器人是不会碰撞到虚拟墙的。接着，机器人在行走过程中实时检测和判断其当前位置是否处于所述预判区。当机器人处于所述预判区时，判断机器人的当前方向是否朝向所述虚拟墙，同时，判断机器人与对照点之间的直线距离是否大于或等于对照点与虚拟墙的中心点之间的直线距离。机器人的当前方向是指机器人当前的前进方向。所述对照点是与机器人位于虚拟墙同一侧的，距虚拟墙的中心点的垂直距离为预设长度的坐标位置点。所述预设长度可以根据具体的研发要求进行设置，比如设置为10米、100米或者1000米等，所设置的值越大，碰撞虚拟墙的检测精度越高。如果机器人当前的前进方向朝向虚拟墙，表明机器人继续按当前方向前进，就有可能会碰撞到虚拟墙；如果机器人当前的前进方向并不是朝向虚拟墙或者背离虚拟墙，则表明机器人继续按照当前方向前进，是不会碰撞到虚拟墙的。在机器人朝向虚拟墙行走时，进一步检测到机器人与对照点之间的直线距离大于或等于对照点与虚拟墙的中心点之间的直线距离，则表明机器人已经行走到了虚拟墙所在的位置，碰撞到了虚拟墙，机器人需要立即停止前进，调转方向离开，避免穿过虚拟墙，误入用户限制的区域。在机器人朝向虚拟墙行走时，进一步检测到机器人与对照点之间的直线距离还是小于对照点与虚拟墙的中心点之间的直线距离，则表明机器人与虚拟墙之间还有一定距离，没有碰撞到虚拟墙，机器人可以继续沿当前方向行走，直至碰撞到虚拟墙。本实施例所述方法，通过在虚拟墙两侧设置预判区，使机器人在进入预判区时，结合机器人的当前方向，以及机器人与对照点之间的直线距离和对照点与虚拟墙的中心点之间的直线距离的关系，可以准确判断出机器人是否碰撞虚拟墙，不易受外界环境干扰，不会出现误判的情况，准确性非常高。
具体的，如图2所示，一条最粗的黑色线表示虚拟墙20,O点是虚拟墙20的中心点。ABCD所标示的矩形区域表示预判区。P所标示的位置点为对照点，机器人10和对照点P都位于虚拟墙20的右侧。机器人10此时位于预判区ABCD内，并且沿箭头方向朝虚拟墙前进，机器人一边前进一边判断其与对照点P的距离PR是否大于或等于O点与对照点P的距离PO。当PR≥PO时，机器人10确定碰撞到虚拟墙20，当PR小于PO，则机器人10确定没有碰撞到虚拟墙20。如图3所示，如果此时机器人10调整前进方向，沿箭头指示的背离虚拟墙20的方向行走，则机器人不会碰撞到虚拟墙20。
作为其中一种实施方式，所述基于机器人所构建的地图，设置虚拟墙，具体包括如下步骤：首先，智能移动终端接收机器人所构建的地图信息，并通过屏幕显示所述地图信息。所述智能终端包括智能手机或平板电脑等智能设备。机器人与智能终端之间通过wifi进行无线通信，机器人将行走过程中所构建的地图数据发送给智能终端，智能终端接收该数据并通过自身屏幕显示相应的地图信息。用户通过这些地图信息可以直观地看到哪里是墙壁，哪里是过道，哪里是房间入口等。然后，智能终端检测到用户输入的设置虚拟墙的信号后，进入设置虚拟墙的模式。在该模式下，智能终端检测用户在屏幕上的触控信号，并将屏幕上的触控信号转换成虚拟墙显示在屏幕所示的地图中，如此，用户可以直观地看到所设置的虚拟墙。所述虚拟墙显示在地图中是以一条线段表示。用户在需要的位置设置好虚拟墙后，所述智能移动终端将设置了虚拟墙的地图信息传输给机器人，此时，机器人分析该地图信息就可以知道当前环境中，哪个位置设有虚拟墙，是不能通过的。本实施例所述方法，通过智能终端设置虚拟墙，便于用户操作，直观快捷，有利于提高用户的产品使用体验。
作为其中一种实施方式，所述以虚拟墙为中心线，在虚拟墙两侧设置预判区，具体包括如下步骤：首先，机器人确定虚拟墙的斜率角度和虚拟墙的中心点的坐标。如图4所示，XY坐标系是地图的坐标系，线段a1b1表示地图中所设置的虚拟墙。虚拟墙a1b1的斜率角度为θ，是虚拟墙与X轴的夹角。虚拟墙a1b1的中心点p1的坐标为（px1，py1），a1点的坐标为（ax1，ay1），b1点的坐标为（bx1，by1）。然后，机器人把虚拟墙以其中心点为参考点平移到坐标系的原点，并旋转所述斜率角度，使虚拟墙置于坐标系的X轴上，如图中线段a2b2所示。则虚拟墙的各点坐标发生了改变，其中，a1点变为a2点，坐标变为（ax2，ay2）；b1点变为b2点，坐标变为（bx2，by2）； p1点变为p2点，坐标变为（px2，py2）。虚拟墙坐标的平移和旋转可以参考现有的坐标平移和旋转公式进行计算，此处不再赘述。接着，机器人以X轴上的虚拟墙为中线，以预设高度框定一个矩形区域作为预判区。所述预设高度可以根据研发设计要求进行相应设置，一般可以设置为十个栅格单元的高度。图4中虚线框v1v2v3v4所标示的区域就是预判区。本实施例所述方法通过将虚拟墙平移和旋转至坐标轴上，可以简化后续机器人判断是否进入预判区的计算，提高机器人的运算效率和判断速度，进而提高机器人的反应能力。
作为其中一种实施方式，所述判断机器人当前位置是否处于所述预判区，具体包括如下步骤：首先，机器人确定其当前位置的坐标点。然后，机器人将当前位置的坐标点进行与虚拟墙相应的平移和旋转，即机器人当前的坐标点进行平移的量和旋转的角度，与上一实施例所述虚拟墙进行平移的量和旋转的角度相同。具体的坐标平移和旋转可以参考现有的坐标平移和旋转公式进行计算，此处不再赘述。然后，机器人判断平移和旋转后的坐标点的X值是否大于所述预判区的最小X值，且小于所述预判区的最大X值，如果是，表明机器人此时位于预判区的X轴坐标范围内，同时，判断平移和旋转后的坐标点的Y值是否大于所述预判区的最小Y值，且小于所述预判区的最大Y值，如果是，表明机器人此时位于预判区的Y轴坐标范围内，由此，可以确定机器人当前位置处于所述预判区。否则，确定机器人当前位置不处于所述预判区。本实施例所述方法，通过将机器人的当前坐标平移和旋转成与虚拟墙对应的坐标系，后续只需判断X值和Y值是否在预判区的XY范围内，就能得出机器人是否位于预判区的结果，不需要经过复杂的对比和分析，大大简化了机器人的计算资源，提高了机器人的运算效率和判断速度，进而提高机器人的反应能力。
作为其中一种实施方式，所述在机器人处于所述预判区时，判断机器人的当前方向是否朝向所述虚拟墙，具体包括如下步骤：机器人通过上述实施例所述方式确定当前处于所述预判区时，先判断其平移和旋转后的前进方向是否与平移和旋转后的虚拟墙相交，也就是判断从机器人当前位置起，其前进方向对应的直线所经过的坐标点，是否与虚拟墙中的坐标点相同，如果有相同的坐标点，表明机器人当前方向会与虚拟墙相交，则确定机器人的当前方向朝向虚拟墙，如果没有相同的坐标点，则确定机器人的当前方向不朝向虚拟墙。本实施例所述方法，通过将机器人当前位置进行平移和旋转后所确定的前进方向，与平移和旋转后的虚拟墙进行是否相交的判断，可以快速得出判断结论，不需要经过复杂的计算，从而大大提高机器人的数据处理和应变能力。
作为其中一种实施方式，所述判断机器人与对照点之间的直线距离是否大于或等于对照点与虚拟墙的中心点之间的直线距离，具体包括如下步骤：首先，机器人10确定其位于虚拟墙20的一侧为参考侧。如图2所示，机器人10位于虚拟墙20的右侧，虚拟墙20的右侧为参考侧。至于机器人10判断位于虚拟墙20哪一侧的方式，可以通过在地图中，以虚拟墙为对称线，在其两侧相同的距离设置参考点，机器人判断其与两个参考点之间的距离大小，机器人与哪个参考点的距离较短，则机器人就位于虚拟墙的该参考点所在的这一侧。当然，对照点也可以作为参考点。然后，机器人10确定位于虚拟墙20的参考侧，且距离虚拟墙20的中心点的垂直距离为预设长度的坐标位置点为对照点。图中，对照点P距离0点的直线距离的长度PO为预设长度，PO的值可以根据产品设计要求进行相应设置，所设置的值越大，判断是否碰撞到虚拟墙的精度越高，一般可以设置为1000个栅格单元的长度。接着，机器人10确定其当前位置与对照点P之间的直线距离为第一距离PR。机器人确定对照点P与虚拟墙20的中心点之间的直线距离为第二距离PO。机器人10判断所述第一距离PR是否大于或等于所述第二距离PO。如果PR≥PO，则确定机器人与对照点之间的直线距离大于或等于对照点与虚拟墙的中心点之间的直线距离，如果PR<PO，则确定机器人与对照点之间的直线距离不大于或等于对照点与虚拟墙的中心点之间的直线距离。本实施例所述方法，通过设置对照点，可以精确地判断机器人是否行走至虚拟墙边界，克服了现有机器人不能准确行走至虚拟墙边界，导致机器人与虚拟墙之间距离过宽或者机器人直接穿越虚拟墙的问题，保证了机器人与虚拟墙之间距离控制的最优效果。
一种芯片，用于存储程序指令，所述程序指令用于控制机器人执行如上任一实施例所述的机器人判断是否碰撞虚拟墙的方法。所述芯片可以控制机器人通过在虚拟墙两侧设置预判区，使机器人在进入预判区时，结合机器人的当前方向，以及机器人与对照点之间的直线距离和对照点与虚拟墙的中心点之间的直线距离的关系，可以准确判断出机器人是否碰撞虚拟墙，不易受外界环境干扰，不会出现误判的情况，准确性非常高。
一种智能机器人，包括主控芯片，所述主控芯片为上述的芯片。所述智能机器人通过在虚拟墙两侧设置预判区，使机器人在进入预判区时，结合机器人的当前方向，以及机器人与对照点之间的直线距离和对照点与虚拟墙的中心点之间的直线距离的关系，可以准确判断出机器人是否碰撞虚拟墙，不易受外界环境干扰，不会出现误判的情况，准确性非常高。
上述实施例中所提到的“上”、“下”、“左”和“右”等方向字词，如果没有具体说明，则是指代附图中的上下左右等方向。如果有具体说明，则按具体说明定义，比如机器人的左侧，则是指代机器人前进方向的左侧，不是指代附图的左侧。
本领域普通技术人员可以理解：实现上述各方法实施例的全部或部分步骤可以通过程序指令相关的硬件来完成。这些程序可以存储于计算机可读取存储介质（比如ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质）中。该程序在执行时，执行包括上述各方法实施例的步骤。最后应说明的是：以上各实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述各实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改， 或者对其中部分或者全部技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (8)
1.一种机器人判断是否碰撞虚拟墙的方法，其特征在于，包括如下步骤：
基于机器人所构建的地图，设置虚拟墙；
以虚拟墙为中心线，在虚拟墙两侧设置预判区；
判断机器人当前位置是否处于所述预判区；
在机器人处于所述预判区时，判断机器人的当前方向是否朝向所述虚拟墙，且机器人与对照点之间的直线距离是否大于或等于对照点与虚拟墙的中心点之间的直线距离，如果都是，则确定机器人碰撞到虚拟墙，否则，确定机器人没有碰撞到虚拟墙；
其中，所述对照点是与机器人位于虚拟墙同一侧的，距虚拟墙的中心点的垂直距离为预设长度的坐标位置点。
2.根据权利要求1所述的方法，其特征在于，所述基于机器人所构建的地图，设置虚拟墙，具体包括如下步骤：
智能移动终端接收机器人所构建的地图信息，并通过屏幕显示所述地图信息；
所述智能移动终端检测到设置虚拟墙的信号，并将屏幕上的触控信号转换成虚拟墙显示在屏幕所示的地图中；
所述智能移动终端将设置了虚拟墙的地图信息传输给机器人。
3.根据权利要求1所述的方法，其特征在于，所述以虚拟墙为中心线，在虚拟墙两侧设置预判区，具体包括如下步骤：
确定虚拟墙的斜率角度和虚拟墙的中心点的坐标；
把虚拟墙以其中心点为参考点平移到坐标系的原点，并旋转所述斜率角度，使虚拟墙置于坐标系的X轴上；
以X轴上的虚拟墙为中线，以预设高度框定一个矩形区域作为预判区。
4.根据权利要求1至3中任一项所述的方法，其特征在于，所述判断机器人当前位置是否处于所述预判区，具体包括如下步骤：
确定机器人当前位置的坐标点；
将当前位置的坐标点进行与虚拟墙相应的平移和旋转；
判断平移和旋转后的坐标点的X值是否大于所述预判区的最小X值，且小于所述预判区的最大X值，同时，判断平移和旋转后的坐标点的Y值是否大于所述预判区的最小Y值，且小于所述预判区的最大Y值；
如果都是，则确定机器人当前位置处于所述预判区，否则，确定机器人当前位置不处于所述预判区。
5.根据权利要求4所述的方法，其特征在于，所述在机器人处于所述预判区时，判断机器人的当前方向是否朝向所述虚拟墙，具体包括如下步骤：
机器人确定当前处于所述预判区；
机器人判断其平移和旋转后的前进方向是否与平移和旋转后的虚拟墙相交，如果是，则确定机器人的当前方向朝向虚拟墙，否则确定机器人的当前方向不朝向虚拟墙。
6.根据权利要求5所述的方法，其特征在于，所述判断机器人与对照点之间的直线距离是否大于或等于对照点与虚拟墙的中心点之间的直线距离，具体包括如下步骤：
确定机器人位于虚拟墙的一侧为参考侧；
确定位于虚拟墙的参考侧，且距离虚拟墙的中心点的垂直距离为预设长度的坐标位置点为对照点；
确定机器人与对照点之间的直线距离为第一距离；
确定对照点与虚拟墙的中心点之间的直线距离为第二距离；
判断所述第一距离是否大于或等于所述第二距离，如果是，则确定机器人与对照点之间的直线距离大于或等于对照点与虚拟墙的中心点之间的直线距离，否则确定机器人与对照点之间的直线距离不大于或等于对照点与虚拟墙的中心点之间的直线距离。
7.一种芯片，用于存储程序指令，其特征在于，所述程序指令用于控制机器人执行权利要求1至6中任意一项所述的机器人判断是否碰撞虚拟墙的方法。
8.一种智能机器人，包括主控芯片，其特征在于，所述主控芯片为权利要求7所述的芯片。
Priority Applications (6)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910664399.6A CN110385719B (zh) | 2019-07-23 | 2019-07-23 | 机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人 |
| US17/609,005 US12042108B2 (en) | 2019-07-23 | 2019-11-11 | Method for robot to judging whether the robot collides with virtual wall, chip and intelligent robot |
| JP2022500753A JP7326578B2 (ja) | 2019-07-23 | 2019-11-11 | ロボットが仮想壁に衝突したか否かを判断する方法及びチップ、並びにスマートロボット |
| KR1020217027613A KR102605746B1 (ko) | 2019-07-23 | 2019-11-11 | 로봇이 가상벽과 충돌하는지 여부를 판단하는 방법과 칩 및 지능형 로봇 |
| EP19938168.2A EP3960391A4 (en) | 2019-07-23 | 2019-11-11 | PROCEDURE FOR ROBOTS TO DETERMINE IF THEY COLLIDE WITH A VIRTUAL WALL, AS WELL AS CHIP AND INTELLIGENT ROBOT |
| PCT/CN2019/117255 WO2021012501A1 (zh) | 2019-07-23 | 2019-11-11 | 机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910664399.6A CN110385719B (zh) | 2019-07-23 | 2019-07-23 | 机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110385719A true CN110385719A (zh) | 2019-10-29 |
| CN110385719B CN110385719B (zh) | 2020-08-28 |
Family
ID=68287003
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910664399.6A Active CN110385719B (zh) | 2019-07-23 | 2019-07-23 | 机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人 |
Country Status (6)
| Country | Link |
|---|---|
| US (1) | US12042108B2 (zh) |
| EP (1) | EP3960391A4 (zh) |
| JP (1) | JP7326578B2 (zh) |
| KR (1) | KR102605746B1 (zh) |
| CN (1) | CN110385719B (zh) |
| WO (1) | WO2021012501A1 (zh) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111070212A (zh) * | 2020-01-06 | 2020-04-28 | 长沙中联恒通机械有限公司 | 随车机械手控制系统及方法 |
| WO2021012501A1 (zh) * | 2019-07-23 | 2021-01-28 | 珠海市一微半导体有限公司 | 机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人 |
| WO2021139165A1 (zh) * | 2020-01-09 | 2021-07-15 | 珠海市一微半导体有限公司 | 机器人移动限制框的工作起点确定方法及运动控制方法 |
| CN113172630A (zh) * | 2021-05-08 | 2021-07-27 | 珠海市一微半导体有限公司 | 基于虚拟墙的机器人控制方法 |
| CN113190009A (zh) * | 2021-05-08 | 2021-07-30 | 珠海市一微半导体有限公司 | 基于栅格地图的机器人曲线虚拟墙实现方法 |
| CN116473678A (zh) * | 2023-06-21 | 2023-07-25 | 杭州键嘉医疗科技股份有限公司 | 一种虚拟墙引导末端执行器移动的方法及装置 |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20230011698A (ko) * | 2021-07-14 | 2023-01-25 | 엘지전자 주식회사 | 이동 로봇 |
| CN115033005A (zh) * | 2022-08-10 | 2022-09-09 | 湖南朗国视觉识别研究院有限公司 | 一种地面清扫方法、扫地机器人以及存储介质 |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106774294A (zh) * | 2015-11-20 | 2017-05-31 | 沈阳新松机器人自动化股份有限公司 | 一种移动机器人虚拟墙设计方法 |
| CN106843230A (zh) * | 2017-03-24 | 2017-06-13 | 上海思岚科技有限公司 | 应用于移动设备的虚拟墙系统及其实现方法 |
| EP3428762A1 (en) * | 2017-07-12 | 2019-01-16 | LG Electronics Inc. -1- | Moving robot and controlling method |
| CN109602341A (zh) * | 2019-01-23 | 2019-04-12 | 珠海市微半导体有限公司 | 一种基于虚拟边界的清洁机器人跌落控制方法及芯片 |
| EP3491906A1 (en) * | 2017-11-30 | 2019-06-05 | LG Electronics Inc. | Mobile robot and method of controlling the same |
| US20190197776A1 (en) * | 2017-12-22 | 2019-06-27 | Korea University Of Technology And Education Industry-University Cooperation Foundation | Vertex optimization method using depth image in workspace modeling and system therefor |
| CN109947094A (zh) * | 2019-01-31 | 2019-06-28 | 科沃斯机器人股份有限公司 | 行进方法、自移动设备及存储介质 |
Family Cites Families (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP5086942B2 (ja) * | 2008-09-02 | 2012-11-28 | トヨタ自動車株式会社 | 経路探索装置、経路探索方法、及び経路探索プログラム |
| KR101021267B1 (ko) * | 2010-09-20 | 2011-03-11 | 주식회사 모뉴엘 | 청소로봇 시스템 및 그 제어 방법 |
| KR20140045025A (ko) * | 2012-10-08 | 2014-04-16 | 송세경 | 가상벽을 이용하는 이동형 로봇 및 이동형 로봇의 이동 방법 |
| JP5882951B2 (ja) * | 2013-06-14 | 2016-03-09 | 株式会社トプコン | 飛行体誘導システム及び飛行体誘導方法 |
| JP6397663B2 (ja) | 2014-06-18 | 2018-09-26 | シャープ株式会社 | 自走式電子機器 |
| TWI533101B (zh) * | 2015-01-23 | 2016-05-11 | cheng-xiang Yan | System and Method of Restricting Robot Action |
| KR20170077756A (ko) * | 2015-12-28 | 2017-07-06 | 삼성전자주식회사 | 청소 로봇 및 청소 로봇의 제어 방법 |
| CN106272420B (zh) * | 2016-08-30 | 2019-07-02 | 北京小米移动软件有限公司 | 机器人及机器人控制方法 |
| US9797247B1 (en) * | 2016-11-21 | 2017-10-24 | Caterpillar Inc. | Command for underground |
| KR102235270B1 (ko) * | 2017-01-18 | 2021-04-01 | 엘지전자 주식회사 | 이동 로봇 시스템 및 그 제어방법 |
| CN106997202A (zh) * | 2017-03-24 | 2017-08-01 | 上海思岚科技有限公司 | 通过移动应用程序设置虚拟墙的实现方法 |
| CN108803589A (zh) * | 2017-04-28 | 2018-11-13 | 深圳乐动机器人有限公司 | 机器人虚拟墙系统 |
| KR102024092B1 (ko) * | 2017-07-12 | 2019-09-23 | 엘지전자 주식회사 | 이동 로봇 시스템 및 그 제어방법 |
| US10583561B2 (en) | 2017-08-31 | 2020-03-10 | Neato Robotics, Inc. | Robotic virtual boundaries |
| WO2019106714A1 (ja) | 2017-11-28 | 2019-06-06 | 株式会社自律制御システム研究所 | 無人航空機、無人航空機の飛行制御装置、無人航空機の飛行制御方法、及びプログラム |
| CN110385719B (zh) * | 2019-07-23 | 2020-08-28 | 珠海市一微半导体有限公司 | 机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人 |
-
2019
- 2019-07-23 CN CN201910664399.6A patent/CN110385719B/zh active Active
- 2019-11-11 WO PCT/CN2019/117255 patent/WO2021012501A1/zh unknown
- 2019-11-11 US US17/609,005 patent/US12042108B2/en active Active
- 2019-11-11 KR KR1020217027613A patent/KR102605746B1/ko active IP Right Grant
- 2019-11-11 EP EP19938168.2A patent/EP3960391A4/en active Pending
- 2019-11-11 JP JP2022500753A patent/JP7326578B2/ja active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106774294A (zh) * | 2015-11-20 | 2017-05-31 | 沈阳新松机器人自动化股份有限公司 | 一种移动机器人虚拟墙设计方法 |
| CN106843230A (zh) * | 2017-03-24 | 2017-06-13 | 上海思岚科技有限公司 | 应用于移动设备的虚拟墙系统及其实现方法 |
| EP3428762A1 (en) * | 2017-07-12 | 2019-01-16 | LG Electronics Inc. -1- | Moving robot and controlling method |
| EP3491906A1 (en) * | 2017-11-30 | 2019-06-05 | LG Electronics Inc. | Mobile robot and method of controlling the same |
| US20190197776A1 (en) * | 2017-12-22 | 2019-06-27 | Korea University Of Technology And Education Industry-University Cooperation Foundation | Vertex optimization method using depth image in workspace modeling and system therefor |
| CN109602341A (zh) * | 2019-01-23 | 2019-04-12 | 珠海市微半导体有限公司 | 一种基于虚拟边界的清洁机器人跌落控制方法及芯片 |
| CN109947094A (zh) * | 2019-01-31 | 2019-06-28 | 科沃斯机器人股份有限公司 | 行进方法、自移动设备及存储介质 |
Cited By (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2021012501A1 (zh) * | 2019-07-23 | 2021-01-28 | 珠海市一微半导体有限公司 | 机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人 |
| US12042108B2 (en) | 2019-07-23 | 2024-07-23 | Amicro Semiconductor Co., Ltd. | Method for robot to judging whether the robot collides with virtual wall, chip and intelligent robot |
| CN111070212A (zh) * | 2020-01-06 | 2020-04-28 | 长沙中联恒通机械有限公司 | 随车机械手控制系统及方法 |
| CN111070212B (zh) * | 2020-01-06 | 2021-06-01 | 中联恒通机械有限公司 | 随车机械手控制系统及方法 |
| WO2021139165A1 (zh) * | 2020-01-09 | 2021-07-15 | 珠海市一微半导体有限公司 | 机器人移动限制框的工作起点确定方法及运动控制方法 |
| CN113172630A (zh) * | 2021-05-08 | 2021-07-27 | 珠海市一微半导体有限公司 | 基于虚拟墙的机器人控制方法 |
| CN113190009A (zh) * | 2021-05-08 | 2021-07-30 | 珠海市一微半导体有限公司 | 基于栅格地图的机器人曲线虚拟墙实现方法 |
| CN113190009B (zh) * | 2021-05-08 | 2024-05-07 | 珠海一微半导体股份有限公司 | 基于栅格地图的机器人曲线虚拟墙实现方法 |
| CN116473678A (zh) * | 2023-06-21 | 2023-07-25 | 杭州键嘉医疗科技股份有限公司 | 一种虚拟墙引导末端执行器移动的方法及装置 |
| CN116473678B (zh) * | 2023-06-21 | 2023-09-29 | 杭州键嘉医疗科技股份有限公司 | 一种虚拟墙引导末端执行器移动的方法及装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110385719B (zh) | 2020-08-28 |
| JP7326578B2 (ja) | 2023-08-15 |
| EP3960391A4 (en) | 2022-06-22 |
| KR20210119512A (ko) | 2021-10-05 |
| US20220211240A1 (en) | 2022-07-07 |
| US12042108B2 (en) | 2024-07-23 |
| WO2021012501A1 (zh) | 2021-01-28 |
| EP3960391A1 (en) | 2022-03-02 |
| JP2022542006A (ja) | 2022-09-29 |
| KR102605746B1 (ko) | 2023-11-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110385719A (zh) | 机器人判断是否碰撞虚拟墙的方法和芯片以及智能机器人 | |
| CN111857127B (zh) | 一种机器人沿边行走的清洁分区规划方法、芯片及机器人 | |
| US20190314991A1 (en) | Method for controlling robot movement and robot | |
| CN102890507A (zh) | 自走机器人、清洁机器人及其定位方法 | |
| CN103902074A (zh) | 防误触控的系统及方法 | |
| CN114431771B (zh) | 一种扫地机器人清扫方法及相关装置 | |
| CN112790669A (zh) | 扫地机清扫方法、设备以及存储介质 | |
| CN113001544B (zh) | 一种机器人的控制方法、装置及机器人 | |
| US20230095552A1 (en) | Map construction method, robot and medium | |
| CN109344435A (zh) | 一种用于建筑排布的设计方法及其装置、存储介质 | |
| CN105653177A (zh) | 终端设备界面的可点击元素的选择方法和终端设备 | |
| EP4033325B1 (en) | Method for determining a working start point in a robot movement limiting frame and robot movement control method | |
| CN103616973B (zh) | 一种触摸屏的操作方法及触摸屏设备 | |
| CN113311981A (zh) | 擦除方法、装置、智能终端及计算机可读存储介质 | |
| CN103123555A (zh) | 一种基于红外触摸屏的图形识别方法、装置及红外触摸屏 | |
| CN103529999B (zh) | 一种触摸屏的检测方法 | |
| CN115993828A (zh) | 机器人避障方法、系统、存储介质及电子设备 | |
| CN112529984B (zh) | 绘制多边形的方法、装置、电子设备及存储介质 | |
| CN115061463A (zh) | 工作区域生成方法、装置、设备及存储介质 | |
| CN110109662A (zh) | 一种面向多模式物联网设备的程序可视化方法 | |
| CN113172630A (zh) | 基于虚拟墙的机器人控制方法 | |
| CN113190009B (zh) | 基于栅格地图的机器人曲线虚拟墙实现方法 | |
| CN118394052A (zh) | 地图摆正方法 | |
| CN104636060B (zh) | 一种软按键定位方法与系统 | |
| CN110390150B (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 | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20210720 Address after: Room 1301, building 1, Sunshine Building, No. 26, Hongshan Road, Xiangzhou, Zhuhai, Guangdong 519000 Patentee after: Zhuhai 1 Micro Robot Technology Co.,Ltd. Patentee after: ZHUHAI AMICRO SEMICONDUCTOR Co.,Ltd. Address before: Room 105-514, No.6 Baohua Road, Hengqin New District, Zhuhai City, Guangdong Province Patentee before: ZHUHAI AMICRO SEMICONDUCTOR Co.,Ltd. |
|
| TR01 | Transfer of patent right | ||
| CP01 | Change in the name or title of a patent holder |
Address after: Room 1301, building 1, Sunshine Building, No. 26, Hongshan Road, Xiangzhou, Zhuhai, Guangdong 519000 Patentee after: Zhuhai 1 Micro Robot Technology Co.,Ltd. Patentee after: Zhuhai Yiwei Semiconductor Co.,Ltd. Address before: Room 1301, building 1, Sunshine Building, No. 26, Hongshan Road, Xiangzhou, Zhuhai, Guangdong 519000 Patentee before: Zhuhai 1 Micro Robot Technology Co.,Ltd. Patentee before: AMICRO SEMICONDUCTOR Co.,Ltd. |
|
| CP01 | Change in the name or title of a patent holder |