Nothing Special   »   [go: up one dir, main page]

CN113768418A - Multifunctional ladder stand cleaning robot based on code disc and gyroscope positioning - Google Patents

Multifunctional ladder stand cleaning robot based on code disc and gyroscope positioning Download PDF

Info

Publication number
CN113768418A
CN113768418A CN202110976937.2A CN202110976937A CN113768418A CN 113768418 A CN113768418 A CN 113768418A CN 202110976937 A CN202110976937 A CN 202110976937A CN 113768418 A CN113768418 A CN 113768418A
Authority
CN
China
Prior art keywords
bottom plate
motor
cleaning
wheel
gyroscope
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202110976937.2A
Other languages
Chinese (zh)
Inventor
李党超
多小川
林心怡
吴启
王迪
杨春风
张家豪
卢政昕
柳滢坤
刘韦辰
叶书航
张育林
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Xian Jiaotong University
Original Assignee
Xian Jiaotong University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Xian Jiaotong University filed Critical Xian Jiaotong University
Priority to CN202110976937.2A priority Critical patent/CN113768418A/en
Publication of CN113768418A publication Critical patent/CN113768418A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/24Floor-sweeping machines, motor-driven
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/28Floor-scrubbing machines, motor-driven
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40Parts 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/4002Installations of electric equipment
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40Parts 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/4011Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40Parts 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/4013Contaminants collecting devices, i.e. hoppers, tanks or the like
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40Parts 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/4013Contaminants collecting devices, i.e. hoppers, tanks or the like
    • A47L11/4025Means for emptying
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40Parts 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/4061Steering means; Means for avoiding obstacles; Details related to the place where the driver is accommodated
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40Parts 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/4063Driving means; Transmission means therefor
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40Parts 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/4094Accessories to be used in combination with conventional vacuum-cleaning devices
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L2201/00Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L2201/00Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
    • A47L2201/04Automatic control of the travelling movement; Automatic obstacle detection
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L2201/00Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
    • A47L2201/06Control of the cleaning action for autonomous devices; Automatic detection of the surface condition before, during or after cleaning

Landscapes

  • Electric Vacuum Cleaner (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Electric Suction Cleaners (AREA)

Abstract

A multifunctional ladder cleaning robot based on code disc and gyroscope positioning comprises a code disc, a moving wheel device, a lead screw sliding table device, a cleaning mechanism, a floor mopping mechanism and a control panel, wherein the code disc is used for realizing the positioning function when the robot moves on the flat ground; the robot is driven by a motor on the basis of a double-screw three-chassis structure, the lifting action of each chassis is realized through screw transmission, the climbing and downstairs actions of the robot are completed, and the chassis is provided with an ultraviolet lamp to realize sterilization and disinfection on the ground; the invention integrates the cleaning function, occupies small area, supports the ladder surface cleaning, meets the intelligent development requirement in a diversified control mode, and fills the market gap of the duplex household cleaning robot.

Description

Multifunctional ladder stand cleaning robot based on code disc and gyroscope positioning
Technical Field
The invention relates to an intelligent household ladder stand cleaning robot, in particular to a multifunctional ladder stand cleaning robot based on coded disc and gyroscope positioning, which is an intelligent household ladder stand cleaning robot capable of realizing accurate positioning, ladder stand, cleaning and disinfection, air monitoring and diversified intelligent control.
Background
With the acceleration of life rhythm, the time that people can do housework is less and less. Therefore, the demand of consumers for the home service robot is increasing, and as early as 2010, the domestic personal and home service robot market is silently emerging. In all household tasks, cleaning work is unavoidable in human life and this can be done by a household cleaning robot. It follows that the cleaning robot has a wide consumer market. Statistics show that the retail amount of the global sweeping robot market in 2012 is $ 10.4 billion, and 3 times in 2018, which reaches $ 35.3 billion, and the number is projected to increase to $ 54.6 billion by 2022. Meanwhile, the sales volume of domestic sweeping robots is increased year by year in recent years, and the retail scale reaches the million orders. As a high-tech partner of human family life, the sweeping robot gradually enters the ordinary families of Chinese residents to provide convenience for the daily life of people
From the hundred-degree search index, since about 2010, the sweeping robot is in the rise in China, the search attention of the sweeping robot tends to rise all the way. At present, a plurality of mature indoor sweeping robot products such as i5Young, millet R1-L083B, Cowss DF45 and the like exist in the market, but most of the products are only suitable for flat ground sweeping. In other words, at present, no mature floor sweeping robot product capable of fully automatically climbing stairs exists at home and abroad. In the academic field, there are many design ideas of ladder climbing robot mechanical structures, such as bionic structures, stepping structures, planar link mechanisms, star wheel mechanisms and crawler mechanisms, and the research conditions are as follows.
(1) Such as CN 201920211996.9. The claw-shaped structure is used for climbing, is flexible, but has high requirements on the ground gripping performance of the structure and poor stability.
(2) Such as CN201711407786.9 wheel obstacle crossing mechanisms. The elastic part is connected with the wheel, the wheel can be bounced to pass through the obstacle when the obstacle is encountered, but the height and the angle of the obstacle are greatly limited, and once the obstacle is higher than the radius of the wheel, the obstacle cannot pass through the obstacle.
(3) Such as the Z-type structure of CN 202010358165.1. The main body of the machine is supported by the two support rods to go upstairs, but the machine is easy to tip over when going upstairs, and the stability is poor.
Disclosure of Invention
In order to overcome the defects of the prior art, the invention aims to provide a multifunctional ladder climbing cleaning robot based on coded disc and gyroscope positioning, which meets the requirement of the current market on a duplex cleaning robot and improves the life quality of users by integrating multiple functions of cleaning, ladder climbing, disinfection and the like and performing diversified application of intelligent control.
In order to achieve the purpose, the technical scheme of the invention is as follows:
a multifunctional ladder cleaning robot based on coded disc and gyroscope positioning comprises a bottom plate 34, coded discs 6 which are arranged on the left side and the right side below the middle of the bottom plate 34 and are used for realizing a positioning function in a flat ground movement state, a moving wheel device 7 which is arranged on the outer side of the coded discs 6 below the bottom plate 34 and is used for realizing the flat ground movement, a screw rod sliding table device 1 which is used for connecting the front part, the middle part and the rear part of the bottom plate 34 and realizing the ladder movement, a cleaning mechanism 3 which is arranged at the front end of the bottom plate 34 and is used for cleaning garbage and absorbing dust, a floor mopping mechanism 5 which is arranged at the rear end of the bottom plate 34 and is used for mopping, disinfecting and spraying and humidifying, and a control panel 4 which is arranged above the bottom plate 34.
The code wheel 6 for realizing the positioning function in the flat ground movement state comprises a code wheel support frame 8, a rolling bearing 10 is arranged on the code wheel support frame 8, the rolling bearing 10 is connected with a universal wheel 16 through a code wheel connecting shaft 15, the universal wheel 16 is connected with an encoder 11 through a flange plate 9, the code wheel support frame 8 is connected with an A sliding block 14, the A sliding block 14 is matched with a sliding rail 12, a spring 13 is sleeved on the sliding rail 12, the sliding rail 12 is connected with the middle of a bottom plate 34, a gyroscope 56 is fixed above the rear end of the bottom plate 34, and photoelectric sensors 54 are arranged on the left side and the right side of the front end of the bottom plate 34.
The moving wheel device 7 for realizing the flat ground movement comprises a friction wheel 22, one side of the friction wheel 22 is connected with a shaft of an M2006 motor 20 through a bearing 21 of a friction wheel coupling I23, and the M2006 motor 20 is connected with a friction wheel motor connecting piece 18; the other side of the friction wheel 22 is fixed with a bearing 25 through a friction wheel coupler II 24, and the bearing 25 is matched with the friction wheel motor base 19; the friction wheel motor connecting sheet 18 and the friction wheel motor base 19 are both connected with the bottom plate 34.
The lead screw sliding table device 1 for achieving crawling ladder movement comprises a motor 30, an output shaft of the motor 30 is connected with a lead screw 28 in a matched mode, the lead screw 28 is connected with an internal thread of a B sliding block 27 through threads, and the lead screw 28 is connected with a fixing main body 29 through a bearing.
The cleaning mechanism 3 for cleaning garbage and absorbing dust comprises a motor 41 fixed on a small motor base 43, the motor 41 is connected with a large gear 42, the large gear 42 is meshed with a small gear 45 to form an accelerating mechanism, the small gear 45 is in driving connection with a rolling brush 40, and two ends of the rolling brush 40 are fixed on a bottom plate 34 by an A broom base 37 and a B broom base 44; the dust absorption mechanism 35 arranged above the rolling brush 40 is fixed on the bottom plate 34; the bottom plate 34 is also fixed with a steering engine 31 through a steering engine fixing frame 32, the steering engine 31 drives the dustpan 38 through a connecting rod 33, and the driving dustpan 38 is fixed on the bottom plate 34 through a dustpan cover 36.
The floor mopping mechanism 5 for mopping, disinfecting, spraying and humidifying comprises a mop cover 48 playing a supporting role, a mop cloth 49 is arranged at the bottom of the mop cover 48, the upper part of the mop cover 48 is connected with the rear end of a bottom plate 34 through a side plate 47, a humidifier 46 is arranged on the bottom plate 34, an ultraviolet disinfection lamp 57 is arranged below the middle end of the bottom plate 34, and the upper connection and the lower connection of the side plate 47 are realized through an angle connector 50.
The control panel 4 of the system comprises an STM32F407ZGT6 singlechip 51, an Arduino MAGA2560 mainboard 52 and a raspberry pie 53; the STM32F407ZGT6 single chip microcomputer 51 controls the motor 30 through PWM wave drive and output IO, and controls the M2006 motor 20 through CAN communication; the Arduino MAGA2560 main board 52 controls the motor 41 and the humidifier 46 through output IO, and controls the steering engine 31 through PWM; raspberry pie 53 communicates with STM32 singlechip 52 through the serial port and receives information from WIFI.
The bottom of the bottom plate 34 is provided with a bull-eye wheel 39.
The invention has the advantages that:
(1) the invention is closely related to the current market situation and the requirement; the cleaning robot can well meet the market demand by designing a compound robot in combination with the increasing demand of the cleaning robot in the existing market and the less current situation of the compound robot.
(2) The invention adopts full-automatic integration of a cleaning system. The multifunctional garbage cleaning machine integrates the functions of cleaning, dust collection, mopping, disinfection, local humidification and automatic garbage dumping, has complete cleaning function, and is different from the products in the market without manually cleaning a robot dust box.
(3) The ladder stand disclosed by the invention adopts the three-chassis double-lead-screw lifting mechanism to realize the ladder stand function and is suitable for all indoor terrains. The double code discs are matched with the gyroscope to realize the positioning function, and the positioning method has higher accuracy compared with the positioning modes such as beacon positioning, laser positioning and the like on the market.
(4) The invention adopts diversified intelligent control. The system supports STM 32-based infrared remote control, voice module control and touch screen control, and raspberry pi-based mobile phone WIFI control, such as an applet and a collection voice assistant.
Drawings
FIG. 1 is an isometric view of the present invention.
FIG. 2 is an isometric view of a code wheel.
Fig. 3 is a bottom view of the moving wheel.
Fig. 4 is an isometric view of a screw slide.
Fig. 5 is an isometric view of the cleaning mechanism.
FIG. 6 is an isometric view of the mopping mechanism.
Fig. 7 is a schematic diagram of the control board.
Detailed Description
The present invention will be described in detail with reference to the accompanying drawings.
Referring to fig. 1, the multifunctional ladder cleaning robot based on coded disc and gyroscope positioning comprises a bottom plate 34, coded discs 6 which are arranged on the left side and the right side below the middle of the bottom plate 34 and are used for realizing a positioning function in a flat ground movement state, a moving wheel device 7 which is arranged on the outer side of the coded discs 6 below the bottom plate 34 and is used for realizing the flat ground movement, a screw rod sliding table device 1 which is used for connecting the front part, the middle part and the rear part of the bottom plate 34 and realizing the ladder movement, a cleaning mechanism 3 which is arranged at the front end of the bottom plate 34 and is used for cleaning garbage and absorbing dust, a floor mopping mechanism 5 which is arranged at the rear end of the bottom plate 34 and is used for mopping, disinfecting and spraying and humidifying, and a control panel 4 which is arranged above the bottom plate 34.
Referring to fig. 2, two coded disks 6 for realizing the positioning function in the state of flat motion are vertically distributed on the left side and the right side below the middle part of the bottom plate 34; the encoder comprises a coded disc support frame 8 which mainly plays a supporting role, wherein a rolling bearing 10 is arranged on the coded disc support frame 8 and is limited through a bearing blocking sheet 17, the rolling bearing 10 is connected with a universal wheel 16 through a coded disc connecting shaft 15, and the universal wheel 16 is connected with an encoder 11 through a flange plate 9. The code wheel support frame 8 is connected with the A sliding block 14, the A sliding block 14 is matched with the sliding rail 12, the sliding rail 12 is sleeved with the spring 13, the sliding rail 12 is connected with the middle of the bottom plate 34, so that the whole code wheel 6 is connected with other supporting structures on the upper portion of the mechanism, the gyroscope 56 is fixed above the rear end of the bottom plate 34, the photoelectric sensors 54 are arranged on the left side and the right side of the front end of the bottom plate 34, the code wheel 6 above the gyroscope 56 is used in a combined mode, and the photoelectric sensors 54 are added for assisting to achieve the whole positioning function.
Referring to fig. 3, two moving wheel devices 7 for realizing the flat ground movement are arranged and distributed outside the coded disc 6 below the bottom plate 34, and each moving wheel device comprises a friction wheel 22, one side of each friction wheel 22 is connected with a shaft of an M2006 motor 20 through a bearing 21 of a friction wheel coupling I23, and the M2006 motor 20 is connected with a friction wheel motor connecting sheet 18; the other side of the friction wheel 22 is fixed with a bearing 25 through a friction wheel coupling II 24, the bearing 25 is matched with the friction wheel motor base 19 and is limited by a friction wheel bearing baffle 26 to prevent the bearing 25 from slipping; the friction wheel motor connecting sheet 18 and the friction wheel motor base 19 are both connected with the bottom plate 34.
Referring to fig. 4, the lead screw sliding table device 1 for realizing ladder climbing movement comprises a motor 30, an output shaft of the motor 30 is in fit connection with a lead screw 28, the lead screw 28 is in threaded connection with an internal thread of a B slider 27, the B slider 27 can move along the axial direction of the lead screw 28 after the lead screw 28 rotates, and the lead screw 28 is connected with a fixed main body 29 through a bearing. The lead screw slip table device 1 totally two, one of them is used for connecting the anterior of bottom plate 34 and the middle part of bottom plate 34: the B slide block 27 is connected with the front part of the bottom plate 34, and the fixed main body 29 is connected with the middle part of the bottom plate 34, so that the relative movement control of the front part of the bottom plate 34 and the middle part of the bottom plate 34 can be realized; the other for connecting the middle of the bottom plate 34 and the rear of the bottom plate 34: the B slide block 27 is connected with the rear part of the bottom plate 34, and the fixing main body 29 is connected with the middle part of the bottom plate 34, so that the relative movement control of the rear part of the bottom plate 34 and the middle part of the bottom plate 34 is realized. The two screw rod sliding table devices 1 are matched for use, lifting and descending of the three parts are controlled, and the function of climbing a ladder of the robot can be achieved.
Referring to fig. 5, the cleaning mechanism 3 for cleaning household garbage and dust comprises a motor 41 fixed on a small motor base 43, the motor 41 is connected with a large gear 42, and the large gear 42 is engaged with a small gear 45 to form an accelerating mechanism. The pinion 45 is connected with the rolling brush 40 in a driving way, and two ends of the rolling brush 40 are also fixed on the bottom plate 34 by the broom seat A37 and the broom seat B44; the dust absorption mechanism 35 arranged above the rolling brush 40 is fixed on the bottom plate 34; the bottom plate 34 is also fixed with a steering engine 31 through a steering engine fixing frame 32, the steering engine 31 drives the dustpan 38 through a connecting rod 33, the driving dustpan 38 is fixed on the bottom plate 34 through a dustpan cover 36, and the bottom of the bottom plate 34 is provided with a bull's eye wheel 39 for preventing collision.
Referring to fig. 6, the mopping mechanism 5 for mopping, spraying and humidifying comprises a mop cover 48 for supporting, a mop cloth 49 is arranged at the bottom of the mop cover 48, the mop cloth 49 is connected with the mop cover 48 through screws, the upper part of the mop cover 48 is connected with the rear end of a bottom plate 34 through a side plate 47, a humidifier 46 is arranged on the bottom plate 34, an ultraviolet disinfection lamp 57 is arranged below the middle end of the bottom plate 34, and the upper and lower connection of the side plate 47 is realized through an angle code 50.
Referring to fig. 7, the control panel 4 of the system is arranged on a bottom plate 34 and comprises a master control algorithm with functions of moving, positioning, obstacle avoidance and ladder climbing; the system comprises an STM32F407ZGT6 singlechip 51, an Arduino MAGA2560 mainboard 52 and a raspberry pie 53, wherein the STM32F407ZGT6 singlechip 51 drives a motor 30 through PWM (pulse-width modulation) waves and through output IO (input/output), and controls an M2006 motor 20 through CAN (controller area network) communication; the Arduino MAGA2560 main board 52 controls the motor 41 and the humidifier 46 through output IO and controls the steering engine 31 through PWM; raspberry pie 53 communicates with STM32 singlechip 52 through the serial port and receives information from WIFI. The control means include infrared remote control based on Arduino, touch screen control based on STM32, and cell-phone WIFI control based on raspberry group, such as applet and collect voice assistant.
The bottom of the bottom plate 34 is provided with a bull-eye wheel 39 for preventing collision.
The specific working process of the invention is as follows:
cleaning the flat ground:
in the first step, the user directly commands the robot to start cleaning through an infrared remote control/touch screen button/voice control mode or remotely commands the robot to start cleaning from a server through a WeChat applet/voice assistant. After receiving the information, the control panel 4 controls the relevant mechanism to start the flat ground cleaning work.
And secondly, starting the system to operate and starting the cleaning work. Firstly, the system starts a rolling brush motor to drive a cleaning brush to rotate so as to send garbage and dust to a dust collection port; secondly, the system starts a dust collection motor to drive a fan to suck the garbage into a dust box. Then, the system starts the driving motor to drive the friction wheel to move along a zigzag path. When the robot moves, the forward direction and angle are obtained through a code disc and a gyroscope, and the real-time position is obtained through calculation, so that the cleaning route is adjusted; the distance detection is carried out through the preposed photoelectric switch sensor to avoid obstacles, prevent collision and control turning. When the system enters a disinfection mode, the ultraviolet disinfection lamp is turned on to sterilize and disinfect the cleaned ground. In the mopping mode, the system turns on the humidifier module for watering and humidifying, and the mop cloth rubs with the ground to mop the ground.
And thirdly, an air quality sensor is additionally arranged on the bottom plate and used for reading the data of the air quality sensor, collecting and updating indoor air quality data in real time and displaying the data on the touch screen. The process is in the terminal logic rather than the main routine and can be performed simultaneously with the cleaning operation.
Climbing a ladder:
the robot carries out the place ahead barrier through two leading photoelectric distance measuring sensors of different height and judges at the in-process that advances, and when the difference value of eminence detection distance and low detection distance is great, think the place ahead and be the stair, the robot gets into the cat ladder mode when low detection distance is nearer.
And secondly, the robot stops in front of the stairs, the system automatically controls the screw rod to move, the front vehicle is lifted to the height of the first step, and the height can be calculated by the time when the detection distance at the lower part changes. And then, the system drives the middle vehicle friction wheel to move forwards for a certain distance, the front vehicle is conveyed to a first-stage step, and the position of the front vehicle is adjusted, so that the front and rear vehicle parts become a whole vehicle fulcrum. And after the robot is stable, the lead screw lifts the middle vehicle to the height of the first step. And then the friction wheel of the rear vehicle drives the whole vehicle to move forward for a certain distance, and the middle vehicle is placed on the first-stage step. Then adjusting the position of the middle vehicle to ensure that the center of gravity of the whole vehicle is positioned at the front part; finally, lifting the lead screw to the height of the first step, and enabling the front vehicle friction wheel to move forward; and the whole vehicle reaches the height of the first step.
And thirdly, the system controls the friction wheel of the middle vehicle to perform differential motion, the whole vehicle rotates by 90 degrees, and the robot enters a flat ground cleaning state to start cleaning the stair surface. After the step surface is cleaned, the whole vehicle rotates 90 degrees in the reverse direction to prepare the step climbing of the next step to act.
Dumping garbage:
firstly, the robot stops in front of the garbage can, and the system drives the lead screw to lift the front vehicle, so that the dustpan is lifted to the height of the recycling opening.
And secondly, the whole vehicle moves forward for a certain distance, and the steering engine drives the dustpan to be opened, so that the garbage is poured out.
And thirdly, the steering engine drives the dustpan to be closed, the whole vehicle retreats and lowers the height of the front vehicle, and the cleaning mode returns to the normal cleaning mode.
When cleaning flat ground, the first step is to move to a designated position. The encoder 11 and the universal wheel 16 are mounted by a single degree of freedom mounting frame which is designed and manufactured autonomously. The mounting frame can meet the requirement that the encoder 11 is rigidly connected with the universal wheel 16, and the encoder assembly body is elastically connected with the middle vehicle body, so that the universal wheel 16 can be used as a counting wheel in the moving process of the robot, can be always kept in contact with the ground along with the fluctuation change of the ground, and can be used for ensuring that the encoder 11 is constantly kept in a working state (the distance is measured by using the rolling circumference and the displacement is recorded) in the moving process of the robot on a mechanical mechanism. The combination of the encoder 11 and the universal wheel 16 is used as a meter counter and is matched with a gyroscope, so that the movement can be accurately and stably carried out according to the specified direction, meanwhile, the displacement is accurately recorded, and the positioning function is realized. The robot can establish a topographic map through multiple times of learning, so that path planning is carried out on the basis of the topographic map, the robot moves according to the path under the cooperation of the encoder 11 and the gyroscope, and the accuracy is extremely high. When the garbage sweeper is used, the friction wheel of the middle vehicle is used for driving, the rear vehicle is suspended and is about 1cm away from the ground, the front vehicle keeps the rolling brush in contact with the ground, and the garbage sweeper can normally realize the function of sweeping garbage.
The second step is cleaning. Driven by the motor 30, gear transmission, the rolling brush 40 rotates at high speed while the robot moves, on one hand, solid garbage such as bottle caps, paper scraps, melon seed peels and the like is swept into the dustpan 38 which is designed and used in a matching way to complete sweeping work; on the other hand, the rolling brush 40 disturbs the air near the ground and directly lifts the tiny dust on the ground in the cleaning process, so that the air is coiled with the dust and enters the dustpan in the air suction process when the blower is powered on.
When the ladder is climbed, the first step is that the front vehicle is lifted to the height of a first step, the front vehicle is driven by the friction wheel 22 of the middle vehicle to advance for a certain distance, the two rear screw rod 28 assemblies work simultaneously, and the vehicle body provided with the B sliding block 27 is matched to lift the middle vehicle to the height of the first step along the screw rods 28.
The second step is that the rear vehicle friction wheel 22 is driven to move forward for a certain distance, the center of gravity of the middle vehicle is stabilized on the first step surface and then works through the screw rod 28, and the B slide block 27 is matched to lift the rear vehicle to the height of the first step.
The third step is that the robot enters a plane cleaning state to clean the ladder surface by realizing the rotation of 90 degrees in situ through the differential motion of the middle car friction wheel 22, and then the robot reversely rotates 90 degrees in situ through the differential motion of the middle car friction wheel 22 after the cleaning of the ladder surface, and enters the ladder climbing action of the next step.
When dumping garbage, the first step is to lift the front vehicle by the lead screw 28 after the cleaning work is finished.
The second step is to combine the double-rocker mechanism driven by the steering engine 31 to realize the turnover of the dustpan, thereby realizing the function of automatically dumping garbage. The method specifically comprises the following steps: the steering engine 31 fixed at the point O drives the OA lever to rotate clockwise, and the CB lever rotates anticlockwise through the double-rocker mechanism to drive the dustpan 38 fixed at the CB position to overturn and pour garbage downwards.

Claims (8)

1. The utility model provides a multi-functional cat ladder cleaning machines people based on code wheel and gyroscope location which characterized in that includes: the device comprises a bottom plate (34), code wheels (6) which are arranged on the left side and the right side below the middle part of the bottom plate (34) and used for realizing a positioning function in a flat ground motion state, a motion wheel device (7) which is arranged on the outer side of the code wheel (6) below the bottom plate (34) and used for realizing the flat ground motion, a screw rod sliding table device (1) which is used for being connected to the front part, the middle part and the rear part of the bottom plate (34) and used for realizing the movement of a ladder stand, a cleaning mechanism (3) which is arranged at the front end of the bottom plate (34) and used for cleaning common garbage and dust collection in a family, a floor mopping mechanism (5) which is arranged at the rear end of the bottom plate (34) and used for mopping and spraying and humidifying, and a control panel (4) which is arranged above the bottom plate (34).
2. The multifunctional ladder climbing cleaning robot based on the coded disc and the gyroscope for positioning is characterized in that the coded disc (6) used for achieving the positioning function in the flat ground movement state comprises a coded disc supporting frame (8), a rolling bearing (10) is arranged on the coded disc supporting frame (8), the rolling bearing (10) is connected with a universal wheel (16) through a coded disc connecting shaft (15), the universal wheel (16) is connected with an encoder (11) through a flange plate (9), the coded disc supporting frame (8) is connected with an A sliding block (14), the A sliding block (14) is matched with a sliding rail (12), a spring (13) is sleeved on the sliding rail (12), and the sliding rail (12) is connected with the middle of a bottom plate (34). The gyroscope 56 is fixed above the rear end of the bottom plate 34, and the photoelectric sensors 54 are arranged on the left side and the right side of the front end of the bottom plate 34.
3. The multifunctional ladder climbing cleaning robot based on coded disc and gyroscope positioning as claimed in claim 1, characterized in that the moving wheel device (7) for realizing the flat ground movement comprises a friction wheel (22), one side of the friction wheel (22) is connected with a shaft of the M2006 motor (20) through a bearing (21) of a friction wheel coupling I (23), and the M2006 motor (20) is connected with a friction wheel motor connecting plate (18); the other side of the friction wheel (22) is fixed with a bearing (25) through a friction wheel coupler II (24), and the bearing (25) is matched with a friction wheel motor base (19); the friction wheel motor connecting sheet (18) and the friction wheel motor base (19) are both connected with the bottom plate (34).
4. The multifunctional ladder climbing cleaning robot based on the coded disc and the gyroscope for positioning is characterized in that the lead screw sliding table device (1) for realizing the ladder climbing movement comprises a motor (30), an output shaft of the motor (30) is connected with a lead screw (28) in a matched mode, the lead screw (28) is connected with an internal thread of a B sliding block (27) through a thread, and the lead screw (28) is connected with a fixing main body (29) through a bearing.
5. The multifunctional ladder cleaning robot based on code disc and gyroscope positioning as claimed in claim 1, characterized in that the cleaning mechanism (3) for cleaning the common garbage and dust in the home comprises a motor (41) fixed on a small motor base (43), the motor (41) is connected with a big gear (42), the big gear (42) is meshed with a small gear (45) to form an accelerating mechanism, the small gear (45) is connected with a rolling brush (40) in a driving way, and two ends of the rolling brush (40) are fixed on the bottom plate (34) by an A broom base (37) and a B broom base (44); a dust suction mechanism (35) arranged above the rolling brush (40) is fixed on the bottom plate (34); the bottom plate (34) is further fixed with a steering engine (31) through a steering engine fixing frame (32), the steering engine (31) drives the dustpan (38) through a connecting rod (33), and the driving dustpan (38) is fixed on the bottom plate (34) through a dustpan cover (36).
6. The multifunctional ladder cleaning robot based on code disc and gyroscope positioning is characterized in that the floor mopping mechanism (5) for mopping and spraying humidification comprises a mop cover (48) for supporting, mop cloth (49) is arranged at the bottom of the mop cover (48), the upper part of the mop cover (48) is connected with the rear end of a bottom plate (34) through a side plate (47), a humidifier (46) is arranged on the bottom plate (34), and an ultraviolet disinfection lamp (57) is arranged below the middle end of the bottom plate (34).
7. The code wheel and gyroscope positioning-based multifunctional ladder cleaning robot is characterized in that a control board (4) of the system comprises an STM32F407ZGT6 singlechip (51), an Arduino MAGA2560 mainboard (52) and a raspberry pi (53), wherein the STM32F407ZGT6 singlechip (51) is driven by PWM waves and controls a motor (30) through output IO, and the M2006 motor (20) is controlled through CAN communication; an Arduino MAGA2560 main board (52) controls a motor (41), a humidifier (46) and a steering engine (31) through output IO; the raspberry pi (53) is communicated with the STM32 single chip microcomputer (52) through a serial port and receives information from WIFI.
8. The multifunctional ladder climbing cleaning robot based on the coded disc and the gyroscope positioning is characterized in that a bull-eye wheel (39) is arranged at the bottom of the bottom plate (34).
CN202110976937.2A 2021-08-24 2021-08-24 Multifunctional ladder stand cleaning robot based on code disc and gyroscope positioning Pending CN113768418A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110976937.2A CN113768418A (en) 2021-08-24 2021-08-24 Multifunctional ladder stand cleaning robot based on code disc and gyroscope positioning

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110976937.2A CN113768418A (en) 2021-08-24 2021-08-24 Multifunctional ladder stand cleaning robot based on code disc and gyroscope positioning

Publications (1)

Publication Number Publication Date
CN113768418A true CN113768418A (en) 2021-12-10

Family

ID=78839009

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110976937.2A Pending CN113768418A (en) 2021-08-24 2021-08-24 Multifunctional ladder stand cleaning robot based on code disc and gyroscope positioning

Country Status (1)

Country Link
CN (1) CN113768418A (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060220606A1 (en) * 2005-03-31 2006-10-05 Lg Electronics Inc. Device for detecting lift of autonomous mobile robot
CN107320022A (en) * 2017-08-31 2017-11-07 西南交通大学 Toilet intelligent cleaning robot
CN107997688A (en) * 2017-12-01 2018-05-08 王冬冬 A kind of miniature clean robot
CN110499728A (en) * 2018-05-18 2019-11-26 姚政 A kind of refuse sweeping equipment
CN212213663U (en) * 2020-07-21 2020-12-25 桂林电子科技大学 Full-automatic climbing type stair cleaning robot
CN112493927A (en) * 2020-11-25 2021-03-16 浙江机电职业技术学院 Robot is swept on stair and ground

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060220606A1 (en) * 2005-03-31 2006-10-05 Lg Electronics Inc. Device for detecting lift of autonomous mobile robot
CN107320022A (en) * 2017-08-31 2017-11-07 西南交通大学 Toilet intelligent cleaning robot
CN107997688A (en) * 2017-12-01 2018-05-08 王冬冬 A kind of miniature clean robot
CN110499728A (en) * 2018-05-18 2019-11-26 姚政 A kind of refuse sweeping equipment
CN212213663U (en) * 2020-07-21 2020-12-25 桂林电子科技大学 Full-automatic climbing type stair cleaning robot
CN112493927A (en) * 2020-11-25 2021-03-16 浙江机电职业技术学院 Robot is swept on stair and ground

Similar Documents

Publication Publication Date Title
CN112568812A (en) Driving wheel module and self-moving robot
CN205989678U (en) A kind of unpiloted sweeper
CN109452911B (en) Intelligent stair cleaning robot
EP4292498A9 (en) Regional map drawing method and apparatus, medium, and electronic device
CN107348906A (en) The system and method for floor cleaning with clean robot
CN113693495A (en) Cleaning method and device for automatic cleaning equipment, medium and electronic equipment
CN112790672B (en) Automatic cleaning equipment control method and device, medium and electronic equipment
CN209966276U (en) Box body and cleaning robot thereof
TW201132327A (en) Home stairs-de-dusting robot
CN112022010A (en) Robot for cleaning rubbish in seat area of stand
CN205904188U (en) Dust absorption machine people
CN113768418A (en) Multifunctional ladder stand cleaning robot based on code disc and gyroscope positioning
CN209733861U (en) Intelligent stair cleaning robot
EP4292491A1 (en) Cleaning robot escape method and apparatus, medium, and electronic device
CN113693523B (en) Cleaning robot escaping method and device, medium and electronic equipment
CN212394823U (en) Regional rubbish of stand seat cleans machine people
CN112956966A (en) Cleaning robot capable of climbing stairs
CN217118314U (en) Commercial cleaning machines people of multi-functional integration
CN108861244A (en) A kind of refuse of building clears robot assembly and its control system
CN215424458U (en) Robot of sweeping floor with function is changed to dustbin
CN216256912U (en) Intelligent atomization floor sweeping robot
CN221622197U (en) Intelligent toy management robot
CN207101224U (en) Suspension type toilet clean robot
CN218922430U (en) Wheel foot type sweeping robot with indoor air monitoring function
CN215227246U (en) Intelligent robot for cleaning industrial workshop

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication

Application publication date: 20211210

RJ01 Rejection of invention patent application after publication