WO2017191928A1 - 청소로봇 및 그 제어 방법 - Google Patents
청소로봇 및 그 제어 방법 Download PDFInfo
- Publication number
- WO2017191928A1 WO2017191928A1 PCT/KR2017/004443 KR2017004443W WO2017191928A1 WO 2017191928 A1 WO2017191928 A1 WO 2017191928A1 KR 2017004443 W KR2017004443 W KR 2017004443W WO 2017191928 A1 WO2017191928 A1 WO 2017191928A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- light
- obstacle
- light emitting
- light receiving
- cleaning robot
- Prior art date
Links
- 238000004140 cleaning Methods 0.000 title claims abstract description 212
- 238000000034 method Methods 0.000 title claims abstract description 101
- 230000005540 biological transmission Effects 0.000 claims description 25
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 238000001514 detection method Methods 0.000 description 43
- 230000003287 optical effect Effects 0.000 description 38
- 230000033001 locomotion Effects 0.000 description 31
- 239000000428 dust Substances 0.000 description 26
- 238000010586 diagram Methods 0.000 description 14
- 230000008569 process Effects 0.000 description 14
- 238000002366 time-of-flight method Methods 0.000 description 14
- 238000006073 displacement reaction Methods 0.000 description 13
- 238000005192 partition Methods 0.000 description 10
- 230000001133 acceleration Effects 0.000 description 7
- 230000006870 function Effects 0.000 description 7
- 230000008859 change Effects 0.000 description 5
- 238000003860 storage Methods 0.000 description 3
- 230000015572 biosynthetic process Effects 0.000 description 2
- 238000002360 preparation method Methods 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 241001123862 Mico Species 0.000 description 1
- 230000001154 acute effect Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000006866 deterioration Effects 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 238000011065 in-situ storage Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 239000012528 membrane Substances 0.000 description 1
- 229910044991 metal oxide Inorganic materials 0.000 description 1
- 150000004706 metal oxides Chemical class 0.000 description 1
- 238000004377 microelectronic Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000011895 specific detection Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Images
Classifications
-
- 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/009—Carrying-vehicles; Arrangements of trollies or wheels; Means for avoiding mechanical obstacles
-
- 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- 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
-
- 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/4061—Steering means; Means for avoiding obstacles; Details related to the place where the driver is accommodated
-
- 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
-
- 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/30—Arrangement of illuminating devices
-
- 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
- B25J11/00—Manipulators not otherwise provided for
- B25J11/008—Manipulators for service tasks
- B25J11/0085—Cleaning
-
- 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
-
- 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
- B25J9/00—Programme-controlled manipulators
-
- 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
-
- 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/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
-
- 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/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/42—Simultaneous measurement of distance and other co-ordinates
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/46—Indirect determination of position data
- G01S17/48—Active triangulation systems, i.e. using the transmission and reflection of electromagnetic waves other than 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/481—Constructional features, e.g. arrangements of optical elements
- G01S7/4814—Constructional features, e.g. arrangements of optical elements of transmitters alone
- G01S7/4815—Constructional features, e.g. arrangements of optical elements of transmitters alone using multiple transmitters
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/481—Constructional features, e.g. arrangements of optical elements
- G01S7/4816—Constructional features, e.g. arrangements of optical elements of receivers alone
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/481—Constructional features, e.g. arrangements of optical elements
- G01S7/4817—Constructional features, e.g. arrangements of optical elements relating to scanning
-
- 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
-
- 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
Definitions
- the present invention relates to a cleaning robot and a method of controlling the same, and more particularly, to a cleaning robot and a method of controlling the same provided to enable detection of a surrounding obstacle.
- the cleaning robot is a device that inhales foreign substances such as dust from the floor while driving by itself on the area to be cleaned without a user's manipulation.
- an obstacle sensor is applied to the cleaning robot.
- the obstacle sensor measures obstacle distribution and distance around the cleaning robot, and the cleaning robot travels based on the measured information. Therefore, the obstacle sensor is closely related to driving and cleaning performance, which is a basic performance factor of the cleaning robot.
- a laser scanner As the obstacle sensor, a laser scanner, a PSD sensor, or the like may be applied.
- the laser scanner is limited in its application to a cleaning robot in terms of cost.
- the PSD sensor when the PSD sensor is applied as a single sensor, since the obstacles cannot be detected at the same time, a delay as much as the time required for the tilting of the sensor is generated, and the durability of the product may be degraded due to the tilting drive.
- An aspect of the present invention is to provide a cleaning robot including a obstacle detecting unit provided to enable detection of obstacles in various directions and a control method thereof.
- the present invention provides a cleaning robot including at least one light emitting part and a light receiving part which is rotatable, and is provided to enable detection of obstacles in various directions by changing the arrangement of the light emitting part and the light receiving part, and a control method thereof.
- the present invention provides a cleaning robot including a rotating multifaceted mirror having a plurality of reflective surfaces around its periphery, and a control method thereof.
- the present invention provides a cleaning robot and a control method thereof in which the reflection mirror of the obstacle detecting unit is rotatable.
- Cleaning robot comprises a light emitting unit for transmitting light; When the transmitted light is reflected on the obstacle, a plurality of light receiving unit provided to receive the light in a predetermined direction of the reflected light reflected from the obstacle; A support plate on which the light emitting unit and the plurality of light receiving units are fixed and rotatably provided; And a controller configured to detect an obstacle based on the output signal transmitted from the light emitting unit and the plurality of light receiving units and the rotation information of the support plate.
- the plurality of light receiving units may be arranged at different inclinations to receive light in different directions.
- the light emitting part and the plurality of light receiving parts may include those formed in a horizontal direction on the support plate or stacked on the support plate in a vertical direction.
- the plurality of light receivers may include: a first light receiver configured to receive light in a predetermined first direction; And a second light receiver configured to receive light in a second predetermined direction.
- the light emitting unit may include: a first light emitting unit provided to transmit light in a first predetermined direction; And a second light emitting part provided to transmit light in a preset second direction.
- the first light receiving part and the first light emitting part may be disposed to be adjacent to the support plate in the horizontal direction, and the second light receiving part and the second light emitting part may be disposed to be adjacent to the support plate in the horizontal direction.
- first light receiving part and the first light emitting part may be formed by being stacked in the vertical direction on the support plate
- the second light receiving part and the second light emitting part may be formed by being stacked in the vertical direction on the support plate.
- the light emitting unit may transmit line light in the longitudinal direction of the cleaning robot.
- the light emitting unit may include a light source; And a conversion lens that converts light generated by the light source into line light.
- the light emitting part and the plurality of light receiving parts may include those formed by being stacked in a vertical direction on the support plate.
- the light emitting part and the plurality of light receiving parts may be disposed to be spaced apart from each other by a first distance in which the light emitting point of the light emitting part and the light receiving point of the plurality of light receiving parts are set in a horizontal direction with the support surface of the support plate.
- the light emitting point of the light emitting part may include a light emitting point of line light formed on the same plane as the light receiving point of the plurality of light receiving parts.
- the apparatus may further include a rotation driver provided to rotate the support plate.
- the rotation driver includes an encoder, and the rotation information includes rotation angle information of the support plate, and the controller may detect an obstacle based on the rotation angle information of the support plate.
- the light receiving unit may include at least one of a photodiode, a photodiode array, a CCD sensor, and a CMOS sensor.
- the controller may detect the obstacle based on at least one of a triangulation method and a time of flight (TOF) method.
- TOF time of flight
- a method of controlling a cleaning robot includes receiving an output signal from a light emitting unit and a plurality of light receiving units, collecting rotation information of a support plate, and detecting an obstacle based on the output signal and the rotation information of the support plate.
- detecting the obstacle based on the output signal and the rotation information may include detecting the obstacle based on at least one of a triangulation method and a time of flight (TOF) scheme.
- TOF time of flight
- detecting the obstacle based on the output signal and the rotation information may include detecting the obstacle based on the light transmission time of the light emitting unit, the light reception time of the light receiving unit, and the rotation information of the support plate.
- collecting rotation information of the support plate may include collecting rotation angle information of the support plate.
- the cleaning robot According to the cleaning robot according to the above, it is possible to provide the upper and lower obstacle detection by changing the arrangement of the light emitting portion and the light receiving portion of the obstacle detection unit.
- FIG. 1 is a view showing the appearance of a cleaning robot according to an embodiment.
- FIG. 2 is a view showing the inside of the cleaning robot according to an embodiment.
- FIG 3 is a view illustrating a bottom of a cleaning robot according to an embodiment.
- 4 and 5 is a control block diagram of the cleaning robot according to an embodiment.
- FIG. 6 is a diagram illustrating an example of a light emitting unit that generates line light.
- FIG. 8 and 9 illustrate a method of arranging a light emitter and a light receiver according to an exemplary embodiment.
- FIG. 10 is a diagram illustrating a disposition method of a light emitting unit and a light receiving unit according to another exemplary embodiment.
- 11 to 13 are views illustrating a light emitting unit and a light receiving unit in a disposition method according to another exemplary embodiment.
- FIG. 14 is a block diagram illustrating a cleaning robot according to another embodiment.
- 15 is a diagram illustrating an example of an obstacle detecting unit of a cleaning robot according to another embodiment.
- Fig. 16 is a diagram showing the detailed structure of a rotating polygon mirror.
- FIG. 17 is a view illustrating an optical path according to the rotation of the rotating polygon mirror based on a cross section of the rotating polygon mirror shown in FIG. 16 in the AA ′ direction.
- FIG. 18 is a block diagram illustrating a cleaning robot according to another embodiment.
- 19 is a cross-sectional view of an obstacle detecting unit of a cleaning robot according to another exemplary embodiment.
- 20 is a diagram illustrating an obstacle detecting principle of an obstacle detecting unit of a cleaning robot according to another embodiment.
- 21 is a flowchart illustrating a control method of a cleaning robot according to an embodiment.
- 22 is a flowchart illustrating a control method of a cleaning robot according to an embodiment.
- FIG. 23 is a flowchart illustrating a control method of a cleaning robot according to an embodiment.
- FIG. 1 is a view showing the appearance of the cleaning robot according to an embodiment
- Figure 2 is a view showing the inside of the cleaning robot according to an embodiment
- the cleaning robot 100 may include a main body 101 and a sub body 103. As shown in FIG. 1, the main body 101 may have a semi-circular shape, and the sub body 103 may have a rectangular shape.
- the shape of the cleaning robot 100 is not limited to including the main body 101 and the sub body 103, the cleaning robot 100 may be formed of a single body or may include three or more bodies.
- the shape of the main body 101 and the sub body 103 is for optimal cleaning, and the shape of the main body 101 and the sub body 103 is not limited to the shape of a semicircle and the shape of a rectangle, respectively.
- the entire body of the cleaning robot 100 may be provided in a circular shape or a rectangular shape.
- Component parts for realizing the function of the cleaning robot 100 may be provided inside and outside the main body 101 and the sub body 103.
- a storage unit 180 for storing a program and data related to the operation of the cleaning robot 100 and a control unit 110 for controlling the operation of the cleaning robot 100 may be provided.
- the names of the respective components included in the cleaning robot 100 may include a user interface 120, a motion detector 130, an obstacle detector 140, an image acquirer 150, a travel unit 160, and a cleaner. It is not limited to the 170, the storage 180, and the controller 110, and each of the components included in the cleaning robot 100 may be referred to by other names that perform the same function.
- the user interface 120 may be provided on an upper surface of the main body 101 of the cleaning robot 100, and may include a plurality of input buttons 121 and a cleaning robot 100 that receive a control command from a user. It may include a display 123 for displaying the operation information of the).
- the plurality of input buttons 121 may include a power button 121a for turning on or off the cleaning robot 100, an operation button 121b for operating or stopping the cleaning robot 100, and a cleaning station 100. It may include a return button (121c) for returning to the (not shown).
- Each of the buttons included in the plurality of input buttons 121 is a push switch for detecting a user's pressure and a membrane switch or a touch switch for detecting a contact of a part of a user's body. ) May be employed.
- the display 123 displays information of the cleaning robot 100 in response to a control command input by the user.
- the display 123 may display an operation state of the cleaning robot, a power state, a cleaning mode selected by the user, whether to return to the charging station, or the like.
- the display 123 may employ a light emitting diode (LED), an organic light emitting diode (OLED), a liquid crystal display, or the like.
- LED light emitting diode
- OLED organic light emitting diode
- liquid crystal display or the like.
- the display 123 may adopt a touch screen panel (TSP) that receives a control command from a user and displays operation information corresponding to the received control command.
- TSP touch screen panel
- the touch screen panel includes a display that displays motion information and control commands that can be input by the user, a touch panel that detects coordinates of a user's body part, and a touch coordinate that is detected by the touch panel. It may include a touch screen controller for determining the input control command.
- the touch screen controller may recognize the control command input by the user by comparing the touch coordinates of the user detected through the touch panel with the coordinates of the control command displayed through the display.
- the motion detector 130 may detect the movement of the cleaning robot 100 while the cleaning robot 100 travels through the cleaning space.
- the motion detector 130 may measure an acceleration, a moving speed, a moving displacement, and a moving direction of the cleaning robot 100 while the cleaning robot 100 moves linearly.
- the motion detector 130 may measure the rotational speed, rotational displacement, and rotational radius of the cleaning robot 100 while the cleaning robot 100 rotates.
- the motion detection unit 130 itself detects the rotation of the acceleration sensor 131, the gyro sensor 133, and the driving wheel 163 described below, which detects the movement of the cleaning robot 100 by itself. ) And the Hall sensor module 137.
- the acceleration sensor 131 may detect linear movement.
- the acceleration sensor 131 may measure linear acceleration, linear velocity and linear displacement of the cleaning robot 100 using Newton's second law of motion (acceleration law).
- the acceleration sensor 131 may employ a micro-electromechanical system (MEMS) type sensor that is miniaturized by fusing micromechanical, microelectronic, and semiconductor process technologies.
- MEMS micro-electromechanical system
- the gyro sensor 133 is called a gyroscope or an angular velocity sensor and detects a rotational movement of the cleaning robot 100.
- the gyro sensor 133 may measure the rotational angular velocity and the rotational displacement of the detection target by using the angular momentum conservation law, the Sagnac effect, the Coriolis force, and the like.
- the gyro sensor 133 may also employ a MEMS (MiCo Electro Mechanical System) sensor.
- MEMS MicroCo Electro Mechanical System
- the capacitive gyro sensor detects the deformation of the micromechanical structure due to the Coriolis force proportional to the rotational speed as the capacitance change and calculates the rotational speed from the change in the capacitance.
- the encoder 135 may include a light emitting device (not shown) for transmitting light, a light receiving device (not shown) for receiving light, a rotating slit (not shown) and a fixed slit (not shown) provided between the light emitting device and the light receiving device. It may include.
- the rotary slit may be provided to rotate together with the traveling wheel 163, and the fixed slit may be fixed to the main body 101.
- the light emitted by the light emitting element may pass through the rotating slit to reach the light receiving element, or may be blocked by the rotating slit.
- the light receiving element can output an electrical signal according to the received light according to the rotation of the rotary slit.
- the controller 110 described below calculates the rotational speed and rotational displacement of the traveling wheel 163 based on the electrical signal output by the light receiving element, and based on the rotational speed and the rotational displacement of the traveling wheel 163.
- a linear movement speed, a linear movement displacement, a rotation movement speed, a rotation movement displacement, and the like of the cleaning robot 100 may be calculated.
- the hall sensor module 137 may include a permanent magnet (not shown) for generating a magnetic field and a hall sensor (not shown) for detecting a magnetic field.
- the permanent magnet may be provided to rotate together with the traveling wheel 163, and the hall sensor may be fixed to the main body 101.
- the hall sensor may or may not detect the magnetic field generated by the permanent magnet. As a result, the hall sensor can output an electrical signal corresponding to the magnetic field detected in accordance with the rotation of the permanent magnet.
- the controller 110 described below calculates the rotational speed and rotational displacement of the traveling wheel 163 based on the electrical signal output from the hall sensor, and based on the rotational speed and the rotational displacement of the traveling wheel 163.
- a linear movement speed, a linear movement displacement, a rotation movement speed, a rotation movement displacement, and the like of the cleaning robot 100 may be calculated.
- the obstacle detecting unit 140 may collect information about an obstacle that hinders the movement of the cleaning robot 100 and transmit it to the control unit 110.
- the obstacle means everything that protrudes from the bottom of the cleaning space to hinder the movement of the cleaning robot 100 or to dent from the bottom of the cleaning space to hinder the movement of the cleaning robot 100.
- Such obstacles may include furniture such as tables, sofas, walls that partition the cleaning space, or porches lower than the floor of the cleaning space.
- the obstacle detecting unit 140 may include a light emitting unit 141 for transmitting light, a light receiving unit 143 provided to receive light in a predetermined direction among the reflected light when the light transmitted from the light emitting unit 141 is reflected from an obstacle,
- the light emitting unit 141 and the light receiving unit 143 may include a support plate 145 is fixed.
- the light emitting unit 141 is fixed to the support plate 145 and provided to rotate 360 degrees in a clockwise or counterclockwise direction with the rotation of the support plate 145.
- the light emitting unit 141 is configured to transmit light, and may be provided in a single or plural number according to the embodiment.
- the light emitting unit 141 may be provided to generate line light.
- FIG. 6 is a diagram illustrating an example of the light emitting unit 141 for generating line light.
- the light emitter 141 converts the light generated by the light source 141-1 and the light source 141-1 into a line light L in the longitudinal direction of the cleaning robot ( 141-2, and the light generated by the light source 141-1 may be converted into line light L while passing through the conversion lens 141-2.
- the longitudinal direction of the cleaning robot means a height direction of the cleaning robot, and may be referred to as a vertical direction for convenience of description.
- the light source 141-1 may transmit light in the infrared region.
- the light source 141-1 may be provided in the form of an LED, but an example of providing the light source 141-1 is not limited thereto and may be provided to transmit laser light according to an exemplary embodiment.
- the conversion lens 141-2 may be formed of a material capable of transmitting light, and may convert the light transmitted from the light source 141-1 to the vertical line light by refraction or total reflection.
- the vertical direction is defined as meaning the vertical direction of the cleaning robot.
- the cleaning robot 100 may generate line light with a single light source 141-1 by introducing a conversion lens 141-2 into the light emitting unit 141.
- the cost generated may be reduced.
- the method of providing the light emitting unit 141 is not limited to the above-described example, and when the obstacle detecting unit 140 employs a plurality of light emitting units 141, the light emitting unit 141 may convert the lens 141-2. ) May not be included. In addition, even when the obstacle detecting unit 140 employs the single light emitting unit 141, the light emitting unit 141 may not include the conversion lens 141-2.
- the light receiver 143 is provided to receive light in a predetermined direction among the reflected light when the light transmitted from the light emitter 141 is reflected from the obstacle.
- the output signal generated by receiving light from the light receiver 143 may be provided to the obstacle detection process of the controller 110.
- the light receiver 143 may be provided in a single or plural number, and when the light receiver 143 is provided in plural, the plurality of light receivers 143 may be disposed at different inclinations to receive light in different directions. For example, when two light receiving units are provided, one light receiving unit may be disposed so that the light receiving surface of the light receiving unit faces the reflected light reflected from an obstacle present at the top of the cleaning robot 100, and the other light receiving unit is receiving the light receiving unit.
- the light receiving surface of the cleaning robot 100 may be disposed to face the obstacle present at the bottom. It will be described below in detail in the relevant section.
- the light receiver 143 may include a condenser lens that collects the received light and an optical sensor that detects the received light. According to an embodiment, the light receiver 143 may include an amplifier for amplifying the light detected by the optical sensor.
- the optical sensor may convert light into an electrical signal and transfer the converted signal to the controller 110.
- Such an optical sensor may include a photo diode, a photo diode array, a CCD sensor, a CMOS sensor, and the like, and more specifically, the photo diode may include a PN diode, a PIN diode, an APD diode, or the like.
- examples of usable optical sensors are not limited thereto.
- the support plate 145 may be provided to be rotatable by the rotation driver 147.
- the rotation driver 147 may include an encoder 149, and the encoder 149 may provide rotation angle information of the support plate 145 to an obstacle detection process of the controller.
- the rotation angle information of the support plate 145 transmitted from the encoder 149 may include direction information of the obstacle.
- the controller may detect an obstacle based on the rotation angle information of the support plate 145 transmitted from the encoder 149 of the rotation driver 147 and the electrical signal output from the light emitting unit 141 and the light receiving unit 143. . Specific detection methods will be described later in the relevant parts.
- the image acquisition unit 150 may include an upward camera module 151 for acquiring an image of the cleaning robot 100, that is, a ceiling, and a front camera module 153 for acquiring an image of the cleaning robot 100 in a driving direction. .
- the upper camera module 151 may include an image sensor (not shown) provided on an upper surface of the cleaning robot 100 to acquire an upper image of the cleaning robot 100, that is, a ceiling image of the cleaning space.
- the front camera module 153 may include an image sensor (not shown) provided on the front surface of the cleaning robot 100 to obtain an image of a driving direction of the cleaning robot 100.
- the image sensor included in each of the upper camera module 151 and the front camera module 153 may employ a complementary metal oxide semiconductor (CMOS) sensor or a charge coupled device (CCD) sensor.
- CMOS complementary metal oxide semiconductor
- CCD charge coupled device
- the image acquirer 150 may output the images acquired by the upper camera module 151 and the front camera module 153 to the controller 110.
- the controller 110 may determine the position of the cleaning robot 100 based on the images acquired by the upper camera module 151 and the front camera module 153. In detail, the controller 110 extracts a feature point from the images acquired by the upper camera module 151 and the front camera module 153, and based on the position change of the extracted feature point, the moving distance, the moving direction, and The movement speed and the like can be determined. In addition, the controller 110 may determine the position of the cleaning robot 100 based on the moving distance, the moving direction, and the moving speed of the cleaning robot 100.
- the driving unit 160 moves the cleaning robot 100 and may include a wheel driving motor 161, a driving wheel 163, and a caster wheel 165 as shown in FIGS. 2 and 3.
- the travel wheels 163 may be provided at both ends of the bottom surface of the main body 101, and the left travel wheels 163a and the cleaning robot 100 provided on the left side of the cleaning robot 100 based on the front of the cleaning robot 100. It may include a right driving wheel (163b) provided on the right side.
- the driving wheel 163 receives the rotational force from the wheel driving motor 161 to move the cleaning robot 100.
- the wheel driving motor 161 generates a rotational force for rotating the driving wheel 163, and includes a left driving motor 161a for rotating the left driving wheel and a right driving motor 161b for rotating the right driving wheel.
- the left driving motor 161a and the right driving motor 161b may operate independently by receiving driving control signals from the controller 110, respectively.
- the left driving wheel 163a and the right driving wheel 163b may be independently rotated by the left driving motor 161a and the right driving motor 161b.
- the cleaning robot 100 may perform various driving operations such as forward driving, backward driving, rotary driving, and in-situ rotation.
- the cleaning robot 100 travels straight forward (forward), and both the left and right traveling wheels 163a and 163b rotate in the second direction.
- the cleaning robot 100 may linearly travel backward.
- the cleaning robot 100 may rotate in place clockwise or counterclockwise.
- the caster wheel 165 is installed on the bottom of the main body 101 and does not interfere with the running of the cleaning robot 100, and allows the cleaning robot 100 to travel while maintaining a stable posture.
- the driving unit 160 may include a motor driving circuit for supplying driving current to the wheel driving motor according to a control signal of the controller 110, a power transmission module for transmitting the rotational force of the wheel driving motor to the driving wheel, the wheel driving motor, or the like. It may further include a rotation sensor (not shown) for detecting the rotational displacement and the rotational speed of the driving wheel.
- the cleaning unit 170 includes a drum brush 173 that scatters dust at the bottom of the cleaning area, a brush drive motor 171 that rotates the drum brush 173, a dust suction fan 177 that sucks scattered dust, and a dust suction unit.
- a dust suction motor 175 rotating the fan 177 and a dust box 179 storing the sucked dust may be included.
- the drum brush 173 is provided in the dust suction port 105 formed on the bottom surface of the sub body 103 as shown in FIG. Dust is scattered into the dust inlet 105.
- the brush driving motor 171 is provided adjacent to the drum brush 173 to rotate the drum brush 173 according to the cleaning control signal of the controller 110.
- the cleaning unit 170 drums the rotational force of the motor driving circuit (not shown) and the brush driving motor 171 to supply the driving current to the brush driving motor 171 according to the control signal of the controller 110. It may further include a power transmission module for transmitting to the brush 173.
- the dust suction fan 177 is provided in the main body 101 as shown in FIG. 2 to suck dust scattered by the drum brush 173 into the dust box 179.
- the dust suction motor 175 is provided at a position adjacent to the dust suction fan 177 to rotate the dust suction fan 177 according to a control signal of the controller 110.
- the cleaning unit 170 dusts the rotational force of the motor driving circuit (not shown) and the dust suction motor 175 to supply a driving current to the dust suction motor 175 according to the control signal of the controller 110.
- a power transmission module (not shown) for transmitting to the suction fan 177 may be further included.
- Dust box 179 is provided in the main body 101, as shown in Figure 2, and stores the dust sucked by the dust suction fan 177.
- the cleaning unit 170 may include a dust guide tube for guiding the dust sucked through the dust suction port 105 of the sub body 103 to the dust box 179 provided in the main body 101.
- the memory 180 may store a control program for controlling the cleaning robot 100, control data, and various application programs and application data for performing various functions according to a user input.
- the memory 180 is an operating system (OS) program that manages configuration and resources (software and hardware) included in the cleaning robot 100, and data that processes electrical signals obtained from the obstacle detecting unit 140.
- OS operating system
- Process program, obstacle detection program for detecting the obstacle based on the electrical signal obtained from the obstacle detection unit 140, the drive motor included in the driving unit 160 and the rotation drive unit 147 of the support plate 145 The motor control program for controlling the drive motor and the like can be stored.
- the memory 180 may be a flash memory, a read only memory, an erasable programmable read only memory (EPROM), as well as a volatile memory such as an S-RAM or a D-RAM. It may include an inactive memory, such as EEPROM (Electrically Erasable Programmable Read Only Memory).
- EPROM erasable programmable read only memory
- EEPROM Electrically Erasable Programmable Read Only Memory
- the inactive memory may semi-permanently store the control program and control data for controlling the operation of the cleaning robot 100, the volatile memory to retrieve and store the control program and control data from the non-volatile memory, or the user interface ( The user command received by the 120, the motion information detected by the motion detector, and location information of the obstacle detected by the controller 110 may be stored.
- the controller 110 controls the overall operation of the cleaning robot 100 and the signal flow between the internal components of the cleaning robot 100 and processes data.
- the controller 110 may execute a program or an application stored in the memory 180 when a command is input from a user or satisfies a preset condition.
- the controller 110 stores a signal or data input from an external device (ROM) 112 and a cleaning robot 100 in which a processor 111, a control program or an application for controlling the cleaning robot 100 is stored, or the cleaning robot 100. It may include a RAM 113 used as a storage area corresponding to various operations performed at 100.
- the ROM 112 and the RAM 113 of the controller 110 may be a concept including a ROM and a RAM of the memory 180.
- the controller 110 may detect the obstacle based on the electrical signal output from the obstacle detector 140 and the information stored in the memory 180. In more detail, the controller 110 may detect an obstacle according to a triangulation method or a time of flight (TOF) method.
- TOF time of flight
- the controller 110 may determine an obstacle detection method according to the design method of the obstacle detection unit 140.
- the triangulation method may be easily applied when the distance from the light emitting point of the light emitting unit 141 to the light receiving point of the light receiving unit 143 is spaced apart by a predetermined distance or more. This is because the distance from the light emitting point of the light emitting unit 141 to the light receiving point of the light receiving unit 143 is provided as an input variable when the triangulation method is applied as described below.
- the TOF method may be easily applied when the distance from the light emitting point of the light emitting unit 141 to the light receiving point of the light receiving unit 143 is set to be smaller than a predetermined distance. This is because obstacle detection is performed under the premise that light is emitted and received at the same point when the TOF method is applied.
- the triangulation method measures the length of one side of a triangle and the angles of both sides of the triangle to calculate the length of the other two sides and the remaining angles.
- the length of one side of the triangle may mean the distance from the light emitting point of the light emitting unit 141 to the light receiving point of the light receiving unit 143.
- the light emitter 141 when the light emitter 141 transmits the line light L, the light emitter 141 emits a point on the line of the line light L, and the support surface of the support plate 145. It may mean a point located in a plane including a light receiving point of the light receiving unit 143 of the virtual plane provided horizontally.
- the controller 110 controls the distance l 1 from the light emitting point P L of the light emitting unit 141 to the light receiving point P D of the light receiving unit 143, and the light emitting unit 141. ),
- the lengths of the other two sides (l 2 , l 3 ) and the remaining angles ( ⁇ o ) can be detected based on the light transmission angle ⁇ L of ), and the light reception angle ⁇ D of the light receiving unit 143. That is, the distance l 3 from the cleaning robot 100 to the obstacle O can be detected.
- the cleaning robot 100 uses a time difference between a time point at which the light is emitted from the light emitter 141 and a time point at which the emitted light is reflected by the obstacle O to return the reflected light to the light receiver 143.
- the controller 110 may detect a distance from the cleaning robot 100 to the obstacle O based on Equation 1 below.
- Equation 1 d denotes a distance from the obstacle detecting unit 140 to the obstacle O, c denotes the speed of light, t1 denotes a time point at which light is received by the light receiving unit 143, and to denotes a light emitting unit ( In step 141, light transmission time is indicated.
- the application example of the TOF method is not limited to the above-described equation 1, according to the embodiment detects the phase difference between the light transmitted from the light emitting unit 141 and the light received from the light receiving unit 143 from the cleaning robot 100
- the distance to the controller 110 can be detected.
- the cleaning robot 100 may freely change the number and arrangement of the light emitting unit 141 and the light receiving unit 143 provided in the obstacle detecting unit 140.
- the light emitter 141 and the light receiver 143 may be stacked in a direction perpendicular to the support plate 145.
- the light emitting unit 141 and the light receiving unit 143 may be provided in a single or plural number, and in some embodiments, the light emitting unit 141 and the light receiving unit 143 may form a sensor module.
- the light emitter 141 and the light receiver 143 may be disposed in the horizontal direction on the support plate 145.
- the light emitting unit 141 and the light receiving unit 143 may be provided in a single or plural number, and in some embodiments, the light emitting unit 141 and the light receiving unit 143 may form a sensor module.
- FIG. 8 and 9 are views illustrating an arrangement method of the light emitting unit 141 and the light receiving unit 143 according to an embodiment
- FIG. 10 is a view illustrating an arrangement of the light emitting unit 141 and the light receiving unit 143 according to another embodiment
- 11 to 13 illustrate a method of arranging the light emitting unit 141 and the light receiving unit 143 according to another embodiment.
- FIGS. 8 to 10 are views illustrating an arrangement method of the light emitter 141 and the light receiver 143 on the premise that the light emitter 141 transmits the line light L.
- FIGS. FIG. 13 is a diagram illustrating an arrangement method of the light emitter 141 and the light receiver 143 on the premise that the light emitter 141 transmits laser light.
- a single light emitting unit 141 and a plurality of light receiving units 143-1, 143-2, and 143-3 are provided on the support plate 145. It may be provided in a stacked form.
- the obstacle detecting unit 140 may include a support plate 145, a first light receiving unit 143-1 disposed on the support plate 145, and configured to receive light in a first predetermined direction D1, and a first The light emitting unit 141 disposed above the light receiving unit 143-1 and arranged to transmit line light L in the vertical direction, and the light in the second direction D2 which is disposed above the light emitting unit 141 and is preset.
- the second light receiving unit 143-2 may be disposed so as to be disposed above the second light receiving unit 143-2, and the third light receiving unit 143-3 may be configured to receive light in a predetermined third direction D3.
- the stacking order of the light emitting unit 141 and the first to third light receiving units 143-1, 143-2, and 143-3 may be provided differently.
- the light in the first to third directions D1, D2, and D3 may be light in different directions.
- the first direction may be a diagonal bottom direction with respect to the xy plane
- the second direction may be in the xy plane.
- the third direction may be a diagonal top direction with respect to the xy plane.
- the light emitting unit 141 and the light receiving unit 143 of the obstacle detecting unit 140 may have a light emitting point P L of the light emitting unit 141 and a light receiving point P D of the light receiving unit 143. ) May be disposed to be spaced apart from a first distance d1 set in a horizontal direction with a support surface of the support plate 145.
- the light emitting point P L of the light emitting unit 141 is defined as being a transmission point of the line light L formed on the same plane as the light receiving point P D of the light receiving unit 143.
- the first distance d1 may be designed differently according to the sensing method of the obstacle detecting unit 140. For example, when the obstacle detecting unit 140 detects the obstacle O by the TOF method, the first distance d1 may be shorter than when the obstacle O is detected by the triangulation method. As described above.
- one light emitting unit 141 transmits line light L in the vertical direction, and the first to third light receiving units 143-1, 143-2, and 143-3 are provided. ) May receive the reflected light reflected from the obstacle O among the line light L transmitted from one light emitter 141.
- the first to third light receiving units 143-1, 143-2, and 143-3 may be inclined to face the direction of light to be received.
- the first light receiving unit 143-1 may be arranged to receive reflected light reflected from an obstacle existing at a lower end of the cleaning robot among the line light L transmitted from the light emitting unit 141.
- the first light receiver 143-1 may be inclined so that the light receiving surface of the first light receiver 143-1 faces the first direction D1.
- the second light receiving unit 143-2 may be inclined so that the light receiving surface of the second light receiving unit 143-2 faces the second direction D2, and the third light receiving unit 143-3 is The third light receiving unit 143-3 may be inclined so that the light receiving surface faces the third direction D3.
- an arrangement angle of the first light receiving unit 143-1 to the third light receiving unit 143-3 may be adjusted according to the height, depth, etc. of the obstacle O to be detected.
- the obstacle detecting unit 140 may be provided in such a manner that one light emitting unit 141 and one light receiving unit 143 are stacked on the support plate 145. .
- the obstacle detecting unit 140 is disposed on the support plate 145, the support plate 145, and is disposed above the light emitting unit 141, and is disposed on the light emitting unit 141 and is set in advance. It may include a light receiving unit 143 provided to receive the light in the direction. In FIG. 10, the light receiving unit 143 receives the light in the second direction D2 as an example. However, the preset direction may be freely designed according to the designer's intention. Hereinafter, a description overlapping with the above-described FIGS. 8 and 9 with respect to the arrangement of the light emitting unit 141 and the light receiving unit 143 will be omitted.
- FIGS. 8 to 10 illustrate the case in which the light emitter 141 transmits the line light L as an example.
- the technical idea of the present invention is not limited to the bar shown in FIGS. 8 to 10.
- a plurality of light emitting units 141 provided to transmit line light L may be provided, and in some embodiments, two or four light receiving units 143 may be provided.
- the stacking order of the light emitting unit 141 and the light receiving unit 143 may be variously changed.
- the obstacle detecting unit 140 includes a plurality of light emitting units 141-1, 141-2, and 141-3 and a plurality of light receiving units 143-1 and 143-2. , 143-3 may be provided to be arranged side by side on the support plate 145.
- the obstacle detecting unit 140 may include a support plate 145, a first light emitting unit 141-1 disposed on the support plate 145, and configured to transmit light in a first direction D1, and first light emission.
- the first light receiving unit 143-1 may be disposed in parallel with the unit 141-1 and provided to receive light in the first direction D1.
- the first light emitter 141-1 and the first light receiver 143-1 may be provided in a module form.
- the optical module including the first light emitting unit 141-1 and the first light receiving unit 143-1 will be referred to as a first optical module M1.
- the obstacle detecting unit 140 is disposed in parallel with the second light emitting unit 141-2 and the second light emitting unit 141-2 provided to transmit light in the second direction D2.
- a second light receiving unit 143-2 provided to receive the light of D2), the third light emitting unit 141-3 provided to transmit light in the third direction D3, and the third light emitting unit (
- the light receiving unit 143-3 may be disposed parallel to the 141-3 and provided to receive light in the third direction D3.
- the second light emitting unit 141-2 and the second light receiving unit 143-2 may form the second optical module M2, and the third light emitting unit 141-3 and the third light receiving unit are formed.
- An 143-3 may form the third optical module M3.
- the first to third optical modules M1 to M3 may be arranged side by side at the edge of the support plate 145.
- the first optical module M1 to the third optical module M3 may be disposed such that the centers of the optical modules M1, M2, and M3 and the support plate 145 form an angle of about 120 degrees.
- the obstacle detecting unit 140 provides the first to third optical modules M1, M2, and M3 in the above-described manner, and simultaneously rotates the support plate 145 in a clockwise or counterclockwise direction. Information on obstacles O present in three directions D3 may be collected.
- the first optical module M1 to the third optical module M3 may be provided to be stacked in the vertical direction on the support plate 145. As shown, it may be provided in the form of a single optical module (M). On the other hand, the technical idea of the invention is not limited to the bar shown in the drawings, two or four or more optical modules are provided in the horizontal direction at the edge of the support plate 145 or stacked in a vertical direction on the upper support plate 145 Of course, it can be prepared.
- the obstacle detecting unit 140 of the cleaning robot 100 according to FIGS. 1 to 13 rotates while the light emitting unit 141 and the light receiving unit 143 are fixed to the support plate 145 and the obstacle O Information can be collected.
- the cleaning robot may collect the obstacle (O) information by employing a variety of obstacle detection unit.
- obstacle detection unit various preparation examples of the obstacle detecting unit will be described.
- Obstacle detection unit of the cleaning robot may be provided to collect the obstacle (O) information of the surrounding by the rotating multi-face mirror or reflecting mirror.
- FIG. 14 is a view showing a control block diagram of a cleaning robot according to another embodiment
- Figure 15 is a view showing an example of the obstacle detection unit of the cleaning robot according to another embodiment
- Figure 16 is a detailed structure of a rotating face mirror The figure is shown.
- the cleaning robot 200 may include a user interface 220, a motion detector 230, an obstacle detector 240, an image acquirer 250, The cleaning unit 270, the memory 280, and the controller 210 may be included.
- a user interface 220 a motion detector 230, an obstacle detector 240, an image acquirer 250,
- the cleaning unit 270, the memory 280, and the controller 210 may be included.
- descriptions overlapping with those of FIGS. 4 and 5 described above with respect to the user interface 220, the motion detector 230, the image acquirer 250, the cleaner 270, and the memory 280 will be omitted. Do it.
- the obstacle detecting unit 240 is configured to rotate the light emitting unit 241, the light receiving unit 243, the rotating polygon mirror 245, and the rotating polygon mirror 245.
- the driver 247 may be included.
- the light emitter 241 may transmit light toward the rotating polygon mirror 245, and the light receiver 243 may receive the reflected light reflected by the rotating polygon mirror 245. Since the obstacle detecting unit 240 according to the present exemplary embodiment detects the obstacle O by the TOF method, the light emitting unit 241 and the light receiving unit 243 are light emitting points of the light emitting unit 241 and light receiving points of the light receiving unit 243, respectively. It may be arranged to form adjacent.
- the light emitting unit 241 and the light receiving unit 243 may be provided in single or plural.
- the light emitter 241 may include a first light emitter 241-1 and a second light emitter 241-2
- the light receiver 243 includes a first light receiver 243-1 and a second light emitter.
- the light receiving unit 243-2 may be included.
- the first light emitting part 241-1 and the first light receiving part 243-1 may form the first optical module M1, and the second light emitting part 241-2 and the second light receiving part 243-2 may be formed. ) May form the second optical module M2.
- the light emitting unit 241 and the light receiving unit 243 may form three or more optical modules, and for convenience of explanation, the light emitting unit 241 and the light receiving unit 243 may be formed of the first and second optical modules, respectively.
- An embodiment of the present invention will be described on the premise of forming M1 and M2).
- the rotating polygon mirror 245 converts the light path of the light transmitted from the light emitting unit 241 into the cleaning area to detect the obstacle O in the cleaning area, and rotates the rotating polygon mirror 245 among the reflected light reflected from the obstacle O.
- the light path of the light incident on the light is converted in the direction of the light receiving unit 243.
- the rotating polygon mirror 245 may be disposed between the first optical module M1 and the second optical module M2 to secure a wide sensing area, and a virtual rotation axis c formed at the center of the rotating polygon mirror 245. It may be provided to be rotated 360 degrees in the clockwise or counterclockwise direction.
- the rotating polygon mirror 245 may be provided in an inclined triangular pillar shape to secure a wide sensing area in the vertical direction of the cleaning robot 200.
- the structure of the rotating polygon mirror 245 will be described in more detail with reference to the accompanying drawings.
- the rotating polygon mirror 245 may be provided such that three reflective surfaces 245-1, 245-2, and 245-3 are provided around the outer periphery.
- the example of providing the rotating multi-face mirror 245 is not limited thereto, and four or five reflective surfaces may be provided.
- an embodiment of the present invention will be described with reference to the rotating multi-faced mirror 245 provided with three reflective surfaces 245-1, 245-2, and 245-3 around the outer periphery, and three reflective surfaces 245.
- At least one of the three reflective surfaces 245-1, 245-2, and 245-3 may be formed to be inclined with the rotation axis c of the rotating polygon mirror 245.
- the rotating face mirror 245 is a rotating face mirror based on a flat top surface 245-4 and a bottom surface 245-5 and a bottom surface 245-5 of the rotating face mirror 245.
- the first reflection surface 245-1 formed to be inclined to the first angle ⁇ 1 in the direction of the rotation axis c of the 245, and the bottom surface 245-5 of the rotation polygon mirror 245.
- the rotation may be provided with a rotation axis (c) in a third direction, the angle ( ⁇ 3), the third reflection surface (245-3) formed in the tilted path 245.
- first to third angles ⁇ 1 , ⁇ 2 , ⁇ 3 may be formed differently, and may be formed within a range of 0 degrees to 180 degrees, respectively.
- an embodiment of the present invention will be described on the assumption that a first angle ⁇ 1 is formed at an obtuse angle, a first angle ⁇ 2 is formed at a right angle, and a third angle ⁇ 3 is formed at an acute angle. do.
- the path of the light transmitted from the light emitter 241 is set in the first direction D 1 as shown in FIG. 16. I can convert it.
- the optical path of the light received from the first direction D 1 of the light reflected from the obstacle O may be converted in the direction of the light receiving unit 243.
- the second reflecting surface 245-2 is formed to be inclined at the first angle ⁇ 2 , so that the path of the light transmitted from the light emitting unit 241 can be converted into the preset second direction D 2 .
- the light path of the light received from the second direction D 2 among the light reflected from the obstacle O may be converted in the direction of the light receiving unit 243.
- the third reflection surface (245-3) can be converted to a third angle ( ⁇ 3), the third direction of the light path originating from the light emitting portion 241 in accordance with the tilting so formed is set in advance (D 3), The light path of the light received from the third direction D 3 among the light reflected from the obstacle O may be converted in the direction of the light receiving unit 243.
- the cleaning robot 200 cleans the reflective surfaces 245-1 and 245-3 of the rotating polygon mirror 245 by being inclined with respect to the central axis c of the rotating polygon mirror 245.
- the obstacle O may be detected at the top or bottom of the cleaning robot 200.
- first to third reflective surfaces 245-1, 245-2, and 245-3 of the rotating polygon mirror 245 are clockwise or counterclockwise as the rotating polygon mirror 245 rotates clockwise or counterclockwise. By rotating together in the direction, it is possible to ensure a wide detection area around the cleaning robot 200.
- the controller 210 controls the overall operation of the cleaning robot 200 and the signal flow between the internal components of the cleaning robot 200 and processes data.
- the controller 210 may detect the obstacle O based on the electrical signal output from the obstacle detector 240 and the information stored in the memory 280.
- the control unit 210 may transmit a light at the light emitting unit 241, a light reception time at the light receiving unit 243, rotation information of the rotating polygon mirror 245, and first to third reflecting surfaces 245-3. Obstacles O may be detected based on the formation angle information.
- FIG. 17 is a view illustrating an optical path according to the rotation of the rotating polygon mirror 245 based on a cross section of the rotating polygon mirror 245 of FIG.
- the optical path is illustrated using the third reflective surface 245-3 of the rotating polygon mirror 245 for convenience of description, and in FIG. 17, T1 and T2 may refer to a T1 and T2 views, respectively.
- the light emitter 241 transmits light in the direction of the rotating polygon mirror 245, the light path transmitted by the light emitter 241 is converted into an optical path by the reflecting surface of the rotating polygon mirror 245 so that the obstacle O ) Function as a detection light for detection purposes.
- the light incident on the rotating polygon mirror 245 may be reflected according to the law of reflection.
- the outgoing light whose light path is converted by the rotating polygon mirror 245 may be referred to as a detection light.
- the rotating polygon mirror 245 is rotated about the virtual axis of rotation (c), accordingly, the detection light is also rotated in the same direction as the rotation direction of the rotary polygon mirror (245).
- the light L1 transmitted from the light emitting unit 241 at the time T1 during the rotation of the rotating polygon mirror 245 is incident on the third reflective surface 245-3 of the rotating polygon mirror 245. Can be.
- the light L1 incident on the third reflecting surface 245-3 is converted into a light path at the third reflecting surface 245-3 to function as detection light.
- FIG. 17 illustrates that the obstacle O does not exist on the optical path of the detection light L1, and the detection light L1 goes straight along the traveling direction.
- the light L2 transmitted from the light emitting unit 241 at the time T2 during the rotation of the rotating polygon mirror 245 may be incident on the third reflective surface 245-3 of the rotating polygon mirror 245.
- the light L2 incident on the third reflecting surface 245-3 is converted into a light path at the third reflecting surface 245-3 to function as detection light.
- FIG. 17 illustrates that the obstacle O exists on the optical path of the detection light L2.
- the reflected light L3 reflected from the obstacle O rotates.
- the optical path is converted by the third reflection surface 245-3 of the mirror 245, and the obstacle O detection signal is generated in the light receiving unit 243.
- the obstacle (O) detection signal generated by the light receiving unit 243 is transmitted to the control unit 210 to be provided to the obstacle (O) detection process of the control unit 210.
- the controller 210 may detect the obstacle O based on the obstacle O detection signal transmitted from the obstacle detector 240.
- the controller 210 detects the distance from the cleaning robot 200 to the obstacle O based on the difference between the light transmission time of the light emitting unit 241 and the light reception time of the light receiving unit 243 and the speed information of the light. Can be.
- controller 210 may detect the direction of the obstacle O based on the rotation information of the rotating polygon mirror 245 and the inclination angle information of the rotating polygon mirror 245.
- the controller 210 determines whether the signal generated by the light receiving unit 243 is a signal due to the light reflected from the light receiving unit 243 based on the rotation angle information of the rotating polygon mirror 245 obtained from the encoder 249.
- the direction of the obstacle O may be detected based on the rotation angle information of the rotating polygon mirror 245 together with the inclination information of the reflection surface previously stored in the memory 280.
- the first to third reflective surfaces 245-1, 245-2, and 245-3 of the rotating polyhedron 245 are formed according to an exemplary embodiment.
- the area By adjusting the area, the size of the sensing area formed by the first to third reflective surfaces 245-1, 245-2, and 245-3 can be adjusted.
- the angle of formation of the detection area may be adjusted by adjusting the inclination of the first to third reflective surfaces 245-1, 245-2, and 245-3 based on the central axis c of the rotating polygon mirror 245.
- the angle of formation of the detection area may be adjusted by adjusting the inclination of the first to third reflective surfaces 245-1, 245-2, and 245-3 based on the central axis c of the rotating polygon mirror 245.
- FIG. 18 is a view showing a control block diagram of a cleaning robot according to another embodiment
- Figure 19 is a view showing a cross section of the obstacle detection unit of the cleaning robot according to another embodiment
- Figure 20 is yet another embodiment 5 is a diagram illustrating an obstacle detection principle of an obstacle detection unit of a cleaning robot according to an example.
- the cleaning robot 300 may include a user interface 320, a motion detector 330, an obstacle detector 340, an image acquirer 350, The cleaning unit 370, the memory 380, and the controller 310 may be included.
- a user interface 320 a motion detector 330, an obstacle detector 340, an image acquirer 350
- the cleaning unit 370, the memory 380, and the controller 310 may be included.
- descriptions overlapping with those of FIGS. 4 and 5 described above with respect to the user interface 320, the motion detector 330, the image acquirer 350, the cleaner 370, and the memory 380 will be omitted. Do it.
- the obstacle detecting unit 340 may include a main body 342 forming the appearance of the obstacle detecting unit 340, a light emitting unit 341, a light receiving unit 343, a splitter, 344, a reflection mirror 345, and a rotation driver 347 provided to rotate the reflection mirror 345.
- the main body 342 has a substantially box shape and is provided such that its outer periphery is opened, and may be partitioned into a plurality of spaces by the first partition 342-1 and the second partition 342-2.
- the first partition 342-1 may be provided to be parallel to the bottom surface of the cleaning robot 300, and the second partition 342-2 may be provided to be perpendicular to the first partition 342-1.
- the first space S1 may be partitioned by the first partition 342-1, and the second space S2 may be partitioned by the second partition 342-2.
- the rotation driver 347 may be accommodated in the first space S1, and a connection line connecting the obstacle detecting unit 340 and the cleaning robot 300 may be accommodated in the second partition 342-2. .
- the light emitting unit 341 may be installed at a lower end of the first partition wall 342-1, and a splitter 344 may be provided around the light emitting unit 341.
- the light emitter 341 transmits light to the front surface, and the transmitted light may be transmitted to the cleaning area through the splitter 344 and the reflection mirror 345.
- the light receiver 343 may be installed at a lower end of the main body 342.
- a splitter 344 may be provided around the light receiver 343, and more specifically, at an upper end of the light receiver 343.
- the light receiver 343 may include a condenser lens 343-1 for condensing the received light and an optical sensor 343-2 for detecting the received light. It may also include an amplifier (not shown) that amplifies the detected light.
- the optical sensor 343-2 may be a concept including a photodiode, and the like and description thereof will be omitted below.
- the splitter 344 may be installed to be adjacent to the light emitting unit 341 and the light receiving unit 343, and more specifically, the light path of the light transmitted from the light emitting unit 341 and the light path of the light received by the light receiving unit 343 are mutually different. Can be installed at the meeting point.
- the splitter 344 converts the path of the light transmitted from the light emitter 341 in the direction of the reflection mirror 345, and enters the splitter 344 so that the light reflected from the reflection mirror 345 travels in the direction of the light receiver 343. It is possible to convert the optical path of the emitted light.
- the reflective mirror 345 may be disposed to be rotatable on the top of the body 342.
- the reflective mirror 345 may be installed on one surface of the reflective mirror body 346, and may be installed at an angle of about 45 degrees with respect to the bottom surface of the main body 342.
- the reflective mirror body 346 may be provided to be rotated in a clockwise or counterclockwise direction by the rotation driver 347 accommodated in the first space S1, and thus the reflective mirror 345 may be provided at the reflective mirror body 346. It can be fixed and rotated clockwise or counterclockwise.
- the controller 310 processes the overall operation of the cleaning robot 300 and the signal flow between the internal components of the cleaning robot 300 and processes data.
- the controller 310 may execute a program or an application stored in the memory 380 when a command is input from the user or satisfies a preset condition.
- the controller 310 may detect the obstacle O based on the electrical signal output from the obstacle detector 340 and the information stored in the memory 380. In more detail, the controller 310 may detect the obstacle O based on the time point at which the light is emitted from the light emitter 341, the time point at which the light is received at the light receiver 343, the rotation information of the reflection mirror 345, and the speed information of the light. have.
- FIG. 20 is a view illustrating an optical path when an obstacle O is detected by the obstacle detecting unit 340 of FIG. 19.
- the transmitted light is converted into an optical path by the splitter 344 to be incident on the reflection mirror 345.
- Light incident on the reflecting mirror 345 is transmitted to the cleaning area according to the law of reflection to function as detection light.
- the reflective mirror 345 is rotated by the rotation driver 347 and forms a wide sensing area around the cleaning robot 300.
- the detection light goes straight along the traveling direction.
- the reflected light reflected from the obstacle O is incident on the reflection mirror 345.
- Light incident on the reflecting mirror 345 may be converted into a light path by the reflecting mirror 345, and may be received by the light sensor 343-2 through a splitter 344 disposed on the light path.
- the controller 310 may detect the distance from the cleaning robot 300 to the obstacle O based on the difference between the light transmission time of the light emitting unit 341 and the light reception time of the light receiving unit 343 and the speed information of the light. have. For example, when the obstacle O is present in the sensing area, a difference may occur between a time point at which light is emitted from the light emitter 341 and a time point at which light is received at the light receiver 343, and the controller 310 transmits light. The distance from the cleaning robot 300 to the obstacle O can be detected based on the viewpoint difference information.
- controller 310 may detect the direction of the obstacle O based on the rotation angle information of the reflection mirror 345 obtained from the rotation driver 347 of the reflection mirror 345.
- the controller 310 may detect the direction of the obstacle O based on the rotation angle information of the reflection mirror 345 obtained from the encoder 349 of the rotation driver 347, and the detected direction information.
- the obstacle O may be detected based on the above-described distance information.
- the cleaning robot 100, 200, 300 may detect an obstacle around the cleaning robot 100, 200, 300 based on at least one of a triangulation method and a time of flight (TOF) method.
- TOF time of flight
- 21 is a flowchart illustrating a control method of a cleaning robot according to an exemplary embodiment.
- control method of the cleaning robot according to FIG. 21 is a control method for the cleaning robot according to FIGS. 1 to 13, and for convenience of the description below, an embodiment of the invention is based on the cleaning robot according to FIGS. 8 and 9. This will be described in detail.
- the cleaning robot 100 may be capable of detecting an obstacle O based on at least one of a triangulation method and a TOF method.
- a triangulation method and a TOF method.
- the control method of the cleaning robot 100 may include collecting obstacle O information from the obstacle detecting unit 140, based on the collected information, based on the collected information. Detecting the obstacle (O) (420).
- Collecting the obstacle O information in the light emitting unit 141 and the first to third light receiving units 143-1, 143-2, and 143-3 may include light transmission angle information of the light emitting unit 141 and the first to third light receiving units. And collecting light reception angle information of the third light receiving units 143-1, 143-2, and 143-3.
- the light transmission angle of the light emitting unit 141 may be stored in advance in the memory 180. In this case, collecting the light transmission angle information of the light emitting unit 141 may be controlled by the controller 110 from the memory 180. It may mean that the light transmission angle information of 141 is received.
- the light reception angles of the first to third light receiving units 143-1, 143-2, and 143-3 may vary depending on the position of the obstacle O.
- FIG. In more detail, the shape of the reflected light may vary according to the position of the obstacle O, and the light receiving angles of the first to third light receiving parts 143-1, 143-2, and 143-3 are different depending on the shape of the reflected light.
- the first to third light receiving units 143-1, 143-2, and 143-3 may generate different output signals according to light receiving angles, and the control unit 110 collects corresponding light receiving angle information to prevent obstacles. (O) may be provided to the detection process (412).
- the collecting of the rotation information of the support plate 145 by the rotation driver 147 may include the controller 110 collecting the rotation angle information of the support plate 145 from the encoder 149 of the rotation driver 147. have. Rotation angle information of the support plate 145 may be provided in the process of detecting the direction of the obstacle (O) (414).
- an operation of detecting the obstacle O based on the collected information may be performed (420).
- the controller 110 may detect the obstacle O according to the triangulation method. More specifically, the control unit 110 is distance information spaced from the light emitting unit 141 to the first to third light receiving units 143-1, 143-2, and 143-3, and light transmission angle information of the light emitting unit 141. The distance from the cleaning robot 100 to the obstacle O can be detected based on the light reception angle information of the light receiving unit. In addition, the direction of the obstacle O may be detected based on the rotation angle information of the rotation driver 147.
- the control unit 110 is distance information spaced from the light emitting unit 141 to the first to third light receiving units 143-1, 143-2, and 143-3, and light transmission angle information of the light emitting unit 141.
- the distance from the cleaning robot 100 to the obstacle O can be detected based on the light reception angle information of the light receiving unit.
- the direction of the obstacle O may be detected based on the rotation angle information of the rotation driver 147.
- the control method of the cleaning robot 100 may include collecting obstacle O information from the obstacle detecting unit 140, based on the collected information, based on the collected information. Detecting the obstacle (O) (420). In the method of detecting the obstacle O according to the TOF method, there is a difference from the triangulation method described above in terms of the type of collected information and the processing method of the collected information.
- the collecting of the obstacle O information by the obstacle detecting unit 140 may include the obstacle O at the light emitting unit 141 and the first to third light receiving units 143-1, 143-2, and 143-3. ) Collecting information 412 and collecting rotation information of the support plate 145 by the rotation driver 147 414.
- the collecting of the obstacle O information from the light emitting unit 141 and the first to third light receiving units 143-1, 143-2, and 143-3 may be performed by using information on the light transmission time of the light emitting unit 141. And collecting light reception time information of the first to third light receiving units 143-1, 143-2, and 143-3.
- the controller 110 may collect the light transmission time information of the light emitter 141 and the light reception time information of the light receiver 143 and provide the information to the obstacle O detection process.
- the controller 110 may collect phase information of the light transmitted from the light emitter 141 and phase information of the light received from the light receiver 143. (412).
- the step of collecting the rotation information of the support plate 145 in the rotation drive unit 147 is the same as described in the triangulation method, and the overlapping description will be omitted (414).
- an operation of detecting the obstacle O based on the collected information may be performed (420).
- the controller 110 may detect the obstacle O according to the TOF method.
- the controller 110 may determine a difference between a light transmission time of the light emitting unit 141 and a light reception time of the first to third light receiving units 143-1, 143-2, and 143-3, from the memory 180.
- the distance from the cleaning robot 100 to the obstacle O may be detected based on the speed information of the received light.
- the direction of the obstacle O may be detected based on the rotation angle information of the rotation driver 147.
- FIG. 22 is a flowchart illustrating a control method of a cleaning robot according to another exemplary embodiment.
- the control method of the cleaning robot according to FIG. 22 is the cleaning robot according to FIGS. 14 to 17, and the control method of the cleaning robot according to the present embodiment will be described below with reference to FIGS. 14 to 17.
- the obstacle detecting unit 240 collects the obstacle O information (510) and the obstacle based on the collected information. It may include detecting (O) (520).
- detecting (O) 520
- collecting the obstacle (O) information in the obstacle detecting unit 240 collecting the obstacle (O) information from the light emitting unit 241 and the light receiving unit 243 (512), and rotates from the rotation drive unit 247 Collecting 514 rotation information of the multi-faceted mirror 245.
- Collecting obstacle O information from the light emitter 241 and the light receiver 243 may include collecting light transmission time information of the light emitter 241 and light reception time information of the light receiver 243.
- the controller 210 may detect the distance from the cleaning robot 200 to the obstacle O based on the light transmission time information of the light emitter 241 and the light reception time information of the light receiver 243 (512). ).
- the control unit 210 may reflect light 245-1, 245-2, and 245-3 of the light receiving unit 243 based on the collected rotation angle information of the rotating polygonal mirror 245. ), Which reflection surface is reflected from the reflection surface, and the description overlapping with the above description will be omitted.
- an operation of detecting the obstacle O based on the collected information may be performed (520).
- the controller 210 may detect the obstacle O based on the TOF method. More specifically, the control unit 210 is an obstacle from the cleaning robot 200 based on the difference between the light transmission time of the light emitting unit 241 and the light receiving time of the light receiving unit 243, the speed information of the light received from the memory 280. The distance to (O) can be detected. In addition, the controller 210 may detect the direction of the obstacle O based on the xy plane based on the rotation angle information of the rotating polygon mirror 245, and the rotation angle information and the memory 280 of the rotating polygon mirror 245. The direction of the obstacle O may be detected based on the z-axis based on the inclination information of the rotating polygon mirror 245 received from). Hereinafter, descriptions overlapping with those described above will be omitted.
- FIG. 23 is a flowchart illustrating a control method of a cleaning robot according to another embodiment.
- the control method of the cleaning robot according to FIG. 23 relates to the cleaning robot according to FIGS. 18 to 20, and the control method of the cleaning robot according to the present embodiment will be described below with reference to FIGS. 18 to 20.
- the obstacle detecting unit 340 collects obstacle (O) information (610) and an obstacle based on the collected information. And detecting (O) (620).
- collecting the obstacle (O) information in the obstacle detecting unit 340 collecting the obstacle (O) information from the light emitting unit 341 and the light receiving unit 343 (612), and reflected from the rotation drive unit 347 Collecting 614 rotation information of the mirror 345.
- Collecting obstacle O information from the light emitter 341 and the light receiver 343 may include collecting light transmission time information of the light emitter 341 and light reception time information of the light receiver 343.
- the controller 310 may detect a distance from the cleaning robot 300 to the obstacle O based on the light transmission time information of the light emitting unit 341 and the light reception time information of the light receiving unit 343 (612). ).
- the step of collecting rotation information of the reflection mirror 345 from the rotation driver 347 may include the control unit 310 collecting rotation angle information of the reflection mirror 345 from the encoder 349 of the rotation driver 347. It may be (614).
- the detecting of the obstacle O based on the collected information may be performed (620).
- the controller 310 may detect the obstacle O based on the TOF method. More specifically, the control unit 310 is an obstacle from the cleaning robot 300 based on the difference between the light transmission time of the light emitting unit 341 and the light receiving time of the light receiving unit 343, the speed information of the light received from the memory 380. The distance to (O) can be detected. In addition, the controller 310 may detect the direction of the obstacle O based on the xy plane based on the rotation angle information of the reflection mirror 345. Hereinafter, descriptions overlapping with those described above will be omitted.
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Robotics (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Optics & Photonics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Electric Vacuum Cleaner (AREA)
Abstract
청소 로봇 및 그 제어 방법에 관한 것으로, 보다 상세하게 여러 방향의 장애물 검출이 가능하도록 마련된 청소 로봇 및 그 제어 방법에 관한 것이다. 일 실시 예에 따른 청소 로봇은 광을 발신하는 발광부; 상기 발신된 광이 장애물에 반사되면, 상기 장애물로부터 반사된 반사 광 중 미리 설정된 방향의 광을 수신하도록 마련된 복수 개의 수광부; 상기 발광부 및 상기 복수 개의 수광부가 고정되며, 회전 가능하도록 마련된 지지판; 및 상기 발광부 및 상기 복수 개의 수광부로부터 전달된 출력 신호 및 상기 지지판의 회전 정보에 기초하여 상기 장애물을 검출하는 제어부;를 포함한다.
Description
청소 로봇 및 그 제어 방법에 관한 발명으로, 보다 상세하게 주위의 장애물 검출이 가능하도록 마련된 청소 로봇 및 그 제어 방법에 관한 발명이다.
청소 로봇은 사용자의 조작 없이도 청소하고자 하는 영역을 스스로 주행하면서 바닥으로부터 먼지 등의 이물질을 흡입하는 장치이다.
청소 로봇의 주행을 위해서는 주변의 장애물을 감지하고 청소 로봇으로부터 장애물까지의 거리를 인식할 필요가 있다. 이를 위해 청소 로봇에는 장애물 센서가 적용되게 된다. 장애물 센서는 청소로봇 주위의 장애물 분포, 거리 등을 측정하고, 청소 로봇은 측정된 정보를 바탕으로 주행을 한다. 따라서, 장애물 센서는 청소로봇의 기본성능 요소인 주행 및 청소 성능에 밀접한 관련을 가지고 있다.
장애물 센서로는 레이저 스캐너, PSD 센서 등이 적용될 수 있다. 여기서, 레이저 스캐너는 가격적인 측면으로 청소 로봇에의 적용에 한계가 있다. 또한, PSD 센서는 단일 센서로 적용될 경우 장애물의 동시 감지가 안되므로 센서의 틸팅에 필요한 시간만큼의 딜레이가 발생하며, 틸팅 구동으로 인해 제품의 내구성이 저하될 수 있었다.
일 측면은 여러 방향의 장애물 검출이 가능하도록 마련된 장애물 감지부를 포함하는 청소 로봇 및 그 제어 방법을 제공하고자 한다.
보다 상세하게, 회전 가능하도록 마련된 적어도 하나의 발광부 및 수광부를 포함하고, 발광부 및 수광부의 배치 변경으로 여러 방향의 장애물 검출이 가능하도록 마련된 청소 로봇 및 그 제어 방법을 제공하고자 한다.
또한, 외곽 둘레에 복수 개의 반사면을 구비하는 회전 다면경을 포함하는 청소 로봇 및 그 제어 방법을 제공하고자 한다.
또한, 장애물 감지부의 반사 거울이 회전 가능하도록 마련된 청소 로봇 및 그 제어 방법을 제공하고자 한다.
일 측면에 따른 청소 로봇은 광을 발신하는 발광부; 발신된 광이 장애물에 반사되면, 장애물로부터 반사된 반사 광 중 미리 설정된 방향의 광을 수신하도록 마련된 복수 개의 수광부; 발광부 및 복수 개의 수광부가 고정되며, 회전 가능하도록 마련된 지지판; 및 발광부 및 복수 개의 수광부로부터 전달된 출력 신호 및 지지판의 회전 정보에 기초하여 장애물을 검출하는 제어부;를 포함한다.
또한, 복수 개의 수광부는, 서로 다른 방향의 광을 수신하도록 서로 다른 기울기로 배치될 수 있다.
또한, 발광부와 복수 개의 수광부는, 지지판에 수평 방향으로 배치되거나, 지지판에 수직 방향으로 적층되어 형성된 것을 포함할 수 있다.
또한, 복수 개의 수광부는, 미리 설정된 제 1 방향의 광을 수광하도록 마련된 제 1 수광부; 및 미리 설정된 제 2 방향의 광을 수광하도록 마련된 제 2 수광부;를 포함할 수 있다.
또한, 발광부는, 미리 설정된 제 1 방향으로 광을 발신하도록 마련된 제 1 발광부; 및 미리 설정된 제 2 방향으로 광을 발신하도록 마련된 제 2 발광부;를 포함할 수 있다.
또한, 제 1 수광부와 제 1 발광부는 지지판에 수평 방향으로 이웃하도록 배치되고, 제 2 수광부와 제 2 발광부는 지지판에 수평 방향으로 이웃하도록 배치될 수 있다.
또한, 제 1 수광부와 제 1 발광부가 지지판에 수직 방향으로 적층되어 형성되고, 제 2 수광부와 제 2 발광부는 지지판에 수직 방향으로 적층되어 형성될 수 있다.
또한, 발광부는, 청소 로봇의 길이 방향으로 라인 광을 발신할 수 있다.
또한, 발광부는, 광원; 및 광원에서 생성된 광을 라인 광으로 변환하는 변환렌즈;를 포함할 수 있다.
또한, 발광부와 복수 개의 수광부는, 지지판에 수직 방향으로 적층되어 형성된 것을 포함할 수 있다.
또한, 발광부와 복수 개의 수광부는, 발광부의 발광 지점과 복수 개의 수광부의 수광 지점이 지지판의 지지면과 수평한 방향으로 미리 설정된 제 1 거리만큼 이격 배치될 수 있다.
또한, 발광부의 발광 지점은, 복수 개의 수광부의 수광 지점과 동일 평면 상에 형성되는 라인 광의 발신 지점을 포함할 수 있다.
또한, 지지판을 회전 구동시키도록 마련된 회전 구동부;를 더 포함할 수 있다.
또한, 회전 구동부는 인코더를 포함하고, 회전 정보는, 지지판의 회전 각도 정보를 포함하고, 제어부는 지지판의 회전 각도 정보에 기초하여 장애물을 검출할 수 있다.
또한, 수광부는, 포토 다이오드, 포토 다이오드 어레이, CCD 센서 및 CMOS 센서 중 적어도 하나를 포함할 수 있다.
또한, 제어부는, 삼각 측량법 및 TOF(Time of flight) 방식 중 적어도 하나에 기초하여 장애물을 검출할 수 있다.
다음으로, 일 측면에 따른 청소 로봇의 제어 방법은, 발광부 및 복수 개의 수광부로부터 출력 신호를 전달 받고, 지지판의 회전 정보를 수집하고, 출력 신호 및 지지판의 회전 정보에 기초하여 장애물을 검출하는 것을 포함한다.
또한, 출력 신호 및 회전 정보에 기초하여 장애물을 검출하는 것은, 삼각 측량법 및 TOF(Time of flight) 방식 중 적어도 하나에 기초하여 장애물을 검출하는 것을 포함할 수 있다.
또한, 발광부와 복수 개의 수광부는, 발광부의 발광 지점과 복수 개의 수광부의 수광 지점이 지지판의 지지면과 수평한 방향으로 미리 설정된 제 1 거리만큼 이격 배치된 것을 포함하고, 출력 신호 및 지지판의 회전 정보에 기초하여 장애물을 검출하는 것은, 제 1 거리, 발광부의 광 발신 각도 정보, 수광부의 광 수신 각도 정보 및 지지판의 회전 정보에 기초하여 장애물을 검출하는 것을 포함할 수 있다.
또한, 출력 신호 및 회전 정보에 기초하여 장애물을 검출하는 것은, 발광부의 광 발신 시점, 수광부의 광 수신 시점 및 지지판의 회전 정보에 기초하여 장애물을 검출하는 것을 포함할 수 있다.
또한, 지지판의 회전 정보를 수집하는 것은, 지지판의 회전 각도 정보를 수집하는 것을 포함할 수 있다.
전술한 바에 따른 청소 로봇에 의하면, 장애물 감지부의 발광부 및 수광부의 배치를 변경 함으로써 상하부 장애물 검출이 가능하도록 마련할 수 있다.
보다 상세하게, 장애물 감지부에 마련된 소자의 틸팅 구동이 아닌 소자의 배치 변경만으로 여러 방향에 대한 장애물 검출이 가능하도록 마련함으로써 가격 상승과 내구성 저하 문제에 대비할 수 있다.
도 1은 일 실시 예에 따른 청소 로봇의 외관을 도시한 도면이다.
도 2는 일 실시 예에 따른 청소 로봇의 내부를 도시한 도면이다.
도 3은 일 실시 예에 따른 청소 로봇의 저면을 도시한 도면이다.
도 4 및 도 5는 일 실시 예에 따른 청소 로봇의 제어 구성도 이다.
도 6은 라인 광을 생성하는 발광부의 예를 도시한 도면이다.
도 7은 삼각 측량 방식의 원리를 도시한 도면이다.
도 8 및 도 9는 일 실시 예에 따른 발광부와 수광부의 배치 방식을 도시한 도면이다.
도 10는 다른 실시 예에 따른 발광부와 수광부의 배치 방식을 도시한 도면이다.
도 11 내지 도 13은 또 다른 실시 예에 따른 발광부와 수광부의 배치 방식을 도시한 도면이다.
도 14는 다른 실시 예에 따른 청소 로봇의 제어 블록도를 도시한 도면이다.
도 15는 다른 실시 예에 따른 청소 로봇의 장애물 감지부의 예를 도시한 도면이다.
도 16은 회전 다면경의 상세 구조를 도시한 도면이다.
도 17은 도 16의 회전 다면경을 AA'방향으로 자른 단면을 기초로 회전 다면경의 회전에 따른 광 경로를 도시한 도면이다.
도 18은 또 다른 실시 예에 따른 청소 로봇의 제어 블록도를 도시한 도면이다.
도 19는 또 다른 실 시 예에 따른 청소 로봇의 장애물 감지부의 단면을 도시한 도면이다.
도 20은 또 다른 실시 예에 따른 청소 로봇의 장애물 감지부의 장애물 감지 원리를 도시한 도면이다.
도 21은 일 실시 예에 따른 청소 로봇의 제어 방법에 대한 순서도 이다.
도 22는 일 실시 예에 따른 청소 로봇의 제어 방법에 대한 순서도 이다.
도 23은 일 실시 예에 따른 청소 로봇의 제어 방법에 대한 순서도 이다.
본 명세서에 기재된 실시 예와 도면에 도시된 구성은 발명의 바람직한 예에 불과할 뿐이며, 본 출원의 출원 시점에 있어서 본 명세서의 실시 예와 도면을 대체할 수 있는 다양한 변형 예들이 있을 수 있다.
이하 첨부된 도면을 참조하여 청소 로봇의 다양한 실시 예에 대해 설명하도록 한다.
도 1은 일 실시 예에 따른 청소 로봇의 외관을 도시한 도면이고, 도 2는 일 실시 예에 따른 청소 로봇의 내부를 도시한 도면이고, 도 3은 일 실시 예에 따른 청소 로봇의 저면을 도시한 도면이고, 도 4 및 도 5는 일 실시 예에 따른 청소 로봇의 제어 구성도 이다.
도 1 내지 도 5를 참조하면, 청소 로봇(100)은 메인 바디(101)와 서브 바디(103)를 포함할 수 있다. 도 1에 도시된 바와 같이 메인 바디(101)는 반원의 형태를 가질 수 있고, 서브 바디(103)는 직사각형의 형태를 가질 수 있다.
다만, 청소 로봇(100)의 형상이 메인 바디(101)와 서브 바디(103)를 포함하는 것에 한정되는 것은 아니며, 청소 로봇(100)은 단일 바디로 형성되거나 3 이상의 바디를 포함할 수 있다. 또한, 메인 바디(101)와 서브 바디(103)의 형상은 최적의 청소를 위한 것이며, 메인 바디(101)와 서브 바디(103)의 형상이 각각 반원의 형태 및 직사각형의 형태에 한정되는 것은 아니다. 예를 들어, 청소 로봇(100)의 바디 전체가 원형 형태로 또는 직사각형 형태로 마련될 수 있다.
메인 바디(101) 및 서브 바디(103)의 내부 및 외부에는 청소 로봇(100)의 기능을 실현하기 위한 구성 부품이 마련될 수 있다.
구체적으로, 메인 바디(101) 및 서브 바디(103) 내부 및 외부에는 사용자와 상호 작용하는 유저 인터페이스(120), 청소 로봇의 움직임과 관련된 정보를 검출하는 움직임 감지부(130), 청소 공간의 장애물을 감지하는 장애물 감지부(140), 청소 로봇(100)의 주변 영상을 획득하는 영상 획득부(150), 청소 로봇(100)을 이동시키는 주행부(160), 청소 공간을 청소하는 청소부(170), 청소 로봇(100)의 동작과 관련된 프로그램 및 데이터를 저장하는 저장부(180) 및 청소 로봇(100)의 동작을 제어하는 제어부(110)가 마련될 수 있다.
다만, 청소 로봇(100)에 포함된 각각의 구성의 명칭이 유저 인터페이스(120), 움직임 감지부(130), 장애물 감지부(140), 영상 획득부(150), 주행부(160), 청소부(170), 저장부(180) 및 제어부(110)에 한정되는 것은 아니며, 청소 로봇(100)에 포함된 각각의 구성은 동일한 기능을 수행하는 다른 명칭으로 호칭될 수 있다. 유저 인터페이스(120)는 도 1에 도시된 바와 같이 청소 로봇(100)의 메인 바디(101) 상면에 마련될 수 있으며, 사용자로부터 제어 명령을 입력받는 복수의 입력 버튼(121)과 청소 로봇(100)의 동작 정보를 표시하는 디스플레이(123)를 포함할 수 있다.
복수의 입력 버튼(121)은 청소 로봇(100)을 온 또는 오프시키는 전원 버튼(121a), 청소 로봇(100)을 동작시키거나 정지시키는 동작 버튼(121b), 청소 로봇(100)을 충전 스테이션(미도시)으로 복귀시키는 복귀 버튼(121c) 등을 포함할 수 있다.
이와 같은 복수의 입력 버튼(121)에 포함된 각각의 버튼은 사용자의 가압을 감지하는 푸시 스위치(push switch)와 멤브레인 스위치(membrane switch) 또는 사용자의 신체 일부의 접촉을 감지하는 터치 스위치(touch switch) 등을 채용할 수 있다.
디스플레이(123)는 사용자가 입력한 제어 명령에 대응하여 청소 로봇(100)의 정보를 표시한다. 예를 들어, 디스플레이(123)는 청소 로봇의 동작 상태, 전원의 상태, 사용자가 선택한 청소 모드, 충전 스테이션으로의 복귀 여부 등을 표시할 수 있다.
이와 같은 디스플레이(123)는 발광 다이오드(Light Emitting Diode:LED)와 유기 발광 다이오드(Organic Light Emitting Diode: OLED) 또는 액정 디스플레이(Liquid Crystal Display) 등을 채용할 수 있다.
또한, 디스플레이(123)는 사용자로부터 제어 명령을 입력받고, 입력 받은 제어 명령에 대응하는 동작 정보를 표시하는 터치 스크린 패널(Touch Screen Panel: TSP)을 채용할 수도 있다.
터치 스크린 패널은 동작 정보 및 사용자가 입력할 수 있는 제어 명령을 표시하는 디스플레이, 사용자의 신체 일부가 접촉한 좌표를 검출하는 터치 패널(touch panel), 터치 패널이 검출한 접촉 좌표를 기초로 사용자가 입력한 제어 명령을 판단하는 터치 스크린 컨트롤러를 포함할 수 있다.
터치 스크린 컨트롤러는 터치 패널을 통하여 검출하는 사용자의 터치 좌표와 디스플레이를 통하여 표시하는 제어 명령의 좌표를 비교하여 사용자가 입력한 제어 명령을 인식할 수 있다.
움직임 감지부(130)는 청소 로봇(100)이 청소 공간을 주행하는 동안 청소 로봇(100)의 움직임을 감지할 수 있다.
구체적으로, 움직임 감지부(130)는 청소 로봇(100)이 선형 이동하는 동안 청소 로봇(100)의 가속도, 이동 속도, 이동 변위 및 이동 방향 등을 측정할 수 있다. 또한 움직임 감지부(130)는 청소 로봇(100)이 회전 이동하는 동안 청소 로봇(100)의 회전 속도, 회전 변위 및 회전 반경 등을 측정할 수 있다.
이와 같은 움직임 감지부(130)는 자체적으로 청소 로봇(100)의 움직임을 감지하는 가속도 센서(131)와 자이로 센서(133), 아래에서 설명되는 주행 바퀴(163)의 회전을 감지하는 엔코더(135)와 홀 센서 모듈(137)을 포함할 수 있다.
가속도 센서(131)는 선형 이동을 감지할 수 있다. 예를 들어, 가속도 센서(131)는 뉴턴의 제 2 운동 법칙(가속도 법칙)을 이용하여 청소 로봇(100)의 선형 가속도, 선형 속도 및 선형 변위 등을 측정할 수 있다.
이러한 가속도 센서(131)는 마이크로 기계, 마이크로 전자 및 반도체 공정 기술을 융합하여 소형화된 MEMS(MiCo Electro Mechanical System)형 센서를 채용할 수 있다.
자이로 센서(133)는 자이로 스코프 또는 각속도 센서라 불리며, 청소 로봇(100)의 회전 이동을 감지한다. 구체적으로 자이로 센서(133)는 각운동량 보존 법칙, 사냑 효과, 코리올리 힘 등을 이용하여 검출 대상의 회전 각속도 및 회전 변위 등을 측정할 수 있다.
이러한 자이로 센서(133) 역시 MEMS(MiCo Electro Mechanical System)형 센서를 채용할 수 있다. 예를 들어, MEMS형 자이로 센서 가운데 정전 용량 자이로 센서는 회전 속도에 비례하는 코리올리 힘에 의한 미세 기계 구조물의 변형을 정전용량 변화로 검출하고, 정전 용량의 변화로부터 회전 속도를 산출한다.
엔코더(135)는 광을 발신하는 발광 소자(미도시), 광을 수신하는 수광 소자(미도시), 발광 소자와 수광 소자 사이에 마련되는 회전 슬릿(미도시)과 고정 슬릿(미도시)을 포함할 수 있다. 여기서, 회전 슬릿은 주행 바퀴(163)와 함께 회전하도록 마련되고, 고정 슬릿은 메인 바디(101)에 고정되어 마련될 수 있다.
회전 슬릿의 회전에 따라 발광 소자가 발신한 광이 회전 슬릿을 통과하여 수광 소자에 도달하거나, 회전 슬릿에 의하여 차단될 수 있다. 그 결과, 수광 소자는 회전 슬릿의 회전에 따라 수신된 광에 따른 전기적 신호를 출력할 수 있다.
또한, 아래에서 설명되는 제어부(110)는 수광 소자가 출력한 전기적 신호를 기초로 주행 바퀴(163)의 회전 속도 및 회전 변위를 산출하고, 주행 바퀴(163)의 회전 속도 및 회전 변위를 기초로 청소 로봇(100)의 선형 이동 속도, 선형 이동 변위, 회전 이동 속도 및 회전 이동 변위 등을 산출할 수 있다.
홀 센서 모듈(137)은 자기장을 생성하는 영구 자석(미도시), 자기장을 검출하는 홀 센서(미도시)를 포함할 수 있다. 여기서, 영구 자석은 주행 바퀴(163)와 함께 회전하도록 마련되고, 홀 센서는 메인 바디(101)에 고정되어 마련될 수 있다.
영구 자석의 회전에 따라 홀 센서는 영구 자석이 생성하는 자기장을 검출하거나 검출하지 못할 수 있다. 그 결과, 홀 센서는 영구 자석의 회전에 따라 검출된 자기장에 대응하는 전기적 신호를 출력할 수 있다.
또한, 아래에서 설명되는 제어부(110)는 홀 센서가 출력한 전기적 신호를 기초로 주행 바퀴(163)의 회전 속도 및 회전 변위를 산출하고, 주행 바퀴(163)의 회전 속도 및 회전 변위를 기초로 청소 로봇(100)의 선형 이동 속도, 선형 이동 변위, 회전 이동 속도 및 회전 이동 변위 등을 산출할 수 있다.
장애물 감지부(140)는 청소 로봇(100)의 이동을 방해하는 장애물에 대한 정보를 수집하고, 이를 제어부(110)에 전달할 수 있다.
여기서, 장애물이란 청소 공간의 바닥으로부터 돌출되어 청소 로봇(100)의 이동을 방해하거나 청소 공간의 바닥으로부터 움푹 패여 청소 로봇(100)의 이동을 방해할 수 있는 모든 것을 의미한다. 이러한 장애물은 테이블, 쇼파 등의 가구, 청소 공간을 구획하는 벽면 또는 청소 공간의 바닥보다 낮은 현관 등을 포함할 수 있다.
장애물 감지부(140)는 광을 발신하는 발광부(141)와, 발광부(141)에서 발신된 광이 장애물로부터 반사되면 반사 광 중 미리 설정된 방향의 광을 수신하도록 마련된 수광부(143)와, 발광부(141) 및 수광부(143)가 고정되는 지지판(145)을 포함할 수 있다.
발광부(141)는 지지판(145)에 고정되어 지지판(145)의 회전과 함께 시계 또는 반시계 방향으로 360도 회전 가능하도록 마련된다.
발광부(141)는 광을 발신하는 구성으로, 실시 예에 따라 단일 또는 복수 개로 마련될 수 있다.
장애물 감지부(140)가 단일 발광부(141)를 채용하는 경우, 발광부(141)는 라인 광을 생성하도록 마련될 수 있다.
도 6은 라인 광을 생성하는 발광부(141)의 예를 도시한 도면이다.
도 6에 도시된 바를 참조하면, 발광부(141)는 광원(141-1)과 광원(141-1)에서 생성된 광을 청소 로봇의 길이 방향의 라인 광(L)으로 변환하는 변환 렌즈(141-2)를 포함할 수 있으며, 광원(141-1)에서 생성된 광은 변환 렌즈(141-2)를 지나며 라인 광(L)으로 변환될 수 있다. 이하, 본 명세서에서 청소 로봇의 길이 방향은 청소 로봇의 높이 방향을 의미하며, 설명의 편의상 세로 방향으로 지칭될 수 있다.
광원(141-1)은 적외선 영역의 광을 발신할 수 있다. 광원(141-1)은 LED 형태로 마련될 수 있으나, 광원(141-1)의 마련 예가 이에 한정되는 것은 아니며 실시 예에 따라 레이저 광을 발신하도록 마련될 수도 있다.
변환 렌즈(141-2)는 광을 투과시킬 수 있는 재질로 마련될 수 있으며, 굴절 또는 전반사 등에 의해 광원(141-1)으로부터 발신된 광을 세로 방향의 라인 광으로 변환할 수 있다. 이하 세로 방향은 청소 로봇의 상하방향을 의미 하는 것으로 정의한다.
본 실시 예에 따른 청소 로봇(100)은 도 6에서 설명한 바와 같이 발광부(141)에 변환 렌즈(141-2)를 도입 함으로써 단일 광원(141-1)으로 라인 광을 생성할 수 있으며, 결과적으로 복수 개의 발광부(141)를 채용할 경우 발생되는 비용을 절감할 수 있다.
한편, 발광부(141)의 마련 방식이 전술한 예에 한정되는 것은 아니며, 장애물 감지부(140)가 복수 개의 발광부(141)를 채용하는 경우 발광부(141)가 변환 렌즈(141-2)를 포함하지 않을 수 있다. 또한, 장애물 감지부(140)가 단일 발광부(141)를 채용하는 경우라도 발광부(141)가 변환 렌즈(141-2)를 포함하지 않을 수 있음은 물론이다.
수광부(143)는 발광부(141)에서 발신된 광이 장애물로부터 반사되면 반사된 광 중 미리 설정된 방향의 광을 수신하도록 마련된다. 수광부(143)에 광이 수신되어 생성된 출력 신호는 제어부(110)의 장애물 검출 과정에 제공될 수 있다.
수광부(143)는 단일 또는 복수 개로 마련될 수 있으며, 수광부(143)가 복수 개로 마련될 경우 복수 개의 수광부(143)는 서로 다른 방향의 광을 수신하도록 서로 다른 기울기로 배치될 수 있다. 예를 들어, 두 개의 수광부가 마련되는 경우 하나의 수광부는 수광부의 수광 면이 청소 로봇(100)의 상단에 존재하는 장애물로부터 반사된 반사 광을 향하도록 배치될 수 있으며, 다른 하나의 수광부는 수광부의 수광 면이 청소 로봇(100)의 하단에 존재하는 장애물을 향하도록 배치될 수 있다. 이하, 관련 부분에서 상세하게 설명하도록 한다.
수광부(143)는 수신되는 광을 집광하는 집광 렌즈와 수신되는 광을 검출하는 광 센서를 포함할 수 있다. 실시 예에 따라 수광부(143)는 광 센서에서 검출된 광을 증폭하는 증폭기를 포함할 수도 있다.
광 센서는 광을 전기적 신호로 변환하고 변환된 신호를 제어부(110)로 전달할 수 있다. 이러한 광 센서는 포토 다이오드, 포토 다이오드 어레이, CCD 센서, CMOS 센서 등을 포함할 수 있으며, 보다 상세하게 포토 다이오드는 PN 다이오드, PIN 다이오드, APD 다이오드 등을 포함할 수 있다. 다만, 사용 가능한 광 센서의 예가 이에 한정되는 것은 아니다.
지지판(145)은 회전 구동부(147)에 의해 회전 가능하도록 마련될 수 있다. 회전 구동부(147)는 엔코더(149)를 포함할 수 있으며, 엔코더(149)는 지지판(145)의 회전 각도 정보를 제어부의 장애물 검출 과정에 제공할 수 있다. 엔코더(149)로부터 전달된 지지판(145)의 회전 각도 정보는 장애물의 방향 정보를 포함할 수 있다. 제어부는, 회전 구동부(147)의 엔코더(149)로부터 전달된 지지판(145)의 회전 각도 정보와 함께 발광부(141)와 수광부(143)로부터 출력된 전기적 신호에 기초해 장애물을 검출할 수 있다. 구체적인 검출 방법은 관련 부분에서 후술하도록 한다.
영상 획득부(150)는 청소 로봇(100) 상방 즉 천장의 영상을 획득하는 상방 카메라 모듈(151)과 청소 로봇(100) 주행 방향의 영상을 획득하는 전방 카메라 모듈(153)을 포함할 수 있다.
상방 카메라 모듈(151)은 청소 로봇(100)의 상면에 마련되어 청소 로봇(100)의 상방 영상 즉 청소 공간의 천장 영상을 획득하는 영상 센서(미도시)를 포함할 수 있다.
전방 카메라 모듈(153)은 청소 로봇(100)의 전면에 마련되어 청소 로봇(100)의 주행 방향의 영상을 획득하는 영상 센서(미도시)를 포함할 수 있다.
또한, 상방 카메라 모듈(151) 및 전방 카메라 모듈(153) 각각에 포함된 영상 센서는 CMOS(Complementary Metal Oxide Semiconductor) 센서 또는 CCD(Charge coupled device) 센서를 채용할 수 있다.
영상 획득부(150)는 상방 카메라 모듈(151) 및 전방 카메라 모듈(153)이 획득한 영상을 제어부(110)로 출력할 수 있다.
제어부(110)는 상방 카메라 모듈(151) 및 전방 카메라 모듈(153)이 획득한 영상을 기초로 청소 로봇(100)의 위치를 판단할 수 있다. 구체적으로 제어부(110)는 상방 카메라 모듈(151) 및 전방 카메라 모듈(153)이 획득한 영상으로부터 특징점을 추출하고 추출된 특징점의 위치 변화를 기초로 청소 로봇(100)의 이동 거리, 이동 방향 및 이동 속도 등을 판단할 수 있다. 또한 제어부(110)는 청소 로봇(100)의 이동 거리, 이동 방향 및 이동 속도 등을 기초로 청소 로봇(100)의 위치를 판단할 수 있다.
주행부(160)는 청소 로봇(100)을 이동시키며, 도 2 및 3에 도시된 바와 같이 바퀴 구동 모터(161), 주행 바퀴(163) 및 캐스터 바퀴(165)를 포함할 수 있다.
주행 바퀴(163)는 메인 바디(101) 저면의 양단에 마련될 수 있으며 청소 로봇(100)의 전방을 기준으로 청소 로봇(100)의 좌측에 마련되는 좌측 주행 바퀴(163a)와 청소 로봇(100)의 우측에 마련되는 우측 주행 바퀴(163b)를 포함할 수 있다.
또한, 주행 바퀴(163)는 바퀴 구동 모터(161)로부터 회전력을 제공받아 청소 로봇(100)을 이동시킨다.
바퀴 구동 모터(161)는 주행 바퀴(163)를 회전시키는 회전력을 생성하며, 좌측 주행 바퀴를 회전시키는 좌측 구동 모터(161a)와 우측 주행 바퀴를 회전시키는 우측 구동 모터(161b)를 포함한다.
좌측 구동 모터(161a)와 우측 구동 모터(161b)는 각각 제어부(110)로부터 구동 제어 신호를 수신하여 독립적으로 동작할 수 있다.
이와 같이 독립적으로 동작하는 좌측 구동 모터(161a)와 우측 구동 모터(161b)에 의하여 좌측 주행 바퀴(163a)와 우측 주행 바퀴(163b)는 서로 독립적으로 회전할 수 있다.
또한, 좌측 주행 바퀴(163a)와 우측 주행 바퀴(163b)가 독립적으로 회전할 수 있으므로 청소 로봇(100)은 전진 주행, 후진 주행, 회전 주행 및 제자리 회전 등 다양한 주행이 가능할 수 있다.
예를 들어, 좌우측 주행 바퀴(163a, 163b) 모두가 제 1 방향으로 회전하면 청소 로봇(100)은 전방으로 직선 주행(전진)하고, 좌우측 주행 바퀴(163a, 163b) 모두가 제 2 방향으로 회전하면 청소 로봇(100)은 후방으로 직선 주행할 수 있다.
또한, 좌우측 주행 바퀴(163a, 163b) 가 같은 방향으로 회전하되 서로 다른 속도로 회전하면 청소 로봇(100)은 제자리에서 시계 방향 또는 반시계 방향으로 회전할 수 있다.
캐스더 바퀴(165)는 메인 바디(101)의 저면에 설치되어 청소 로봇(100)의 주행을 방해하지 않으며, 청소 로봇(100)이 안정된 자세를 유지한 채 주행할 수 있도록 한다.
또한, 이외에도 주행부(160)는 제어부(110)의 제어 신호에 따라 바퀴 구동 모터에 구동 전류를 공급하는 모터 구동 회로, 바퀴 구동 모터의 회전력을 주행 바퀴에 전달하는 동력 전달 모듈, 바퀴 구동 모터 또는 주행 바퀴의 회전 변위 및 회전 속도를 검출하는 회전 감지 센서(미도시) 등을 더 포함할 수 있다.
청소부(170)는 청소 영역의 바닥의 먼지를 비산시키는 드럼 브러시(173), 드럼 브러시(173)를 회전시키는 브러시 구동 모터(171), 비산된 먼지를 흡입하는 먼지 흡입 팬(177), 먼지 흡입 팬(177)을 회전시키는 먼지 흡입 모터(175) 및 흡입된 먼지를 저장하는 먼지함(179)을 포함할 수 있다.
드럼 브러시(173)는 도 3에 도시된 바와 같이 서브 바디(103)의 저면에 형성된 먼지 흡입구(105)에 마련되어 서브 바디(103)의 청소 바닥과 수평하게 마련된 회전 축을 중심으로 회전하면서 청소 바닥의 먼지를 먼지 흡입구(105) 내부로 비산시킨다.
브러시 구동 모터(171)는 드럼 브러시(173)에 인접하게 마련되어 제어부(110)의 청소 제어 신호에 따라 드럼 브러시(173)를 회전시킨다.
도면에는 도시되지 않았으나, 청소부(170)는 제어부(110)의 제어 신호에 따라 브러시 구동 모터(171)에 구동 전류를 공급하는 모터 구동 회로(미도시), 브러시 구동 모터(171)의 회전력을 드럼 브러시(173)에 전달하는 동력 전달 모듈을 더 포함할 수 있다.
먼지 흡입 팬(177)은 도 2에 도시된바와 같이 메인 바디(101)에 마련되어 드럼 브러시(173)에 의하여 비산된 먼지를 먼지함(179)으로 흡입한다.
먼지 흡입 모터(175)는 먼지 흡입 팬(177)과 인접한 위치에 마련되어 제어부(110)의 제어 신호에 의하여 먼지 흡입 팬(177)을 회전시킨다.
도면에는 도시되지 않았으나, 청소부(170)는 제어부(110)의 제어 신호에 따라 먼지 흡입 모터(175)에 구동 전류를 공급하는 모터 구동 회로(미도시), 먼지 흡입 모터(175)의 회전력을 먼지 흡입 팬(177)에 전달하는 동력 전달 모듈(미도시)을 더 포함할 수 있다.
먼지함(179)은 도 2에 도시된 바와 같이 메인 바디(101)에 마련되며, 먼지 흡입 팬(177)에 의하여 흡입된 먼지를 저장한다.
또한, 청소부(170)는 서브 바디(103)의 먼지 흡입구(105)를 통하여 흡입된 먼지를 메인 바디(101)에 마련된 먼지함(179)까지 안내하는 먼지 안내관을 포함할 수 있다.
메모리(180)는 청소 로봇(100)을 제어하기 위한 제어 프로그램, 제어 데이터, 사용자 입력에 따라 다양한 기능을 수행하는 다양한 어플리케이션 프로그램 및 어플리케이션 데이터를 저장할 수 있다.
예를 들어, 메모리(180)는 청소 로봇(100)에 포함된 구성 및 자원(소프트웨어 및 하드웨어)를 관리하는 OS(Operating System) 프로그램, 장애물 감지부(140)로부터 획득된 전기적 신호를 처리하는 데이터 처리 프로그램, 장애물 감지부(140)로부터 획득된 전기적 신호 등을 기초로 장애물을 검출하는 장애물 검출 프로그램, 주행부(160)에 포함된 구동 모터 및 지지판(145)의 회전 구동부(147)에 포함된 구동 모터 등을 제어하는 모터 제어 프로그램 등을 저장할 수 있다.
이와 같은 메모리(180)는 S램(S-RAM), D램(D-RAM) 등의 휘발성 메모리 뿐만 아니라 플래시 메모리, 롬(Read Only Memory), 이피롬(Erasable Programmable Read Only Memory: EPROM), 이이피롬(Electrically Erasable Programmable Read Only Memory: EEPROM) 등의 비활성 메모리를 포함할 수 있다.
구체적으로, 비활성 메모리는 청소 로봇(100)의 동작을 제어하기 위한 제어 프로그램 및 제어 데이터를 반영구적으로 저장할 수 있으며, 휘발성 메모리는 비휘발성 메모리로부터 제어 프로그램 및 제어 데이터를 불러와 기억하거나, 유저 인터페이스(120)가 수신한 사용자 명령, 움직임 감지부가 검출한 움직임 정보, 제어부(110)에서 검출한 장애물의 위치 정보 등을 기억할 수 있다.
제어부(110)는 청소 로봇(100)의 전반적인 동작 및 청소 로봇(100)의 내부 구성요소들 사이의 신호 흐름을 제어하고 데이터를 처리하는 기능을 수행한다. 제어부(110)는 사용자로부터 명령이 입력되거나 미리 설정된 조건을 만족하는 경우 메모리(180)에 저장된 프로그램 또는 어플리케이션을 실행할 수 있다.
제어부(110)는 프로세서(111), 청소 로봇(100)의 제어를 위한 제어 프로그램 또는 어플리케이션이 저장된 롬(ROM, 112), 청소 로봇(100)의 외부에서 입력되는 신호 또는 데이터를 저장하거나 청소 로봇(100)에서 수행되는 다양한 작업에 대응되는 저장 영역으로 사용되는 램(RAM, 113)을 포함할 수 있다. 이하, 제어부(110)의 롬(112)과 램(113)은 메모리(180)의 롬과 램을 포함하는 개념일 수 있다.
제어부(110)는 장애물 감지부(140)로부터 출력된 전기적 신호 및 메모리(180)에 저장된 정보를 기초로 장애물을 검출할 수 있다. 보다 상세하게, 제어부(110)는 삼각 측량 방식 또는 TOF(Time of flight) 방식에 따라 장애물을 검출할 수 있다.
제어부(110)는 장애물 감지부(140)의 설계 방식에 따라 장애물의 검출 방식을 결정할 수 있다.
삼각 측량 방식은 발광부(141)의 발광 지점으로부터 수광부(143)의 수광 지점까지의 거리가 일정 거리 이상 이격 되도록 설치된 경우 적용이 용이할 수 있다. 이는 후술하는 바와 같이 삼각 측량 방식의 적용 시 발광부(141)의 발광 지점으로부터 수광부(143)의 수광 지점까지의 거리가 입력 변수로 제공되기 때문이다.
TOF 방식은 발광부(141)의 발광 지점으로부터 수광부(143)의 수광 지점까지의 거리가 일정 거리 이하로 좁게 설치된 경우 적용이 용이할 수 있다. TOF 방식의 적용 시 동일 지점에서 광이 발광 및 수광됨을 전제로 장애물 검출이 수행되기 때문이다.
이하, 첨부된 도면을 참조하여 삼각 측량 방식과 TOF 방식에 대해 보다 상세하게 설명하도록 한다.
도 7은 삼각 측량 방식의 원리를 도시한 도면이다.
삼각 측량 방식은 삼각형의 한 변의 길이와 해당 변의 양 쪽 각을 측정하여 다른 두 변의 길이와 나머지 각도를 산출하는 방식이다. 여기서, 삼각형의 한 변의 길이는 발광부(141)의 발광 지점으로부터 수광부(143)의 수광 지점까지의 거리를 의미할 수 있다. 실시 예에 따라 발광부(141)에서 라인 광(L)을 발신할 경우 발광부(141)의 발신 지점은 라인 광(L)의 라인 상에 존재하는 일 지점으로, 지지판(145)의 지지면과 수평하게 마련된 가상의 평면 중 수광부(143)의 수광 지점을 포함하는 평면에 위치하는 일 지점을 의미할 수 있다.
도 7에 도시된 바를 참조하면, 제어부(110)는 발광부(141)의 발광 지점(PL)으로부터 수광부(143)의 수광 지점(PD)까지의 거리(l1), 발광부(141)의 광 발신 각도(ΘL), 수광부(143)의 광 수신 각도(ΘD) 정보에 기초해 다른 두 변의 길이(l2, l3)와 나머지 각도(Θo)를 검출할 수 있다. 즉, 청소 로봇(100)으로부터 장애물(O)까지의 거리(l3)를 검출할 수 있다.
다음으로, TOF 방식은 발광부(141)에서 광을 발신한 시점과 발광된 광이 장애물(O)에 반사되어 반사 광이 수광부(143)로 되돌아오는 시점의 시간 차이를 이용하여 청소 로봇(100)으로부터 장애물(O)까지의 거리를 검출하는 방식이다. 제어부(110)는 아래의 식 1을 기초로 청소 로봇(100)으로부터 장애물(O)까지의 거리를 검출할 수 있다.
식 1
d = (t1-t0)/2 * c = Δt/2 * c
식 1에서 d는 장애물 감지부(140)로부터 장애물(O)까지의 거리를 의미하며, c는 광의 속도를 의미하며, t1은 수광부(143)에서 광의 수신 시점을 의미하고, to는 발광부(141)에서 광의 발신 시점을 의미한다.
한편, TOF 방식의 적용 예가 전술한 식 1에 의해 한정되는 것은 아니며,실시 예에 따라 발광부(141)에서 발신된 광과 수광부(143)에서 수신된 광의 위상차를 검출해 청소 로봇(100)으로부터 제어부(110)까지의 거리를 검출할 수 있음은 물론이다.
이상으로, 청소 로봇(100)의 기본적인 구성에 대해 설명하였다. 이하, 청소 로봇(100)의 장애물 감지부(140)에 대해 보다 구체적으로 설명하도록 한다.
일 실시 예에 따른 청소 로봇(100)은 장애물 감지부(140)에 마련된 발광부(141)와 수광부(143)의 개수 및 배치를 자유롭게 변경 가능할 수 있다.
일 예로, 발광부(141)와 수광부(143)는 지지판(145)에 수직 방향으로 적층 형성될 수 있다. 발광부(141)와 수광부(143)는 단일 또는 복수 개로 마련될 수 있으며, 실시 예에 따라 발광부(141)와 수광부(143)가 센서 모듈을 형성할 수도 있다.
다른 예로, 발광부(141)와 수광부(143)는 지지판(145)에 수평 방향으로 배치될 수 있다. 발광부(141)와 수광부(143)는 단일 또는 복수 개로 마련될 수 있으며, 실시 예에 따라 발광부(141)와 수광부(143)가 센서 모듈을 형성할 수도 있다.
이하, 첨부된 도면을 참조하여 장애물 감지부(140)의 마련 방식에 대해 보다 상세하게 설명하도록 한다.
도 8 및 도 9는 일 실시 예에 따른 발광부(141)와 수광부(143)의 배치 방식을 도시한 도면이고, 도 10는 다른 실시 예에 따른 발광부(141)와 수광부(143)의 배치 방식을 도시한 도면이고, 도 11 내지 도 13은 또 다른 실시 예에 따른 발광부(141)와 수광부(143)의 배치 방식을 도시한 도면이다.
보다 상세하게, 도 8 내지 도 10은 발광부(141)에서 라인 광(L)을 발신하는 경우를 전제로 발광부(141)와 수광부(143)의 배치 방식을 도시한 도면이고, 도 11 내지 도 13은 발광부(141)에서 레이저 광을 발신하는 경우를 전제로 발광부(141)와 수광부(143)의 배치 방식을 도시한 도면이다.
먼저 도 8 및 도 9를 참조해 일 실시 예에 따른 장애물 감지부(140)의 마련 방식에 대해 설명하도록 한다.
도 8에 도시된 바를 참조하면, 일 실시 예에 따른 장애물 감지부(140)는 단일 발광부(141)와 복수 개의 수광부(143-1, 143-2, 143-3)가 지지판(145) 상부에 적층된 형태로 마련될 수 있다.
일 예로, 장애물 감지부(140)는 지지판(145)과, 지지판(145) 상부에 배치되며 미리 설정된 제 1 방향(D1)의 광을 수신하도록 마련된 제 1 수광부(143-1)와, 제 1 수광부(143-1) 상부에 배치되며 세로 방향의 라인 광(L)을 발신하도록 마련된 발광부(141)와, 발광부(141) 상부에 배치되며 미리 설정된 제 2 방향(D2)의 광을 수신하도록 마련된 제 2 수광부(143-2)와, 제 2 수광부(143-2) 상부에 배치되며 미리 설정된 제 3 방향(D3)의 광을 수신하도록 마련된 제 3 수광부(143-3)를 포함할 수 있다. 실시 예에 따라, 발광부(141)와 제 1 내지 제 3 수광부(143-1, 143-2, 143-3)의 적층 순서가 다르게 마련될 수 있음은 물론이다.
제 1 내지 제 3 방향(D1, D2, D3)의 광은 서로 다른 방향의 광일 수 있다. 예를 들어, 청소 로봇(100)이 x, y, z 좌표계 상 xy 평면에 위치하는 경우를 전제로, 제 1 방향은 xy 평면을 기준으로 대각선 하단 방향일 수 있으며, 제 2 방향은 xy 평면과 동일 평면 상에 마련된 임의의 방향일 수 있으며, 제 3 방향은 xy 평면을 기준으로 대각선 상단 방향일 수 있다.
도 9에 도시된 바를 참조하면, 장애물 감지부(140)의 발광부(141)와 수광부(143)는 발광부(141)의 발광 지점(PL)과 수광부(143)의 수광 지점(PD)이 지지판(145)의 지지면과 수평한 방향으로 미리 설정된 제 1 거리(d1) 이격되도록 배치될 수 있다. 이하 발광부(141)의 발광 지점(PL)은 수광부(143)의 수광 지점(PD)과 동일 평면 상에 형성되는 라인 광(L)의 발신 지점인 것으로 정의한다.
제 1 거리(d1)는 장애물 감지부(140)의 감지 방식에 따라 다르게 설계될 수 있다. 예를 들어, 장애물 감지부(140)가 TOF 방식으로 장애물(O)을 감지하는 경우에는 삼각 측량 방식으로 장애물(O)을 감지하는 경우에 비해 제 1 거리(d1)가 짧게 설계될 수 있으며 이는 전술한 바와 같다.
도 8 및 도 9에 도시된 바를 참조하면, 하나의 발광부(141)가 세로 방향의 라인 광(L)을 발신하고, 제 1 내지 제 3 수광부(143-1, 143-2, 143-3)는 하나의 발광부(141)에서 발신된 라인 광(L) 중 장애물(O)로부터 반사된 반사 광을 수신할 수 있다.
제 1 내지 제 3 수광부(143-1, 143-2, 143-3)는 수신하고자 하는 광의 방향을 향하도록 기울어져 배치될 수 있다. 보다 상세하게, 제 1 수광부(143-1)는 발광부(141)에서 발신된 라인 광(L) 중 청소 로봇의 하단에 존재하는 장애물로부터 반사된 반사 광을 수신하도록 배치될 수 있다. 일 예로, 제 1 수광부(143-1)는 제 1 수광부(143-1)의 수광 면이 제 1 방향(D1)을 향하도록 기울어져 배치될 수 있다.
같은 방식으로, 제 2 수광부(143-2)는 제 2 수광부(143-2)의 수광 면이 제 2 방향(D2)을 향하도록 기울어져 배치될 수 있으며, 제 3 수광부(143-3)는 제 3 수광부(143-3)이 수광 면이 제 3 방향(D3)을 향하도록 기울어져 배치될 수 있다.
실시 예에 따라 감지하고자 하는 장애물(O)의 높이, 깊이 등에 따라 제 1 수광부(143-1) 내지 제 3 수광부(143-3)의 배치 각도를 조절할 수 있음은 물론이다.
다음으로, 도 10을 참조해 다른 실시 예에 따른 장애물 감지부(140)의 마련 방식에 대해 설명한다.
도 10에 도시된 바를 참조하면, 다른 실시 예에 따른 장애물 감지부(140)는 하나의 발광부(141)와 하나의 수광부(143)가 지지판(145) 상부에 적층된 형태로 마련될 수 있다.
일 예로 장애물 감지부(140)는 지지판(145)과, 지지판(145) 상부에 배치되어 라인 광(L)을 발신하도록 마련된 발광부(141)와, 발광부(141) 상부에 배치되며 미리 설정된 방향의 광을 수신하도록 마련된 수광부(143)를 포함할 수 있다. 도 10에서는 수광부(143)가 제 2 방향(D2)의 광을 수신하는 경우를 예로 들어 도시하였으나, 미리 설정된 방향은 설계자의 의도에 따라 자유롭게 설계 가능할 수 있다. 이하 발광부(141)와 수광부(143)의 배치 방식과 관련해 전술한 도 8 및 도 9와 중복되는 설명은 생략하도록 한다.
도 8 내지 도 10에서는 발광부(141)에서 라인 광(L)을 발신하는 경우를 예로 들어 설명하였다. 다만 발명의 기술적 사상이 도 8 내지 도 10에서 도시된 바에 의해 한정되는 것은 아니다. 다시 말해, 라인 광(L)을 발신하도록 마련된 발광부(141)가 복수 개로 마련될 수 있으며, 실시 예에 따라 수광부(143)가 두 개 또는 네 개 이상으로 마련될 수도 있다. 아울러, 발광부(141)와 수광부(143)의 적층 순서가 다양하게 변경될 수도 있다.
다음으로, 도 11을 참조해 또 다른 실시 예에 따른 장애물 감지부(140)의 마련 예에 대해 설명한다.
도 11에 도시된 바를 참조하면, 일 실시 예에 따른 장애물 감지부(140)는 복수개의 발광부(141-1, 141-2, 141-3)와 복수 개의 수광부(143-1, 143-2, 143-3)가 지지판(145) 상부에 나란하게 배치되도록 마련될 수 있다.
일 예로, 장애물 감지부(140)는 지지판(145)과, 지지판(145) 상부에 배치되어 제 1 방향(D1)으로 광을 발신하도록 마련된 제 1 발광부(141-1)와, 제 1 발광부(141-1)와 나란하게 배치되며 제 1 방향(D1)의 광을 수신하도록 마련된 제 1 수광부(143-1)를 포함할 수 있다. 실시 예에 따라 제 1 발광부(141-1)와 제 1 수광부(143-1)는 모듈 형태로 마련될 수도 있다. 이하, 제 1 발광부(141-1)와 제 1 수광부(143-1)를 포함하는 광 모듈을 제 1 광 모듈(M1)로 지칭하도록 한다.
또한, 장애물 감지부(140)는 제 2 방향(D2)으로 광을 발신하도록 마련된 제 2 발광부(141-2)와, 제 2 발광부(141-2)와 나란하게 배치되며 제 2 방향(D2)의 광을 수신하도록 마련된 제 2 수광부(143-2)를 포함할 수 있으며, 제 3 방향(D3)으로 광을 발신하도록 마련된 제 3 발광부(141-3)와, 제 3 발광부(141-3)와 나란하게 배치되며 제 3 방향(D3)의 광을 수신하도록 마련된 제 3 수광부(143-3)를 포함할 수 있다.
실시 예에 따라, 제 2 발광부(141-2)와 제 2 수광부(143-2)는 제 2 광 모듈(M2)을 형성할 수 있으며, 제 3 발광부(141-3)와 제 3 수광부(143-3)는 제 3 광 모듈(M3)을 형성할 수 있다.
제 1 광 모듈(M1) 내지 제 3 광 모듈(M3)은 지지판(145)의 가장자리에 나란하게 배치될 수 있다. 일 예로 제 1 광 모듈(M1) 내지 제 3 광 모듈(M3)은 각각의 광 모듈(M1, M2, M3)과 지지판(145)의 중심이 대략 120도의 각도를 형성하도록 배치될 수 있다.
장애물 감지부(140)는 제 1 내지 제 3 광 모듈(M1, M2, M3)을 전술한 방식으로 마련함과 동시에 지지판(145)을 시계 또는 반시계 방향으로 회전시킴으로써 제 1 방향(D1) 내지 제 3 방향(D3)에 존재하는 장애물(O) 정보를 수집할 수 있다.
한편, 제 1 광 모듈(M1) 내지 제 3 광 모듈(M3)은 도 12에 도시된 바와 같이 지지판(145) 상부에 수직 방향으로 적층된 형태로 마련될 수 있으며, 실시 예에 따라 도 13에 도시된 바와 같이 단일 광 모듈 형태(M)로 마련될 수도 있다. 한편, 발명의 기술적 사상이 도면에 도시된 바에 의해 한정된 것은 아니며, 두 개 또는 네 개 이상의 광 모듈이 지지판(145) 가장자리에 수평 방향으로 마련되거나 지지판(145) 상부에 수직 방향으로 적층된 형태로 마련될 수 있음은 물론이다.
이상으로, 장애물 감지부(140)의 다양한 마련 예에 대해 설명하였다. 전술한 바와 같이, 도 1 내지 도 13에 따른 청소 로봇(100)의 장애물 감지부(140)는 발광부(141)와 수광부(143)가 지지판(145)에 고정된 채 회전하며 장애물(O) 정보를 수집할 수 있다.
한편, 청소 로봇은 다양한 방식의 장애물 감지부를 채용함으로써 장애물(O) 정보를 수집할 수 있다. 이하, 장애물 감지부의 다양한 마련 예에 대해 설명하도록 한다.
청소 로봇의 장애물 감지부는 회전 다면경 또는 반사 거울에 의해 주위의 장애물(O) 정보를 수집하도록 마련될 수 있다. 이하, 각각의 실시 예에 대해 보다 상세하게 설명하도록 한다.
먼저, 회전 다면경을 포함하는 청소 로봇의 실시 예에 대해 설명하도록 한다.
도 14는 다른 실시 예에 따른 청소 로봇의 제어 블록도를 도시한 도면이고, 도 15는 다른 실시 예에 따른 청소 로봇의 장애물 감지부의 예를 도시한 도면이고, 도 16은 회전 다면경의 상세 구조를 도시한 도면이다.
도 14에 도시된 바를 참조하면, 본 실시 예에 따른 청소 로봇(200)은 유저 인터페이스(220)와, 움직임 감지부(230)와, 장애물 감지부(240)와, 영상 획득부(250)와, 청소부(270)와, 메모리(280)와, 제어부(210)를 포함할 수 있다. 이하, 유저 인터페이스(220)와, 움직임 감지부(230)와, 영상 획득부(250)와, 청소부(270)와, 메모리(280)와 관련해 전술한 도 4 및 도 5와 중복되는 설명은 생략하도록 한다.
도 15에 도시된 바를 참조하면, 장애물 감지부(240)는 발광부(241)와, 수광부(243)와, 회전 다면경(245)과, 회전 다면경(245)을 회전 구동 시키도록 마련된 회전 구동부(247)를 포함할 수 있다.
발광부(241)는 회전 다면경(245) 방향으로 광을 발신할 수 있으며, 수광부(243)는 회전 다면경(245)에서 반사된 반사 광을 수신할 수 있다. 본 실시 예에 따른 장애물 감지부(240)는 TOF 방식으로 장애물(O)을 감지하므로 발광부(241)와 수광부(243)는 각각 발광부(241)의 발광 지점과 수광부(243)의 수광 지점이 인접 형성되도록 배치될 수 있다.
발광부(241)와 수광부(243)는 각각 단일 또는 복수개로 마련될 수 있다. 일 예로, 발광부(241)는 제 1 발광부(241-1)와 제 2 발광부(241-2)를 포함할 수 있으며, 수광부(243)는 제 1 수광부(243-1)와 제 2 수광부(243-2)를 포함할 수 있다. 여기서 제 1 발광부(241-1)와 제 1 수광부(243-1)는 제 1 광 모듈(M1)을 형성할 수 있으며, 제 2 발광부(241-2)와 제 2 수광부(243-2)는 제 2 광 모듈(M2)을 형성할 수 있다. 실시 예에 따라 발광부(241)와 수광부(243)는 세 개 이상의 광 모듈을 형성할 수 있으며, 이하 설명의 편의상 발광부(241)와 수광부(243)가 각각 제 1 및 제 2 광 모듈(M1, M2)을 형성하는 경우를 전제로 발명의 실시 예에 대해 설명하도록 한다.
회전 다면경(245)은 청소 영역 내의 장애물(O)을 탐지하도록 발광부(241)에서 발신된 광의 광 경로를 청소 영역으로 변환시키고, 장애물(O)로부터 반사된 반사광 중 회전 다면경(245)에 입사되는 광의 광 경로를 수광부(243) 방향으로 변환시킨다.
회전 다면경(245)은 넓은 감지 영역을 확보하도록 제 1 광 모듈(M1)과 제 2 광 모듈(M2) 사이에 배치될 수 있으며, 회전 다면경(245) 중심에 형성된 가상의 회전 축(c)을 중심으로 시계 또는 반시계 방향으로 360도 회전 가능하도록 마련될 수 있다.
회전 다면경(245)은 기울어진 삼각 기둥 형상으로 마련됨으로써 청소 로봇(200)의 상하 방향으로 넓은 감지 영역을 확보할 수 있다. 이하, 회전 다면경(245)의 구조에 대해 첨부된 도면을 참조하여 보다 상세하게 설명하도록 한다.
도 16에 도시된 바를 참조하면, 일 실시 예에 따른 회전 다면경(245)은 외곽 둘레에 세 개의 반사면(245-1, 245-2, 245-3)이 구비되도록 마련될 수 있다. 다만 회전 다면경(245)의 마련 예가 이에 한정되는 것은 아니며 네 개 또는 다섯 개의 반사면이 구비되도록 마련될 수 있음은 물론이다. 이하 외곽 둘레에 세 개의 반사면(245-1, 245-2, 245-3)이 구비된 회전 다면경(245)을 예로 들어 발명의 실시 예에 대해 설명하도록 할 것이며, 세 개의 반사면(245-1, 245-2, 245-3)을 각각 제 1 반사면(245-1)(245-1), 제 2 반사면(245-2)(245-2) 및 제 3 반사면(245-3)(245-3)으로 지칭하도록 한다.
세 개의 반사면(245-1, 245-2, 245-3) 중 적어도 하나의 반사면은 회전 다면경(245)의 회전 축(c)과 경사지도록 형성될 수 있다. 일 예로, 회전 다면경(245)은 편평하게 마련된 상부면(245-4) 및 바닥면(245-5)과, 회전 다면경(245)의 바닥면(245-5)을 기준으로 회전 다면경(245)의 회전 축(c) 방향으로 제 1 각도(Θ1) 기울어지도록 형성된 제 1 반사면(245-1)과, 회전 다면경(245)의 바닥면(245-5)을 기준으로 회전 다면경(245)의 회전 축(c) 방향으로 제 1 각도(Θ2) 기울어지도록 형성된 제 2 반사면(245-2)과, 회전 다면경(245)의 바닥면(245-5)을 기준으로 회전 다면경(245)의 회전 축(c) 방향으로 제 3 각도(Θ3) 기울어지도록 형성된 제 3 반사면(245-3)을 구비할 수 있다.
여기서, 제 1 내지 제 3 각도(Θ1, Θ2, Θ3)는 서로 다르게 형성될 수 있으며, 각각 0도 내지 180도 범위 내에서 형성될 수 있다. 이하 제 1 각도(Θ1)가 둔각으로 형성되고, 제 1 각도(Θ2)가 직각으로 형성되고, 제 3 각도(Θ3)가 예각으로 형성된 경우를 전제로 발명의 실시 예에 대해 설명하도록 한다.
제 1 반사면(245-1)은 제 1 각도(Θ1) 기울어지도록 형성됨에 따라 도 16에 도시된 바와 같이 발광부(241)로부터 발신된 광의 경로를 미리 설정된 제 1 방향(D1)으로 변환할 수 있다. 아울러, 장애물(O)로부터 반사된 광 중 제 1 방향(D1)으로부터 수신된 광의 광 경로를 수광부(243) 방향으로 변환할 수 있다.
같은 방식으로, 제 2 반사면(245-2)은 제 1 각도(Θ2) 기울어지도록 형성됨에 따라 발광부(241)로부터 발신된 광의 경로를 미리 설정된 제 2 방향(D2)으로 변환할 수 있으며, 장애물(O)로부터 반사된 광 중 제 2 방향(D2)으로부터 수신된 광의 광 경로를 수광부(243) 방향으로 변환할 수 있다.
또한, 제 3 반사면(245-3)은 제 3 각도(Θ3) 기울어지도록 형성됨에 따라 발광부(241)로부터 발신된 광의 경로를 미리 설정된 제 3 방향(D3)으로 변환할 수 있으며, 장애물(O)로부터 반사된 광 중 제 3 방향(D3)으로부터 수신된 광의 광 경로를 수광부(243) 방향으로 변환할 수 있다.
본 실시 예에 따른 청소 로봇(200)은 회전 다면경(245)의 반사면(245-1, 245-3)이 회전 다면경(245)의 중심 축(c)을 기준으로 경사지게 형성되도록 함으로써 청소 로봇(200)과 동일 평면상에 존재하는 감지 영역 뿐만 아니라 청소 로봇(200)의 상단 또는 하단에 존재하는 장애물(O) 검출이 가능할 수 있다.
또한, 회전 다면경(245)의 제 1 내지 제 3 반사면(245-1, 245-2, 245-3)은 회전 다면경(245)이 시계 또는 반시계 방향으로 회전함에 따라 시계 또는 반시계 방향으로 함께 회전 함으로써 청소 로봇(200) 주위에 넓은 감지 영역을 확보하도록 할 수 있다.
제어부(210)는 청소 로봇(200)의 전반적인 동작 및 청소 로봇(200)의 내부 구성요소들 사이의 신호 흐름을 제어하고 데이터를 처리하는 기능을 수행한다.
제어부(210)는 장애물 감지부(240)에서 출력된 전기적 신호 및 메모리(280)에 저장된 정보를 기초로 장애물(O)을 검출할 수 있다. 보다 상세하게, 제어부(210)는 발광부(241)에서 광의 발신 시점, 수광부(243)에서 광의 수신 시점, 회전 다면경(245)의 회전 정보, 제 1 내지 제 3 반사면(245-3)의 형성 각도 정보를 기초로 장애물(O)을 검출할 수 있다.
이하, 첨부된 도면을 참조해 청소 로봇(200)의 장애물(O) 검출 방법에 대해 보다 상세하게 설명하도록 한다.
도 17은 도 16의 회전 다면경(245)을 AA'방향으로 자른 단면을 기초로 회전 다면경(245)의 회전에 따른 광 경로를 도시한 도면이다. 도 17에서는 설명의 편의상 회전 다면경(245)의 제 3 반사면(245-3)을 예로 들어 광 경로를 도시하였으며, 도 17에서 T1 및 T2는 각각 T1 시점 및 T2 시점을 의미할 수 있다.
먼저, 발광부(241)가 회전 다면경(245) 방향으로 광을 발신하면, 발광부(241)에서 발신된 광은 회전 다면경(245)의 반사면에 의해 광 경로가 변환되어 장애물(O) 탐지 목적의 탐지광으로 기능하게 된다. 회전 다면경(245)에 입사된 광은 반사의 법칙에 따라 반사될 수 있으며, 이하 회전 다면경(245)에 의해 광 경로가 변환된 발신 광은 탐지광으로 지칭될 수 있다.
한편, 회전 다면경(245)은 가상의 회전 축(c)을 중심으로 회전하게 되며, 이에 따라 탐지광 역시 회전 다면경(245)의 회전 방향과 동일한 방향으로 회전하게 된다.
도 17에 도시된 바를 참조하면, 회전 다면경(245)의 회전 중 T1 시점에 발광부(241)로부터 발신된 광 L1은 회전 다면경(245)의 제 3 반사면(245-3)에 입사될 수 있다. 제 3 반사면(245-3)에 입사된 광 L1은 제 3 반사면(245-3)에서 광 경로가 변환되어 탐지 광으로서 기능하게 된다. 도 17은 탐지 광 L1의 광 경로 상에 장애물(O)이 존재하지 않는 경우로, 탐지 광 L1은 진행 방향을 따라 직진하게 된다.
한편, 회전 다면경(245)의 회전 중 T2 시점에 발광부(241)로부터 발신된 광 L2는 회전 다면경(245)의 제 3 반사면(245-3)에 입사될 수 있다. 제 3 반사면(245-3)에 입사된 광 L2는 제 3 반사면(245-3)에서 광 경로가 변환되어 탐지 광으로서 기능하게 된다.
도 17은 탐지 광 L2의 광 경로 상에 장애물(O)이 존재하는 경우로, 탐지 광 L2의 광 경로 상에 장애물(O)이 존재하는 경우 장애물(O)로부터 반사된 반사 광 L3는 회전 다면경(245)의 제 3 반사면(245-3)에 의해 광 경로가 변환되게 되고, 수광부(243)에서는 장애물(O) 감지 신호가 생성되게 된다. 수광부(243)에서 생성된 장애물(O) 감지 신호는 제어부(210)로 전달되어, 제어부(210)의 장애물(O) 검출 과정에 제공되게 된다.
제어부(210)는 장애물 감지부(240)에서 전달된 장애물(O) 감지 신호를 기초로 장애물(O)을 검출할 수 있다.
제어부(210)는, 발광부(241)의 광 발신 시점 및 수광부(243)의 광 수신 시점의 차이와, 광의 속도 정보에 기초해 청소 로봇(200)으로부터 장애물(O)까지의 거리를 검출할 수 있다.
또한, 제어부(210)는 회전 다면경(245)의 회전 정보 및 회전 다면경(245)의 기울기 각도 정보에 기초해 해당 장애물(O)의 방향을 검출할 수 있다.
보다 상세하게, 제어부(210)는 엔코더(249)로부터 획득한 회전 다면경(245)의 회전 각도 정보를 기초로 수광부(243)에서 생성된 신호가 어느 반사면에서 반사된 광에 의한 신호인지를 결정할 수 있으며, 메모리(280)에 미리 저장된 반사면의 기울기 정보와 함께 회전 다면경(245)의 회전 각도 정보를 기초로 장애물(O)의 방향을 검출할 수 있다.
이상으로, 회전 다면경(245)을 포함하는 청소 로봇(200)의 실시 예에 대해 설명하였다.
발명의 기술적 사상이 전술한 내용에 의해 한정되는 것은 아니며 실시 예에 따라 회전 다면경(245)의 측면에 형성되는 제 1 내지 제 3 반사면(245-1, 245-2, 245-3)의 면적을 조절함으로써 제 1 내지 제 3 반사면(245-1, 245-2, 245-3)에 의해 형성되는 감지 영역의 크기를 조절할 수 있다. 아울러, 회전 다면경(245)의 중심 축(c)을 기준으로 제 1 내지 제 3 반사면(245-1, 245-2, 245-3)의 기울기를 조절하여 감지 영역의 형성 각도를 조절할 수 있음은 물론이다.
다음으로, 회전 거울을 포함하는 포함하는 청소 로봇의 실시 예에 대해 설명하도록 한다.
도 18은 또 다른 실시 예에 따른 청소 로봇의 제어 블록도를 도시한 도면이고, 도 19는 또 다른 실 시 예에 따른 청소 로봇의 장애물 감지부의 단면을 도시한 도면이고, 도 20은 또 다른 실시 예에 따른 청소 로봇의 장애물 감지부의 장애물 감지 원리를 도시한 도면이다.
도 18에 도시된 바를 참조하면, 본 실시 예에 따른 청소 로봇(300)은 유저 인터페이스(320)와, 움직임 감지부(330)와, 장애물 감지부(340)와, 영상 획득부(350)와, 청소부(370)와, 메모리(380)와, 제어부(310)를 포함할 수 있다. 이하, 유저 인터페이스(320)와, 움직임 감지부(330)와, 영상 획득부(350)와, 청소부(370)와, 메모리(380)와 관련해 전술한 도 4 및 도 5와 중복되는 설명은 생략하도록 한다.
도 19에 도시된 바를 참조하면, 장애물 감지부(340)는 장애물 감지부(340)의 외관을 형성하는 본체(342)와, 발광부(341)와, 수광부(343)와, 스플리터(splitter, 344)와, 반사 거울(345)과, 반사 거울(345)을 회전 구동 시키도록 마련된 회전 구동부(347)를 포함할 수 있다.
본체(342)는 대략 박스 형상을 가지고 외곽 둘레가 개방되도록 마련되며, 제 1 격벽(342-1)과 제 2 격벽(342-2)에 의해 복수의 공간으로 구획될 수 있다. 제 1 격벽(342-1)은 청소 로봇(300)의 바닥면과 나란하게 마련될 수 있으며, 제 2 격벽(342-2)은 제 1 격벽(342-1)과 수직하게 마련될 수 있다.
본체(342)는 제 1 격벽(342-1)에 의해 제 1 공간(S1)이 구획되며, 제 2 격벽(342-2)에 의해 제 2 공간(S2)이 구획될 수 있다. 제 1 공간(S1)에는 회전 구동부(347)가 수용될 수 있으며, 제 2 격벽(342-2)에는 장애물 감지부(340)와 청소 로봇(300)을 연결하는 연결 선 등이 수용될 수 있다.
발광부(341)는 제 1 격벽(342-1)의 하단에 설치되며, 발광부(341)의 주위에는 스플리터(344)가 마련될 수 있다. 발광부(341)는 전면으로 광을 발신하며, 발신된 광은 스플리터(344)와 반사 거울(345)을 지나 청소 영역으로 발신될 수 있다.
수광부(343)는 본체(342)의 하단에 설치될 수 있다. 수광부(343) 주위, 보다 상세하게 수광부(343)의 상단에는 스플리터(344)가 마련될 수 있다.
수광부(343)는 수신된 광을 집광하는 집광 렌즈(343-1)와 수신된 광을 검출하는 광 센서(343-2)를 포함할 수 있으며, 실시 예에 따라 광 센서(343-2)에서 검출된 광을 증폭하는 증폭기(미도시)를 포함할 수도 있다. 광 센서(343-2)는 포토 다이오드 등을 포함하는 개념일 수 있으며, 이하 전술한 광 센서와 중복되는 설명은 생략하도록 한다.
스플리터(344)는 발광부(341) 및 수광부(343)와 이웃하도록 설치될 수 있으며, 보다 상세하게 발광부(341)로부터 발신된 광의 광 경로 및 수광부(343)로 수신되는 광의 광 경로가 서로 만나는 지점에 설치될 수 있다.
스플리터(344)는 발광부(341)에서 발신된 광의 경로를 반사 거울(345) 방향으로 변환하고, 반사 거울(345)에서 반사된 광이 수광부(343) 방향으로 진행하도록 스플리터(344)에 입사된 광의 광 경로를 변환할 수 있다.
반사 거울(345)은 본체(342)의 상단에 회전 가능하도록 배치될 수 있다. 보다 상세하게, 반사 거울(345)은 반사 거울 몸체(346)의 일면에 설치되며, 본체(342)의 바닥면을 기준으로 대략 45도 기울어진 각도로 설치될 수 있다. 반사 거울 몸체(346)는 제 1 공간(S1)에 수용된 회전 구동부(347)에 의해 시계 또는 반시계 방향으로 회전 가능하도록 마련될 수 있으며, 이에 반사 거울(345)은 반사 거울 몸체(346)에 고정되어 시계 또는 반시계 방향으로 회전될 수 있다.
제어부(310)는 청소 로봇(300)의 전반적인 동작 및 청소 로봇(300)의 내부 구성요소들 사이의 신호 흐름을 처리하고 데이터를 처리하는 기능을 수행한다. 제어부(310)는 사용자로부터 명령이 입력되거나 미리 설정된 조건을 만족하는 경우 메모리(380)에 저장된 프로그램 또는 어플리케이션을 실행할 수 있다.
제어부(310)는 장애물 감지부(340)로부터 출력된 전기적 신호 및 메모리(380)에 저장된 정보를 기초로 장애물(O)을 검출할 수 있다. 보다 상세하게 제어부(310)는 발광부(341)에서 광의 발신 시점, 수광부(343)에서 광의 수신 시점, 반사 거울(345)의 회전 정보, 광의 속도 정보에 기초해 장애물(O)을 검출할 수 있다.
이하, 첨부된 도면을 참조해 청소 로봇(300)의 장애물(O) 검출 방법에 대해 보다 상세하게 설명하도록 한다.
도 20은 도 19의 장애물 감지부(340)에서 장애물(O) 감지 시 광 경로를 도시한 도면이다.
도 20에 도시된 바를 참조하면, 먼저 발광부(341)에서 광이 발신 되면 발신된 광은 스플리터(344)에 의해 광 경로가 변환되어 반사 거울(345)에 입사되게 된다. 반사 거울(345)에 입사된 광은 반사의 법칙에 따라 청소 영역으로 발신되어 탐지광으로 기능하게 된다.
반사 거울(345)은 회전 구동부(347)에 의해 회전하며 청소 로봇(300) 주위에 넓은 감지 영역을 형성하게 된다.
청소 로봇(300)의 감지 영역 내에 장애물(O)이 존재하지 않는 경우, 탐지 광은 진행 방향을 따라 직진하게 된다.
청소 로봇(300)의 감지 영역 내에 장애물(O)이 존재하는 경우, 장애물(O)로부터 반사된 반사 광은 반사 거울(345)로 입사되게 된다. 반사 거울(345)에 입사된 광은 반사 거울(345)에 의해 광 경로가 변환되고, 광 경로 상에 배치된 스플리터(344)를 지나 광 센서(343-2)에 수신될 수 있다.
제어부(310)는 발광부(341)의 광 발신 시점 및 수광부(343)의 광 수신 시점의 차이와, 광의 속도 정보에 기초해 청소 로봇(300)으로부터 장애물(O)까지의 거리를 검출할 수 있다. 예를 들어, 감지 영역 내에 장애물(O)이 존재하는 경우, 발광부(341)에서 광의 발신 시점과 수광부(343)에서 광의 수신 시점에 차이가 발생될 수 있으며, 제어부(310)는 광의 수 발신 시점 차이 정보에 기초해 청소 로봇(300)으로부터 장애물(O)까지의 거리를 검출할 수 있다.
또한, 제어부(310)는 반사 거울(345)의 회전 구동부(347)로부터 획득된 반사 거울(345)의 회전 각도 정보에 기초해 장애물(O)의 방향을 검출할 수 있다.
보다 상세하게, 제어부(310)는 회전 구동부(347)의 엔코더(349)로부터 획득된 반사 거울(345)의 회전 각도 정보를 기초로 장애물(O)의 방향을 검출할 수 있으며, 검출된 방향 정보와 함께 전술한 거리 정보를 기초로 장애물(O)을 검출할 수 있다.
지금까지, 청소 로봇(100, 200, 300)의 다양한 실시 예에 대해 설명하였다. 다음으로 전술한 청소 로봇(100, 200, 300)의 제어 방법에 대해 구체적으로 설명하도록 한다.
개시된 발명에 따른 청소 로봇(100, 200, 300)은 삼각 측량법 및 TOF(time of flight) 방식 중 적어도 하나의 방법에 기초하여 청소 로봇(100, 200, 300) 주위의 장애물을 검출할 수 있다.
이하 첨부된 도면을 참조하여 청소 로봇의 제어 방법에 대해 상세하게 설명하도록 한다.
도 21은 일 실시 예에 따른 청소 로봇의 제어 방법을 도시한 순서도 이다.
보다 상세하게, 도 21에 따른 청소 로봇의 제어 방법은 도 1 내지 도 13에 따른 청소 로봇에 대한 제어 방법으로, 이하 설명의 편의상 도 8 및 도 9에 따른 청소 로봇을 기초로 발명의 실시 예에 대해 상세하게 설명하도록 한다.
도 8 및 도 9에 도시된 바에 따른 청소 로봇(100)은 삼각 측량 방법 및 TOF 방법 중 적어도 하나의 방법에 기초하여 장애물(O) 검출이 가능할 수 있다. 이하, 각각의 방법으로 장애물(O)을 검출하는 과정에 대해 상세하게 설명하도록 한다.
먼저, 삼각 측량 방법으로 장애물(O)을 검출하는 청소 로봇(100)의 제어 방법에 대해 설명하도록 한다.
도 21에 도시된 바를 참조하면, 일 실시 예에 따른 청소 로봇(100)의 제어 방법은 장애물 감지부(140)에서 장애물(O) 정보를 수집하는 단계와(410), 수집된 정보에 기초하여 장애물(O)을 검출하는 단계(420)를 포함한다.
장애물 감지부(140)에서 장애물(O) 정보를 수집하는 단계는, 발광부(141) 및 제 1 내지 제 3 수광부(143-1, 143-2, 143-3)에서 장애물(O) 정보를 수집하는 단계와(412), 회전 구동부(147)에서 지지판(145)의 회전 정보를 수집하는 단계(414)를 포함할 수 있다.
발광부(141) 및 제 1 내지 제 3 수광부(143-1, 143-2, 143-3)에서 장애물(O) 정보를 수집하는 단계는 발광부(141)의 광 발신 각도 정보와 제 1 내지 제 3 수광부(143-1, 143-2, 143-3)의 광 수신 각도 정보를 수집하는 것을 포함할 수 있다.
발광부(141)의 광 발신 각도는 메모리(180)에 미리 저장될 수 있으며, 이 경우 발광부(141)의 광 발신 각도 정보를 수집하는 것은 제어부(110)가 메모리(180)로부터 발광부(141)의 광 발신 각도 정보를 전달 받는 것을 의미할 수 있다.
제 1 내지 제 3 수광부(143-1, 143-2, 143-3)의 광 수신 각도는 장애물(O)의 위치에 따라 달라질 수 있다. 보다 상세하게, 장애물(O)의 위치에 따라 반사 광의 형태가 달라질 수 있으며, 반사 광의 형태에 따라 제 1 내지 제 3 수광부(143-1, 143-2, 143-3)는 의 광 수신 각도가 달라질 수 있다. 제 1 내지 제 3 수광부(143-1, 143-2, 143-3)는 광 수신 각도에 따라 각각 서로 다른 출력 신호를 생성할 수 있으며, 제어부(110)는 해당 광 수신 각도 정보를 수집해 장애물(O) 검출 과정에 제공할 수 있다(412).
회전 구동부(147)에서 지지판(145)의 회전 정보를 수집하는 단계는, 제어부(110)가 회전 구동부(147)의 엔코더(149)로부터 지지판(145)의 회전 각도 정보를 수집하는 것을 포함할 수 있다. 지지판(145)의 회전 각도 정보는 장애물(O)의 방향을 검출하는 과정에 제공될 수 있다(414).
다음으로, 수집된 정보에 기초하여 장애물(O)을 검출하는 단계가 수행될 수 있다(420).
제어부(110)는 삼각 측량 방법에 따라 장애물(O)을 검출할 수 있다. 보다 상세하게, 제어부(110)는 발광부(141)로부터 제 1 내지 제 3 수광부(143-1, 143-2, 143-3)까지 이격된 거리 정보, 발광부(141)의 광 발신 각도 정보, 수광부의 광 수신 각도 정보에 기초해 청소 로봇(100)으로부터 장애물(O)까지의 거리를 검출할 수 있다. 아울러, 회전 구동부(147)의 회전 각도 정보에 기초해 장애물(O)의 방향을 검출할 수 있다. 이하, 전술한 바와 중복되는 설명은 생략하도록 한다.
다음으로, 청소 로봇(100)이 TOF 방법에 따라 장애물(O)을 검출하는 경우 청소 로봇의 제어 방법에 대해 설명하도록 한다.
도 21에 도시된 바를 참조하면, 일 실시 예에 따른 청소 로봇(100)의 제어 방법은 장애물 감지부(140)에서 장애물(O) 정보를 수집하는 단계와(410), 수집된 정보에 기초하여 장애물(O)을 검출하는 단계(420)를 포함한다. TOF 방법에 따라 장애물(O)을 검출하는 방법의 경우, 수집되는 정보의 종류 및 수집된 정보의 처리 방법 측면에서 전술한 삼각 측량 방식과 차이가 있다.
구체적으로, 장애물 감지부(140)에서 장애물(O) 정보를 수집하는 단계는, 발광부(141) 및 제 1 내지 제 3 수광부(143-1, 143-2, 143-3)에서 장애물(O) 정보를 수집하는 단계와(412), 회전 구동부(147)에서 지지판(145)의 회전 정보를 수집하는 단계(414)를 포함할 수 있다.
구체적으로, 발광부(141) 및 제 1 내지 제 3 수광부(143-1, 143-2, 143-3)에서 장애물(O) 정보를 수집하는 단계는 발광부(141)의 광 발신 시점 정보와 제 1 내지 제 3 수광부(143-1, 143-2, 143-3)의 광 수신 시점 정보를 수집하는 것을 포함할 수 있다.
장애물 감지부(140)의 감지 영역 내에 장애물(O)이 존재하는 경우 장애물(O)이 존재하지 않는 경우와 비교해 발광부(141)에서 발신된 광이 수광부(143)까지 되돌아오는 시간이 짧아질 것이다. 따라서, 제어부(110)는 발광부(141)의 광 발신 시점 정보와 수광부(143)의 광 수신 시점 정보를 수집하여 장애물(O) 검출 과정에 제공할 수 있다.
실시 예에 따라 TOF 방식 중 광의 위상 차 방식을 적용할 경우, 제어부(110)가 발광부(141)에서 발신되는 광의 위상 정보와 수광부(143)에서 수신되는 광의 위상 정보를 수집할 수 있음은 물론이다(412).
회전 구동부(147)에서 지지판(145)의 회전 정보를 수집하는 단계는 삼각 측량 방법에서 설명한 내용과 동일하며, 이하 중복되는 설명은 생략하도록 한다(414).
다음으로, 수집된 정보에 기초하여 장애물(O)을 검출하는 단계가 수행될 수 있다(420).
제어부(110)는 TOF 방법에 따라 장애물(O)을 검출할 수 있다. 보다 상세하게, 제어부(110)는 발광부(141)의 광 발신 시점과 제 1 내지 제 3 수광부(143-1, 143-2, 143-3)의 광 수신 시점의 차이, 메모리(180)로부터 전달 받은 광의 속도 정보에 기초하여 청소 로봇(100)으로부터 장애물(O)까지의 거리를 검출할 수 있다. 아울러, 회전 구동부(147)의 회전 각도 정보에 기초해 장애물(O)의 방향을 검출할 수 있다. 이하, 전술한 바와 중복되는 설명은 생략하도록 한다.
다음으로, 도 22는 다른 실시 예에 따른 청소 로봇의 제어 방법을 도시한 순서도 이다. 도 22에 따른 청소 로봇의 제어 방법은 도 14 내지 도 17에 따른 청소 로봇에 대한 것으로, 이하 도 14 내지 도 17을 참조하여 본 실시 예에 따른 청소 로봇의 제어 방법에 대해 설명하도록 한다.
도 22에 도시된 바를 참조하면, 본 실시 예에 따른 청소 로봇(200)의 제어 방법은 장애물 감지부(240)에서 장애물(O) 정보를 수집하는 것과(510), 수집된 정보에 기초하여 장애물(O)을 검출하는 것을 포함할 수 있다(520). 여기서, 장애물 감지부(240)에서 장애물(O) 정보를 수집하는 것은, 발광부(241) 및 수광부(243)로부터 장애물(O) 정보를 수집하는 것과(512), 회전 구동부(247)로부터 회전 다면경(245)의 회전 정보를 수집하는 것(514)을 포함할 수 있다.
발광부(241) 및 수광부(243)로부터 장애물(O) 정보를 수집하는 것은 발광부(241)의 광 발신 시점 정보와 수광부(243)의 광 수신 시점 정보를 수집하는 것을 포함할 수 있다.
장애물 감지부(240)의 감지 영역 내에 장애물(O)이 존재하는 경우 장애물(O)이 존재하지 않는 경우와 비교해 발광부(241)에서 발신된 광이 다시 수광부(243)까지 되돌아오는 시간이 짧아질 것이다. 따라서, 제어부(210)는 발광부(241)의 광 발신 시점 정보와 수광부(243)의 광 수신 시점 정보에 기초하여 청소 로봇(200)으로부터 장애물(O)까지의 거리를 검출할 수 있다(512).
회전 구동부(247)로부터 회전 다면경(245)의 회전 정보를 수집하는 단계는, 제어부(210)가 회전 다면경(245)의 엔코(249)더로부터 회전 다면경(245)의 회전 각도 정보를 수집하는 것을 포함할 수 있다.
제어부(210)는 수집된 회전 다면경(245)의 회전 각도 정보에 기초하여 수광부(243)에서 수신된 광이 회전 다면경(245)의 반사면(245-1, 245-2, 245-3) 중 어느 반사 면으로부터 반사된 반사 광인지 결정할 수 있으며 이하 전술한 바와 중복되는 내용은 생략하도록 한다.
다음으로, 수집된 정보에 기초하여 장애물(O)을 검출하는 단계가 수행될 수 있다(520).
제어부(210)는 TOF 방법에 기초하여 장애물(O)을 검출할 수 있다. 보다 상세하게, 제어부(210)는 발광부(241)의 광 발신 시점과 수광부(243)의 광 수신 시점의 차이, 메모리(280)로부터 전달 받은 광의 속도 정보에 기초하여 청소 로봇(200)으로부터 장애물(O)까지의 거리를 검출할 수 있다. 아울러, 제어부(210)는 회전 다면경(245)의 회전 각도 정보에 기초해 xy 평면 기준으로 장애물(O)의 방향을 검출할 수 있으며, 회전 다면경(245)의 회전 각도 정보 및 메모리(280)로부터 전달 받은 회전 다면경(245)의 기울기 정보에 기초하여 z축을 기준으로 장애물(O)의 방향을 검출할 수 있다. 이하, 전술한 바와 중복되는 설명은 생략하도록 한다.
다음으로, 도 23은 또 다른 실시 예에 따른 청소 로봇의 제어 방법을 도시한 순서도 이다. 도 23에 따른 청소 로봇의 제어 방법은 도 18 내지 도 20에 따른 청소 로봇에 대한 것으로, 이하 도 18 내지 도 20을 참조하여 본 실시 예에 따른 청소 로봇의 제어 방법에 대해 설명하도록 한다.
도 23에 도시된 바를 참조하면, 본 실시 예에 따른 청소 로봇(300)의 제어 방법은 장애물 감지부(340)에서 장애물(O) 정보를 수집하는 것과(610), 수집된 정보에 기초하여 장애물(O)을 검출하는 것을 포함할 수 있다(620). 여기서, 장애물 감지부(340)에서 장애물(O) 정보를 수집하는 것은, 발광부(341) 및 수광부(343)로부터 장애물(O) 정보를 수집하는 것과(612), 회전 구동부(347)로부터 반사 거울(345)의 회전 정보를 수집하는 것(614)을 포함할 수 있다.
발광부(341) 및 수광부(343)로부터 장애물(O) 정보를 수집하는 것은 발광부(341)의 광 발신 시점 정보와 수광부(343)의 광 수신 시점 정보를 수집하는 것을 포함할 수 있다.
장애물 감지부(340)의 감지 영역 내에 장애물(O)이 존재하는 경우 장애물(O)이 존재하지 않는 경우와 비교해 발광부(341)에서 발신된 광이 수광부(343)까지 되돌아오는 시간이 짧아질 것이다. 따라서, 제어부(310)는 발광부(341)의 광 발신 시점 정보와 수광부(343)의 광 수신 시점 정보에 기초하여 청소 로봇(300)으로부터 장애물(O)까지의 거리를 검출할 수 있다(612).
회전 구동부(347)로부터 반사 거울(345)의 회전 정보를 수집하는 단계는, 제어부(310)가 회전 구동부(347)의 엔코더(349)로부터 반사 거울(345)의 회전 각도 정보를 수집하는 것을 포함할 수 있다(614).
다음으로, 수집된 정보에 기초하여 장애물(O)을 검출하는 단계가 수행될 수 있다(620).
제어부(310)는 TOF 방법에 기초하여 장애물(O)을 검출할 수 있다. 보다 상세하게, 제어부(310)는 발광부(341)의 광 발신 시점과 수광부(343)의 광 수신 시점의 차이, 메모리(380)로부터 전달 받은 광의 속도 정보에 기초하여 청소 로봇(300)으로부터 장애물(O)까지의 거리를 검출할 수 있다. 아울러, 제어부(310)는 반사 거울(345)의 회전 각도 정보에 기초해 xy 평면 기준으로 장애물(O)의 방향을 검출할 수 있다. 이하, 전술한 바와 중복되는 설명은 생략하도록 한다.
이상으로, 청소 로봇 및 그 제어 방법의 실시 예에 대해 상세하게 설명하였다. 발명의 기술적 사상이 전술한 바에 의해 한정되는 것은 아니며 당해 업계에서 통상의 지식을 가진 자가 쉽게 생각할 수 있는 범위 내의 변경을 포함하는 개념으로 넓게 이해되어야 할 것이다.
Claims (15)
- 광을 발신하는 발광부;상기 발신된 광이 장애물에 반사되면, 상기 장애물로부터 반사된 반사 광 중 미리 설정된 방향의 광을 수신하도록 마련된 복수 개의 수광부;상기 발광부 및 상기 복수 개의 수광부가 고정되며, 회전 가능하도록 마련된 지지판; 및상기 발광부 및 상기 복수 개의 수광부로부터 전달된 출력 신호 및 상기 지지판의 회전 정보에 기초하여 상기 장애물을 검출하는 제어부;를 포함하는 청소 로봇.
- 제 1항에 있어서,상기 복수 개의 수광부는,서로 다른 방향의 광을 수신하도록 서로 다른 기울기로 배치되는 청소 로봇.
- 제 1항에 있어서,상기 발광부와 상기 복수 개의 수광부는,상기 지지판에 수평 방향으로 배치되거나,상기 지지판에 수직 방향으로 적층되어 형성된 것을 포함하는 청소 로봇.
- 제 3항에 있어서,상기 복수 개의 수광부는,미리 설정된 제 1 방향의 광을 수광하도록 마련된 제 1 수광부; 및미리 설정된 제 2 방향의 광을 수광하도록 마련된 제 2 수광부;를 포함하고,상기 발광부는,미리 설정된 제 1 방향으로 광을 발신하도록 마련된 제 1 발광부; 및미리 설정된 제 2 방향으로 광을 발신하도록 마련된 제 2 발광부;를 포함하는 청소 로봇.
- 제 4항에 있어서,상기 제 1 수광부와 상기 제 1 발광부는 상기 지지판에 수평 방향으로 이웃하도록 배치되고,상기 제 2 수광부와 상기 제 2 발광부는 상기 지지판에 수평 방향으로 이웃하도록 배치되는 청소 로봇.
- 제 4항에 있어서,상기 제 1 수광부와 상기 제 1 발광부가 상기 지지판에 수직 방향으로 적층되어 형성되고,상기 제 2 수광부와 상기 제 2 발광부는 상기 지지판에 수직 방향으로 적층되어 형성된 청소 로봇.
- 제 1항에 있어서,상기 발광부는,상기 청소 로봇의 길이 방향으로 라인 광을 발신 하도록 마련되고,광원; 및상기 광원에서 생성된 광을 상기 라인 광으로 변환하는 변환렌즈;를 포함하는 청소 로봇.
- 제 7항에 있어서,상기 발광부와 상기 복수 개의 수광부는,상기 지지 판에 수직 방향으로 적층되어 형성된 것을 포함하는 청소 로봇.
- 제 8항에 있어서,상기 발광부와 상기 복수 개의 수광부는,상기 발광부의 발광 지점과 상기 복수 개의 수광부의 수광 지점이 상기 지지판의 지지면과 수평한 방향으로 미리 설정된 제 1 거리만큼 이격 배치되고,상기 발광부의 발광 지점은,상기 복수 개의 수광부의 수광 지점과 동일 평면 상에 형성되는 상기 라인 광의 발신 지점을 포함하는 청소 로봇.
- 제 1항에 있어서,상기 지지판을 회전 구동시키도록 마련된 회전 구동부;를 더 포함하고,상기 회전 구동부는 인코더를 포함하고,상기 회전 정보는,상기 지지판의 회전 각도 정보를 포함하고,상기 제어부는 상기 지지판의 회전 각도 정보에 기초하여 상기 장애물을 검출하는 청소 로봇.
- 제 1항에 있어서,상기 제어부는,삼각 측량법 및 TOF(Time of flight) 방식 중 적어도 하나에 기초하여 상기 장애물을 검출하는 청소 로봇.
- 광을 발신하는 발광부와, 상기 발신된 발신 광이 장애물에 반사되면 상기 장애물로부터 반사된 반사 광 중 미리 설정된 방향의 광을 수신하도록 마련된 복수 개의 수광부와, 회전 가능하도록 마련되며 상기 발광부 및 상기 복수 개의 수광부가 고정되는 지지판을 포함하는 청소 로봇의 제어 방법에 있어서,상기 발광부 및 상기 복수 개의 수광부에서 장애물 정보를 수집하고,회전 구동부에서 상기 지지판의 회전 정보를 수집하고,상기 발광부 및 상기 복수 개의 수광부로부터 전달된 출력 신호 및 상기 지지판의 회전 정보에 기초하여 상기 장애물을 검출하는 청소 로봇의 제어 방법.
- 제 12항에 있어서,상기 장애물을 검출하는 것은,삼각 측량법 및 TOF(Time of flight) 방식 중 적어도 하나에 기초하여 상기 장애물을 검출하는 것을 포함하는 청소 로봇의 제어 방법.
- 제 12항에 있어서,상기 발광부와 상기 복수 개의 수광부는,상기 발광부의 발광 지점으로부터 상기 복수 개의 수광부의 수광 지점 까지의 거리가 상기 지지판의 지지면과 수평한 방향으로 미리 설정된 제 1 거리만큼 이격 배치된 것을 포함하고,상기 장애물을 검출하는 것은,상기 제 1 거리, 상기 발광부의 광 발신 각도 정보, 상기 수광부의 광 수신 각도 정보 및 상기 지지판의 회전 정보에 기초하여 상기 장애물을 검출하는 것을 포함하는 청소 로봇의 제어 방법.
- 제 12항에 있어서,상기 장애물을 검출하는 것은,상기 발광부의 광 발신 시점, 상기 수광부의 광 수신 시점 및 상기 지지판의 회전 정보에 기초하여 상기 장애물을 검출하는 것을 포함하고,상기 지지판의 회전 정보를 수집하는 것은,상기 지지판의 회전 각도 정보를 수집하는 것을 포함하는 청소 로봇의 제어 방법.
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US16/098,594 US11067998B2 (en) | 2016-05-02 | 2017-04-26 | Cleaning robot and control method therefor |
EP17792830.6A EP3437536B1 (en) | 2016-05-02 | 2017-04-26 | Cleaning robot and control method therefor |
US17/348,327 US11803190B2 (en) | 2016-05-02 | 2021-06-15 | Cleaning robot and control method therefor |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR10-2016-0053827 | 2016-05-02 | ||
KR1020160053827A KR20170124216A (ko) | 2016-05-02 | 2016-05-02 | 청소로봇 및 그 제어 방법 |
Related Child Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US16/098,594 A-371-Of-International US11067998B2 (en) | 2016-05-02 | 2017-04-26 | Cleaning robot and control method therefor |
US17/348,327 Continuation US11803190B2 (en) | 2016-05-02 | 2021-06-15 | Cleaning robot and control method therefor |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2017191928A1 true WO2017191928A1 (ko) | 2017-11-09 |
Family
ID=60203548
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/KR2017/004443 WO2017191928A1 (ko) | 2016-05-02 | 2017-04-26 | 청소로봇 및 그 제어 방법 |
Country Status (4)
Country | Link |
---|---|
US (2) | US11067998B2 (ko) |
EP (1) | EP3437536B1 (ko) |
KR (1) | KR20170124216A (ko) |
WO (1) | WO2017191928A1 (ko) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019177391A1 (en) | 2018-03-14 | 2019-09-19 | Lg Electronics Inc. | Cleaner |
CN111123937A (zh) * | 2019-12-27 | 2020-05-08 | 南京天创电子技术有限公司 | 一种基于自动跨障清扫机器人控制方法及其控制*** |
CN111936024A (zh) * | 2018-01-25 | 2020-11-13 | Lg电子株式会社 | 机器人清洁器的控制方法 |
WO2021060682A1 (ko) * | 2019-09-26 | 2021-04-01 | 삼성전자주식회사 | 이동 수단을 구비한 전자 장치 및 그 동작 방법 |
WO2021177540A1 (ko) | 2020-03-04 | 2021-09-10 | 엘지전자 주식회사 | 이동 로봇 및 이의 제어 방법 |
US11197595B2 (en) | 2017-08-07 | 2021-12-14 | Lg Electronics Inc. | Cleaner |
US11478120B2 (en) | 2017-08-07 | 2022-10-25 | Lg Electronics Inc. | Cleaner |
US11622661B2 (en) | 2017-08-07 | 2023-04-11 | Lg Electronics Inc. | Robot cleaner |
US11744429B2 (en) | 2017-08-07 | 2023-09-05 | Lg Electronics Inc. | Cleaner |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20170124216A (ko) * | 2016-05-02 | 2017-11-10 | 삼성전자주식회사 | 청소로봇 및 그 제어 방법 |
KR102014141B1 (ko) | 2017-08-07 | 2019-10-21 | 엘지전자 주식회사 | 로봇청소기 |
KR102014142B1 (ko) | 2017-08-07 | 2019-08-26 | 엘지전자 주식회사 | 로봇 청소기 |
KR102024089B1 (ko) | 2017-08-07 | 2019-09-23 | 엘지전자 주식회사 | 로봇 청소기 |
KR102011827B1 (ko) | 2017-08-07 | 2019-08-19 | 엘지전자 주식회사 | 로봇청소기 및 그 제어방법 |
JP7000992B2 (ja) * | 2018-05-25 | 2022-01-19 | トヨタ自動車株式会社 | マニピュレータおよび移動ロボット |
WO2020243901A1 (en) * | 2019-06-04 | 2020-12-10 | Texas Instruments Incorporated | An optical time of flight sensor for navigation systems in robotic applications |
JPWO2021019906A1 (ko) * | 2019-07-26 | 2021-02-04 | ||
CN111026163B (zh) * | 2019-12-20 | 2021-10-26 | 华南理工大学 | 一种面向室内的失控放射源自主搜寻机器人及其搜寻方法 |
CN118119488A (zh) * | 2021-10-19 | 2024-05-31 | Abb瑞士股份有限公司 | 包括环境传感器的机器人*** |
EP4343381A1 (de) * | 2022-09-26 | 2024-03-27 | Vorwerk & Co. Interholding GmbH | Sich selbsttätig fortbewegendes bodenbearbeitungsgerät mit einer optischen abstandsmesseinrichtung |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20020080897A (ko) * | 2001-04-18 | 2002-10-26 | 삼성광주전자 주식회사 | 로봇 청소기의 장애물 형태 감지 장치 및 그 방법 |
KR20090019480A (ko) * | 2007-08-21 | 2009-02-25 | 에이스로봇 주식회사 | 로봇 청소기의 바닥 감지 방법 그리고 이에 적합한 로봇청소기 |
KR101395888B1 (ko) * | 2013-03-21 | 2014-05-27 | 엘지전자 주식회사 | 로봇 청소기 및 그 동작방법 |
KR20150095440A (ko) * | 2014-02-13 | 2015-08-21 | 엘지전자 주식회사 | 거리 검출 장치 및 그 방법 |
KR101578878B1 (ko) * | 2014-05-07 | 2015-12-21 | 에브리봇 주식회사 | 거리 센서 장치, 로봇 청소기 및 이의 제어 방법 |
Family Cites Families (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SE455539B (sv) * | 1986-05-23 | 1988-07-18 | Electrolux Ab | Elektrooptiskt positionskennande system for ett i plan rorligt foremal, foretredesvis en mobil robot |
EP1232424A1 (en) * | 1999-11-18 | 2002-08-21 | The Procter & Gamble Company | Home cleaning robot |
US8412377B2 (en) * | 2000-01-24 | 2013-04-02 | Irobot Corporation | Obstacle following sensor scheme for a mobile robot |
US6956348B2 (en) * | 2004-01-28 | 2005-10-18 | Irobot Corporation | Debris sensor for cleaning apparatus |
US6496754B2 (en) * | 2000-11-17 | 2002-12-17 | Samsung Kwangju Electronics Co., Ltd. | Mobile robot and course adjusting method thereof |
WO2003026474A2 (en) * | 2001-09-26 | 2003-04-03 | Friendly Robotics Ltd. | Robotic vacuum cleaner |
KR20040086940A (ko) * | 2003-04-03 | 2004-10-13 | 엘지전자 주식회사 | 이미지센서를 채용한 이동로봇 및 그의 이동거리 측정방법 |
KR20050063546A (ko) * | 2003-12-22 | 2005-06-28 | 엘지전자 주식회사 | 로봇 청소기 및 그 운전방법 |
CN101688774A (zh) | 2006-07-13 | 2010-03-31 | 威力登音响公司 | 高精确度激光雷达*** |
US8774970B2 (en) * | 2009-06-11 | 2014-07-08 | S.C. Johnson & Son, Inc. | Trainable multi-mode floor cleaning device |
US8612599B2 (en) * | 2011-09-07 | 2013-12-17 | Accenture Global Services Limited | Cloud service monitoring system |
KR20130030472A (ko) | 2011-09-19 | 2013-03-27 | 권영길 | 빗물활용을 위한 건물의 빗물 저장장치 및 그 사용 방법 |
CN103608696B (zh) | 2012-05-22 | 2016-05-11 | 韩国生产技术研究院 | 3d扫描***和获得3d图像的方法 |
US9020641B2 (en) * | 2012-06-07 | 2015-04-28 | Samsung Electronics Co., Ltd. | Obstacle sensing module and cleaning robot including the same |
EP2869514A1 (en) * | 2013-10-30 | 2015-05-06 | Alcatel Lucent | Method and system for queue management in a packet-switched network |
EP2894491B1 (en) | 2013-12-18 | 2020-05-27 | LG Electronics Inc. | Distance measuring device and method thereof |
KR102138522B1 (ko) | 2013-12-18 | 2020-07-28 | 엘지전자 주식회사 | 레이저 거리 측정 장치 및 제어방법 |
US10025305B2 (en) * | 2014-02-28 | 2018-07-17 | Samsung Electronics Co., Ltd. | Cleaning robot and remote controller included therein |
KR20160034719A (ko) | 2014-09-22 | 2016-03-30 | 한화테크윈 주식회사 | 라이다 시스템 |
US9919425B2 (en) * | 2015-07-01 | 2018-03-20 | Irobot Corporation | Robot navigational sensor system |
KR20170124216A (ko) * | 2016-05-02 | 2017-11-10 | 삼성전자주식회사 | 청소로봇 및 그 제어 방법 |
US11348269B1 (en) * | 2017-07-27 | 2022-05-31 | AI Incorporated | Method and apparatus for combining data to construct a floor plan |
US11274929B1 (en) * | 2017-10-17 | 2022-03-15 | AI Incorporated | Method for constructing a map while performing work |
-
2016
- 2016-05-02 KR KR1020160053827A patent/KR20170124216A/ko not_active IP Right Cessation
-
2017
- 2017-04-26 WO PCT/KR2017/004443 patent/WO2017191928A1/ko active Application Filing
- 2017-04-26 EP EP17792830.6A patent/EP3437536B1/en active Active
- 2017-04-26 US US16/098,594 patent/US11067998B2/en active Active
-
2021
- 2021-06-15 US US17/348,327 patent/US11803190B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20020080897A (ko) * | 2001-04-18 | 2002-10-26 | 삼성광주전자 주식회사 | 로봇 청소기의 장애물 형태 감지 장치 및 그 방법 |
KR20090019480A (ko) * | 2007-08-21 | 2009-02-25 | 에이스로봇 주식회사 | 로봇 청소기의 바닥 감지 방법 그리고 이에 적합한 로봇청소기 |
KR101395888B1 (ko) * | 2013-03-21 | 2014-05-27 | 엘지전자 주식회사 | 로봇 청소기 및 그 동작방법 |
KR20150095440A (ko) * | 2014-02-13 | 2015-08-21 | 엘지전자 주식회사 | 거리 검출 장치 및 그 방법 |
KR101578878B1 (ko) * | 2014-05-07 | 2015-12-21 | 에브리봇 주식회사 | 거리 센서 장치, 로봇 청소기 및 이의 제어 방법 |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11197595B2 (en) | 2017-08-07 | 2021-12-14 | Lg Electronics Inc. | Cleaner |
US11478120B2 (en) | 2017-08-07 | 2022-10-25 | Lg Electronics Inc. | Cleaner |
US11622661B2 (en) | 2017-08-07 | 2023-04-11 | Lg Electronics Inc. | Robot cleaner |
US11744429B2 (en) | 2017-08-07 | 2023-09-05 | Lg Electronics Inc. | Cleaner |
CN111936024A (zh) * | 2018-01-25 | 2020-11-13 | Lg电子株式会社 | 机器人清洁器的控制方法 |
US11439287B2 (en) | 2018-01-25 | 2022-09-13 | Lg Electronics Inc. | Controlling method of robot cleaner |
WO2019177391A1 (en) | 2018-03-14 | 2019-09-19 | Lg Electronics Inc. | Cleaner |
EP3764864A4 (en) * | 2018-03-14 | 2021-12-08 | LG Electronics Inc. | CLEANSER |
WO2021060682A1 (ko) * | 2019-09-26 | 2021-04-01 | 삼성전자주식회사 | 이동 수단을 구비한 전자 장치 및 그 동작 방법 |
CN111123937A (zh) * | 2019-12-27 | 2020-05-08 | 南京天创电子技术有限公司 | 一种基于自动跨障清扫机器人控制方法及其控制*** |
WO2021177540A1 (ko) | 2020-03-04 | 2021-09-10 | 엘지전자 주식회사 | 이동 로봇 및 이의 제어 방법 |
Also Published As
Publication number | Publication date |
---|---|
EP3437536A1 (en) | 2019-02-06 |
US11803190B2 (en) | 2023-10-31 |
EP3437536A4 (en) | 2019-05-01 |
US11067998B2 (en) | 2021-07-20 |
US20190146504A1 (en) | 2019-05-16 |
EP3437536B1 (en) | 2020-05-13 |
US20210311477A1 (en) | 2021-10-07 |
KR20170124216A (ko) | 2017-11-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2017191928A1 (ko) | 청소로봇 및 그 제어 방법 | |
WO2016129950A1 (ko) | 청소 로봇 및 그 제어방법 | |
WO2017200302A2 (ko) | 이동 로봇 및 그 제어방법 | |
WO2015060672A1 (ko) | 청소 로봇 | |
AU2018239735B2 (en) | Cleaner and method of controlling the same | |
WO2017048046A1 (ko) | 청소 로봇 및 그 제어 방법 | |
WO2018155999A2 (en) | Moving robot and control method thereof | |
WO2018230852A1 (ko) | 3차원 공간의 이동 객체를 식별하는 방법 및 이를 구현하는 로봇 | |
WO2021060661A1 (ko) | 로봇 청소기 | |
WO2017204517A1 (ko) | 청소 로봇 및 그 제어 방법 | |
WO2021006677A2 (en) | Mobile robot using artificial intelligence and controlling method thereof | |
WO2016200035A1 (en) | Moving robot and method for controlling the same | |
EP3829833A1 (en) | Moving robot and controlling method thereof | |
EP3209185A1 (en) | Robot cleaner and method for controlling the same | |
WO2016028021A1 (ko) | 청소 로봇 및 그 제어 방법 | |
WO2021006542A1 (en) | Mobile robot using artificial intelligence and controlling method thereof | |
AU2018216517B9 (en) | Cleaner | |
WO2018101631A2 (ko) | 청소 로봇, 청소 로봇에 구비되는 청소 기능 제어 장치, 및 청소 로봇에 구비되는 다채널 라이더 기반 장애물 검출 장치 | |
WO2020256370A1 (en) | Moving robot and method of controlling the same | |
WO2019054676A1 (ko) | 이동 로봇 시스템 및 그 제어 방법 | |
WO2018117616A1 (ko) | 이동 로봇 | |
WO2021172936A1 (en) | Moving robot and control method thereof | |
WO2019221523A1 (ko) | 청소기 및 그 제어방법 | |
WO2022035150A1 (ko) | 청소 로봇 및 그 제어 방법 | |
WO2022010029A1 (ko) | 로봇 청소기 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
WWE | Wipo information: entry into national phase |
Ref document number: 2017792830 Country of ref document: EP |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2017792830 Country of ref document: EP Effective date: 20181031 |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 17792830 Country of ref document: EP Kind code of ref document: A1 |