Summary of the invention
A kind of obstacle detection method and system for being designed to provide sweeper of the application, can save sweeper
Cost.
To achieve the above object, the application provides a kind of obstacle detection method of sweeper, which comprises
Visual pattern is obtained, and identifies the characteristic point for including in the visual pattern;
Spatial obstacle object point collection is constructed according to the characteristic point identified, and according to sweeper fuselage height and Horizon
Face filters out effective obstacle object point from spatial obstacle object point concentration;
According to the current location information of the effective obstacle object point filtered out and the sweeper, the sweeper is planned
Walking path.
Further, include: according to the characteristic point building spatial obstacle object point collection identified
The characteristic point is converted into three-dimensional coordinate point set, and using the three-dimensional coordinate point set as the spatial obstacle of building
Object point collection.
Further, it according to sweeper fuselage height and ground level, is filtered out effectively from spatial obstacle object point concentration
Obstacle object point includes:
Each obstacle object point that the spatial obstacle object point is concentrated is traversed, if height locating for current obstacle object point is greater than
The fuselage height of the sweeper, or less than the height of ground level, by the current obstacle object point from the spatial obstacle
Object point, which is concentrated, rejects;
Concentrate remaining obstacle object point as the effective obstacle object point filtered out the spatial obstacle object point.
Further, after filtering out effective obstacle object point from spatial obstacle object point concentration, the method is also wrapped
It includes:
Effective obstacle object point is projected into two-dimensional surface locating for the sweeper.
Further, the walking path for planning the sweeper includes:
The size or type of effective obstacle object point are judged, if the size of effective obstacle object point exceeds default threshold
Value or the type of effective obstacle object point, which belong to, evades type, controls the sweeper and avoids effective obstacle object point.
Further, the method also includes:
If the size of effective obstacle object point is less than the type category of the preset threshold or effective obstacle object point
In cleaning type, controls the sweeper and clean effective obstacle object point.
Further, the method also includes:
Final position is set for the sweeper, and according to the current location of the sweeper, is planned from the present bit
The action path in the final position is set, effective obstacle object point is evaded in the action path.
To achieve the above object, the application also provides a kind of obstacle detection system of sweeper, the system comprises:
Feature point recognition unit for obtaining visual pattern, and identifies the characteristic point for including in the visual pattern;
Obstacle object point screening unit, for the characteristic point building spatial obstacle object point collection that basis identifies, and according to
Sweeper fuselage height and ground level filter out effective obstacle object point from spatial obstacle object point concentration;
Path planning unit, for the position letter current according to the effective obstacle object point and the sweeper that filter out
Breath, plans the walking path of the sweeper.
Further, the obstacle object point screening unit includes:
Module is rejected, each obstacle object point concentrated for traversing the spatial obstacle object point, if current obstacle object point
Locating height is greater than the fuselage height of the sweeper, or less than the height of ground level, by the current obstacle object point
It concentrates and rejects from the spatial obstacle object point;
Screening module, for concentrating remaining obstacle object point as the effective obstacle filtered out the spatial obstacle object point
Object point.
Further, the path planning unit includes:
Evade module, for judging the size or type of effective obstacle object point, if effective obstacle object point
Size belongs to beyond the type of preset threshold or effective obstacle object point and evades type, controls the sweeper and avoids institute
State effective obstacle object point;
Module is cleaned, if the size for effective obstacle object point is less than the preset threshold or effective barrier
Hinder the type of object point to belong to cleaning type, controls the sweeper and clean effective obstacle object point.
Therefore technical solution provided by the present application, after identifying barrier point set, can according to fuselage height and
Height above ground level is concentrated from barrier point and rejects excessive height or too low obstacle object point, very easy so as to pass through
Mode filter out effective obstacle object point.In this way, while guaranteeing accuracy of identification, moreover it is possible to greatly reduce required calculating money
Source, to reduce the cost of sweeper.
Specific embodiment
In order to make those skilled in the art better understand the technical solutions in the application, below in conjunction with the application reality
The attached drawing in mode is applied, the technical solution in the application embodiment is clearly and completely described, it is clear that described
Embodiment is only a part of embodiment of the application, rather than whole embodiments.Based on the embodiment party in the application
Formula, all other embodiment obtained by those of ordinary skill in the art without making creative efforts, is all answered
When the range for belonging to the application protection.
The application provides a kind of obstacle detection method of sweeper, referring to Fig. 1, the described method comprises the following steps:
S1: visual pattern is obtained, and identifies the characteristic point for including in the visual pattern;
S2: spatial obstacle object point collection is constructed according to the characteristic point identified, and according to sweeper fuselage height and ground
Plane filters out effective obstacle object point from spatial obstacle object point concentration;
S3: it according to the current location information of the effective obstacle object point filtered out and the sweeper, is swept described in planning
The walking path of ground machine.
In one embodiment, include: according to the characteristic point building spatial obstacle object point collection identified
The characteristic point is converted into three-dimensional coordinate point set, and using the three-dimensional coordinate point set as the spatial obstacle of building
Object point collection.
In practical applications, the characteristic point in visual pattern is based on camera coordinates system, then can be according to existing skill
Characteristic point in camera coordinates system is converted to the three-dimensional coordinate point of world coordinate system by art, so as to obtain having X, Y, Z tri-
The three-dimensional coordinate point of a coordinate value.
In one embodiment, it according to sweeper fuselage height and ground level, concentrates and sieves from the spatial obstacle object point
Selecting effective obstacle object point includes:
Each obstacle object point that the spatial obstacle object point is concentrated is traversed, if height locating for current obstacle object point is greater than
The fuselage height of the sweeper, or less than the height of ground level, by the current obstacle object point from the spatial obstacle
Object point, which is concentrated, rejects;
Concentrate remaining obstacle object point as the effective obstacle object point filtered out the spatial obstacle object point.
In one embodiment, described after filtering out effective obstacle object point from spatial obstacle object point concentration
Method further include:
Effective obstacle object point is projected into two-dimensional surface locating for the sweeper.
In one embodiment, the walking path for planning the sweeper includes:
The size or type of effective obstacle object point are judged, if the size of effective obstacle object point exceeds default threshold
Value or the type of effective obstacle object point, which belong to, evades type, controls the sweeper and avoids effective obstacle object point.
In one embodiment, the method also includes:
If the size of effective obstacle object point is less than the type category of the preset threshold or effective obstacle object point
In cleaning type, controls the sweeper and clean effective obstacle object point.
In one embodiment, the method also includes:
Final position is set for the sweeper, and according to the current location of the sweeper, is planned from the present bit
The action path in the final position is set, effective obstacle object point is evaded in the action path.
In practical applications, the technical solution of the application can be realized in the following way:
1) characteristic point obtained in visual pattern is converted into three-dimensional coordinate point set, spatial obstacle object point collection is consequently formed.
Due to being three-dimensional coordinate point, so each point has (x, y, z) three attributes, wherein z is height of this away from ground.
2) spatial obstacle object point collection is screened, only retains effective data.Concrete operations are as follows:
Each spatial obstacle object point is judged, if being higher than the obstacle object point of sweeper fuselage height, is rejected.
For being lower than the obstacle object point of ground level, rejected.Obstacle point set after rejecting is being higher than ground level, but is being lower than sweeper
Between fuselage height.It handles in this way, has not only filtered out the point set of ceiling portion, but also only remain the obstacle of effective coverage
Object point collection, this considerably reduce the quantity of barrier point set, can effectively promote computational efficiency.
3) it by spatial obstacle object point collection, projects to two-dimensional surface, obtains these barrier point sets on two-dimensional surface
Coordinate points.
4) the current positioning coordinate points of sweeper are obtained.
5) positional relationship of current coordinate point and obstacle object point is analyzed.Carry out respective handling.Such as avoiding obstacles, explore clear
All barriers in region are swept, to the path planning etc. of some position of room.
Referring to Fig. 2, the application also provides a kind of obstacle detection system of sweeper, the system comprises:
Feature point recognition unit for obtaining visual pattern, and identifies the characteristic point for including in the visual pattern;
Obstacle object point screening unit, for the characteristic point building spatial obstacle object point collection that basis identifies, and according to
Sweeper fuselage height and ground level filter out effective obstacle object point from spatial obstacle object point concentration;
Path planning unit, for the position letter current according to the effective obstacle object point and the sweeper that filter out
Breath, plans the walking path of the sweeper.
In one embodiment, the obstacle object point screening unit includes:
Module is rejected, each obstacle object point concentrated for traversing the spatial obstacle object point, if current obstacle object point
Locating height is greater than the fuselage height of the sweeper, or less than the height of ground level, by the current obstacle object point
It concentrates and rejects from the spatial obstacle object point;
Screening module, for concentrating remaining obstacle object point as the effective obstacle filtered out the spatial obstacle object point
Object point.
In one embodiment, the path planning unit includes:
Evade module, for judging the size or type of effective obstacle object point, if effective obstacle object point
Size belongs to beyond the type of preset threshold or effective obstacle object point and evades type, controls the sweeper and avoids institute
State effective obstacle object point;
Module is cleaned, if the size for effective obstacle object point is less than the preset threshold or effective barrier
Hinder the type of object point to belong to cleaning type, controls the sweeper and clean effective obstacle object point.
Therefore technical solution provided by the present application, after identifying barrier point set, can according to fuselage height and
Height above ground level is concentrated from barrier point and rejects excessive height or too low obstacle object point, very easy so as to pass through
Mode filter out effective obstacle object point.In this way, while guaranteeing accuracy of identification, moreover it is possible to greatly reduce required calculating money
Source, to reduce the cost of sweeper.
Those skilled in the art are supplied to the purpose described to the description of the various embodiments of the application above.It is not
It is intended to exhaustion or be not intended to and limit the invention to single disclosed embodiment.As described above, the application's is various
Substitution and variation will be apparent for above-mentioned technology one of ordinary skill in the art.Therefore, although specifically begging for
Some alternative embodiments are discussed, but other embodiment will be apparent or those skilled in the art are opposite
It is easy to obtain.The application is intended to include all substitutions of the invention discussed herein, modification and variation, and falls in
Other embodiment in the spirit and scope of above-mentioned application.