CN105595924B - Effectively realize stair clean robot method to stair transition from stair to halfpace - Google Patents
Effectively realize stair clean robot method to stair transition from stair to halfpace Download PDFInfo
- Publication number
- CN105595924B CN105595924B CN201610012211.6A CN201610012211A CN105595924B CN 105595924 B CN105595924 B CN 105595924B CN 201610012211 A CN201610012211 A CN 201610012211A CN 105595924 B CN105595924 B CN 105595924B
- Authority
- CN
- China
- Prior art keywords
- robot
- stair
- halfpace
- wall
- distance
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 57
- 230000007704 transition Effects 0.000 title claims abstract description 34
- 238000004140 cleaning Methods 0.000 claims abstract description 25
- 238000012545 processing Methods 0.000 claims abstract description 6
- 230000008569 process Effects 0.000 claims description 18
- 230000009471 action Effects 0.000 claims description 5
- 230000004888 barrier function Effects 0.000 claims description 3
- 230000000694 effects Effects 0.000 claims description 3
- 238000009434 installation Methods 0.000 claims description 3
- 238000012360 testing method Methods 0.000 claims description 2
- 230000001052 transient effect Effects 0.000 claims 1
- 238000012790 confirmation Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 9
- 238000013461 design Methods 0.000 description 5
- 230000009194 climbing Effects 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 238000001514 detection method Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 230000007306 turnover Effects 0.000 description 2
- 150000001875 compounds Chemical class 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000002360 explosive Substances 0.000 description 1
- 230000021715 photosynthesis, light harvesting Effects 0.000 description 1
- 238000007493 shaping process Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0219—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/24—Floor-sweeping machines, motor-driven
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4061—Steering means; Means for avoiding obstacles; Details related to the place where the driver is accommodated
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
- B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
- B62D57/024—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members specially adapted for moving on inclined or vertical surfaces
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
- A47L2201/04—Automatic control of the travelling movement; Automatic obstacle detection
Abstract
Effectively stair clean robot method to stair transition from stair to halfpace is realized the invention discloses a kind of, including transition of the robot from stair to halfpace, the traversal of stair halfpace, robot run into the methods such as the processing of obstacle from the transition of the downward first floor ladder of halfpace, robot.The traversal of wherein stair halfpace takes the method that roundabout and plough path planning is combined.The present invention, which has, plans regular, simply easily realizes, it is ensured that clean coverage rate, is easy to robot to determine to have traveled through halfpace, and is to ensure that robot can complete the essential means of stair continuity cleaning the advantages of the stair of confirmation down.
Description
The application is application number:201410245199.4, the applying date:2014.6.4, " stair clean robot is from building for title
The divisional application of transition method of the ladder to halfpace to stair ".
Technical field
The present invention relates to a kind of robot and field of intelligent control, be clean robot from stair to halfpace to stair
Transition and planing method.
Background technology
World today's explosive population growth, in order to effectively utilize limited ground space, people are increasingly developed toward eminence, various
The building that high buildings and large mansions, lecture theater, conference hall, Stadium etc. include stair is increasingly common, and stair are cleaned with corridor
Work substantially increase, the market demand of this respect is arisen at the historic moment.On the other hand, the cleaning machine of people's daily life has been come into
The people overwhelming majority is indoor level land clean robot, it is therefore necessary to research and develop stair clean robot.Stair cleaning machine
People is more than the cleaning for stair, should also design suitable path planning algorithm to meet the cleaning of stair landing, and
Complete from stair to half space again to the transition of stair.Wherein, when robot is in stair, from stair to halfpace mistake
Cross and reached halfpace, it is necessary to distinguish or be still stair;Reach after halfpace, the traversal of halfpace is robot building
Terraced halfpace clean whether complete important symbol;Robot has traveled through halfpace, it is necessary in end point, judge that front is
No is stair down, completes the transition again to stair.The relevant knowledge property right of current such research not yet has shaping, the present invention
It is expected to fill up such blank, therefore cleaning of the research for completely realizing stair is significant.
The existing longer history of research of the people on climbing building method and its associated mechanisms, is successively proposed various
Building method is climbed, is mainly included:Wheeled, crawler type, leg formula, rolling type.Wherein crawler type and rolling type is complicated, it is difficult in building
Cleaning task is completed on ladder, it is simply pure to climb building, limited by practical.The wheeled more use planetary gear or other of stair climbing robot
Compound wheel type, huge structure is complicated, also seldom takes into account stair cleaning function, practicality is had a greatly reduced quality.Leg formula stair climbing robot compared with
Use apery walking, mechanism is complicated, and cost is high, it appears wastes one's talent on a petty job, is unfavorable for marketing more.Therefore, pin of the present invention
Stair clean robot that is relatively small to volume and can moving back and forth in stair step, this kind of robot can be in half space
On flexibly turn, turn around, to realize halfpace transition proposed by the present invention and planing method.
Harbin Engineering University was proposed a kind of stair cleaning machine based on Archimedes spiral trilobed wheel in 2008
People manufactures experimently machine.The stair clean robot, which can be realized, continuously climbs building, although climbing, building action is steady, turning on level land, falls
It is first-class inconvenient on the contrary, therefore do not there is corresponding transition of the robot on stair halfpace to be reported with planing method.
Using a kind of current eight more popular caster structure design stair clean robots in the Liu Chao of Taiwan.It is flat downstairs thereon
Surely, the stair of different height are suitable for, but because volume is huger, it has not been convenient to move back and forth in stair step, it is clear with reality
It is clean to require that gap is larger, there is not the actual report come into operation of the robot.Therefore also just the clean robot does not tackle building
Report in terms of terraced halfpace.
Although halfpace is a kind of level land, but different from general level land.First, general level land is not present and stair
Transition problem, so naturally also just discrimination not related to stair;Secondly, general level land path planning algorithm,
Although traversal can be realized, traversal end point has randomness, and this is unfavorable for the stair of robot searching down, even if finding,
Whole traversal necessarily takes with searching process, causes energy dissipation larger, or needs to be equipped with high end sensor to robot, into
This increase, is unfavorable for the popularization of robot;Furthermore, if robot finds that stair down in midway, then whether immediately
Downstairs, or later go downstairs again, later when downstairs, etc. be all need solve the problem of.Therefore general level land road
Footpath planning algorithm cannot be directly used to the planning of stair halfpace, it is necessary to special for the transition and traversal design of stair halfpace
The method of door.
The content of the invention
Easily and effectively realize stair clean robots from stair to halfpace it is an object of the invention to provide a kind of
Transition;The traversal transition of halfpace;Method of the halfpace to the transition of lower first floor ladder, it is ensured that robot can complete one
The continuity that floor ladder is cleaned.
The present invention technical solution be:
A kind of stair clean robot from stair to halfpace to stair transition method, it is characterized in that:Robot car
Two driving wheels for being symmetrical with fuselage or so medium line are provided with below body;Below robot automobile body front and back end respectively have one it is universal
Wheel, on the one hand plays the effect of support robot, on the other hand facilitates robot to turn, have sanitizer cartridge below robot automobile body front end
Put;Robot automobile body both sides are respectively mounted two distance measuring sensors:First, second distance measuring sensor and the three, the 4th rangings are passed
Sensor, the distance for detecting robot automobile body both sides and stair riser or wall is robot halfpace walking with
Traversal provides road information foundation;The first proximity transducer detected obliquely, robot are installed above robot automobile body front end
Body structure installs first, second touch sensor, and the first proximity transducer is used to detect whether front is stair down,
Touch sensor be used for detect front whether be wall or meet other barriers, for robot correct processing provide according to
According to;Second, third proximity transducer detected downwards is installed below robot automobile body rear end, is building for sensing robot rear
Ladder or halfpace;Robot is cleaned using mode downstairs;
Transition of the robot from stair to halfpace:
Robot turns round 90 ° marking time to have cleaned when front step so that the riser in front of robot just to upper level step,
Judge that robot rear is halfpace or or stair using second, third proximity transducer:If robot retreats a spacing
Lower section is all sensed from, second, third proximity transducer unobstructed, illustrate that the ground that robot is currently located is still that stair are stepped on
Step face, lower section is still necessarily staircase;If the distance that robot is retreated reaches d, d=L/2, second, third proximity transducer
Do not sense lower section unobstructed, illustrate that the ground that robot is currently located has been stair halfpace, robot should be transferred to
Halfpace planning control state;Wherein L is the width marked time;
Traversal transition of the robot in stair halfpace:
Robot reaches the traversal completion transition by halfpace after halfpace, using roundabout and plough path planning
The method being combined realizes the traversal of halfpace;
The roundabout paths planning method is:
Robot reaches halfpace from stair, has two kinds of landing points, i.e. first position, the second place, first position is
Close to stairwell and at the position to side of going upstairs on halfpace, the second place is to going upstairs one on halfpace
Side, the position by wall, sense the distance with wall using the distance measuring sensor on the right side of robot, judge in first position to the right
Or the second place;Robot, to stair riser certain distance has been pulled back from after halfpace, makes before robot this moment lower
OK, when contact plate touches stair riser, robot returns to first position or the second place;If in first position, machine
People turns round 90 ° clockwise, is seted out to the second place, if turn over 90 °, when robot is turned round, by the first of robot side,
Second distance measuring sensor senses the equal guarantee of distance of stair riser, then reaches the second place, robot also needs to up time
Pin turns round 90 °, and ensures by first, second distance measuring sensor sensing with right side wall apart from equal;If robot is from stair
It is in the second place, then robot is turned round 180 ° to arrive halfpace down, by first, second distance measuring sensor sensing and the right side
Side walls ensure apart from equal;
Then during robot is completed along stair riser edge and halfpace wall by circuitous path programme path mode
Between land regions size determination and the cleaning at each side of halfpace and angle;Robot cleans middle flat using circuitous path planning
Platform it is each when with corner, it is necessary to kept while each with halfpace one it is less apart from X, it is ensured that clean coverage rate;Robot
Brush radius is R, and brush installation site is D apart from vehicle body edge;The sensing distance X of first, second distance measuring sensor is met, X
< R-D, it is ensured that vehicle body can be completely covered to the ground between left side wall or stair riser in robot, while robot relies on one
First, second sensor of side ensures that robot, when advancing, with keeping equal distance before and after stair riser or wall, makes machine
Device people moves ahead parallel to stair riser or wall;
Robot by circuitous path planning along along the traveling process of halfpace wall and stair riser edge route,
When each corner is turned, then elder generation of robot backway d2 turns, radius of turn is increased to R, and the R mathematical relationships are extremely
It is few to meet:Therefore R values are minimum to meet:Wherein a is robot length;Institute
Stating d2 minimums should meet:d2=R-a/2;
The plough paths planning method is:
Robot completes to carry out the traversal of halfpace after circuitous path planning according to plough paths planning method;Robot
Side and wall are a body width b apart from X2, and brush width is wider than vehicle body, and the posture that robot starts faces for front
Right side wall, is turned round clockwise first, and the distance measured using first, second distance measuring sensor of vehicle body side is equal,
Guarantee turns round 90 °;Then the forward vehicle body in wall direction toward stair opposite is wide to A points, and 90 ° are then turned round clockwise and is turned left
Side walls direction move ahead, continue with vehicle body side first, second distance measuring sensor measure with the wall on stair opposite away from
From equal, it is ensured that vehicle body is moved ahead along the wall parallel to stair opposite, and initial distance value Y is recorded this moment;Until close to left side wall
Wall to B points, robot is encountered after the wall of left side using crash sensor, retreats certain distance by wheel reversing delay, makes machine
Device people side and wall are a body width apart from X2, and robot inverse hour hands turn round 90 °, utilize the of vehicle body opposite side
3rd, the 4th distance measuring sensor, similar method ensures to turn round 90 °, while making robot side be X2 away from left side wall;Then machine
Robot inverse hour hands turn round 90 ° after a forward body width to the C points of people, and then robot is from C points along parallel to stair opposite
The rectilinear direction of wall moves ahead to the D points close to right side wall, this process robot automobile body side and stair to sidewalls away from
From for Y-b, it ensures that right side is encountered using crash sensor by robot by the three, the 3rd distance measuring sensors of vehicle body opposite side
After wall, certain distance is retreated by wheel reversing delay, robot inverse hour hands turn round 90 °, and the distance with right side wall is also
X2;Then repeat aforementioned process, often come or return once, make robot automobile body side and stair to the distances of sidewalls with it is preceding once
Than reducing a wide b of vehicle body;
When robot detects that vehicle body side is more than body width with stair to the distance of sidewalls, illustrate that robot does not connect
The nearly wall, robot, which continues to move ahead, to be cleaned;When detection vehicle body side and stair are less than body width to the distance of sidewalls
When, illustrate robot close to stair to sidewalls, after Robot moves ahead parallel to the route of the wall, plough path rule
Draw and close to an end;
The halfpace of different in width, the final position difference that plough path planning terminates is stair to sidewalls and a left side
The corner location Z1 and stair of side walls are to sidewalls and the corner location Z2 of right side wall, but two positions can not conduct
The final end position of halfpace is, it is necessary to be transitioned into the corner of left side wall and stair tread, i.e. ZE points can just be carried out down
Building is acted;If the terminal of plough path planning is in Z1 positions, illustrate that in last time straight line cleaning process be by machine
What first, second distance measuring sensor on the left of people's vehicle body was sensed, straight trip reaches ZE positions after 90 ° clockwise of control machine people according to this
Place;If the terminal of plough path planning is in Z2 positions, illustrate that in last time straight line cleaning process be by robot car
Three, the 4th distance measuring sensors sensing on the right side of body, straight trip reaches Z1 positions after clockwise turn 180 ° of control machine people according to this, so
Turn 90 ° clockwise again afterwards to reach at ZE positions;
Transition of the robot from the downward first floor ladder of halfpace
When robot is reached near ZE points position, continue to move ahead, if the sensing of proximity transducer 1 direction above body structure
Do not block, show that robot reaches the edge that crosses of halfpace and lower first floor ladder, front is stair down, then
Robot turns round 180 degree using distance measuring sensor, and is combined with second, third proximity transducer at vehicle body rear, to test
Measure all unobstructed, now robot faces the terraced edge of lower first floor, and robot is executable downstairs to be acted, action downstairs be with
The form of retrogressing is carried out, and then repeats stair cleaning works;So far, robot complete from stair to halfpace again to
The transition of stair;
Robot runs into people or other moving obstacles in cleaning process, such as, then is sensed using crash sensor, sensing
To collision, robot is allowed to suspend, when not occurring to collide again, robot continues to move ahead.
, can not be always parallel to stair riser when robot moves ahead by sets requirement parallel to stair riser or wall
Or wall, produce sometimes front side and stair riser or the distance of wall and rear side and stair riser or wall away from
From the situation not waited, pass through first, second distance measuring sensor or the three, the 4th real-time robot measurement vehicle bodies one of distance measuring sensor
Side and the distance of stair riser or wall;If the distance that front distance measuring sensor is measured be less than rear distance measuring sensor measure away from
From then control machine people is outside, i.e., the direction away from stair riser or wall, turns to and moves ahead;If front distance measuring sensor is measured
Distance be more than the distance that measures of rear distance measuring sensor, then control machine people inwardly, i.e., the side of close stair riser or wall
To steering moves ahead.
The present invention can easily and effectively realize stair clean robot to realizing the transition from stair to halfpace;Centre is flat
The traversal of platform;Transition of the halfpace to lower first floor ladder, it is ensured that the continuity that robot can complete individual layer stair is swept
Journey.
Brief description of the drawings
The invention will be further described with reference to the accompanying drawings and examples.
Fig. 1 is the structural representation of stair clean robot.
Fig. 2 is Fig. 1 left view.
Fig. 3 is Fig. 1 top view.
Fig. 4 robots have been cleaned on stair, turn round clockwise 90 ° just to stair riser posture figure.
Fig. 5, Fig. 6 are that the proximity transducer below robot rear end judges the current schematic diagram for whether having arrived halfpace.
Fig. 7 is indoor parallel pair of race stair standard halfpace schematic diagram.
Fig. 8 is that distance measuring sensor ensures robot side parallel to stair riser or the schematic diagram of wall.
Fig. 9 is robot should be near enough by stair riser or wall, it is ensured that the ground that brush is covered between them shows
It is intended to.
Figure 10 is robot in traveling, and the distance of side front rear and stair riser or wall is unequal and tackles and does
Method schematic diagram.
Figure 11, Figure 12 are the difficulty and solution schematic diagram that robot runs into corner turning.
Figure 13 is that robot retreats combination S-shaped steering, makes the schematic diagram increased apart from X of side and stair riser.
Figure 14 is plough path planning schematic diagram.
Figure 15 is plough path planning end point and the final end point E schematic diagrames of halfpace.
Figure 16 be robot in front of the judgement of halfpace destination county whether be stair down schematic diagram.
Figure 17 is that robot shows vertical view of the robot just to stair edge using the proximity transducer of the rear end left and right sides
It is intended to.
Embodiment
A kind of stair clean robot from stair to halfpace to stair transition method, the lower section of robot automobile body 1 is set
It is equipped with two driving wheels 2,3 for being symmetrical with fuselage or so medium line;Respectively there is a universal wheel 4,5 front and back end below robot automobile body,
On the one hand the effect of support robot is played, on the other hand facilitates robot to turn, has cleaning device below robot automobile body front end
6;Robot automobile body both sides are respectively mounted two distance measuring sensors:First, second distance measuring sensor 7,8 and the three, the 4th rangings
Sensor 9,10, the distance for detecting robot automobile body both sides and stair riser or wall is robot in halfpace
Walking provides road information foundation with traversal;The first proximity transducer detected obliquely is installed above robot automobile body front end
11, first, second touch sensor 12,13 is installed in robot automobile body front end, and the first proximity transducer is used to detect that front is
No is stair down, and touch sensor is used to detect whether front is wall or meets other barriers, is robot
Correct processing provides foundation;Second, third proximity transducer 14,15 detected downwards is installed below robot automobile body rear end, used
It is stair or halfpace in sensing robot rear;
Transition of the robot from stair to halfpace
To make robot smoothly be transitioned into halfpace from stair, robot marks time from the right side shown in Fig. 4 when front step
While marching to the left side has cleaned (it could also be possible that having cleaned from left to right, that is to turn round counterclockwise), 90 ° are turned round clockwise,
So that the riser in front of robot just to upper level step, such as Fig. 4 is, it is necessary to judge that robot rear is halfpace or or building
Terraced (robot is gone downstairs in the way of retrogressing).Devise and differentiate close to second, third sensor 14,15, if after robot
Certain distance is moved back, second, third sensor 14,15 all senses that lower section is unobstructed, illustrate ground that robot is currently located still
It is so stair step face, lower section is still necessarily staircase, such as Fig. 5;If the distance that robot is retreated reaches d (d=L/2), such as
Fig. 6, second, third sensor 14,15 do not sense lower section it is unobstructed, illustrate that the ground that robot is currently located has been building
Terraced halfpace, robot should be transferred to halfpace planning control state.Wherein L is the width marked time.
When it is implemented, according to national standard, the comfortable tread run L of stair is between 280mm to 300mm, therefore, d
=140mm to 150mm, for certain nargin, takes d=150mm.Due to no sensor sensing distance forward, by wheel
Retreat delay and realize that the value need not be very accurate, you can ensure the reliability of sensing.Actual situation, although exist beyond country
The width of standard is marked time stair, but this kind of stair typically belong to exterior stair, and this kind of stair are typically no as the standard of interior stairs
The halfpace of rule, although some exterior stairs or step may have halfpace, shape difference is very big, and irregularly,
The present invention does not consider reply.So the present invention is applied to comfortably mark time wide in the range of national standard, or than national standard
The interior stairs of degree wide a bit (most width go out L/2), this kind of stair have the halfpace of comparison rule and standard, such as Fig. 7.
The traversal of stair halfpace
Robot reaches the traversal completion transition by halfpace after halfpace.Using roundabout and plough path planning
The method being combined realizes the traversal of halfpace.It is middle flat that wherein roundabout paths planning method can be such that robot cleans first
Each side of platform and corner, determine the region of halfpace, robot is moved in the range of restriction;Plough paths planning method
Robot can be made to cover halfpace with minimal path, it is ensured that the whole halfpace of traversal, while being also convenient for robot finds past
Under stair, so comprehensive two methods complete the traversal of halfpace.
Robot reaches halfpace from stair, has two kinds of landing points, i.e. first position, the second place, first position is
Close to stairwell 16 (space between two bench) and at the position (the position P1 in Fig. 7) to side of going upstairs, the second place
For on halfpace to side of going upstairs, by wall position (the position P2 in Fig. 7).Therefore it is first to need to determine first
Position P1 or second place P2, distance (such as Fig. 7 to right-side wall with wall is sensed using the distance measuring sensor on right side to the right
The horizontal dotted line of wall), if in larger distance, judge in position P1;If apart from very little, judging in position P2.When it is implemented, both
It is very big apart from difference, it is not necessary to be accurate threshold value, you can to ensure the reliability of difference.Robot is lower to after after halfpace
Recess out stair riser certain distance d, such as Fig. 6.Robot is set to move ahead this moment, when contact plate touches stair riser, robot
Return to position P1 or position P2.If in position P1, robot turns round 90 ° clockwise, is seted out to position P2.Whether turn over
90 °, can when robot is turned round, by two first, second distance measuring sensors of robot side sense stair riser away from
Ensure from equal, in Fig. 8, robot turns 90 ° to position shown in solid by dotted line position;Then in-position P2, robot is also
Need to turn round 90 ° clockwise, ensure by first, second distance measuring sensor sensing with right side wall apart from equal, such as Fig. 8.If
Robot is in position P2, then robot is turned round 180 ° to halfpace under stair, equally leans on first, second ranging
Sensor is sensed to be ensured with right side wall apart from equal.
When robot is in position P2 and is in the posture shown in Fig. 8, just by P2-P3-P4-P5-P2 as shown in Figure 7
Circuitous path programme path mode complete the determination of halfpace area size and the cleaning at each side of halfpace and angle.Machine
People using circuitous path planning clean halfpace it is each when with corner, it is necessary to kept while each with halfpace one it is less away from
From X, it is ensured that clean coverage rate.Robot is by wall or the walking of stair riser as shown in figure 9, brush radius is R, installation position in figure
It is D to put apart from vehicle body edge.Robot is swept into position P2 from the position P1 in Fig. 7, according to the direction walked in Fig. 9, first,
The sensing distance of second distance measuring sensor is designed as X, X < R-D, it is ensured that robot can be completely covered vehicle body to left side wall or
Ground between stair riser.Robot ensures robot when advancing by first, second distance measuring sensor of side simultaneously,
With keeping equal distance before and after stair riser or wall, robot is set to be moved ahead parallel to stair riser or wall.
During actual implementation, robot can not be always parallel to stair riser or wall, before producing sometimes when advancing
The situation that side side is not waited with stair riser or the distance of wall and rear side with the distance of stair riser or wall, such as figure
10.The present invention former and later two distance measuring sensors are respectively installed in robot both sides, by first, second distance measuring sensor or the 3rd,
The real-time robot measurement vehicle body side of 3rd distance measuring sensor and the distance of stair riser or wall;If front distance measuring sensor is surveyed
The distance obtained is less than the distance that rear distance measuring sensor is measured, then control machine people is slightly outwards (i.e. away from stair riser or wall
Direction) turn to move ahead, such as Figure 10;If the distance that front distance measuring sensor is measured is more than the distance that rear distance measuring sensor is measured,
Then control machine people turns to move ahead slightly inwards (this feelings with symmetrical shown in Figure 10) (i.e. close to the direction of stair riser or wall).
Implementation above robot side when advancing is parallel with stair riser or wall trend, apart in setting near X.
Robot is in the traveling process along P2-P3-P4-P5-P2 routes, to make robot as far as possible by the side of halfpace
Cleaned up with corner, the distance that robot keeps to the side is smaller so that when each corner is turned vehicle body easily occurs for robot
Encounter the situation of wall, cause the difficulty turned round, such as Figure 11.If carrying out original place this moment to turn round, left and right sidesing driving wheel constant speed is turned to
Conversely so that the pivot O points that robot is turned round are just at the center of itself, and radius of turn is too small, and rear end is easily encountered stair and kicked
Face.Solution:Radius of turn is turned round in increase, and O points are at least met in such as Figure 12 positions, mathematical relationship:Therefore R values are minimum to meet:On radius of turn R realization, left and right wheels
(be no longer one forward, two opposite directions rotation backward) is rotated forward, but has certain differential, with reference to speed wink
Heart method determines differential size.In order that under the radius of turn, wall is not touched in robot automobile body front end, robot is needed from Figure 11
Position shrink back, backway d2 minimums should be met:d2=R-a/2, such as Figure 12.When it is implemented, X take it is smaller only
30mm, and the robot dimensions length a designed is 280mm, thus:R=342mm, d2=200mm.During actual implementation, machine
People retreats the mode taken and S-shaped steering is carried out when retreating, and such as Figure 13 makes robot side increase with stair riser apart from X,
Robot can be reduced and turn round the possibility that stair riser is encountered in rear end, backway d2 can also reduced, is conducive to robot turning
Turning at angle.For robot, the turning of corner is also similar realization between wall and wall.
Position P2 is returned to after robot completes circuitous path planning, it is complete according to the plough paths planning method shown in Figure 14
Into the traversal of halfpace.The robot side of this method and wall apart from X2 be a body width, the machine of specific design
Device people's overall width b=220mm.Because brush width is wider than vehicle body, thus the X2 values can ensure this travel region of robot with
The near zone of circuitous path planing method walking before has certain overlapping, so as to ensure to clean coverage rate.In position during P2, machine
The posture that device people starts is that front faces right side wall, is turned round clockwise first, is passed using two rangings of vehicle body side
The distance that sensor is measured is equal, it is ensured that turn round 90 °;Then the forward vehicle body in wall direction toward stair opposite is wide to A points, and
Turn round clockwise afterwards 90 ° turn left side walls directions move ahead, continue with vehicle body side first, second distance measuring sensor measure with
The distance of the wall on stair opposite is equal, it is ensured that vehicle body is moved ahead along the wall parallel to stair opposite, and initial distance is recorded this moment
Value Y;Until the B points close to left side wall into figure, robot is encountered after the wall of left side using crash sensor, retreats a spacing
From (be delayed and realized using wheel reversing), robot inverse hour hands turn round 90 °, are sensed using the ranging of vehicle body opposite side the three, the 4th
Device, similar method ensures to turn round 90 °, while making robot side be X2 away from left side wall.Then robot proceeds to C points, preceding
Row distance is that robot inverse hour hands turn round 90 ° after body width, then robot from C points along parallel to stair to sidewalls
Rectilinear direction moved ahead to D points, this process robot automobile body side and stair are Y-b to the distance of sidewalls, and it is another by vehicle body
The distance measuring sensor of side the three, the 4th ensures.Robot runs to D points using the similar method of crash sensor, and robot turns
Body, the distance with right side wall is also X2, then repeats foregoing similar procedure.Often come or return once, make robot automobile body side
With stair to the distances of sidewalls with preceding once than reducing a wide b of vehicle body.
When robot detects that vehicle body side is more than body width with stair to the distance of sidewalls, illustrate that robot does not connect
The nearly wall, robot, which continues to move ahead, to be cleaned;When detection vehicle body side and stair are less than body width to the distance of sidewalls
When, illustrate robot close to stair to sidewalls, after Robot moves ahead parallel to the route of the wall, plough path rule
Draw and close to an end.The halfpace of different in width, the final position that plough path planning terminates is different, there is Z1 as shown in figure 15
With two positions of Z2.But two positions can not be as the final end position of halfpace, it is necessary to be transitioned into such as Figure 15
ZE points, just can downstairs be acted.If the terminal of plough path planning is in Z1 positions, illustrate to clean in last time straight line
During be by robot automobile body on the left of first, second distance measuring sensor sense, 90 ° clockwise of control machine people according to this
Straight trip is reached at ZE positions afterwards.If the terminal of plough path planning is in Z2 positions, illustrate in last time straight line cleaning process
In be to be sensed by the three, the 4th distance measuring sensors on the right side of robot automobile body, control machine people turns after 180 ° clockwise according to this
Straight trip reaches Z1 positions, and then turning 90 ° clockwise again reaches at ZE positions.
Transition of the robot from the downward first floor ladder of halfpace
When robot is reached near ZE points position, continue to move ahead, if the first proximity transducer sensing above body structure
Direction is not blocked, and shows that robot reaches the edge that crosses of halfpace and lower first floor ladder, front is stair down,
Such as Figure 16.Then robot turns round 180 degree (reason of angle-determining is similar, and above turning round 90 ° utilizes distance measuring sensor), and ties
Second, third proximity transducer using vehicle body rear is closed, all unobstructed, such as Figure 17 is detected downwards.Now robot is just right
Down the terraced edge of first floor, the executable action downstairs of robot (action downstairs is carried out in the form of retrogressing), then repeat into
Row stair cleaning works.So far, robot is completed again to the transition of stair from stair to halfpace, in this way can be real
The continuous-cleaning of existing first floor ladder.
Robot runs into the processing of moving obstacle
Robot runs into people or other moving obstacles in cleaning process, such as, is sensed using crash sensor, sensing
To collision, robot is allowed to suspend, when not occurring to collide again, robot continues to move ahead.
Due to the diversity and complexity of stair, the present invention only considers to apply in most common parallel pair of race stair in interior
Close;The present invention does not include reply and possesses the floor half space of door, main reply do not include door in this layer and last layer or
Interval platform (referred to as " halfpace ") between this layer and next layer, halfpace should not have the obstacle of static placement
Thing, shape matching rule such as Fig. 7.
The inventive method using stair as dextrorotation (if people is from bottom to top upstairs, every half space always turns left again up,
Downstairs always turn right) exemplified by design, (if people from bottom to top upstairs, always turn right to be left-handed by every half space for such as stair
Again up, downstairs always turn left) mode, then the sensor judged, the path used etc. using and the symmetrical side of the application
Formula processing.
The present invention, which has, plans regular, simple easily to realize, is easy to robot to determine to have traveled through halfpace, and really
The advantages of recognizing stair down.
Claims (1)
1. a kind of effectively realize stair clean robot method to stair transition from stair to halfpace, it is characterized in that:Machine
Two driving wheels for being symmetrical with fuselage or so medium line are provided with below device people vehicle body;Front and back end respectively has one below robot automobile body
Universal wheel, on the one hand plays the effect of support robot, on the other hand facilitates robot to turn, there is clear below robot automobile body front end
Clean device;Robot automobile body both sides are respectively mounted two distance measuring sensors:First, second distance measuring sensor and the three, the 4th is surveyed
It is row of the robot in halfpace for detecting robot automobile body both sides and the distance of stair riser or wall away from sensor
Walk and provide road information foundation with traversal;The first proximity transducer detected obliquely, machine are installed above robot automobile body front end
Device people body structure installs first, second touch sensor, and the first proximity transducer is used to detect whether front is down
Stair, touch sensor is used to detect whether front is wall or meets other barriers, is that the correct processing of robot is carried
For foundation;Second, third proximity transducer detected downwards is installed, for sensing robot rear below robot automobile body rear end
It is stair or halfpace;Robot is cleaned using mode downstairs;
Transition of the robot from stair to halfpace:
Robot turns round 90 ° marking time to have cleaned when front step so that the riser in front of robot just to upper level step, utilizes
Second, third proximity transducer judges that robot rear is halfpace or or stair:If robot retreats certain distance, the
2nd, the 3rd proximity transducer all sense lower section it is unobstructed, illustrate that the ground that robot is currently located is still stair step face,
Lower section is still necessarily staircase;If the distance that robot is retreated reaches d, d=L/2, second, third proximity transducer is not felt
It is unobstructed below measuring, illustrate that the ground that robot is currently located has been stair halfpace, robot should be transferred to middle flat
Platform planning control state;Wherein L is the width marked time;
Traversal transition of the robot in stair halfpace:
Robot reaches the traversal completion transition by halfpace after halfpace, is mutually tied with plough path planning using roundabout
The method of conjunction realizes the traversal of halfpace;
The roundabout paths planning method is:
Robot reaches halfpace from stair, there is two kinds of landing points, i.e. first position, the second place, and first position is centre
Close to stairwell and at the position to side of going upstairs on platform, the second place be on halfpace to side of going upstairs, lean on
The position of wall, senses the distance with wall using the distance measuring sensor on the right side of robot, judges in first position still to the right
The second place;Robot makes robot move ahead this moment lower to stair riser certain distance has been pulled back from after halfpace, when
Contact plate touches stair riser, and robot returns to first position or the second place;If in first position, robot up time
Pin turns round 90 °, is seted out to the second place, when robot is turned round, and is sensed by first, second distance measuring sensor of robot side
Distance to stair riser is equal, it is ensured that whether it turns over 90 °, then reaches the second place, and robot also needs to turn clockwise
90 ° of body, and ensure by first, second distance measuring sensor sensing with right side wall apart from equal;If robot under stair to
Halfpace is in the second place, then robot is turned round 180 °, by first, second distance measuring sensor sensing and right-side wall
Wall ensures apart from equal;
Then robot completes middle flat along stair riser edge and halfpace wall by circuitous path programme path mode
The determination of platform area size and the cleaning at each side of halfpace and angle;It is each that robot cleans halfpace using circuitous path planning
When with corner, it is necessary to kept while each with halfpace one it is less apart from X, it is ensured that clean coverage rate;The brush of robot
Radius is R, and brush installation site is D apart from vehicle body edge;The sensing distance X of first, second distance measuring sensor is met, X < R-
D, it is ensured that vehicle body can be completely covered to the ground between left side wall or stair riser in robot, while robot is by side
First, second sensor ensures that robot, when advancing, with keeping equal distance before and after stair riser or wall, makes robot
Moved ahead parallel to stair riser or wall;
Robot is planned along along the traveling process of halfpace wall and stair riser edge route by circuitous path, at each
When corner is turned, elder generation of robot backway d2, then turn, radius of turn is increased to R, the R mathematical relationships are at least full
Foot:Therefore R values are minimum to meet:Wherein a is robot length;The d2Most
It is small to meet:d2=R-a/2;
The plough paths planning method is:
Robot completes to carry out the traversal of halfpace after circuitous path planning according to plough paths planning method;Robot side
Apart from X2 it is body width b with wall, brush width is wider than vehicle body, and the posture that robot starts is that front faces right side
Wall, is turned round clockwise first, and the distance measured using first, second distance measuring sensor of vehicle body side is equal, it is ensured that
Turn round 90 °;Then the forward vehicle body in wall direction toward stair opposite is wide to A points, and 90 ° of side walls of turning left then are turned round clockwise
Wall direction moves ahead, and first, second distance measuring sensor for continuing with vehicle body side measures distance phase with the wall on stair opposite
Deng, it is ensured that vehicle body is moved ahead along the wall parallel to stair opposite, and initial distance value Y is recorded this moment;Until close to left side wall to B
Point, robot is encountered after the wall of left side using crash sensor, retreats certain distance by wheel reversing delay, makes robot one
Side and wall are a body width apart from X2, and robot inverse hour hands turn round 90 °, utilize the three, the 4th of vehicle body opposite side
The equidistant method that distance measuring sensor is measured ensures to turn round 90 °, while making robot side be X2 away from left side wall;Then
Robot inverse hour hands turn round 90 ° after a forward body width to the C points of robot, and then robot is from C points along parallel to stair
Rectilinear direction to sidewalls moves ahead to the D points close to right side wall, and this process robot automobile body side is with stair to sidewalls
Distance be Y-b, its by vehicle body opposite side the three, the 4th distance measuring sensors ensure, robot is encountered using crash sensor
After the wall of right side, certain distance is retreated by wheel reversing delay, robot inverse hour hands turn round 90 °, the distance with right side wall
Also it is X2;Then aforementioned process is repeated, often comes or returns once, makes robot automobile body side and stair to the distance of sidewalls with before
Once than reducing a wide b of vehicle body;
When robot detects that vehicle body side is more than body width with stair to the distance of sidewalls, illustrate robot not close to institute
Wall is stated, robot, which continues to move ahead, to be cleaned;When detecting that vehicle body side is less than body width with stair to the distance of sidewalls, say
Bright robot is close to stair to sidewalls, and after Robot moves ahead parallel to the route of the wall, plough path planning is
It will terminate;
The halfpace of different in width, the final position difference that plough path planning terminates is stair to sidewalls and left side wall
The corner location Z1 and stair of wall are to sidewalls and the corner location Z2 of right side wall, but two positions can not be used as centre
The final end position of platform is, it is necessary to be transitioned into the corner of left side wall and stair tread, i.e. ZE points just can be moved downstairs
Make;If the terminal of plough path planning is in Z1 positions, illustrate that in last time straight line cleaning process be by robot car
What first, second distance measuring sensor on the left of body was sensed, straight trip is reached at ZE positions after 90 ° clockwise of control machine people according to this;
If the terminal of plough path planning is in Z2 positions, illustrate it is right by robot automobile body in last time straight line cleaning process
The distance measuring sensor sensing of side the three, the 4th, control machine people turns straight trip arrival Z1 positions, Ran Houzai after 180 ° clockwise according to this
Turn 90 ° clockwise to reach at ZE positions;
The transient process of robot from halfpace downward first floor ladder is:
When robot is reached near ZE points position, continue to move ahead, if the first proximity transducer sensing direction above body structure
Do not block, show that robot reaches the edge that crosses of halfpace and lower first floor ladder, front is stair down, then
Robot turns round 180 degree using distance measuring sensor, and is combined with second, third proximity transducer at vehicle body rear, to test
Measure all unobstructed, now robot faces the terraced edge of lower first floor, and robot is executable downstairs to be acted, action downstairs be with
The form of retrogressing is carried out, and then repeats stair cleaning works;So far, robot complete from stair to halfpace again to
The transition of stair;
Robot runs into people or other moving obstacles in cleaning process, such as, then is sensed using crash sensor, sense and touch
Hit, allow robot to suspend, when not occurring to collide again, robot continues to move ahead.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610012211.6A CN105595924B (en) | 2014-06-04 | 2014-06-04 | Effectively realize stair clean robot method to stair transition from stair to halfpace |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410245199.4A CN103989443B (en) | 2014-06-04 | 2014-06-04 | Stair clean robot from stair to halfpace to the transition method of stair |
CN201610012211.6A CN105595924B (en) | 2014-06-04 | 2014-06-04 | Effectively realize stair clean robot method to stair transition from stair to halfpace |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410245199.4A Division CN103989443B (en) | 2014-06-04 | 2014-06-04 | Stair clean robot from stair to halfpace to the transition method of stair |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105595924A CN105595924A (en) | 2016-05-25 |
CN105595924B true CN105595924B (en) | 2017-10-17 |
Family
ID=51303974
Family Applications (3)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610013274.3A Expired - Fee Related CN105496317B (en) | 2014-06-04 | 2014-06-04 | Clean robot from stair to halfpace to stair continuity transition method |
CN201410245199.4A Expired - Fee Related CN103989443B (en) | 2014-06-04 | 2014-06-04 | Stair clean robot from stair to halfpace to the transition method of stair |
CN201610012211.6A Expired - Fee Related CN105595924B (en) | 2014-06-04 | 2014-06-04 | Effectively realize stair clean robot method to stair transition from stair to halfpace |
Family Applications Before (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610013274.3A Expired - Fee Related CN105496317B (en) | 2014-06-04 | 2014-06-04 | Clean robot from stair to halfpace to stair continuity transition method |
CN201410245199.4A Expired - Fee Related CN103989443B (en) | 2014-06-04 | 2014-06-04 | Stair clean robot from stair to halfpace to the transition method of stair |
Country Status (1)
Country | Link |
---|---|
CN (3) | CN105496317B (en) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105824313A (en) * | 2016-03-15 | 2016-08-03 | 深圳市华讯方舟科技有限公司 | Barrier avoidance method and device |
CN107943021B (en) * | 2017-10-19 | 2021-03-30 | 布法罗机器人科技(成都)有限公司 | Self-adaptive stair ascending and descending control system and method |
CN108078498A (en) * | 2017-10-30 | 2018-05-29 | 苏州花坞信息科技有限公司 | A kind of stair face cleaning method of intelligent stair clean robot |
CN108415421A (en) * | 2018-01-26 | 2018-08-17 | 广东宝乐机器人股份有限公司 | Method for improving corner coverage rate of mobile robot |
CN110448231B (en) * | 2019-08-12 | 2021-04-13 | 侨银城市管理股份有限公司 | Cleaning device suitable for municipal administration ladder |
CN111214173A (en) * | 2019-11-21 | 2020-06-02 | 三峡大学 | Crawler-type stair-climbing dust collection device and method |
CN110861095B (en) * | 2019-12-09 | 2021-03-19 | 上海高仙自动化科技发展有限公司 | Robot control method, robot, and readable storage medium |
CN111759241B (en) * | 2020-06-24 | 2021-10-15 | 湖南格兰博智能科技有限责任公司 | Sweeping path planning and navigation control method for sweeping robot |
WO2022041236A1 (en) * | 2020-08-31 | 2022-03-03 | 苏州珊口智能科技有限公司 | Traveling control method and path planning method for mobile robot, and mobile robot |
CN113854892B (en) * | 2021-10-21 | 2022-08-02 | 唐山学院 | Cleaning device capable of automatically planning path |
CN114569002A (en) * | 2022-03-18 | 2022-06-03 | 广州大学 | Intelligent cleaning robot and control method thereof |
CN114569028A (en) * | 2022-04-28 | 2022-06-03 | 南京福亿智能机器人科技有限公司 | Control method, device and equipment for robot climbing stairs and storage medium |
CN114794991B (en) * | 2022-06-02 | 2024-01-16 | 南通大学 | Control method for stair cleaning robot to go downstairs without turning around |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE2364002C2 (en) * | 1973-12-21 | 1983-02-24 | Frey, Helmut, Dr.jur., 8000 München | Orientation device for a device system that moves on a surface in order to process it |
KR100473274B1 (en) * | 2000-06-09 | 2005-03-09 | 시마즈멕템가부시기가이샤 | Moving unit |
RU2220643C2 (en) * | 2001-04-18 | 2004-01-10 | Самсунг Гванджу Электроникс Ко., Лтд. | Automatic cleaning apparatus, automatic cleaning system and method for controlling of system (versions) |
SE0201740D0 (en) * | 2002-06-07 | 2002-06-07 | Electrolux Ab | Electronic routing system |
CN1883889A (en) * | 2005-06-22 | 2006-12-27 | 王冬雷 | Route planning suitable for cleaning robot |
KR101281512B1 (en) * | 2007-04-06 | 2013-07-03 | 삼성전자주식회사 | Robot cleaner and control method thereof |
KR101361562B1 (en) * | 2007-05-31 | 2014-02-13 | 삼성전자주식회사 | Cleanning robot |
EP2045624A1 (en) * | 2007-10-01 | 2009-04-08 | Samsung Electronics Co., Ltd. | Ultrasonic distance sensor and robot cleaner using the same |
JP2009234534A (en) * | 2008-03-28 | 2009-10-15 | Ihi Corp | Locomotive robot |
JP2009241246A (en) * | 2008-03-31 | 2009-10-22 | Kazuya Yoshida | Semi-automatic travelling method for irregular ground movable body |
TWI423779B (en) * | 2011-01-28 | 2014-01-21 | Micro Star Int Co Ltd | Cleaning robot and control method thereof |
CN202681848U (en) * | 2012-04-18 | 2013-01-23 | 燕山大学 | Wall surface cleaning robot based on vacuum absorption principle |
CN102631172B (en) * | 2012-04-20 | 2013-05-08 | 南通大学 | Lifting telescopic corridor cleaning robot |
CN203195609U (en) * | 2013-04-02 | 2013-09-18 | 宋晓龙 | Overtravel cleaning robot |
-
2014
- 2014-06-04 CN CN201610013274.3A patent/CN105496317B/en not_active Expired - Fee Related
- 2014-06-04 CN CN201410245199.4A patent/CN103989443B/en not_active Expired - Fee Related
- 2014-06-04 CN CN201610012211.6A patent/CN105595924B/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN103989443A (en) | 2014-08-20 |
CN105496317B (en) | 2017-09-29 |
CN105496317A (en) | 2016-04-20 |
CN103989443B (en) | 2016-03-02 |
CN105595924A (en) | 2016-05-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105595924B (en) | Effectively realize stair clean robot method to stair transition from stair to halfpace | |
US11022976B2 (en) | Path planning method of intelligent robot | |
CN105320140B (en) | A kind of sweeping robot and its clean paths planning method | |
US9630319B2 (en) | Localization and mapping using physical features | |
CN103399294B (en) | For the method and apparatus identifying the point of interest in predefined region | |
CN111522339A (en) | Automatic path planning and positioning method and device for inspection robot of livestock and poultry house | |
CN105197123A (en) | Judgment method of walking up and down stairs of lifting telescopic corridor cleaning robot easy to operate | |
WO2015181995A1 (en) | Autonomous travel device, method for controlling autonomous travel device, and control program for autonomous travel device | |
CN104881027A (en) | Autonomic barrier-crossing system for wheel-track transformer station inspection robot and control method thereof | |
TWM451103U (en) | Walking device | |
CN104360687B (en) | Multi-mode autonomous driving control method for underground carry scraper | |
CN113465728B (en) | Terrain awareness method, system, storage medium and computer equipment | |
CN110189547A (en) | A kind of obstacle detection method, device and vehicle | |
CN108873900A (en) | Method, system and the robot to clear the jumps when a kind of robot ambulation | |
CN204557216U (en) | Wheel-track combined Intelligent Mobile Robot active obstacle system | |
CN106843239A (en) | Motion planning and robot control method based on map prediction | |
US20220101534A1 (en) | Sidewalk edge finder device, system and method | |
CN104875800A (en) | Self-climbing control method of tracked mobile robot with double-rod arm | |
CN103950482B (en) | Dropproof and collision processing method when stair clean robot moves on marking time | |
CN113442138B (en) | Routing inspection path planning method for climbing robot in tunnel | |
Le et al. | Long-term trials for improvement of autonomous area coverage with a Tetris inspired tiling self-reconfigurable system | |
CN114211512A (en) | Whole-face loop inspection method for tunnel lining detection climbing robot | |
Ohkawa et al. | Development of autonomous mobile robot using articulated steering vehicle and lateral guiding method | |
CN202605226U (en) | Universal wheel crutch for the blind | |
CN108078498A (en) | A kind of stair face cleaning method of intelligent stair clean robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20171017 Termination date: 20180604 |
|
CF01 | Termination of patent right due to non-payment of annual fee |