Embodiment
First embodiment
Fig. 2 is the principle schematic of the welt control system of glass-cleaning robot of the present invention.Glass-cleaning robot 1 of the present invention comprises driver element 11 and the first walking unit 12, and welt control system 2 comprises sensing unit 21 and control module 22.This control module 22 is connected with sensing unit 21 and driver element 11 respectively, and controls driver element 11.In the present invention, described sensing unit 21 comprises former and later two sensor subunits being positioned at the same side, described glass-cleaning robot side.In the welt process of glass-cleaning robot, the transducing signal that control module 22 sends according to former and later two sensor subunits of the same side, described glass-cleaning robot side, controlling driver element 11 drives the first walking unit 12 to move, and presses close to the side and glass edge that make described glass-cleaning robot.The present invention, by controlling glass-cleaning robot welt, can make robot along glass edge work, thus can carry out wiping to glass edge, realize the position that the glass periphery of dust is easily piled up in light wiping.
Fig. 3 is the process flow diagram of welt control method first embodiment of glass-cleaning robot of the present invention, and Fig. 4 is the process schematic that glass-cleaning robot of the present invention completes welt state.The welt process of the glass-cleaning robot of the first embodiment is described referring to Fig. 3 and Fig. 4.
The sensing unit 21 of the first embodiment is made up of touch sensor 210, can select travel switch, pressure transducer and conductive rubber etc.From the simple consideration of use, preferably use travel switch.The main body front of glass-cleaning robot 1 and the left and right side at rear are respectively provided with a sensor, in addition, respectively there is a sensor front-end and back-end on the left of glass-cleaning robot 1, and respectively there is a sensor front-end and back-end on right side, can sense the obstacle signal of left and right side respectively.When the left side of glass-cleaning robot or touch sensor 210 making contact on right side are to bezel, touch sensor 210 sends signal to control module 22.According to this set, when making glass-cleaning robot 1 cleaning glass window or when needing welt, turn to without the need to tune, thus reach more time saving and energy saving object.
As shown in the state A of Fig. 4, the left side of glass-cleaning robot 1 is close to bezel, and about it, the front-end and back-end of two sides are respectively provided with two touch sensors 210.Now start glass-cleaning robot 1, as shown in Figure 3, in step 110, whether the touch sensor 210 being detected glass-cleaning robot 1 side by the control module 22 in the welt control system of glass-cleaning robot 1 sends collision alarm.If these two sensors 210 all do not send collision alarm, control module 22 will send control signal to driver element 11, and control signal makes driver element 11 drive the first walking unit 12 to turn to, thus rotate glass-cleaning robot 1, as shown in the state B of Fig. 4.Then repeat the process of step 110, until control module 22 these two touch sensors 210 detected any one due to making contact to send collision alarm to bezel time, enter into step 120.
In step 120, control module 22 judges that whether the collision alarm that now receives is the collision alarm of two sensors 210 in front-end and back-end of the same side of the close bezel of glass-cleaning robot 1.If two, the front-end and back-end sensor 210 that the collision alarm received is the same side sends, namely when control module 22 detects the collision limit signal of these two sensors 210 simultaneously, control module 22 can judge that glass-cleaning robot 1 has been in welt state, therefore control signal is not sent, glass-cleaning robot 1 keeps former attitude motionless, and welt process terminates.When control module 22 only detect one in these two sensors 210 send welt signal time, enter into step 130.
In step 130, control module 22 judges it is the collision alarm that front end sensors or rear end sensor send.Such as, first judge whether receive is the collision alarm that front end sensors sends, if, then control module 22 sends control signal to driver element 11, control signal makes driver element 11 drive the first walking unit 12 to move, rotate the rear end of glass-cleaning robot 1, as shown in the state C of Fig. 4, turn back to step 120 again, repeat each step from step 120, until when control module 22 detects the collision alarm of two sensors 210 in front-end and back-end of the same side of glass-cleaning robot 1, welt process terminates, as shown in the state D of Fig. 4 simultaneously.If not, then enter into step 140.
In step 140, control module 22 judges whether the collision alarm received is that after glass-cleaning robot 1, end sensor is sent.When rear end sensor sends collision alarm, control module 22 sends control signal to driver element 11, control signal makes driver element 11 drive the first walking unit 12 to move, the front end rotating glass-cleaning robot 1 turns back to step 120, repeat each step from step 120, until when control module 22 detects the collision alarm of two sensors 210 in front-end and back-end of the same side of glass-cleaning robot 1, welt process terminates simultaneously.
In the present embodiment, because the sensor used is touch sensor, its signal sent is a switching value, as long as the signal received is switching value, then illustrate that glass-cleaning robot 1 bumps against with bezel, when have received the on-off model that former and later two touch sensors of the same side are sent, the requirement meeting welt is described.
Second embodiment
The different structure of the glass-cleaning robot of the second embodiment and the glass-cleaning robot of the first embodiment is, the sensor of sensing unit 21 is non-contacting sensor, and this non-contacting sensor comprises infrared sensor or sonac etc.Detecting distance due to non-contacting sensor has certain scope, barrier in its sensing range can be detected, if this detecting distance is excessive, just signal can be detected when the distance of glass-cleaning robot and bezel is also large, if now think glass-cleaning robot and bezel welt, obvious error is excessive.Two solutions are had for this problem, the first: select the non-contacting sensor that detecting distance is little, in its detecting distance, can with the requirement making the distance between glass-cleaning robot and bezel meet welt.The second: control module is after receiving detection signal, it is calculated, only at the signal value of detection signal enough large (distance between the glass-cleaning robot of this signal value representative and bezel meets the requirement of welt), just think that this detection signal is effective, otherwise think that this signal is invalid.Flow process described in following Fig. 5 described in embodiment is the second.At the present embodiment, basic process is identical with embodiment one, and difference is, when after the collision alarm receiving front end and rear end simultaneously, also will carry out calculating, comparing, this flow process as shown in Figure 5.
As shown in Figure 5, glass-cleaning robot 1 is started.First, in step 111, for the intensity of the signal that two non-contacting sensors of the front-end and back-end of the same side of the close bezel of glass-cleaning robot 1 send, by the control module 22 of welt control system, these two signal intensities and a pre-stored values are compared, judge in these two sensors any one whether meet the requirement of welt.If these two sensors all do not meet the requirement of welt, namely from glass edge too away from, control module 22 will send control signal to driver element 11, and control signal makes driver element 11 drive the first walking unit 12 to move, thus rotate glass-cleaning robot 1.The process of step 111 repeats, until the signal value of these two sensors of control module 22 calculating all reaches pre-stored values, thus judges that the front-end and back-end of this sensor all reach the requirement of welt, enters into step 121.
In step 121, control module 22 compares the signal value of two sensors in front-end and back-end of the same side of the close bezel of glass-cleaning robot 1.Control module 22 is according to the signal value of these two sensors calculated, the relatively size of two signal values, when the difference of two signal values is in preset range, control module 22 can judge that driving machine 2 is in welt state, therefore control signal is not sent, glass-cleaning robot 1 keeps former attitude motionless, and welt process terminates.When the difference of two signal values that control module 22 compares is not in preset range, enter into step 131.
In step 131, when the signal value of rear end sensor is less, control module 22 sends control signal to driver element 11, and control signal makes driver element 11 drive the first walking unit 12 to move, rotate the rear end of glass-cleaning robot 1, the signal value of end sensor after increasing.Then step 121 is turned back to.When control module 22 calculate and the difference of the signal value of two sensors in front-end and back-end compared in preset range time, welt process terminates.And when the difference of signal value is not in preset range, and when the signal value of front end sensors is less, then enter into step 141.
In step 141, when the signal value of front end sensors is less, control module 22 sends control signal to driver element 11, and control signal makes driver element 11 drive the first walking unit 12 to move, rotate the front end of glass-cleaning robot 1, increase the signal value of front end sensors.Then step 121 is turned back to.Repeat each step from step 121, until control module 22 calculate and the difference of the signal value of two sensors in front-end and back-end compared in preset range time, welt process terminates.
In the present embodiment, what compare is the difference of the signal value of two sensors in front-end and back-end, can certainly be the quotient of the signal value of two sensors in front-end and back-end.
In above two embodiments, be positioned at former and later two sensor subunits of the same side, described glass-cleaning robot side, as the non-contacting sensor in the touch sensor in embodiment one and embodiment two, particular location in glass-cleaning robot side is without the need to being limited to two ends, i.e. front-end and back-end, as long as the position before and after being in side, and, former and later two sensors can be positioned in a plane, also can not be in one plane.Described plane refers to the plane parallel with glass-cleaning robot base.
A specific embodiment of glass-cleaning robot of the present invention
Fig. 6 ~ Fig. 8 is the schematic diagram of a specific embodiment of glass-cleaning robot of the present invention.As shown in Figure 6, glass-cleaning robot 1 of the present invention is made up of driving machine 3 and follower 4, and both are separate piece.When using glass-cleaning robot 1 of the present invention, driving machine 3 and follower 4 are placed in respectively the both sides of glass 5.
Driver element, the first walking unit, magnet 6 and electricity feeding unit is provided with in the housing 30 of driving machine 3.Wherein, driver element and driving machine energy unit not illustrated in the accompanying drawings.
First walking unit comprises crawler belt travel wheel.Crawler belt travel wheel is arranged on the both sides of the direct of travel of driving machine 3, and each crawler belt travel wheel comprises a crawler belt 341 and two Athey wheels 342, and crawler belt 341 comprises multiple track unit joint.Rotated by Athey wheel 342 rotary actuation crawler belt 341, thus driving machine 3 is advanced.The driver element of driving machine 3 comprises drive motor, and each crawler belt travel wheel is driven by a drive motor, and drive motor is connected with Athey wheel 342.Drive single crawler belt travel wheel by single drive motor, thus realize being synchronized with the movement and differential motion; Be synchronized with the movement and make driving machine 3 advance or retreat, differential motion makes driving machine 3 rotate.
The second walking unit, magnet 61, electricity feeding unit, cleaning glass window unit and liquid-jet device is provided with in the housing 40 that the chassis of follower 4 and face-piece are formed.Wherein, electricity feeding unit, cleaning glass window unit and liquid-jet device are not illustrated in the accompanying drawings.
Second walking unit of follower 4 comprises four supporting rollers 440, is respectively provided with two supporting rollers 440 in the both sides of the direct of travel of follower 4.Second walking unit is followed the first walking unit and is moved.
Be provided with one or two strong magnets 6 between two crawler belt travel wheel of driving machine 3, between four supporting rollers 440 of follower 4, be provided with the opposite polarity strong magnets 61 of strong magnets 6 of one or two and driving machine.When driving machine 3 and follower 4 be placed into simultaneously glass 5 on the surface time, because two strong magnets are adsorbed mutually, there is provided enough large normal pressure to glass surface, thus correspondence provides enough large stiction, make driving machine 3 and follower 4 can overcome the gravity of self and be adsorbed on glass 5 surface.And under the magnetic action between strong magnets, driving machine 3 can drive follower 4 to move with same trajectories.
In addition, not illustrated also having in accompanying drawing, the driving machine sensing unit that driving machine 3 is also provided with and driving machine control module, the follower sensing unit that follower 4 is also provided with and follower control module.
The driving machine that the driving machine sensing unit of driving machine 3 is floating type setting by the main body relative to driving machine 3 hits plate and driving machine sensor forms.Before and after the main body of driving machine 3, both sides respectively have a driving machine to hit plate, hit the working direction of plate relative to driving machine 3, be placed in the front end of driving machine 3 before driving machine.Hit the working direction of plate relative to driving machine 3 after driving machine, be placed in the rear end of driving machine 3, each driving machine hits plate and is provided with four driving machine sensors, and wherein, the front left and right side hitting plate at each driving machine is respectively provided with a driving machine sensor.The arranged on left and right sides that each driving machine hits plate is respectively provided with a driving machine sensor, can sense the signal that driving machine hits plate left and right side respectively.Therefore, respectively there is a driving machine sensor front-end and back-end in the left side of driving machine 3, and respectively there is a driving machine sensor front-end and back-end on the right side of driving machine 3.The sensor of driving machine 3 side front end forms a sensor subunits of welt control system of the present invention, and the sensor of rear end, driving machine 3 side forms another sensor subunits of welt control system of the present invention.
The follower sensing unit of follower 4 has the structure identical with above-mentioned driving machine sensing unit.Therefore repeat specification is omitted.
In the present invention, the function of the sensing unit 21 of welt control system 2 is such as performed by driving machine sensing unit, and the function of the control module 22 of welt control system 2 is such as performed by driving machine control module.According to the signal that driving machine sensing unit sends, driving machine control module controls drive unit drives first unit of walking and moves.By the control method of the various embodiments described above, realize the welt process of glass-cleaning robot.