CN113344263A - Method and device for judging track closure in edge walking process and computer equipment - Google Patents
Method and device for judging track closure in edge walking process and computer equipment Download PDFInfo
- Publication number
- CN113344263A CN113344263A CN202110592934.9A CN202110592934A CN113344263A CN 113344263 A CN113344263 A CN 113344263A CN 202110592934 A CN202110592934 A CN 202110592934A CN 113344263 A CN113344263 A CN 113344263A
- Authority
- CN
- China
- Prior art keywords
- map
- point
- suspected
- current time
- closing
- 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.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
- G06Q10/00—Administration; Management
- G06Q10/04—Forecasting or optimisation specially adapted for administrative or management purposes, e.g. linear programming or "cutting stock problem"
- G06Q10/047—Optimisation of routes or paths, e.g. travelling salesman problem
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T17/00—Three dimensional [3D] modelling, e.g. data description of 3D objects
- G06T17/05—Geographic models
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Business, Economics & Management (AREA)
- Human Resources & Organizations (AREA)
- Geometry (AREA)
- Strategic Management (AREA)
- Software Systems (AREA)
- Economics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Development Economics (AREA)
- Computer Graphics (AREA)
- Game Theory and Decision Science (AREA)
- Remote Sensing (AREA)
- Entrepreneurship & Innovation (AREA)
- Marketing (AREA)
- Operations Research (AREA)
- Quality & Reliability (AREA)
- Tourism & Hospitality (AREA)
- General Business, Economics & Management (AREA)
- Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
The application discloses a track closing judgment method in the process of edgewise walking, wherein a suspected closing point is found through distance calculation in the process of edgewise walking; and then the truth of the suspected closing point is judged according to the map similarity comparison result, so that whether the track is closed or not in the edgewise walking process is accurately judged, and the condition of misjudgment due to similar environments is avoided. The scheme realizes the searching and the confirmation of the suspected closing point through two judgments, and the result is more accurate.
Description
Technical Field
The invention relates to the field of intelligent equipment operation rules, in particular to a method and a device for judging track closure in an edge walking process and computer equipment.
Background
At present, the application of intelligent equipment is more and more extensive, such as a robot for answering services, a robot for patrol security check or a sweeping and cleaning robot. The smart devices described above often require a patrol-like walking process. The "edge" referred to in the above-mentioned edge walking process is an edge of the walking track of the smart device, and is not necessarily a real boundary (e.g., a wall).
For example, in the cleaning process of a sweeping robot for a specified area, the scanning process generally comprises bow-shaped scanning in the area and wall walking in the area. In a conventional mode, firstly, a bow-shaped scanning process is carried out, and then a wall walking process is carried out. During the walking along the wall, the closing of the running track along the wall is one of the important end conditions of the walking along the wall. The general standard for judging whether the track is closed in the prior art is to calculate whether the position of the current sweeping robot is overlapped with the environment near the starting point of the wall walking process (for example, the distance between point positions meeting the overlapping condition is 5-10 cm).
However, due to the fact that the sweeping robot may have a deviation in the current position coordinate determination or the complexity of the application environment, and the like, the determination of whether the trajectory in the edgewise walking process is closed may be determined only by the determination condition of the distance between the current position and the starting position, which may cause a problem of erroneous determination.
Disclosure of Invention
The invention mainly aims to provide a method and a device for judging the closing of a track in an edge walking process and computer equipment, and aims to solve the problem of wrong judgment of whether the track is closed by intelligent equipment in the edge walking process.
In order to achieve the above object, the present invention provides a method for determining a trajectory closure during an edgewise walking process, which is applied to an intelligent device, and comprises:
recording information of the intelligent equipment at the point location of the current time every set interval in the process of walking along the edge, wherein the information at least comprises coordinate information of the intelligent equipment at the current time;
if the distance value between a historical point position before the current time and the point position at the current time is smaller than a first judgment distance, judging that the point position at the current time is a suspected closed point which has walked along the edge, and judging that the historical point position is a suspected starting point;
obtaining a second map according to the coordinates of all point positions in the edge walking process;
and judging whether the track of the edgewise walking process is closed at the suspected closing point or not according to the similarity comparison result of the second map and a first map, wherein the first map is a shape map of a target area aimed at by the edgewise walking process.
Further, the step of determining whether the trajectory of the edgewise walking process is closed at the suspected closing point according to the similarity comparison result between the second map and the first map includes:
calculating the areas of the first map and the second map as a first area value and a second area value respectively;
obtaining a difference in magnitude between the first area value and the second area value;
and if the size difference falls into a first judgment range, judging that the track of the edgewise walking process is closed at the suspected closing point.
Further, the step of determining whether the trajectory of the edgewise walking process is closed at the suspected closing point according to the similarity comparison result between the second map and the first map includes:
dividing the first map and the second map into a first pixel map and a second pixel map which are composed of a plurality of pixel block areas in the same dividing mode;
obtaining a difference in the number of the pixel block regions included in the first pixel map and the second pixel map;
and if the quantity difference falls into a second judgment range, judging that the track of the edgewise walking process is closed at the suspected closing point.
Further, the step of determining whether the trajectory of the edgewise walking process is closed at the suspected closing point according to the similarity comparison result between the second map and the first map includes:
calculating the intersection ratio of the first map and the second map;
and if the intersection ratio falls into a third judgment range, judging that the track of the edgewise walking process is closed at the suspected closing point.
Further, the information further includes a speed direction of the smart device, and the determining that the point location at the current time is a suspected closed point that has traveled along the edge if the distance value between a historical point location before the current time and the point location at the current time is smaller than a first determination distance includes, after the determining that the historical point location is a suspected starting point:
calculating a direction included angle between the speed direction of the intelligent equipment at the suspected closing point and the speed direction of the intelligent equipment at the suspected starting point;
if the included angle of the directions is smaller than a first preset judgment angle, maintaining the judgment that the current point location is the suspected closing point;
if the direction included angle is larger than a first preset judgment angle, abandoning the judgment that the current point position is the suspected closing point, and executing the track closing judgment method again.
Further, if the distance value between a historical point location before the current time and the point location at the current time is smaller than the first determination distance, it is determined that the point location at the current time is a suspected closed point that has traveled along the edge, and the step of determining that the historical point location is a suspected starting point includes:
calculating to obtain a real-time judgment distance DTWherein D isTA is a distance base number, and the unit is length, b is a distance increasing coefficient, and the unit is length/time, and T is the current running time in the edgewise walking process, and the unit is time;
taking the real-time judgment distance DTThe smaller value from Dc is a first determination distance, where DCIs the limit distance.
Further, the set interval is a distance interval or a time interval.
Further, the step of determining that the point location at the current time is a suspected closed point that has traveled along the edge if the distance value between the historical point location before the current time and the point location at the current time is smaller than the first determination distance, and the step of determining that the historical point location is a suspected starting point includes:
judging whether the number of the set intervals existing between the suspected closing point and the suspected starting point in the edgewise walking process is larger than a first preset judgment number or not;
if yes, maintaining the point position of the current time as a suspected closed point which is walked along the edge;
if not, the judgment that the point position of the current time is a suspected closing point which is walked along the edge is denied, and the track closing judgment method is executed again.
The invention also provides a device for operating the track closing judgment method in the edgewise walking process, which comprises the following steps:
the first obtaining unit is used for recording information of the intelligent equipment at a point position of current time every time a set interval passes in the process of walking along the edge, wherein the information at least comprises coordinate information of the intelligent equipment at the current time;
a first comparison confirming unit, configured to confirm that, if a distance value between a historical point location before the current time and a point location at the current time is smaller than a first determination distance, the point location at the current time is determined to be a suspected closed point that has traveled along the edge, and the historical point location is determined to be a suspected starting point;
the second obtaining unit is used for obtaining a second map according to the coordinates of all point positions in the edgewise walking process;
and the first calculation and confirmation unit is used for judging whether the track of the edgewise walking process is closed at the suspected closing point according to the similarity comparison result of the second map and a first map, wherein the first map is a shape map of a target area aimed at by the edgewise walking process.
The invention also provides computer equipment which comprises a memory and a processor, wherein the memory stores a computer program, and the processor realizes the steps of the track closing judgment method when executing the computer program.
In summary, the present application discloses a trajectory closure determination method in an edgewise walking process, wherein a suspected closure point is found by distance calculation in the edgewise walking process; and then the truth of the suspected closing point is judged according to the map similarity comparison result, so that whether the track is closed or not in the edgewise walking process is accurately judged, and the condition of misjudgment due to similar environments is avoided. The scheme realizes the searching and the confirmation of the suspected closing point through two judgments, and the result is more accurate.
Drawings
Fig. 1 is a schematic flow chart of a track closing determination method in an edge walking process according to an embodiment of the present invention;
fig. 2 is a schematic diagram illustrating a comparison of similarity between a second map and a first map in a track closing determination method for a walking-along process according to an embodiment of the present invention;
FIG. 3 is a schematic structural diagram of an apparatus for operating a trajectory closure determination method for an edgewise walking process according to an embodiment of the present invention;
FIG. 4 is a schematic diagram of a computer device according to an embodiment of the invention.
The implementation, functional features and advantages of the objects of the present invention will be further explained with reference to the accompanying drawings.
Detailed Description
It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention.
As used herein, the singular forms "a", "an", "the" and "the" include plural referents unless the content clearly dictates otherwise. It will be further understood that the terms "comprises" and/or "comprising," when used in this specification, specify the presence of stated features, integers, steps, operations, elements, units, modules, and/or components, but do not preclude the presence or addition of one or more other features, integers, steps, operations, elements, units, modules, components, and/or groups thereof. It will be understood that when an element is referred to as being "connected" or "coupled" to another element, it can be directly connected or coupled to the other element or intervening elements may also be present. Further, "connected" or "coupled" as used herein may include wirelessly connected or wirelessly coupled. As used herein, the term "and/or" includes all or any element and all combinations of one or more of the associated listed items.
It will be understood by those skilled in the art that, unless otherwise defined, all terms (including technical and scientific terms) used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs. It will be further understood that terms, such as those defined in commonly used dictionaries, should be interpreted as having a meaning that is consistent with their meaning in the context of the prior art and will not be interpreted in an idealized or overly formal sense unless expressly so defined herein.
Referring to fig. 1, in an embodiment of the present invention, a method for determining a track closure in an edgewise walking process is applied to an intelligent device, and includes:
s1, recording information of the intelligent equipment at the point of the current time every set interval in the process of walking along the edge, wherein the information at least comprises coordinate information of the intelligent equipment at the current time;
s2, if the distance value between a historical point position before the current time and the point position at the current time is smaller than a first judgment distance, judging that the point position at the current time is a suspected closed point which has traveled along the edge, and judging that the historical point position is a suspected starting point;
s3, obtaining a second map according to the coordinates of all point positions in the edge walking process;
and S4, judging whether the track of the edgewise walking process is closed at the suspected closing point according to the similarity comparison result of the second map and a first map, wherein the first map is a shape map of a target area aimed at by the edgewise walking process.
The intelligent equipment is a self-propelled intelligent device such as a sweeping robot or a patrol robot. In this embodiment, the intelligent device is a sweeping robot, and the edgewise walking process is an edgewise sweeping process of the sweeping robot. In the step S1, in the process of walking along the edge, the coordinates of the intelligent device at the point location of the current time are recorded every time a set interval elapses, so that a complete record is formed for the point location of the intelligent device in the whole process of walking along the edge. The point location of the intelligent device at the current time is realized through a position acquisition unit arranged on the intelligent device, such as data of visual/inertial navigation. Of course, the intelligent device may be required to record the speed direction of the current time as needed.
In the step S2, a suspected closing point is found by calculating the distance between the current point and the historical point before the current point by the smart device. In the step S2, the suspected closed point may be determined by excluding a point position spaced apart from the starting point position of the edgewise travel process by a plurality of set intervals, so as to avoid that a point position close to the starting point position satisfies the determination condition in the step S2 and is erroneously determined as a suspected closed point, but the suspected closed point is apparently a false point (it is needless to say that the real-time distance may be calculated after the first set interval from the starting point position).
In the above steps S3-S4, the second map is obtained according to the coordinates of all the point locations during the walking process, for example, a closed track is obtained by sequentially connecting the coordinates of all the point locations. And verifying whether the suspected closing point is true or not by comparing the similarity of the second map and the first map, namely, if the second map is closer to the first map, judging that the track in the process of walking along the edge is closed to the suspected closing point. The first map is a shape map of a target area aimed at in the process of walking along the edge, the first map can be manually input by a user or automatically obtained by intelligent equipment, and in one embodiment, the scanning of the target area by the intelligent equipment comprises a global scanning process and a process of walking along the edge; after the global scanning process, extracting a target area graph obtained in the global scanning process as a first map through a radar component or an infrared sensing element or other components on the global scanning process. By the method, a suspected closing point is found out firstly in the process of walking along the edge; and judging the authenticity of the suspected closing point according to the map similarity comparison result, thereby accurately judging whether the track in the edgewise walking process is closed or not.
It should be noted that, if the similarity comparison result between the second map and the first map is greatly different, the intelligent device may send out a warning message, so that the user can perform inspection and maintenance. If the first map is obtained by the intelligent device, the intelligent device may need to obtain the correct first map again after certain trimming is performed on the target area; if the first map is manually entered by the user, the user may be required to review, modify, etc. the first map. The user can also monitor the edge walking process of the intelligent device to confirm whether the edge walking process is abnormal or not, so that the first map is abnormal to obtain.
It is worth mentioning that in one embodiment, the first map is typically obtained by the robot performing a "bow-type sweep" in the sweep area, and after the "bow-type sweep" is performed, the edgewise sweep (i.e., walking edgewise) is performed and the second map is obtained. In order to make the first map itself, which is the comparison object/comparison sample, sufficiently accurate if the "second map is obtained by the smart device itself", it is preferable to perform the following verification before the edge sweeping in step S1.
S1.1, when the cleaning area is subjected to arch-shaped cleaning, simultaneously obtaining the cleaning area recorded under the arch-shaped cleaning, and finally accumulating the total cleaning area A of the cleaning area;
s1.2, after the bow-shaped cleaning of the cleaning area is finished, obtaining a first map of the whole cleaning area based on the bow-shaped track;
s1.3, obtaining a total area B in the outline of the first map by adopting an outline extraction mode for the first map;
s1.4, comparing the total area A with the total area B;
s1.5, when the ratio/difference value of the total area A and the total area B is within a fault tolerance range, the contour accuracy of the extracted first map is considered to be higher, and the first map can be used for comparing with a second map in the subsequent step;
if the ratio/difference between the total area A and the total area B is large, the contour accuracy of the extracted first map is considered to be possibly low; the foregoing process may be self-checked, and the step of comparing the contour and the area may be re-extracted, or a prompt of "the contour of the first map may be inaccurate" may be output to the user, and an operation may be performed according to an instruction of the user, for example, to see whether the user uses the first map data in a subsequent step, or whether the user requires processing the first map before using it.
Therefore, in the 'bow-shaped cleaning' cleaning mode, the area of the cleaning area is obtained in two modes, the first map obtained in the 'bow-shaped cleaning' mode is checked according to the comparison condition of the two area data, the map comparison in the steps of S3-S4 can be executed by using a more accurate first map, and whether the track closing is realized by the edgewise walking can be accurately judged. It should be noted that, in the prior art, whether the trajectory is closed is determined only by whether the distance between the current point position of the sweeping robot and the starting point of the edgewise walking process is smaller than a preset value (5-10 cm). The positioning function of the sweeping robot adopting the visual/inertial navigation is not accurate enough, so that the sweeping robot cannot judge whether the distance between the current point position and the starting point of the edgewise walking process is smaller than a preset value or not in the edgewise walking process of the sweeping robot, and the edgewise walking process cannot normally judge the closing end; or the walking route of the sweeping robot has certain deviation, so that the edgewise walking process of the sweeping robot is actually closed, but the distance between the current point position and the starting point of the edgewise walking process does not fall into the preset value range, and the closing knot cannot be normally judged in the edgewise walking process. In this embodiment, if the first determination distance is enlarged (for example, selected in the range of 30-200cm or 100-200 cm), through the steps from S3 to S4, even if the accuracy of the position acquisition unit of the smart device is not sufficient or the target area targeted by the edgewise walking process is complex, the suspected closing point is easy to find; through the steps from S3 to S4, whether the suspected closing point is true or not is verified through the similarity comparison between the second map and the first map, so that whether the track of the edgewise walking process is closed or not is accurately judged.
In summary, the present application discloses a trajectory closure determination method in an edgewise walking process, wherein a suspected closure point is found by distance calculation in the edgewise walking process; and then the truth of the suspected closing point is judged according to the map similarity comparison result, so that whether the track is closed or not in the edgewise walking process is accurately judged, and the condition of misjudgment due to similar environments is avoided. The scheme realizes the searching and the confirmation of the suspected closing point through two judgments, and the result is more accurate.
In one implementation, the step of determining whether the trajectory of the edgewise walking process is closed at the suspected closing point according to the similarity comparison result between the second map and the first map includes:
j1, calculating the areas of the first map and the second map as a first area value and a second area value respectively;
j2, obtaining the difference of the first area value and the second area value;
j3, if the size difference falls within a first determination range, determining that the trajectory of the edgewise walking process is closed at the suspected closing point.
In the steps from J1 to J3, the similarity between the first map and the second map is directly represented by comparing the areas of the first map and the second map, and the similarity representation method is most direct. The area of the first map may be directly input by the user or calculated by the smart device itself in other modes. In this embodiment, the method for calculating the difference between the first area value and the second area value includes: and calculating the ratio of the first area value to the second area value, wherein the first judgment range is 0.8-1.2. And if the ratio of the first area value to the second area value is between 0.8 and 1.2, judging the suspected closing point to be true.
Referring to fig. 2, in one implementation, the step of determining whether the trajectory of the edgewise walking process is closed at the suspected closing point according to the similarity comparison result between the second map and the first map includes:
k1, dividing the first map and the second map into a first pixel map and a second pixel map which are composed of a plurality of pixel block areas in the same dividing mode;
k2, obtaining the difference of the number of the pixel block areas contained in the first pixel map and the second pixel map;
and K3, if the quantity difference falls into a second determination range, determining that the track of the edgewise walking process is closed at the suspected closing point.
In the steps K1 to K3, the first map and the second map are divided into a first pixel map and a second pixel map, each of which is composed of a plurality of pixel block regions, in the same division manner; and then the similarity of the first map and the second map is represented by the difference of the number of the pixel block areas in the first pixel map and the second pixel map, and the similarity representation method is simple and quick in operation. Referring to fig. 2, the rectangular frame line of the outer layer is represented as a first map, the curved folding line of the inner layer is represented as a second map, and the rectangular frame line and the curved folding line enclose a plurality of pixel block regions, respectively. In this embodiment, the method for calculating the difference between the numbers of the pixel block regions may be: and calculating the ratio of the number of the pixel block areas contained in the first pixel map to the number of the pixel block areas contained in the second pixel map, wherein the second judgment range is 0.8-1.2. Of course, the method for calculating the difference between the numbers of pixel block regions may be a method for calculating the difference between the numbers of pixel block regions.
In one embodiment, the step of determining whether the trajectory of the edgewise walking process is closed at the suspected closing point according to the similarity comparison result between the second map and the first map includes:
l1, calculating the intersection ratio of the first map and the second map;
and L2, if the intersection ratio falls into a third judgment range, judging that the track of the edgewise walking process is closed at the suspected closing point.
The similarity between the first map and the second map is judged according to the degree of coincidence between the first map and the second map, and the authenticity of the suspected closing point is verified.
In one embodiment, the step of determining whether the trajectory of the edgewise walking process is closed at the suspected closing point according to the similarity comparison result between the second map and the first map includes:
m1, calculating the areas of the first map and the second map into a first area value and a second area value respectively;
m2, obtaining the size difference of the first area value and the second area value;
m3, if the size difference falls into a first judgment range, calculating the intersection ratio of the first map and the second map;
m4, if the intersection ratio falls into a third judgment range, judging that the track of the edgewise walking process is closed at the suspected closing point.
In the above-described steps of M1 to M2, the similarity of the first map and the second map is characterized by area comparison of the first map and the second map. In the steps from M3 to M4, if the size difference falls within the first determination range, the intersection ratio of the first map and the second map is calculated and obtained, and the similarity comparison result between the second map and the first map is accurately represented. In the present embodiment, the result of the similarity comparison between the second map and the first map is preliminarily determined by performing the steps M1 and M2 in which the operation speed is fast; if the size difference falls into the first judgment range, the M3 step and the M4 step with slower operation speed are continuously executed to accurately represent the similarity comparison result of the second map and the first map, compared with the embodiment of directly executing the L1-L2 steps, the quick M1-M2 steps directly remove a part of pseudo closing point data, and when the closing point reliability is higher, the subsequent accurate judgment of M3-M4 is carried out, so that the time saving and the accuracy are better.
In one embodiment, the step of determining whether the trajectory of the edgewise walking process is closed at the suspected closing point according to the similarity comparison result between the second map and the first map includes:
p1, dividing the first map and the second map into a first pixel map and a second pixel map composed of a plurality of pixel block areas in the same dividing mode;
p2, obtaining the difference of the number of the pixel block areas contained in the first pixel map and the second pixel map;
p3, if the quantity difference falls into a second judgment range, calculating the intersection ratio of the first map and the second map;
and P4, if the intersection ratio falls into a third judgment range, judging that the track of the edgewise walking process is closed at the suspected closing point.
In the steps of P1 to P2, the first map and the second map are divided into the first pixel map and the second pixel map each composed of a plurality of pixel block regions in the same division manner; and then the similarity of the first map and the second map is represented by the difference of the number of the pixel block areas in the first pixel map and the second pixel map, and the similarity representation method is simple and quick in operation. In the steps from P3 to P4, if the number difference falls within the second determination range, the intersection ratio of the first map and the second map is calculated and obtained, so as to accurately represent the similarity comparison result between the second map and the first map. In the present embodiment, the result of the similarity comparison between the second map and the first map is preliminarily determined by performing the steps P1 and P2 in which the arithmetic speed is fast; if the number difference falls within the second determination range, the P3 step and the P4 step with slower operation speed are continuously executed to accurately represent the comparison result of the similarity between the second map and the first map, and compared with the aforementioned embodiment with L1 to L2, the number difference of the pixel block area is combined with the map area for operation, i.e. a part of the false closing point data is directly removed through the earlier stage of simpler and faster P1 to P2 steps, and when the reliability of the closing point is higher, the subsequent accurate re-determination of P3-P4 is performed, which is more time-saving and accurate.
In one embodiment, the information further includes a speed direction of the smart device, and the determining that the point location at the current time is a suspected closed point that has traveled along the edge if the distance value between a historical point location before the current time and the point location at the current time is smaller than a first determination distance includes, after the determining that the historical point location is a suspected starting point:
SP1, calculating a direction included angle between the speed direction of the intelligent device at the suspected closing point and the speed direction of the intelligent device at the suspected starting point;
SP2, if the included angle of direction is smaller than a first preset determination angle, determining that the current point location is the suspected closing point;
and SP3, if the included angle of the directions is larger than a first preset judgment angle, abandoning the judgment that the current point position is the suspected closing point, and executing the track closing judgment method again.
In the above steps SP1 to SP3, when the track of the edgewise walking process is closed, that is, the edgewise walking process is cyclically repeated; at this time, not only the coordinates of the point location of the smart device are repeated, but also the speed direction of the smart device should be repeated. The method comprises the steps that the suspected closing point is assisted to judge the authenticity of the suspected closing point through comparison between the speed direction of the suspected closing point and the speed direction of the intelligent device at the suspected starting point; thus, a second map does not need to be formed for each suspected closing point and compared with the first map, and the amount of calculation is reduced. In this embodiment, if an included angle between the speed direction of the intelligent device at the suspected closing point and the speed direction of the intelligent device at the starting point position is less than 30 degrees, the determination that the current point location is the suspected closing point is maintained, otherwise, the determination that the current point location is the suspected closing point is discarded, and the trajectory closing determination method is executed again.
In one embodiment, if a distance value between a historical point location before the current time and a point location at the current time is smaller than a first determination distance, the step of determining that the point location at the current time is a suspected closed point that has traveled along the edge is preceded by the step of determining that the historical point location is a suspected starting point includes:
calculating to obtain a real-time judgment distance DTWherein D isTA is a distance base number, and the unit is length, b is a distance increasing coefficient, and the unit is length/time, and T is the current running time in the edgewise walking process, and the unit is time;
taking the real-time judgment distance DTThe smaller value from Dc is the first determination distance, where Dc is the limit distance.
In the present embodiment, a is 10cm, b is 5cm/min, and Dc is 200cm, that is, the initial value representing the preset determination distance is 10cm, and the preset determination distance is increased by 5cm every 1 minute until the preset determination distance is increased to 200 cm. When the edgewise walking process starts, if the preset judgment distance is longer, a plurality of suspected closing points are easy to judge, and the suspected closing points are fake in most cases; and the probability of closing the track at the later stage of the edge walking process is higher, and at the moment, the first judgment distance is larger, so that the suspected closing point can be found favorably. In the step, the first judgment distance is a value which is gradually increased and then is a constant, and the first judgment distance value is small at the early stage, so that the meaningless calculation at the initial stage of the edgewise walking process is shielded; the first judgment distance value in the later stage is large, and the probability of correctly judging the closing of the track in the later stage in the edgewise walking process is improved.
It should be noted that the "edge" referred to in the above-mentioned edge walking process is an edge of the walking track of the intelligent device, and is not necessarily a real boundary (e.g. a wall).
In one implementation, the set interval is a distance interval or a time interval.
In implementation, when the distance interval is set as the set interval, the point group formed by the coordinates of the intelligent device on the point location recording the current time is very uniform, which is beneficial to subsequently acquiring the second map. Such as the number of turns the moving wheel of the smart device makes to calculate the distance the smart device moves, the set interval is set to 10cm, although in other embodiments the set interval may be selected between 10-20 cm.
In implementation, when the time interval is set as the interval, the coordinate extraction of the intelligent device in the complex area is favorable, and the subsequent acquisition of the second map is also favorable. Because the movement of the intelligent device in the complex area has more turning or collision, the time consumption is more, and a plurality of coordinates can be extracted in the complex area by taking the time interval as the set interval.
In one implementation, if a distance value between a historical point location before the current time and a point location at the current time is smaller than a first determination distance, determining that the point location at the current time is a suspected closed point that has traveled along the edge, and determining that the historical point location is a suspected starting point includes:
judging whether the number of the set intervals existing between the suspected closing point and the suspected starting point in the edgewise walking process is larger than a first preset judgment number or not;
if yes, maintaining the point position of the current time as a suspected closed point which is walked along the edge;
if not, the judgment that the point position of the current time is a suspected closing point which is walked along the edge is denied, and the track closing judgment method is executed again.
In the above step, the determination of the suspected closed point excludes the point position which is spaced apart from the starting point position of the edgewise travel process by a plurality of set intervals, so as to avoid the point position close to the starting point position from being erroneously determined as the suspected closed point while the suspected closed point is apparently false due to the point position satisfying the determination condition in step S2.
Referring to fig. 3, in an embodiment of the present invention, an apparatus for determining a track closure during an edgewise walking process includes:
a first obtaining unit 10, configured to record information of the intelligent device at a point location of current time every time a set interval elapses in the process of walking along the edge, where the information at least includes coordinate information of the intelligent device at the current time;
a first comparison confirming unit 20, configured to confirm that, if a distance value between a historical point location before the current time and a point location at the current time is smaller than a first determination distance, it is determined that the point location at the current time is a suspected closed point that has traveled along the edge, and that the historical point location is a suspected starting point;
the second obtaining unit 30 is configured to obtain a second map according to the coordinates of all point locations in the process of walking along the edge;
the first calculation and confirmation unit 40 is configured to determine whether the track of the edgewise walking process is closed at the suspected closing point according to a similarity comparison result between the second map and a first map, where the first map is a shape map of a target area targeted by the edgewise walking process.
In one embodiment, the first calculation confirmation unit 40 includes:
the first calculation unit is used for calculating the areas of the first map and the second map into a first area value and a second area value respectively;
a third obtaining unit, configured to obtain a difference between the first area value and the second area value;
and if the size difference falls within a first judgment range, the third comparison and confirmation unit judges that the track of the edgewise walking process is closed at the suspected closing point.
In this embodiment, please refer to the corresponding method embodiments for the specific implementation of each unit, which will not be described herein again.
In one embodiment, the first calculation confirmation unit 40 includes:
a second calculation unit configured to divide both the first map and the second map into a first pixel map and a second pixel map composed of a plurality of pixel block regions in the same division manner;
a fourth obtaining unit configured to obtain a difference in the number of the pixel block regions included in the first pixel map and the second pixel map;
and if the quantity difference falls into a second determination range, the third comparison and confirmation unit determines that the track of the edgewise walking process is closed at the suspected closing point.
In this embodiment, please refer to the corresponding method embodiments for the specific implementation of each unit, which will not be described herein again.
In one embodiment, the first calculation confirmation unit 40 includes:
the third calculating unit is used for calculating the intersection ratio of the first map and the second map;
and if the intersection ratio falls within a third judgment range, the fourth comparison and confirmation unit judges that the track of the edgewise walking process is closed at the suspected closing point.
In this embodiment, please refer to the corresponding method embodiments for the specific implementation of each unit, which will not be described herein again.
In one embodiment, the first calculation confirmation unit 40 includes:
a fourth calculation unit configured to calculate areas of the first map and the second map as a first area value and a second area value, respectively;
a fifth obtaining unit, configured to obtain a difference between the first area value and the second area value;
a fifth comparison and confirmation unit, which calculates an intersection ratio of the first map and the second map if the size difference falls within a first determination range;
and if the intersection ratio falls within a third judgment range, the sixth comparison and confirmation unit judges that the track of the edgewise walking process is closed at the suspected closing point.
In this embodiment, please refer to the corresponding method embodiments for the specific implementation of each unit, which will not be described herein again.
In one embodiment, the first calculation confirmation unit 40 includes:
a fifth calculation unit configured to divide both the first map and the second map into a first pixel map and a second pixel map composed of a plurality of pixel block regions in the same division manner;
a sixth acquisition unit configured to acquire a difference in the number of the pixel block regions included in the first pixel map and the second pixel map;
a seventh comparison calculation unit, configured to calculate an intersection ratio of the first map and the second map if the quantity difference falls within a second determination range;
and if the intersection ratio falls within a third judgment range, the eighth comparison and confirmation unit judges that the track of the edgewise walking process is closed at the suspected closing point.
In this embodiment, please refer to the corresponding method embodiments for the specific implementation of each unit, which will not be described herein again.
In one embodiment, the apparatus for operating the trajectory closure determination method for the edgewise walking process further includes:
a seventh obtaining unit, configured to obtain an included angle between a speed direction of the intelligent device at the suspected closing point and a speed direction of the intelligent device at the suspected starting point;
and the ninth comparison and confirmation unit is used for judging the magnitude relation between the direction clamp and the first preset judgment angle and confirming the authenticity of the suspected closing point.
In this embodiment, please refer to the corresponding method embodiments for the specific implementation of each unit, which will not be described herein again.
In one embodiment, the apparatus for operating the trajectory closure determination method for the edgewise walking process further includes:
a fifth calculation unit for calculating and obtaining the real-time judgment distance DTWherein D isTA is a distance base number, and the unit is length, b is a distance increasing coefficient, and the unit is length/time, and T is the current running time in the edgewise walking process, and the unit is time;
a tenth comparison confirming unit for taking the real-time judgment distance DTThe smaller value from Dc is a first determination distance, where DCIs the limit distance.
In this embodiment, please refer to the corresponding method embodiments for the specific implementation of each unit, which will not be described herein again.
In one embodiment, the apparatus for operating the trajectory closure determination method for the edgewise walking process further includes:
an eighth obtaining unit, configured to determine whether the number of the set intervals existing between the suspected closing point and the suspected starting point in the edgewise walking process is greater than a first preset determination number;
an eleventh comparison and confirmation unit configured to maintain the determination that the point location at the current time is a suspected closed point that has traveled edgewise;
and the eleventh comparison and confirmation unit is used for negating the judgment that the point position at the current time is a suspected closing point which is walked along the edge, and re-executing the track closing judgment method.
In this embodiment, please refer to the corresponding method embodiments for the specific implementation of each unit, which will not be described herein again.
Referring to fig. 4, an embodiment of the present invention is a computer device, including a memory and a processor, where the memory stores a computer program, and the processor implements the steps of the trajectory closure determination method when executing the computer program.
The above description is only a preferred embodiment of the present invention, and not intended to limit the scope of the present invention, and all modifications of equivalent structures and equivalent processes, which are made by using the contents of the present specification and the accompanying drawings, or directly or indirectly applied to other related technical fields, are included in the scope of the present invention.
Claims (10)
1. A track closing judgment method in the process of walking along the edge is applied to intelligent equipment and is characterized by comprising the following steps:
recording information of the intelligent equipment at the point location of the current time every set interval in the process of walking along the edge, wherein the information at least comprises coordinate information of the intelligent equipment at the current time;
if the distance value between a historical point position before the current time and the point position at the current time is smaller than a first judgment distance, judging that the point position at the current time is a suspected closed point which has walked along the edge, and judging that the historical point position is a suspected starting point;
obtaining a second map according to the coordinates of all point positions in the edge walking process;
and judging whether the track of the edgewise walking process is closed at the suspected closing point or not according to the similarity comparison result of the second map and a first map, wherein the first map is a shape map of a target area aimed at by the edgewise walking process.
2. The method according to claim 1, wherein the step of determining whether the trajectory of the edgewise walking process is closed at the suspected closing point according to the comparison result of the similarity between the second map and the first map comprises:
calculating the areas of the first map and the second map as a first area value and a second area value respectively;
obtaining a difference in magnitude between the first area value and the second area value;
and if the size difference falls into a first judgment range, judging that the track of the edgewise walking process is closed at the suspected closing point.
3. The method according to claim 1, wherein the step of determining whether the trajectory of the edgewise walking process is closed at the suspected closing point according to the comparison result of the similarity between the second map and the first map comprises:
dividing the first map and the second map into a first pixel map and a second pixel map which are composed of a plurality of pixel block areas in the same dividing mode;
obtaining a difference in the number of the pixel block regions included in the first pixel map and the second pixel map;
and if the quantity difference falls into a second judgment range, judging that the track of the edgewise walking process is closed at the suspected closing point.
4. The method according to claim 1, wherein the step of determining whether the trajectory of the edgewise walking process is closed at the suspected closing point according to the comparison result of the similarity between the second map and the first map comprises:
calculating the intersection ratio of the first map and the second map;
and if the intersection ratio falls into a third judgment range, judging that the track of the edgewise walking process is closed at the suspected closing point.
5. The method according to any one of claims 1 to 4, wherein the information further includes a speed direction of the smart device, and the determining that the point location at the current time is a suspected closed point that has traveled along the edge if a distance value between a historical point location before the current time and the point location at the current time is smaller than a first determination distance includes:
calculating a direction included angle between the speed direction of the intelligent equipment at the suspected closing point and the speed direction of the intelligent equipment at the suspected starting point;
if the included angle of the directions is smaller than a first preset judgment angle, maintaining the judgment that the current point location is the suspected closing point;
if the direction included angle is larger than a first preset judgment angle, abandoning the judgment that the current point position is the suspected closing point, and executing the track closing judgment method again.
6. The method according to any one of claims 1 to 4, wherein, if a distance value between a historical point location before the current time and a point location at the current time is smaller than a first determination distance, it is determined that the point location at the current time is a suspected closed point that has traveled along the edge, and the step of determining that the historical point location is a suspected starting point includes:
calculating to obtain a real-time judgment distance DTWherein D isTA is a distance base number, and the unit is length, b is a distance increasing coefficient, and the unit is length/time, and T is the current running time in the edgewise walking process, and the unit is time;
taking the real-time judgment distance DTThe smaller value from Dc is a first determination distance, where DCIs the limit distance.
7. The method for judging the closing of the trajectory during the edgewise walking process according to any one of claims 1 to 4, wherein the set interval is a distance interval or a time interval.
8. The method according to any one of claims 1 to 4, wherein if a distance value between a historical point location before the current time and a point location at the current time is smaller than a first determination distance, it is determined that the point location at the current time is a suspected closed point that has traveled along the edge, and the step of determining that the historical point location is a suspected starting point includes:
judging whether the number of the set intervals existing between the suspected closing point and the suspected starting point in the edgewise walking process is larger than a first preset judgment number or not;
if yes, maintaining the point position of the current time as a suspected closed point which is walked along the edge;
if not, the judgment that the point position of the current time is a suspected closing point which is walked along the edge is denied, and the track closing judgment method is executed again.
9. A device for operating a track closing judgment method in an edgewise walking process is characterized by comprising the following steps:
the first obtaining unit is used for recording information of the intelligent equipment at a point position of current time every time a set interval passes in the process of walking along the edge, wherein the information at least comprises coordinate information of the intelligent equipment at the current time;
a first comparison confirming unit, configured to confirm that, if a distance value between a historical point location before the current time and a point location at the current time is smaller than a first determination distance, the point location at the current time is determined to be a suspected closed point that has traveled along the edge, and the historical point location is determined to be a suspected starting point;
the second obtaining unit is used for obtaining a second map according to the coordinates of all point positions in the edgewise walking process;
and the first calculation and confirmation unit is used for judging whether the track of the edgewise walking process is closed at the suspected closing point according to the similarity comparison result of the second map and a first map, wherein the first map is a shape map of a target area aimed at by the edgewise walking process.
10. A computer device comprising a memory and a processor, the memory having stored therein a computer program, wherein the processor when executing the computer program implements the steps of the trajectory closure determination method according to any one of claims 1 to 8.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110592934.9A CN113344263B (en) | 2021-05-28 | 2021-05-28 | Method and device for judging track closure in edge walking process and computer equipment |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110592934.9A CN113344263B (en) | 2021-05-28 | 2021-05-28 | Method and device for judging track closure in edge walking process and computer equipment |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113344263A true CN113344263A (en) | 2021-09-03 |
| CN113344263B CN113344263B (en) | 2022-12-27 |
Family
ID=77472001
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110592934.9A Active CN113344263B (en) | 2021-05-28 | 2021-05-28 | Method and device for judging track closure in edge walking process and computer equipment |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113344263B (en) |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102039595A (en) * | 2009-10-09 | 2011-05-04 | 泰怡凯电器(苏州)有限公司 | Self-moving ground handling robot and facing ground handling control method thereof |
| JP2017142866A (en) * | 2017-05-25 | 2017-08-17 | 株式会社日立産機システム | Position identification device |
| CN108196555A (en) * | 2018-03-09 | 2018-06-22 | 珠海市微半导体有限公司 | The control method that autonomous mobile robot is walked along side |
| CN108508891A (en) * | 2018-03-19 | 2018-09-07 | 珠海市微半导体有限公司 | A kind of method of robot reorientation |
| CN109394095A (en) * | 2018-10-23 | 2019-03-01 | 珠海市微半导体有限公司 | A kind of control method, chip and the clean robot of the offset of robot motion's carpet |
| CN111158353A (en) * | 2018-10-19 | 2020-05-15 | 广达电脑股份有限公司 | Movement control method for a plurality of robots and system thereof |
| CN111580525A (en) * | 2020-05-26 | 2020-08-25 | 珠海市一微半导体有限公司 | Judgment method for returning to starting point in edgewise walking, chip and visual robot |
-
2021
- 2021-05-28 CN CN202110592934.9A patent/CN113344263B/en active Active
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102039595A (en) * | 2009-10-09 | 2011-05-04 | 泰怡凯电器(苏州)有限公司 | Self-moving ground handling robot and facing ground handling control method thereof |
| US20120232696A1 (en) * | 2009-10-09 | 2012-09-13 | Ecovacs Robotics (Suzhou) Co., Ltd. | Autonomous Moving Floor-Treating Robot and Control Method Thereof for Edge-Following Floor-Treating |
| JP2017142866A (en) * | 2017-05-25 | 2017-08-17 | 株式会社日立産機システム | Position identification device |
| CN108196555A (en) * | 2018-03-09 | 2018-06-22 | 珠海市微半导体有限公司 | The control method that autonomous mobile robot is walked along side |
| CN108508891A (en) * | 2018-03-19 | 2018-09-07 | 珠海市微半导体有限公司 | A kind of method of robot reorientation |
| CN111158353A (en) * | 2018-10-19 | 2020-05-15 | 广达电脑股份有限公司 | Movement control method for a plurality of robots and system thereof |
| CN109394095A (en) * | 2018-10-23 | 2019-03-01 | 珠海市微半导体有限公司 | A kind of control method, chip and the clean robot of the offset of robot motion's carpet |
| CN111580525A (en) * | 2020-05-26 | 2020-08-25 | 珠海市一微半导体有限公司 | Judgment method for returning to starting point in edgewise walking, chip and visual robot |
Also Published As
| Publication number | Publication date |
|---|---|
| CN113344263B (en) | 2022-12-27 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Williams et al. | A comparison of loop closing techniques in monocular SLAM | |
| EP3633615A1 (en) | Deep learning network and average drift-based automatic vessel tracking method and system | |
| Yang et al. | Deep concrete inspection using unmanned aerial vehicle towards cssc database | |
| CN112102646B (en) | Parking lot entrance positioning method and device in parking positioning and vehicle-mounted terminal | |
| CN112417926A (en) | Parking space identification method and device, computer equipment and readable storage medium | |
| CN111220153A (en) | Positioning method based on visual topological node and inertial navigation | |
| WO2016013095A1 (en) | Autonomous moving device | |
| US10989555B2 (en) | System and method for automated semantic map generation | |
| Heo et al. | Consistent EKF-based visual-inertial navigation using points and lines | |
| Yang et al. | A robotic system towards concrete structure spalling and crack database | |
| CN109829936B (en) | Target tracking method and device | |
| CN111832343B (en) | Tracking method and device, and storage medium | |
| CN109945877B (en) | Patrol track generation method and device | |
| CN113344263B (en) | Method and device for judging track closure in edge walking process and computer equipment | |
| CN109720353A (en) | A kind of driving behavior detection method based on smart phone | |
| Kong et al. | Simultaneous Viewpoint-and Condition-Invariant Loop Closure Detection Based on LiDAR Descriptor for Outdoor Large-Scale Environments | |
| CN115392407B (en) | Non-supervised learning-based danger source early warning method, device, equipment and medium | |
| CN117146795A (en) | Loop detection method, system, equipment and medium for visual laser double verification | |
| CN106096554A (en) | Decision method and system are blocked in a kind of parking stall | |
| CN113554705B (en) | Laser radar robust positioning method under changing scene | |
| CN114973425A (en) | Traffic police gesture recognition method and device | |
| US20210124958A1 (en) | Road surface management system and road surface management method thereof | |
| CN112802095B (en) | Positioning method, device and equipment, and automatic driving positioning system | |
| WO2021138372A1 (en) | Feature coverage analysis | |
| CN113762030A (en) | Data processing method and device, computer equipment and storage medium |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |