Embodiment
Below in conjunction with drawings and Examples, further specify the utility model clean the windows machine people's structure and control system control flow thereof.
Embodiment one
The utility model artificial single robot of machine that cleans the windows.Fig. 2 is the utility model machine human agent synoptic diagram one that cleans the windows; Fig. 3 is clean the windows robot body's synoptic diagram two of machine people of the utility model; Fig. 4 is the synoptic diagram when cleaning the windows machine human agent collision obstacle in the utility model; Fig. 5 is the enlarged diagram of B among Fig. 4; Fig. 6 is the clean the windows control flow synoptic diagram of machine philtrum of the utility model embodiment one; Fig. 7 is clean the windows machine people's structural representation of the utility model embodiment one.Shown in Fig. 2~7, the machine people that cleans the windows of the utility model embodiment one comprises robot body 1, walking unit 15, driver element 16, collision sensing device and control module 11, described collision sensing device comprises impingement plate 5 and sensing unit 12, described impingement plate 5 is positioned at the end of described robot body's 1 working direction, described control module 11 is connected with described driver element 16 with described sensing unit 12 respectively, under the effect of described control module 11, the described walking of described driver element 16 controls unit 15 work; The sidepiece of described impingement plate 5 is provided with pulley 4, and pulley 4 is positioned at the bottom of described impingement plate 5, and the contour edge of described pulley 4 is exposed to the contour edge of described impingement plate 5.The quantity of pulley can be 1-4, and as shown in Figure 2, described pulley 4 is two, lays respectively at the and arranged on left and right sides of described impingement plate 5, and is a center with respect to described robot body 1 and is symmetrical arranged.Preferred scheme as shown in Figure 3, described pulley 4 lays respectively at the end of described impingement plate 5; Pulley 4 sizes of described and arranged on left and right sides are identical.In order to guarantee at pulley when detecting barrier and hiding flexibly, reduce the friction of impingement plate and barrier, it is D that one horizontal range is arranged between the contour edge of the contour edge of described pulley 4 and described impingement plate 5, and the span of D is 0<D≤10mm, and wherein the preferred value of D is 2mm.
In conjunction with Fig. 6 and shown in Figure 7, this robot body 1 comprises robot body's shell 111, energy unit (not shown), driver element 16, control module 11 are positioned at the inside of robot body's shell 111, walking unit 15 and wiping unit lay respectively at the bottom of robot body's shell 111, and this wiping unit can be dish brush, scraping article or fiber cloth or the like.This energy unit is the rechargeable type battery, as: Ni-MH battery or lithium battery or the like.Walking unit 15 follows away the two bottom sides setting that direction is arranged on robot, and as shown in Figure 8, this walking unit 15 comprises crawler belt 151 and the Athey wheel 152 that is positioned at the robot left and right sides, and driver element 16 comprises drive motor.Crawler belt 151 is a plurality of track unit joint sealed joints that 151a constituted connected to one another, the inboard two ends of sealed joint are respectively arranged with Athey wheel 152, the gear teeth of Athey wheel 152 are plugged in the gap of adjacent two track unit, and driver element 16 links to each other with Athey wheel 152.Driver element 16 is under the energy of energy unit is supplied with, under the control of control module 11, driver element 16 drives Athey wheel 152 and rotates, and Athey wheel 152 drives crawler belt 151 motions, and track unit joint 151a constantly alternately contacts glass surface A provides enough big stiction to advance for window wiping robot.By the individual drive to every crawler belt, thereby realization is synchronized with the movement, differential motion.Be synchronized with the movement and make driving machine advance or retreat; Differential motion can make robot realize rotation.
This robot is adsorbed on glass surface by sucker, and in addition, robot can also realize being attached to glass surface by the method for negative pressure of vacuum.The technology how the associated machine people is adsorbed on glass surface is a prior art, does not repeat them here.
This robot also comprises sensing unit 12, this sensing unit 12 comprises end sensor 121 that is positioned at the same end of machine people that cleans the windows and the side sensor 122 that is positioned at machine people one side that cleans the windows, machine people's the same end of cleaning the windows is provided with 2 pulleys 4, and control module 11 is connected with driver element 16 with sensing unit 12 respectively; When driver element 16 drives the walking cell moving, the signal that control module 11 is sent according to the side sensor 122 of the end sensor 121 of the same end of machine people that cleans the windows and/or a side, control drive unit 16 drives walking unit 15 and moves.When cleaning the windows machine people welt when walking, because the contour edge of pulley 4 is exposed to the contour edge of impingement plate 5, reduced the friction of hitting plate 5 and glass frame, the machine people's that helps cleaning the windows walking.
End sensor 121 comprises two sensors, and these two sensors lay respectively at the left and right sides of the same end of robot, and is provided with axisymmetricly with respect to the center of robot.Easy for designing, these left and right two sensors all are positioned on the same surface level.For making robot can advance forward and can realize retreating advancing, in the preferred version, the forward and backward two ends of robot be respectively equipped with end sensor 121.
The side sensor 122 that is positioned at machine people one side that cleans the windows comprises two sensors, and these two sensors lay respectively at the forward and backward two ends of the same side of robot.
Two sensors in the end sensor 121 of the above-mentioned same end of mentioning and two sensors that are arranged in the side sensor 122 of machine people one side that cleans the windows can be touch sensors, also can be non-contacting sensors.When adopting touch sensor, can be travel switch, as microswitch, also can be pressure transducer, or conductive rubber.When adopting non-contacting sensor, can be infrared sensor, also can sonac.
Embodiment two
By embodiment one different be that the utility model machine people that cleans the windows is split type.Figure 9 shows that clean the windows control flow synoptic diagram in machine people's the mobile control system of present embodiment two.Figure 10 shows that clean the windows machine people's structural representation of present embodiment two.Figure 11 is clean the windows machine people's the structural representation of walking unit of the utility model embodiment two.In conjunction with Fig. 9~shown in Figure 11, the utility model window wiping robot comprises driving machine 2 and follower 3, and both are separate piece.Driving machine 2 comprises robot body 1, walking unit 215, driver element 216, collision sensing device and control module 211.Described collision sensing device comprises impingement plate 5 and sensing unit 212, described impingement plate 5 is positioned at the end of described robot body's 1 working direction, described control module 211 is connected with described driver element 216 with described sensing unit 212 respectively, under the effect of described control module 211, the described walking of described driver element 216 controls unit 215 work; The sidepiece of described impingement plate 5 is provided with pulley 4, and pulley 4 is positioned at the bottom of described impingement plate 5, and the contour edge of described pulley 4 is exposed to the contour edge of described impingement plate 5.The quantity of pulley can be 1-4, and in the preferred version, described pulley 4 is two, lays respectively at the and arranged on left and right sides of described impingement plate 5, and is a center with respect to described robot body 1 and is symmetrical arranged.In the preferred scheme, described pulley 4 lays respectively at the end of described impingement plate 5; Pulley 4 sizes of described and arranged on left and right sides are identical.In order to guarantee at pulley when detecting barrier and hiding flexibly, reduce the friction of impingement plate and barrier, it is D that one horizontal range is arranged between the contour edge of the contour edge of described pulley 4 and described impingement plate 5, and the span of D is 0<D≤10mm, and wherein the preferred value of D is 2mm.
Driving machine 2 and follower 3 are built-in with first, second magnet 214,314 respectively, make both can be adsorbed on the inside and outside both sides of glass A mutually, and under the suction of first, second magnet 214,314, follower 3 produces servo-actuated with driving machine 2.
Driving machine 2 comprises driving machine shell 213, and driver element 216, energy unit (not shown) and control module 211 are separately positioned in the driving machine shell 213, and walking unit 215 is positioned at robot body 1 the left and right sides.Follower 3 comprises follower housing 311, and the bottom of this follower housing 311 is provided with wipes examination unit (not shown), and this wiping unit can be dish brush, scraping article or fiber cloth or the like.This energy unit is the rechargeable type battery, as: Ni-MH battery or lithium battery or the like.
In conjunction with Fig. 9~shown in Figure 11, walking unit 215 follows away the two bottom sides setting that direction is arranged on robot, and this walking unit 215 comprises crawler belt 2151 and the Athey wheel 2152 that is positioned at the robot left and right sides, and driver element 216 comprises drive motor.Crawler belt 2151 is a plurality of track unit joint sealed joints that 2151a constituted connected to one another, the inboard two ends of sealed joint are respectively arranged with Athey wheel 2152, the gear teeth of Athey wheel 2152 are plugged in the gap of adjacent two track unit, and driver element 216 links to each other with Athey wheel 2152.Driver element 216 is under the energy of energy unit is supplied with, under the control of control module 211, driver element 216 drives Athey wheel 152 and rotates, Athey wheel 2152 drives crawler belt 2151 motions, and track unit joint 2151a constantly alternately contacts glass surface provides enough big stiction to advance for window wiping robot.By the individual drive to every crawler belt, thereby realization is synchronized with the movement, differential motion.Be synchronized with the movement and make driving machine advance or retreat; Differential motion can make robot realize rotation.
As shown in figure 10, the inside of driving machine 2 is provided with first magnet 214, the inside of follower 3 is provided with second magnet 314, both put the inside and outside both sides that are adsorbed on glass surface under the suction of magnet within it, follower 3 is followed driving machine 2 and is produced servo-actuated, and follower is treated wipe surfaces and carried out wiping when moving.Becoming light for making follower 3 follow when driving machine 2 moves, can be provided with on the follower housing 311 with moving cell 313, should be supporting roller with moving cell 316.
Driving machine 2 also comprises sensing unit 212 except comprising above-mentioned mentioned walking unit 215, driver element 216, control module 211 and energy unit.
This sensing unit 212 comprises end sensor 2121 that is positioned at the same end of machine people that cleans the windows and the side sensor 2122 that is positioned at machine people one side that cleans the windows, and control module 211 is connected with driver element 216 with sensing unit 212 respectively; When driver element 216 drives the walking cell moving, the signal that control module 211 is sent according to the side sensor 2122 of the end sensor 2121 of the same end of machine people that cleans the windows and/or a side, control drive unit 216 drives walking unit 215 and moves.
When cleaning the windows machine people welt when walking, because the contour edge of pulley 4 is exposed to the contour edge of impingement plate 5, reduced the friction of impingement plate 5, the machine people's that helps cleaning the windows walking with glass frame.
The end sensor 2121 of same end comprises two sensors, and these two sensors lay respectively at the left and right sides of robot, and is provided with axisymmetricly with respect to the center of robot.Easy for designing, these left and right two sensors all are positioned on the same surface level.For making robot can advance forward and can realize retreating advancing, in the preferred version, the forward and backward two ends of robot be respectively equipped with end sensor 2121.
The side sensor 2122 that is positioned at machine people one side that cleans the windows comprises two sensors, and these two sensors lay respectively at the forward and backward two ends of the same side of robot.
Two sensors in the end sensor 2121 of the above-mentioned same end of mentioning and two sensors that are arranged in the side sensor 2122 of machine people one side that cleans the windows can be touch sensors, also can be non-contacting sensors.When adopting touch sensor, can be travel switch, as microswitch, also can be pressure transducer, or conductive rubber.When adopting non-contacting sensor, can be infrared sensor, also can sonac.
When using this robot, driving machine 2 is placed on a certain position on glassy phase to be cleaned opposite, as its starting point that moves.Therewith correspondingly, follower 3 is placed on the glass to be cleaned, and makes the position of follower 3 and driving machine 2 overlap substantially.Driving machine 2 leads follower 3 to begin the work of entering, and follower 3 moves synchronously with the location status that keeps with driving machine 2 overlaps substantially, and it realizes treating the work that cleaning glass carries out wiping when moving.
Figure 12 is the process flow diagram of first kind of control method for movement of the machine people that cleans the windows of above-mentioned any one structure of employing.This machine people that cleans the windows realizes moving of robot by sensing unit, and its control method for movement comprises the steps:
Step S100: the people starts the machine;
Step S115: robot walks forward;
Step S120:, enter step S130 if when the signal of end sensor of robot front end is received in the ROBOT CONTROL unit;
Step S130: the walking unit half-twist of robot;
Step S135: robot welt walking;
Step S140:, enter step S146 if control module is received the signal of the end sensor of robot front end; Step S146: robot drives the rotation of walking unit by two drive motor differential movement in the driver element, makes substantially parallel with the running route of step S135 and the certain at interval distance of robot after the posture adjustment;
Step S152: robot walks forward;
Step S155: if control module is received the signal of side sensor, enter step 170, otherwise, return step S140;
Step S170: walking unit welt walking;
Step S175: control module receives the signal that the end sensor of front end is sent, and enters step S201;
Step S201: the walking unit half-twist of robot;
Step S205: robot adjusts welt;
Step S210: robot keeps straight on;
Step S215: if control module is received the signal of the end sensor of front end, enter step S220, otherwise, return step S210;
Step S220: walking unit half-twist, turn greatly by the differential realization of driving wheel, reach the position relative with step S210; The synoptic diagram that Figure 14 moves for this step of reflection welt.
Step S225: robot adjusts welt;
Step S230: robot keeps straight on;
Step S235: if control module is received the signal of the end sensor of front end, enter step S240, otherwise, return step S230;
Step S240: robot is along the direction walking opposite with step S230;
Step S245: if control module is received the signal of the end sensor of front end, enter step S250, otherwise, return step S240;
Step S250: robot changes other mode of operation or power cut-off over to.
Above-mentioned control method for movement is to adopt first wiping glass (step S100 is to step S245), the working method of wiping glass frame (step S201 is to step S250) position all around again.
As shown in figure 13, the utility model also provides the control method for movement of second kind of wiping glass robot, this method is to adopt first wiping glass frame (step S200 is to step S245), and the working method of wiping glass (step S101 is to step S180) specifically comprises the steps: again
Step S200: the people starts the machine;
Step S205: robot adjusts welt;
Step S210: robot keeps straight on;
Step S215: if control module is received the signal of the end sensor of front end, enter step S220, otherwise, return step S210;
Step S220: walking unit half-twist, turn greatly by the differential realization of driving wheel, reach the position relative with step S210;
Step S225: robot adjusts welt;
Step S230: robot keeps straight on;
Step S235: if control module is received the signal of the end sensor of front end, enter step S240, otherwise, return step S230;
Step S240: robot is along the direction walking opposite with step S230;
Step S245: if control module is received the signal of the end sensor of front end, enter step S101, otherwise, return step S240;
Step S101: the walking unit half-twist of robot;
Step S115: robot walks forward;
Step S120:, enter step S130 if when the signal of end sensor of robot front end is received in the ROBOT CONTROL unit;
Step S130: the walking unit half-twist of robot;
Step S135: robot welt walking;
Step S140:, enter step S146 if control module is received the signal of the end sensor of robot front end; Step S146: robot drives the rotation of walking unit by two drive motor differential movement in the driver element, makes substantially parallel with the running route of step S135 and the certain at interval distance of robot after the posture adjustment;
Step S152: robot walks forward;
Step S155: if control module is received the signal of side sensor, enter step 170, otherwise, return step S140;
Step S170: walking unit welt walking;
Step S175: control module receives the signal that the end sensor of front end is sent, and enters step S180;
Step S180: power cut-off.
In the above-mentioned control method step, as shown in figure 10, be the moving process synoptic diagram of robot adjustment welt, detailed process comprises: when the front end sensors in the side sensor senses signal, the control module control drive unit turns clockwise the walking unit, changes the attitude of robot; When perhaps the back end sensor in the side sensor sensed signal, the control module control drive unit was rotated counterclockwise robot, changed the attitude of robot.Saidly turn clockwise and be rotated counterclockwise, the angle of its rotation can be at random, also can set in advance.
By as above step, can make robot wipe trial work and do, thereby solve near the problem of the easy dust stratification of instrument bezel effectively in instrument bezel one side of required welt.
In above-mentioned two kinds of control method for movement, also comprise following concrete steps.
Between step S100 and step S115, also comprise:
Step S105: the acceleration transducer in the robot is adjusted the position of robot, corrects the position deflection of robot;
Step S110: control module is received the signal that acceleration transducer sends, if judge that robot is in perfect condition, enters step S115;
Further comprising the steps of between step S120 and step S130:
Step S121: the signal of the sensing subelement of control module receiving front-end, if control module judge when robot is in the opposite side state, enter step S130; Otherwise enter step S122; Wherein, the opposite side state is the signal of the side sensor of the control module and arranged on left and right sides that receives the robot front end simultaneously;
Step S122: control module after the adjustment robot pose, returns step S121 by the signal of the end sensor of judgement front end; Step S122 specifically comprises: when having only left side sensor in the end sensor of front end to sense signal, the control module control drive unit turns clockwise robot, changes the attitude of robot; When perhaps having only right sensor in the end sensor of front end to sense signal, the control module control drive unit is rotated counterclockwise robot, changes the attitude of robot.
Further comprising the steps of between step S140 and step S146:
Step S141: the signal of the end sensor of control module receiving front-end, if control module judge when robot is in the opposite side state, enter step S146; Otherwise, enter step S142; Wherein, the opposite side state is the signal of the and arranged on left and right sides sensor of the control module end sensor that receives the robot front end simultaneously; Otherwise, enter step S142;
Step S142: control module after the adjustment robot pose, returns step S141 by the signal of the end sensor of judgement front end;
Step S142 specifically comprises: when having only left side sensor in the end sensor of front end to sense signal, the control module control drive unit turns clockwise robot, changes the attitude of robot; When perhaps having only right sensor in the end sensor of front end to sense signal, the control module control drive unit is rotated counterclockwise robot, changes the attitude of robot.
Further comprising the steps of between step S146 and step S152:
Step S147: the acceleration transducer in the robot is adjusted the position of robot, corrects the position deflection of robot;
Step S148: control module is received the signal that acceleration transducer sends, if judge that robot is in perfect condition, enters step S152.
Further comprising the steps of between step S175 and step S180 (first kind of control method for movement) or step S175 and step S201 (second kind of control method for movement):
Step S176: walking unit half-twist;
Step S177: robot welt walking;
Step S178:, enter step S180 if control module is received the signal of the end sensor of robot front end.
Between step S215 and step S220, increase by two steps:
Step S216: robot ambulation, direction of travel is opposite with step S210 direction;
Step S217: if control module is received the signal of the end sensor of front end, enter step S220, otherwise, return step S216.
Robot adjusts welt and specifically comprises: when the front end sensors in the side sensor sensed signal, the control module control drive unit turned clockwise the walking unit, changes the attitude of robot; When perhaps having only back end sensor in the side sensor to sense signal, the control module control drive unit is rotated counterclockwise robot, changes the attitude of robot; Control module receives that the signal of the end sensor of front end is meant that control module receives the signal of left and right both sides sensor of the end sensor of front end simultaneously.
Some concrete steps during below to the monomer-type robot movement are analyzed.
In the above-mentioned control method step, robot adjusts welt and specifically comprises: when the front end sensors in the inductor unit, side 122 sensed signal, control module 11 control drive unit 16 turned clockwise walking unit 15, change the attitude of robot; When perhaps the back end sensor in the side sensor 122 sensed signal, control module 11 control drive unit 16 were rotated counterclockwise robot, changed the attitude of robot.Saidly turn clockwise and be rotated counterclockwise, the angle of its rotation can be at random, also can set in advance.
In the above-mentioned control method step, control module 11 receives that the signal of the end sensor 121 of front end is meant that control module 11 receives the signal of left and right both sides sensor of the end sensor 121 of front end simultaneously.
In order to make the user use this robot more to save worry, between the step S215 of second kind of welt control method for movement and step S220, increase step, specific as follows:
Step S216: robot ambulation, direction of travel is opposite with step S210 direction;
Step S217: if control module is received the signal of the end sensor of front end, enter step S220, otherwise, return step S216;
By increasing as above two steps, can make the user arbitrarily place this robot, this robot is by adjusting welt, craspedodrome and collision automatically, can find the corner voluntarily, begin oppositely to keep straight on from this corner, thereby can not omit the zone of welt wiping, the intellectuality of the robot that more seems and hommization.
By as above step, not only can carry out wiping work to the opposite side instrument bezel of this frame correspondence again simultaneously, thereby more effectively solve near the problem of the easy dust stratification of instrument bezel so that trial work is wiped in instrument bezel one side of required welt by robot to be done.
Some concrete steps during below to split type robot movement are analyzed.
In step S200, robot carries out welt and moves, and follower is followed driving machine and carried out correspondingly that welt moves under the effect that attracts each other with driving machine magnetic force, and follower is treated wipe surfaces and carried out wiping when moving.
By as above step, can make robot wipe trial work and do, thereby solve near the problem of the easy dust stratification of instrument bezel effectively in instrument bezel one side of required welt.
Robot adjusts welt and specifically comprises: when the front end sensors in the side sensor 2122 sensed signal, control module 211 control drive unit 216 turned clockwise walking unit 215, change the attitude of robot; When perhaps having only back end sensor in the side sensor 2122 to sense signal, control module 211 control drive unit 216 are rotated counterclockwise walking unit 215, change the attitude of robot.Change the attitude of robot.Saidly turn clockwise and be rotated counterclockwise, the angle of its rotation can be at random, also can set in advance.
In the above-mentioned control method step, control module 211 receives that the signal of the end sensor of front end is meant that control module receives the signal of left and right both sides sensor of the end sensor of front end simultaneously.
In order to make the user use this robot more to save worry, between the step S215 of welt control method for movement and step S220, increase step, specific as follows:
Step S216: robot ambulation, direction of travel is opposite with step S210 direction;
Step S217: if control module is received the signal of the end sensor of front end, enter step S220, otherwise, return step S216;
By increasing as above two steps, can make the user arbitrarily place this robot, this robot is by adjusting welt, craspedodrome and collision automatically, can find the corner voluntarily, begin oppositely to keep straight on from this corner, thereby can not omit the zone of welt wiping, the intellectuality of the robot that more seems and hommization.
By as above step, not only can do so that follower is wiped trial work in instrument bezel one side of required welt under the leading of driving machine, simultaneously can carry out wiping work to the opposite side instrument bezel of this frame correspondence again, thereby more effectively solve near the problem of the easy dust stratification of instrument bezel.
Figure 15 finishes the synoptic diagram that above-mentioned control is moved.
In the preferred version, also can be provided with sensing unit on the follower 3.Therefore, no matter be that driving machine 2 is felt as barriers such as window frames in the active moving process, still follower 3 is felt barrier in passive moving process, can dodge by the communication information interactive function that driving machine 2 and follower 3 are possessed between the two, can realize that all driving machine 2 and follower 3 carry out work in real erasable zone, and can not occur taking place such as being stuck in the first-class abnormal conditions of similar window frame.
The sensing unit that all has in driving machine and the follower is done technical guarantee, make the utility model machine people that cleans the windows easily to tackle the contingent many unpredictalbe abnormal conditions in glass both sides, and the utility model cleans the windows in the process can avoiding barrier, realize around even wiping glass and the glass frame, avoid occurring leaking the wiping phenomenon, solve near the problem of the easy dust stratification of instrument bezel effectively, and reduce the friction of impingement plate and glass frame, the machine people's that helps cleaning the windows walking.