CN113165184A - 清洁机器人控制装置及控制方法 - Google Patents
清洁机器人控制装置及控制方法 Download PDFInfo
- Publication number
- CN113165184A CN113165184A CN201980078103.0A CN201980078103A CN113165184A CN 113165184 A CN113165184 A CN 113165184A CN 201980078103 A CN201980078103 A CN 201980078103A CN 113165184 A CN113165184 A CN 113165184A
- Authority
- CN
- China
- Prior art keywords
- work tool
- cleaning robot
- tool
- video
- pressure
- 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
- 238000004140 cleaning Methods 0.000 title claims abstract description 63
- 238000000034 method Methods 0.000 title claims abstract description 25
- 238000001931 thermography Methods 0.000 claims abstract description 23
- 230000033001 locomotion Effects 0.000 claims abstract description 8
- 230000001678 irradiating effect Effects 0.000 claims abstract description 5
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 claims description 19
- 239000000428 dust Substances 0.000 claims description 13
- 230000007423 decrease Effects 0.000 claims description 7
- 229910052742 iron Inorganic materials 0.000 claims description 7
- 238000003723 Smelting Methods 0.000 claims description 5
- 238000007664 blowing Methods 0.000 claims description 3
- 230000004044 response Effects 0.000 claims description 3
- 238000010298 pulverizing process Methods 0.000 claims description 2
- 230000009471 action Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 6
- 238000005259 measurement Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000008021 deposition Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/008—Manipulators for service tasks
- B25J11/0085—Cleaning
-
- 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
- A47L7/00—Suction cleaners adapted for additional purposes; Tables with suction openings for cleaning purposes; Containers for cleaning articles by suction; Suction cleaners adapted to cleaning of brushes; Suction cleaners adapted to taking-up liquids
-
- 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
- A47L7/00—Suction cleaners adapted for additional purposes; Tables with suction openings for cleaning purposes; Containers for cleaning articles by suction; Suction cleaners adapted to cleaning of brushes; Suction cleaners adapted to taking-up liquids
- A47L7/009—Details of suction cleaner tools for additional purposes
-
- 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
- A47L9/00—Details or accessories of suction cleaners, e.g. mechanical means for controlling the suction or for effecting pulsating action; Storing devices specially adapted to suction cleaners or parts thereof; Carrying-vehicles specially adapted for suction cleaners
- A47L9/28—Installation of the electric equipment, e.g. adaptation or attachment to the suction cleaner; Controlling suction cleaners by electric means
-
- 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
- A47L9/00—Details or accessories of suction cleaners, e.g. mechanical means for controlling the suction or for effecting pulsating action; Storing devices specially adapted to suction cleaners or parts thereof; Carrying-vehicles specially adapted for suction cleaners
- A47L9/28—Installation of the electric equipment, e.g. adaptation or attachment to the suction cleaner; Controlling suction cleaners by electric means
- A47L9/2805—Parameters or conditions being sensed
-
- 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
- A47L9/00—Details or accessories of suction cleaners, e.g. mechanical means for controlling the suction or for effecting pulsating action; Storing devices specially adapted to suction cleaners or parts thereof; Carrying-vehicles specially adapted for suction cleaners
- A47L9/28—Installation of the electric equipment, e.g. adaptation or attachment to the suction cleaner; Controlling suction cleaners by electric means
- A47L9/2836—Installation of the electric equipment, e.g. adaptation or attachment to the suction cleaner; Controlling suction cleaners by electric means characterised by the parts which are controlled
- A47L9/2852—Elements for displacement of the vacuum cleaner or the accessories therefor, e.g. wheels, casters or nozzles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J15/00—Gripping heads and other end effectors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J15/00—Gripping heads and other end effectors
- B25J15/0019—End effectors other than grippers
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
- B25J19/021—Optical sensing devices
- B25J19/022—Optical sensing devices using lasers
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
- B25J19/021—Optical sensing devices
- B25J19/023—Optical sensing devices including video camera means
-
- 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
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
-
- 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/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- 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/1679—Programme controls characterised by the tasks executed
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F27—FURNACES; KILNS; OVENS; RETORTS
- F27D—DETAILS OR ACCESSORIES OF FURNACES, KILNS, OVENS, OR RETORTS, IN SO FAR AS THEY ARE OF KINDS OCCURRING IN MORE THAN ONE KIND OF FURNACE
- F27D25/00—Devices or methods for removing incrustations, e.g. slag, metal deposits, dust; Devices or methods for preventing the adherence of slag
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F27—FURNACES; KILNS; OVENS; RETORTS
- F27D—DETAILS OR ACCESSORIES OF FURNACES, KILNS, OVENS, OR RETORTS, IN SO FAR AS THEY ARE OF KINDS OCCURRING IN MORE THAN ONE KIND OF FURNACE
- F27D25/00—Devices or methods for removing incrustations, e.g. slag, metal deposits, dust; Devices or methods for preventing the adherence of slag
- F27D25/008—Devices or methods for removing incrustations, e.g. slag, metal deposits, dust; Devices or methods for preventing the adherence of slag using fluids or gases, e.g. blowers, suction units
-
- 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
-
- 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/06—Control of the cleaning action for autonomous devices; Automatic detection of the surface condition before, during or after cleaning
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- General Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Optics & Photonics (AREA)
- Multimedia (AREA)
- Manipulator (AREA)
Abstract
根据本发明的实施例,公开了一种清洁机器人控制装置及清洁机器人的控制方法。根据本发明的实施例的清洁机器人控制装置包括:热成像摄像机,用于获取作业工具周围的热成像并输出热成像信号;视频摄像机,用于获取所述作业工具周围的视频并输出视频信号;激光指示器,用于将激光照射到指定地点;以及控制单元,用于基于所述热成像信号确定所述指定地点,并控制所述激光指示器,利用所述视频信号控制所述作业工具,以使所述作业工具围绕所述指定地点进行圆周运动。
Description
技术领域
本申请涉及一种用于控制清洁机器人的清洁机器人控制装置及清洁机器人的控制方法。特别地,本发明涉及一种用于清除沉积在炼铁工艺设备内部的喷嘴之间的粉尘沉积物的清洁机器人控制装置及控制方法。
背景技术
炼铁工艺设备中会沉积各种类型的粉尘沉积物。例如,将熔炼炉中产生的还原气体吹入粉矿形态的铁矿石使其流动以生产还原铁的流化炉内部有喷嘴,随着设备的运行,喷嘴周围会沉积粉尘沉积物。如果不清除这些粉尘沉积物,就会发生还原气体的压力损失,气体流动变得不顺畅,从而发生还原效率降低等问题。因此,有必要清除这些粉尘等。
专利文献1:日本专利公开公报第1994-154718号
发明内容
技术问题
根据本发明的实施例,提供一种清洁机器人控制装置。
根据本发明的另一实施例,提供一种清洁机器人的控制方法。
技术方案
根据本发明的实施例的清洁机器人控制装置包括:热成像摄像机,用于获取作业工具周围的热成像并输出热成像信号;视频摄像机,用于获取所述作业工具周围的视频并输出视频信号;激光指示器,用于将激光照射到指定地点;以及控制单元,用于基于所述热成像信号确定所述指定地点,并控制所述激光指示器,利用所述视频信号控制所述作业工具,以使所述作业工具围绕所述指定地点进行圆周运动。
根据本发明的实施例的清洁机器人控制装置,其中,所述指定地点可以是流化炉内部的喷嘴的中心,该流化炉是将熔炼炉中产生的还原气体吹入粉矿形态的铁矿石使其流动以生产还原铁的设备。
根据本发明的实施例的清洁机器人控制装置,其中,所述作业工具可以设置在由多个臂和多个致动器组成的操纵器的未端。
根据本发明的实施例的清洁机器人控制装置,其中,所述作业工具可以包括:旋转叶片,其包括旋转刀片,用于通过旋转粉碎沉积在所述流化炉内部的粉尘沉积物;以及吸入器,用于回收粉碎的所述粉尘沉积物。
根据本发明的实施例的清洁机器人控制装置,还可以包括传感器单元,用于测量所述操纵器与所述作业工具之间的压力,并提供关于所测压力的信息。
根据本发明的实施例的清洁机器人控制装置,其中,所述控制单元可以控制所述操纵器,以使所述传感器单元所测的压力保持恒定的压力。
根据本发明的实施例的清洁机器人控制装置,还可以包括传感器单元,用于测量所述多个致动器中至少一个致动器的压力。
根据本发明的实施例的清洁机器人控制装置,其中,所述控制单元可以控制成响应于所述传感器单元所测的压力,使得用于移动所述工作工具的作用力随着所述作业工具的目标位置与所述作业工具的实际位置之差减小而减小。
根据本发明的另一实施例的清洁机器人的控制方法,该清洁机器人用于清洁流化炉内部,该流化炉是将熔炼炉中产生的还原气体吹入粉矿形态的铁矿石使其流动以生产还原铁的设备,所述方法包括以下步骤:获取所述流化炉内部的热成像,并利用所述热成像确定设置在所述流化炉内部的喷嘴的位置;根据所述喷嘴的位置移动所述清洁机器人的作业工具;以及获取所述流化炉内部的视频,并利用所述视频控制所述作业工具,以使所述作业工具进行圆周运动。
根据本发明的另一实施例的清洁机器人的控制方法,其中,控制所述作业工具的步骤可以包括以下步骤:将激光照射到所述中心位置;以及获取所述流化炉内部的视频,并利用所述视频移动所述作业工具。
根据本发明的另一实施例的清洁机器人的控制方法,其中,所述清洁机器人可以包括:操纵器,其由多个臂和多个致动器组成;以及作业工具,其布置在所述操纵器的未端。
根据本发明的另一实施例的清洁机器人的控制方法,还可以包括以下步骤:将所述操纵器与所述作业工具之间的压力控制成恒定压力。
根据本发明的另一实施例的清洁机器人的控制方法,其中,所述清洁机器人还可以包括操作工具,其作为摇杆型输入装置,用于控制所述作业工具的操作。
根据本发明的另一实施例的清洁机器人的控制方法,还可以包括以下步骤:感测所述作业工具的目标位置与所述作业工具的实际位置之差;以及控制施加到所述作业工具的力量随着所述位置之差减小而减小。
发明效果
因此,根据本发明的实施例的清洁机器人控制装置及控制方法,不仅可以减少清洁作业所需的时间,还可以防止作业工具受损。
附图说明
图1是清洁机器人所清洁的设备的一个实例的示意图。
图2是图1所示的喷嘴的剖面示意图。
图3是应用根据本发明的一实施例的清洁机器人控制装置的清洁机器人的一实施例的结构示意图。
图4是根据本发明的一实施例的清洁机器人控制装置的结构示意图。
图5是用于说明根据本发明的一实施例的清洁机器人控制装置移动清洁机器人的作业工具的方法的视图。
图6是用于说明根据本发明的一实施例的清洁机器人的控制方法的操作流程图。
图7是用于说明根据本发明的一实施例的清洁机器人控制装置的操作工具控制动作的视图。
图8是图7的清洁机器人控制装置的刚度模型的一实施例的示意图。
图9是图7的清洁机器人控制装置的摩擦模型的一实施例的示意图。
图10是用于说明根据本发明的一实施例的清洁机器人控制装置的作业工具控制动作的视图。
具体实施方式
在下文中,将参照附图详细描述优选实施例,以使本发明所属技术领域的普通技术人员容易实施本发明。
图1是清洁机器人所清洁的设备的一个实例的示意图,图2是图1所示的喷嘴的剖面示意图。
如上所述,根据本发明的一实施例的清洁机器人所清洁的设备可以包括多个喷嘴1。各喷嘴的中心部C上可以设置孔。
如图1所示,多个喷嘴1周围会沉积粉尘沉积物,应用根据本发明的一实施例的清洁机器人控制装置的清洁机器人可以清除这些粉尘沉积物。
图3是应用根据本发明的一实施例的清洁机器人控制装置的清洁机器人的一实施例的结构示意图,清洁机器人可以包括控制装置100、作业工具200、操纵器(manipulator)300、主体部400以及操作工具500。
控制装置100可以由传感器及控制器等组成,并且可以控制作业工具200的位置,或者可以根据作业工具200的位置调节施加到作业工具200的力量。下面参照图4至图10等描述控制装置100的具体结构或动作。
作业工具200设置在操纵器300的未端,可以清除和回收形成在设备上的沉积物。例如,作业工具200可以包括具有旋转刀片等的旋转叶片及吸入器等,通过使旋转叶片旋转,将沉积物粉碎后,可以利用吸入器等回收粉碎的沉积物。
操纵器300可以包括多个臂310、320、330和多个旋转致动器340、350。旋转致动器340、350可以在控制装置100的控制下工作,由此操纵器300可以将作业工具200移动到所希望的位置。虽然图中没有示出,但是臂330可以包括用于使作业工具200沿垂直方向移动的致动器,臂330与作业工具200之间也可以布置压力传感器。
主体部400可以包括机器人主体410和移动单元420。机器人主体410上可以布置用于控制操纵器300或作业工具200的各种构件。移动单元420可以将清洁机器人(包括机器人主体410)移动到所希望的位置。
操作工具500可以是摇杆型输入装置如操纵杆(joystick),可以输出用于调节操纵器300的信号。
图4是根据本发明的一实施例的清洁机器人控制装置的结构示意图,根据本发明的一实施例的清洁机器人控制装置100可以包括热成像摄像机110、视频摄像机120、激光指示器130、传感器单元140及控制单元150。
热成像摄像机110可以安装在与作业工具200相邻的位置(例如,连接有作业工具200的臂330)上,用于获取作业工具200可移动的范围内的热成像,并输出包括热成像信息的热成像信号。
视频摄像机120可以安装在与作业工具200相邻的位置(例如,连接有作业工具200的臂330)上,用于获取作业工具200可移动的范围内的视频,并输出包括视频信息的视频信号。
激光指示器130可以安装在与作业工具200相邻的位置(例如,连接有作业工具200的臂330)上,在控制单元150的控制下,将激光照射到特定地点。例如,激光指示器130可以将激光照射到喷嘴1的中心部C。
传感器单元140可以布置在操纵器300的各种致动器或其他所需的位置上,用于测量所设位置上的压力等,并将关于所测压力的信息提供给控制单元150。
控制单元150可以利用热成像摄像机110所输入的热成像信号、视频摄像机120所输入的视频信号以及传感器单元140所输入的压力信息等控制激光指示器130和作业工具200的位置和动作等。例如,控制单元150响应于热成像信号、视频信号及压力信息,可以控制操纵器300的各种致动器的动作和作业工具200的旋转叶片的动作。控制单元150可以安装在与作业工具200相邻的位置(例如,连接有作业工具200的臂330)上,也可以布置在机器人主体410上。
图5是用于说明根据本发明的一实施例的清洁机器人控制装置移动清洁机器人的作业工具的方法的视图。
首先,控制单元150确定喷嘴的位置,利用喷嘴的位置将作业工具移动到特定地点(例如,图5的P1)。
然后,控制单元150可以控制成作业工具200以所述喷嘴的中心为中心点进行圆周运动。例如,当作业工具的现在位置为P1时,控制单元150可以控制作业工具的位置,使作业工具的下一个位置为P2。此时,控制单元150可以控制激光指示器130,以使激光照射到所述喷嘴的中心P0。
图6是用于说明根据本发明的一实施例的清洁机器人的控制方法的操作流程图。图6所示的各个步骤可以由控制单元150执行。
首先,控制单元150可以利用热成像摄像机110所输入的热成像信号确定喷嘴的位置(步骤S100)。如图1所示,由于设备上沉积了粉尘沉积物,难以确定喷嘴的位置。但是,由于喷嘴的温度与其他部分不同,因此可以利用热成像信号确定喷嘴的位置。此时,控制单元150还可以进一步考虑视频摄像机120所输入的视频信号,以确定喷嘴的位置。
接着,控制单元150可以利用激光指示器130将激光照射到喷嘴的中心部(步骤S200)。
接着,控制单元150可以利用视频摄像机120所输入的视频信号控制作业工具200的位置(步骤S300)。例如,如图5所示,控制单元150可以先利用激光指示器130所照射的激光确定喷嘴的中心位置,再控制操纵器300,以使作业工具200以喷嘴的中心为中心点进行圆周运动。
图7是用于说明根据本发明的一实施例的清洁机器人控制装置的控制动作的视图,其中示意性地示出控制单元150的结构。控制单元150可以包括刚度(stiffness)模型151、摩擦(friction)模型152、控制器153及反馈单元154,图8所示的控制单元150的各构件可以通过硬件来实现,也可以通过软件来实现。另外,图7中的致动器155可以是组成图3的操纵器300的多个致动器中的一个或多个。另外,图7中的致动器155可以是用于使作业工具200沿水平方向移动的构件。
在图7中,X_d表示希望作业工具所处的目标位置,X_m表示作业工具的实际位置,P_A表示第一压力,该第一压力是用于使作业工具沿第一方向移动的致动器的压力,P_B表示第二压力,该第二压力是用于使作业工具沿与第一方向不同的方向移动的致动器的压力。所述第一方向和所述第二方向可以是彼此正交的方向,也可以是彼此相反的方向。
首先,求出作业工具的目标位置X_d和实际位置X_m的位置误差e_x。对于实际位置X_m,通过检测控制作业工具的多个致动器(例如,组成图3的操纵器300的多个致动器)的状态,可以确定实际位置X_m。另外,对于目标位置X_d,基于操作工具(图3中的500)所输入的信号,可以确定目标位置X_d。
接着,将位置误差e_x输入到刚度(stiffness)模型151和摩擦(friction)模型152,以求出第一误差e_1及第二误差e_2。图8是刚度模型151的一实施例,图9是摩擦模型152的一实施例。刚度(stiffness)模型151和摩擦(friction)模型152分别输出对应于所输入的位置误差e_x的第一误差e_1和第二误差e_2。
接着,将第一误差e_1和第二误差e_2相加,以求出目标力f_d。
另外,反馈单元154求出第一压力P_A与第二压力P_B的压力差作为测量力f_m,控制器153调节第一压力P_A和第二压力P_A,以使测量力f_m成为目标力f_d。为此,控制器153可以使用PID(Proportional-Integral-Derivative)控制器或PI控制器。
通过如上所述的配置控制致动器,以使施加到作业工具的力量也随着作业工具的目标位置与作业工具的实际位置之差减小而减小。也就是说,作业工具接近目标位置的情形一般是接近待清洁的对象(例如,喷嘴等)的情形。因此,当接近目标物时,使得致动器施加到作业工具的力量减小,从而即使作业工具撞到待清洁的对象物体,作业工具也不会受力太大。由此,可以防止作业工具受损。
图10是用于说明根据本发明的一实施例的清洁机器人控制装置的控制动作的视图,其示意性地示出控制单元150的结构。控制单元150可以包括控制器156和反馈单元157,图10所示的控制单元的各构件可以通过硬件模块来实现,也可以通过软件模块来实现。图10中伺服阀158和线性致动器159可以是组成图3的操纵器300的多个致动器中的一个或多个。具体地,伺服阀158和线性致动器159可以是用于使作业工具200上下移动的构件。
在图10中,P_C表示用于使作业工具沿第三方向移动的第三压力,P_D表示用于使作业工具沿与第三方向不同的方向移动的第四压力。第三方向和第四方向可以是彼此相反的方向。
首先,目标压力P_d输入到控制单元150。目标压力P_d可以预先设定,并且可以是在清除粉尘沉积物的情况下也不会造成作业工具200或喷嘴1等损坏的压力值。
反馈单元157输出第三压力P_C与第四压力P_d之差作为测量压力P_m。控制器156可以控制伺服阀156,以使测量压力P_m成为目标压力P_d。为此,控制器156可以使用PID(Proportional-Integral-Derivative)控制器或PI控制器。如此,控制单元150可以使操纵器与作业工具之间的压力保持恒定压力。
上文中描述的本发明不限于前述的实施例及附图,而是受限于权利要求书,本发明所属领域的技术人员应该理解在不脱离本发明的技术思想的范围内可以进行各种变形和改进。
Claims (14)
1.一种清洁机器人控制装置,其包括:
热成像摄像机,用于获取作业工具周围的热成像并输出热成像信号;
视频摄像机,用于获取所述作业工具周围的视频并输出视频信号;
激光指示器,用于将激光照射到指定地点;以及
控制单元,用于基于所述热成像信号确定所述指定地点,并控制所述激光指示器,利用所述视频信号控制所述作业工具,以使所述作业工具围绕所述指定地点进行圆周运动。
2.根据权利要求1所述的装置,其中,
所述指定地点是流化炉内部的喷嘴的中心,所述流化炉是将熔炼炉中产生的还原气体吹入粉矿形态的铁矿石使其流动以生产还原铁的设备。
3.根据权利要求2所述的装置,其中,
所述作业工具设置在由多个臂和多个致动器组成的操纵器的未端。
4.根据权利要求3所述的装置,其中,
所述作业工具包括:
旋转叶片,其包括旋转刀片,用于通过旋转粉碎沉积在所述流化炉内部的粉尘沉积物;以及
吸入器,用于回收粉碎的所述粉尘沉积物。
5.根据权利要求3所述的装置,其还包括:
传感器单元,用于测量所述操纵器与所述作业工具之间的压力,并提供关于所测压力的信息。
6.根据权利要求5所述的装置,其中,
所述控制单元控制所述操纵器,以使所述传感器单元所测的压力保持恒定压力。
7.根据权利要求3所述的装置,其还包括:
传感器单元,用于测量所述多个致动器中至少一个致动器的压力。
8.根据权利要求7所述的装置,其中,
所述控制单元控制成响应于所述传感器单元所测的压力,使得作用于所述作业工具的力量随着所述作业工具的目标位置与所述作业工具的实际位置之差减小而减小。
9.一种清洁机器人的控制方法,该清洁机器人用于清洁流化炉内部,该流化炉是将熔炼炉中产生的还原气体吹入粉矿形态的铁矿石使其流动以生产还原铁的设备,所述方法包括以下步骤:
获取所述流化炉内部的热成像,并利用所述热成像确定设置在所述流化炉内部的喷嘴的位置;
根据所述喷嘴的位置移动所述清洁机器人的作业工具;以及
获取所述流化炉内部的视频,并利用所述视频控制所述作业工具,以使所述作业工具进行圆周运动。
10.根据权利要求9所述的方法,其中,
控制所述作业工具的步骤包括以下步骤:
将激光照射到所述中心位置;以及
获取所述流化炉内部的视频,并利用所述视频移动所述作业工具。
11.根据权利要求9所述的方法,其中,
所述清洁机器人包括:
操纵器,其由多个臂和多个致动器组成;以及
作业工具,其布置在所述操纵器的未端。
12.根据权利要求11所述的方法,其还包括以下步骤:
将所述操纵器与所述作业工具之间的压力控制成恒定压力。
13.根据权利要求11所述的方法,其中,
所述清洁机器人还包括操作工具,其作为摇杆型输入装置,用于控制所述作业工具的操作。
14.根据权利要求13所述的方法,其还包括以下步骤:
感测所述作业工具的目标位置与所述作业工具的实际位置之差;以及
控制施加到所述作业工具的力量随着所述位置之差减小而减小。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020180150822A KR102178742B1 (ko) | 2018-11-29 | 2018-11-29 | 청소 로봇 제어 장치 및 제어 방법 |
KR10-2018-0150822 | 2018-11-29 | ||
PCT/KR2019/016558 WO2020111810A1 (ko) | 2018-11-29 | 2019-11-28 | 청소 로봇 제어 장치 및 제어 방법 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113165184A true CN113165184A (zh) | 2021-07-23 |
CN113165184B CN113165184B (zh) | 2024-05-24 |
Family
ID=70853574
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201980078103.0A Active CN113165184B (zh) | 2018-11-29 | 2019-11-28 | 清洁机器人控制装置及控制方法 |
Country Status (3)
Country | Link |
---|---|
KR (1) | KR102178742B1 (zh) |
CN (1) | CN113165184B (zh) |
WO (1) | WO2020111810A1 (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102643164B1 (ko) * | 2023-04-21 | 2024-03-06 | 한국해양과학기술원 | 힘제어를 이용한 수중 선체 청소 로봇 시스템 및 이를 이용한 청소 방법 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0679416A (ja) * | 1992-09-01 | 1994-03-22 | Sumitomo Heavy Ind Ltd | ロングノズルの取付位置検出装置 |
JP2012139792A (ja) * | 2011-01-05 | 2012-07-26 | Mitsui Eng & Shipbuild Co Ltd | 清掃ロボットシステム及びその制御方法 |
TW201448484A (zh) * | 2013-06-07 | 2014-12-16 | Pixart Imaging Inc | 指向式機器人之遙控系統 |
CN105310604A (zh) * | 2014-07-30 | 2016-02-10 | Lg电子株式会社 | 机器人清洁系统以及控制机器人清洁器的方法 |
CN106231971A (zh) * | 2014-02-28 | 2016-12-14 | 三星电子株式会社 | 清扫机器人及包含于此的远程控制器 |
CN106455883A (zh) * | 2014-05-08 | 2017-02-22 | 阿尔弗雷德·凯驰两合公司 | 自行驶的和自转向的地面清洁设备以及用于清洁地面的方法 |
KR20170130131A (ko) * | 2016-05-18 | 2017-11-28 | 주식회사 이호테크 | 열연강판의 로봇 연마장치 |
CN107663559A (zh) * | 2016-07-29 | 2018-02-06 | 株式会社Posco | 粉末沉积物去除机器人及其粉末沉积物去除单元 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2540121B2 (ja) | 1992-03-13 | 1996-10-02 | アタカ工業株式会社 | ダクト内清掃装置 |
KR101620698B1 (ko) * | 2014-07-18 | 2016-05-13 | 주식회사 포스코 | 이물막힘 방지장치 및 이를 포함하는 청소로봇 |
KR101819279B1 (ko) * | 2015-05-14 | 2018-01-17 | 주식회사 포스코 | 배관청소로봇 |
-
2018
- 2018-11-29 KR KR1020180150822A patent/KR102178742B1/ko active IP Right Grant
-
2019
- 2019-11-28 WO PCT/KR2019/016558 patent/WO2020111810A1/ko active Application Filing
- 2019-11-28 CN CN201980078103.0A patent/CN113165184B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0679416A (ja) * | 1992-09-01 | 1994-03-22 | Sumitomo Heavy Ind Ltd | ロングノズルの取付位置検出装置 |
JP2012139792A (ja) * | 2011-01-05 | 2012-07-26 | Mitsui Eng & Shipbuild Co Ltd | 清掃ロボットシステム及びその制御方法 |
TW201448484A (zh) * | 2013-06-07 | 2014-12-16 | Pixart Imaging Inc | 指向式機器人之遙控系統 |
CN106231971A (zh) * | 2014-02-28 | 2016-12-14 | 三星电子株式会社 | 清扫机器人及包含于此的远程控制器 |
CN106455883A (zh) * | 2014-05-08 | 2017-02-22 | 阿尔弗雷德·凯驰两合公司 | 自行驶的和自转向的地面清洁设备以及用于清洁地面的方法 |
CN105310604A (zh) * | 2014-07-30 | 2016-02-10 | Lg电子株式会社 | 机器人清洁系统以及控制机器人清洁器的方法 |
KR20170130131A (ko) * | 2016-05-18 | 2017-11-28 | 주식회사 이호테크 | 열연강판의 로봇 연마장치 |
CN107663559A (zh) * | 2016-07-29 | 2018-02-06 | 株式会社Posco | 粉末沉积物去除机器人及其粉末沉积物去除单元 |
Also Published As
Publication number | Publication date |
---|---|
KR20200065152A (ko) | 2020-06-09 |
CN113165184B (zh) | 2024-05-24 |
WO2020111810A1 (ko) | 2020-06-04 |
KR102178742B1 (ko) | 2020-11-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11345042B2 (en) | Robot system equipped with video display apparatus that displays image of virtual object in superimposed fashion on real image of robot | |
JP7122821B2 (ja) | ロボットシステム及びロボット制御方法 | |
CN104249195A (zh) | 具备视觉传感器和力传感器的毛刺去除装置 | |
CN113165184B (zh) | 清洁机器人控制装置及控制方法 | |
WO2021139373A1 (zh) | 一种机械臂混杂控制方法、装置及系统 | |
US11891893B2 (en) | Civil engineering device | |
JP2018144223A (ja) | 複数のロボットに動作を教示する教示方法、およびそれに用いる教示装置 | |
KR20160030863A (ko) | 대상물 이동 장치 및 방법 | |
CN104942453A (zh) | 激光加工装置 | |
CN104412193A (zh) | 载物台装置以及试样观察装置 | |
WO2020161910A1 (ja) | 制御装置、制御方法、記録媒体 | |
JP5666920B2 (ja) | 粗倣い制御を行うロボットの制御装置 | |
CN114730171A (zh) | 加工程序变换装置、数控装置及加工程序的变换方法 | |
WO2021166842A1 (ja) | バリ取り装置、及び制御システム | |
JP2010240782A (ja) | ロボット制御システム、制御装置および制御方法 | |
Changhyun et al. | Macro-micro manipulation with visual tracking and its application to wheel assembly | |
JPWO2020084673A1 (ja) | 数値制御装置、付加製造装置および付加製造装置の制御方法 | |
Ghasemi et al. | Adaptive image-based visual servoing of 6 DOF robots using switch approach | |
JP7098062B2 (ja) | ロボットの動作調整装置、動作制御システムおよびロボットシステム | |
JP7149815B2 (ja) | ロボットシステム及びその運転方法 | |
KR102175585B1 (ko) | 청소 로봇 제어 장치, 제어 방법 및 컴퓨터로 독출 가능한 기록 매체 | |
JP3175623B2 (ja) | ロボットの制御装置 | |
Lange et al. | Predictive feedforward control for high speed tracking tasks | |
JP7498141B2 (ja) | 溶接システム、溶接方法、溶接ロボット及びプログラム | |
JP7426333B2 (ja) | ロボット制御装置 |
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 | ||
CB02 | Change of applicant information |
Address after: Seoul City, Korea Applicant after: POSCO Holdings Co.,Ltd. Address before: Gyeongbuk, South Korea Applicant before: POSCO |
|
CB02 | Change of applicant information | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20230608 Address after: Gyeongbuk, South Korea Applicant after: POSCO Co.,Ltd. Address before: Seoul City, Korea Applicant before: POSCO Holdings Co.,Ltd. |
|
TA01 | Transfer of patent application right | ||
GR01 | Patent grant | ||
GR01 | Patent grant |