CN105974914A - Control system for floor-sweeping robot - Google Patents

Control system for floor-sweeping robot Download PDF

Info

Publication number
CN105974914A
CN105974914A CN201610305714.2A CN201610305714A CN105974914A CN 105974914 A CN105974914 A CN 105974914A CN 201610305714 A CN201610305714 A CN 201610305714A CN 105974914 A CN105974914 A CN 105974914A
Authority
CN
China
Prior art keywords
floor
robot
sweeping
resistance
transport
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
CN201610305714.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.)
Guangxi Shenghe Environmental Protection Technology Co Ltd
Original Assignee
Guangxi Shenghe Environmental Protection Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Guangxi Shenghe Environmental Protection Technology Co Ltd filed Critical Guangxi Shenghe Environmental Protection Technology Co Ltd
Priority to CN201610305714.2A priority Critical patent/CN105974914A/en
Publication of CN105974914A publication Critical patent/CN105974914A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0242Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0255Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals

Abstract

The invention discloses a control system for a floor-sweeping system. The system comprises a supersonic sensor, multiple supersonic range-finding sensors, an infrared sensor, a movement path planning module and a controller, wherein the supersonic sensor detects whether there is an obstacle in a travelling path of a floor-sweeping robot, the supersonic range-finding sensors prevent the floor-sweeping robot from falling off, the infrared sensor is arranged at the top of a rubbish storage chamber of the floor-sweeping robot and used to detect the rubbish storage chamber, the movement path planning module is arranged in the controller in the floor-sweeping robot and used to plan the traveling path, and the controller corrects the movement path of the floor-sweeping robot according to positioning information of a positioning module and the traveling path planned by the movement path planning module. The floor-sweeping robot is internally provided with a temperature sensor. Output signals of the supersonic sensor, the supersonic range-finding sensors and the infrared sensor are transmitted to the controller via a filtering circuit, an amplification circuit and an analog-to-digital conversion circuit successively. Thus, the sweeping efficiency is improved.

Description

Control system for robot of sweeping the floor
Technical field
The present invention relates to field of intelligent control, in particular it relates to a kind of control system for robot of sweeping the floor.
Background technology
At present, robot of sweeping the floor is applied the most in the family, and in avenue, main or employing sweeper or the mode of hand sweeping, and use sweeper to be also required to pilot steering, therefore there is the problem that sweeping efficiency is low.
Summary of the invention
It is an object of the invention to, for the problems referred to above, propose a kind of control system for robot of sweeping the floor, to realize the advantage improving sweeping efficiency.
For achieving the above object, the technical solution used in the present invention is:
A kind of control system for robot of sweeping the floor, including:
It is arranged on the ultrasonic sensor swept the floor within robot: be used for detecting whether have barrier in sweeping robot course;
It is arranged on multiple ultrasonic distance-measuring sensors of surrounding bottom robot of sweeping the floor: when sweeping robot marches to step edge, ultrasonic distance-measuring sensor utilizes ultrasound wave to record the distance between sweeping robot and ground, when distance between the sweeping robot recorded and ground exceedes limit value, ultrasonic distance-measuring sensor sends signal to controller, controller controls sweeping robot and turns to, change sweeping robot direction of advance, thus the robot that prevents from sweeping the floor falls;
It is arranged on the infrared sensor at the garbage storing storage top of robot of sweeping the floor, this infrared sensor includes infrared transmitter and infrared remote receiver, what infrared transmitter was relative with infrared remote receiver is arranged on the inwall of garbage storing storage, when infrared remote receiver does not receives the infrared signal that infrared transmitter is launched, illustrate garbage storing storage already filled with, infrared remote receiver sends signal to controller, and controller sends instruction and reminds cleaning garbage storing storage;
It is arranged in the controller swept the floor within robot and running orbit planning module is set, running orbit planning module is according to storing map, planning travel route, and the built-in locating module of robot of sweeping the floor, the running orbit of robot of sweeping the floor is corrected in real time by controller according to the location information of locating module and the travel route of running orbit planning module planning;
Sweep the floor robot built-in temperature sensor, the temperature signal swept the floor on robot circuit board of detection is transmitted to controller by temperature sensor, when temperature signal reaches the temperature upper limit set, controller controls to sweep the floor robot break-off, by the time temperature signal reach to set at a temperature of in limited time, the controller robot that controls to sweep the floor works on;
The output signal of described ultrasonic sensor, ultrasonic distance-measuring sensor and infrared sensor is transmitted to controller after all sequentially passing through filter circuit, amplifying circuit and analog to digital conversion circuit.
nullPreferably,Described filter circuit,Including transport and placing device A1 and transport and placing device A2,Input signal is input to the in-phase input end of transport and placing device A1 by resistance R4,And series resistance R3 between the in-phase input end of transport and placing device A1 and ground,Series resistance R2 between the inverting input of transport and placing device A1 and ground,Series resistance R5 between outfan and the in-phase input end of transport and placing device A2 of transport and placing device A1,Series resistance R1 between inverting input and the inverting input of transport and placing device A2 of transport and placing device A1,The outfan of transport and placing device A2 is connected with the inverting input of transport and placing device A2,Series inductance L1 between outfan and the in-phase input end of transport and placing device A2 of transport and placing device A2,Inductance L2 is in parallel with inductance L1,The series circuit of electric capacity C1 and electric capacity C4 composition is in parallel with inductance L1,The series circuit of electric capacity C2 and electric capacity C3 composition is in parallel with inductance L1,And the node ground connection between electric capacity C1 and electric capacity C4,Node ground connection between electric capacity C2 and electric capacity C3.
Preferably, the resistance of described resistance R1 is 10K Ω, and the resistance of described resistance R2 and resistance R3 is 200 Ω, and the resistance of described resistance R4 is 10K Ω, and the resistance of described resistance R5 is 54.1 K Ω, the capacitance of described electric capacity C1 is 10 pF, and the capacitance of described electric capacity C2 is 10 μ F, and the capacitance of described electric capacity C3 is 4700 μ F, and the capacitance of described electric capacity C4 is 10 pF, and the size of described inductance L1 and inductance L2 is 33 μ H.
Technical scheme has the advantages that
Technical scheme, realizes the Based Intelligent Control to cleaning machine people by various sensors, because using mechanized operation, intelligentized control method, thus reaches to improve the purpose of sweeping efficiency.
Below by drawings and Examples, technical scheme is described in further detail.
Accompanying drawing explanation
Fig. 1 is the theory diagram of the control system for robot of sweeping the floor described in the embodiment of the present invention;
Fig. 2 is the electronic circuitry of the filter circuit described in the embodiment of the present invention;
Fig. 3 is the electronic circuitry of the amplifying circuit described in the embodiment of the present invention.
Detailed description of the invention
Below in conjunction with accompanying drawing, the preferred embodiments of the present invention are illustrated, it will be appreciated that preferred embodiment described herein is merely to illustrate and explains the present invention, is not intended to limit the present invention.
As it is shown in figure 1, a kind of control system for robot of sweeping the floor, including:
It is arranged on the ultrasonic sensor swept the floor within robot: be used for detecting whether have barrier in sweeping robot course;
It is arranged on multiple ultrasonic distance-measuring sensors of surrounding bottom robot of sweeping the floor: when sweeping robot marches to step edge, ultrasonic distance-measuring sensor utilizes ultrasound wave to record the distance between sweeping robot and ground, when distance between the sweeping robot recorded and ground exceedes limit value, ultrasonic distance-measuring sensor sends signal to controller, controller controls sweeping robot and turns to, change sweeping robot direction of advance, thus the robot that prevents from sweeping the floor falls;
It is arranged on the infrared sensor at the garbage storing storage top of robot of sweeping the floor, this infrared sensor includes infrared transmitter and infrared remote receiver, what infrared transmitter was relative with infrared remote receiver is arranged on the inwall of garbage storing storage, when infrared remote receiver does not receives the infrared signal that infrared transmitter is launched, illustrate garbage storing storage already filled with, infrared remote receiver sends signal to controller, controller sends instruction and reminds cleaning garbage storing storage, when controller sends instruction prompting cleaning garbage storing storage, controller need to look for nearest rubbish set-point according to built-in map, thus the rubbish in garbage storing storage is placed into rubbish set-point, then the location information preserved according to controller, return the original cleaning point cleaned on path to continue to clean.
It is arranged in the controller swept the floor within robot and running orbit planning module is set, running orbit planning module is according to storing map, planning travel route, and the built-in locating module of robot of sweeping the floor, the running orbit of robot of sweeping the floor is corrected in real time by controller according to the location information of locating module and the travel route of running orbit planning module planning;
Sweep the floor robot built-in temperature sensor, the temperature signal swept the floor on robot circuit board of detection is transmitted to controller by temperature sensor, when temperature signal reaches the temperature upper limit set, controller controls to sweep the floor robot break-off, by the time temperature signal reach to set at a temperature of in limited time, the controller robot that controls to sweep the floor works on;
The output signal of ultrasonic sensor, ultrasonic distance-measuring sensor and infrared sensor is transmitted to controller after all sequentially passing through filter circuit, amplifying circuit and analog to digital conversion circuit.
nullAs shown in Figure 2,Filter circuit,Including transport and placing device A1 and transport and placing device A2,Input signal is input to the in-phase input end of transport and placing device A1 by resistance R4,And series resistance R3 between the in-phase input end of transport and placing device A1 and ground,Series resistance R2 between the inverting input of transport and placing device A1 and ground,Series resistance R5 between outfan and the in-phase input end of transport and placing device A2 of transport and placing device A1,Series resistance R1 between inverting input and the inverting input of transport and placing device A2 of transport and placing device A1,The outfan of transport and placing device A2 is connected with the inverting input of transport and placing device A2,Series inductance L1 between outfan and the in-phase input end of transport and placing device A2 of transport and placing device A2,Inductance L2 is in parallel with inductance L1,The series circuit of electric capacity C1 and electric capacity C4 composition is in parallel with inductance L1,The series circuit of electric capacity C2 and electric capacity C3 composition is in parallel with inductance L1,And the node ground connection between electric capacity C1 and electric capacity C4,Node ground connection between electric capacity C2 and electric capacity C3.
Preferably, the resistance of resistance R1 is 10K Ω, and the resistance of resistance R2 and resistance R3 is 200 Ω, and the resistance of resistance R4 is 10K Ω, and the resistance of resistance R5 is 54.1 K Ω, the capacitance of electric capacity C1 is 10 pF, and the capacitance of electric capacity C2 is 10 μ F, and the capacitance of electric capacity C3 is 4700 μ F, and the capacitance of electric capacity C4 is 10 pF, and the size of inductance L1 and inductance L2 is 33 μ H.
nullAs shown in Figure 3,Amplifying circuit: include audion T201、Audion T202 and audion T203,Series capacitance C201 in the base stage of audion T201,Series capacitance R201 between the base stage of audion T201 and power supply VCC,Series capacitance R202 between the colelctor electrode of audion T201 and power supply VCC,Series capacitance R204 between the colelctor electrode of audion T202 and power supply VCC,Series capacitance R205 between the colelctor electrode of audion T203 and power supply VCC,Series capacitance C202 between the colelctor electrode of audion T201 and the base stage of audion T202,The base stage of audion T202 and inter-collector series resistance R203,The emitter stage of audion T201 and the emitter stage series connection ground connection of audion T202,The colelctor electrode of audion T202 is sequentially connected in series swept resistance R206 and resistance R208 with the transmitting interpolar of audion T203,And series capacitance C203 between the base stage of the sliding end of swept resistance R206 and audion T203,The base stage of audion T203 and inter-collector series resistance R207,And on the colelctor electrode of audion T203, connect electric capacity C204,The emitter stage of audion T203 is connected with resistance 208 ground connection.
The size of resistance R201 is 680K Ω, the size of resistance R202 is 22K Ω, and the size of resistance R203 is 220K Ω, and the size of resistance R204 is 10K Ω, the size of resistance R205 is 3.3K Ω, the size of resistance R206 is 47K Ω, and the size of resistance R207 is 220K Ω, and the size of resistance R208 is 100 Ω, the size of electric capacity C201 is 0.1 μ F, the size of electric capacity C202 is 0.1 μ F, and the size of electric capacity C203 is 4.7 μ F, and the size of electric capacity C204 is 10 μ F.
Last it is noted that the foregoing is only the preferred embodiments of the present invention, it is not limited to the present invention, although the present invention being described in detail with reference to previous embodiment, for a person skilled in the art, technical scheme described in foregoing embodiments still can be modified by it, or wherein portion of techniques feature is carried out equivalent.All within the spirit and principles in the present invention, any modification, equivalent substitution and improvement etc. made, should be included within the scope of the present invention.

Claims (3)

1. the control system for robot of sweeping the floor, it is characterised in that including:
It is arranged on the ultrasonic sensor swept the floor within robot: be used for detecting whether have barrier in sweeping robot course;
It is arranged on multiple ultrasonic distance-measuring sensors of surrounding bottom robot of sweeping the floor: when sweeping robot marches to step edge, ultrasonic distance-measuring sensor utilizes ultrasound wave to record the distance between sweeping robot and ground, when distance between the sweeping robot recorded and ground exceedes limit value, ultrasonic distance-measuring sensor sends signal to controller, controller controls sweeping robot and turns to, change sweeping robot direction of advance, thus the robot that prevents from sweeping the floor falls;
It is arranged on the infrared sensor at the garbage storing storage top of robot of sweeping the floor, this infrared sensor includes infrared transmitter and infrared remote receiver, what infrared transmitter was relative with infrared remote receiver is arranged on the inwall of garbage storing storage, when infrared remote receiver does not receives the infrared signal that infrared transmitter is launched, illustrate garbage storing storage already filled with, infrared remote receiver sends signal to controller, and controller sends instruction and reminds cleaning garbage storing storage;
It is arranged in the controller swept the floor within robot and running orbit planning module is set, running orbit planning module is according to storing map, planning travel route, and the built-in locating module of robot of sweeping the floor, the running orbit of robot of sweeping the floor is corrected in real time by controller according to the location information of locating module and the travel route of running orbit planning module planning;
Sweep the floor robot built-in temperature sensor, the temperature signal swept the floor on robot circuit board of detection is transmitted to controller by temperature sensor, when temperature signal reaches the temperature upper limit set, controller controls to sweep the floor robot break-off, by the time temperature signal reach to set at a temperature of in limited time, the controller robot that controls to sweep the floor works on;
The output signal of described ultrasonic sensor, ultrasonic distance-measuring sensor and infrared sensor is transmitted to controller after all sequentially passing through filter circuit, amplifying circuit and analog to digital conversion circuit.
nullControl system for robot of sweeping the floor the most according to claim 1,It is characterized in that,Described filter circuit,Including transport and placing device A1 and transport and placing device A2,Input signal is input to the in-phase input end of transport and placing device A1 by resistance R4,And series resistance R3 between the in-phase input end of transport and placing device A1 and ground,Series resistance R2 between the inverting input of transport and placing device A1 and ground,Series resistance R5 between outfan and the in-phase input end of transport and placing device A2 of transport and placing device A1,Series resistance R1 between inverting input and the inverting input of transport and placing device A2 of transport and placing device A1,The outfan of transport and placing device A2 is connected with the inverting input of transport and placing device A2,Series inductance L1 between outfan and the in-phase input end of transport and placing device A2 of transport and placing device A2,Inductance L2 is in parallel with inductance L1,The series circuit of electric capacity C1 and electric capacity C4 composition is in parallel with inductance L1,The series circuit of electric capacity C2 and electric capacity C3 composition is in parallel with inductance L1,And the node ground connection between electric capacity C1 and electric capacity C4,Node ground connection between electric capacity C2 and electric capacity C3.
Control system for robot of sweeping the floor the most according to claim 2, it is characterized in that, the resistance of described resistance R1 is 10K Ω, the resistance of described resistance R2 and resistance R3 is 200 Ω, the resistance of described resistance R4 is 10K Ω, the resistance of described resistance R5 is 54.1 K Ω, the capacitance of described electric capacity C1 is 10 pF, the capacitance of described electric capacity C2 is 10 μ F, the capacitance of described electric capacity C3 is 4700 μ F, the capacitance of described electric capacity C4 is 10 pF, and the size of described inductance L1 and inductance L2 is 33 μ H.
CN201610305714.2A 2016-05-10 2016-05-10 Control system for floor-sweeping robot Pending CN105974914A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610305714.2A CN105974914A (en) 2016-05-10 2016-05-10 Control system for floor-sweeping robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610305714.2A CN105974914A (en) 2016-05-10 2016-05-10 Control system for floor-sweeping robot

Publications (1)

Publication Number Publication Date
CN105974914A true CN105974914A (en) 2016-09-28

Family

ID=56991544

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610305714.2A Pending CN105974914A (en) 2016-05-10 2016-05-10 Control system for floor-sweeping robot

Country Status (1)

Country Link
CN (1) CN105974914A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109958089A (en) * 2017-12-26 2019-07-02 苏州宝时得电动工具有限公司 Intelligent snowplough and its control method
CN116038650A (en) * 2023-03-31 2023-05-02 安徽大学 Book management robot based on FPGA

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101299154A (en) * 2008-05-23 2008-11-05 深圳职业技术学院 Unmanned cleaning device
CN203807993U (en) * 2014-04-11 2014-09-03 东北林业大学 Waste containing barrel for automatic cleaning robot
CN203909295U (en) * 2014-05-26 2014-10-29 国家电网公司 Ultrasonic wave transmitting module used for bionic robot
CN204080716U (en) * 2014-09-20 2015-01-07 河南省黄河防爆起重机有限公司 A kind of city automatic sweeping system
CN204071961U (en) * 2014-09-15 2015-01-07 湖南格兰博智能科技有限责任公司 A kind of purification of air sweeping robot
CN104887155A (en) * 2015-05-21 2015-09-09 南京创维信息技术研究院有限公司 Intelligent sweeper
CN105182980A (en) * 2015-09-23 2015-12-23 上海物景智能科技有限公司 Automatic cleaning equipment control system and control method
CN105388896A (en) * 2015-09-23 2016-03-09 上海物景智能科技有限公司 CAN bus-based distributed cleaning robot control system and control method

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101299154A (en) * 2008-05-23 2008-11-05 深圳职业技术学院 Unmanned cleaning device
CN203807993U (en) * 2014-04-11 2014-09-03 东北林业大学 Waste containing barrel for automatic cleaning robot
CN203909295U (en) * 2014-05-26 2014-10-29 国家电网公司 Ultrasonic wave transmitting module used for bionic robot
CN204071961U (en) * 2014-09-15 2015-01-07 湖南格兰博智能科技有限责任公司 A kind of purification of air sweeping robot
CN204080716U (en) * 2014-09-20 2015-01-07 河南省黄河防爆起重机有限公司 A kind of city automatic sweeping system
CN104887155A (en) * 2015-05-21 2015-09-09 南京创维信息技术研究院有限公司 Intelligent sweeper
CN105182980A (en) * 2015-09-23 2015-12-23 上海物景智能科技有限公司 Automatic cleaning equipment control system and control method
CN105388896A (en) * 2015-09-23 2016-03-09 上海物景智能科技有限公司 CAN bus-based distributed cleaning robot control system and control method

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109958089A (en) * 2017-12-26 2019-07-02 苏州宝时得电动工具有限公司 Intelligent snowplough and its control method
CN116038650A (en) * 2023-03-31 2023-05-02 安徽大学 Book management robot based on FPGA

Similar Documents

Publication Publication Date Title
CN105773626A (en) Robotic vacuum cleaner control platform with real-time road detection function
CN108143364A (en) A kind of method for cleaning map area division from mobile clean robot
CN101278247B (en) Method for operating an automatically displaceable domestic appliance and method for operating a base station
CN101446832B (en) Control method of automatic obstacle-avoiding of robot cleaner
CN105955263A (en) Control platform having road detection and fingerprint detection functions and applied to sweeping robots
EP3084539B1 (en) Prioritizing cleaning areas
CN105773624A (en) Robotic vacuum cleaner control platform with real-time road detection and fingerprint defection functions
CN105974915A (en) Floor-sweeping robot control system capable of fingerprint detection
US20170075353A1 (en) Local obstacle avoidance walking method of self-moving robot
JP6879478B2 (en) Experience-based roadmap for robot vacuums
KR20180048705A (en) System of robot cleaning device
JP7204990B2 (en) Mapping for autonomous mobile robots
KR20060118901A (en) Position-reconizing system for a self-moving robot
CN110037619B (en) Control method of sweeping robot special for passenger train and sweeping robot
CN104626204B (en) robot autonomous charging docking system and method
CN103099583A (en) Robot cleaner and control method thereof
US20170090456A1 (en) Autonomous cleaning robot
CN102262407A (en) Guide device and operating system
CN105974914A (en) Control system for floor-sweeping robot
CN105744872A (en) Adaptive speed control of rotating side brush
CN105974916A (en) Floor-sweeping robot control system capable of real-time road detection
CN105962849A (en) Sweeper robot control platform
CN107608353A (en) The sweeping robot of automatic pathfinding
CN105786005A (en) Sweeping robot control system
CN106020185A (en) Floor sweeping robot control system having real-time road detection function

Legal Events

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

Application publication date: 20160928