Stopping generation of a map of an environment
By dynamically adjusting bounding volumes and setting stopping criteria based on cell size relationships, the method addresses the inefficiencies of existing exploration algorithms, enabling adaptive and efficient mapping of environments by mobile devices.
Patent Information
- Application Number
- PCT/SE2023/050466
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-11
- Publication Date
- 2024-11-14
AI Technical Summary
Existing exploration algorithms for mobile devices struggle with adaptable stopping criteria, requiring prior knowledge of the environment's size and leading to inefficient mapping due to fixed temporal or spatial constraints, which can result in incomplete or excessively long mapping processes.
The method involves measuring distances from a sensor to objects in the environment, identifying frontier cells, and dynamically adjusting bounding volumes to include unmeasured cells, with a stopping criterion based on the relationship between measured and unmeasured cell sizes, allowing for continuous adaptation of the mapping process.
This approach enables efficient and adaptive mapping by allowing the mobile device to selectively stop or continue mapping based on dynamic criteria, ensuring comprehensive coverage without prior knowledge of the environment's size, reducing mapping time, and improving operational efficiency.
Smart Images

Figure SE2023050466_14112024_PF_FP_ABST
Abstract
Description
STOPPING GENERATION OF A MAP OF AN ENVIRONMENTTECHNICAL FIELD
[0001] The present disclosure relates to a method for stopping generation of a map of an environment, a corresponding mobile device, and a corresponding computer program product.BACKGROUND
[0002] Exploration algorithms enable mobile devices such as robots to autonomously create maps of an environment. The mobile device captures occupancy information about the environment, identifies regions of interest and navigates towards them. As more information is captured, a richer map representation is created. Regions of interest are usually called frontiers and defined as the boundary between explored and unknown space. An important part of an exploration algorithm is its stopping criterion, which tells the mobile device when the exploration should be stopped.
[0003] A recent review paper [1] identifies the definition of meaningful stopping criteria for exploration algorithms as a relevant research topic, which has not received much attention. Most of the approaches in the literature use either a temporal or a spatial criterion. A temporal criterion gives the mobile device a certain amount of time to explore the environment and stops the exploration once the time has run out. A spatial criterion often uses a pre-defined bounding box and stops the exploration once the mobile device has covered more than a configurable fraction of the bounding box’s volume.
[0004] Another paper [2] defines an uncertainty -based stopping criterion that tracks progress of coverage and localization uncertainty. In this paper, if progress of mapping coverage is below a desired threshold, exploration is concluded.
[0005] The most traditional approach to exploration is frontier based and can be summarized as navigating to every frontier region until no more frontiers exists. Hence, the stopping criterion is to stop as soon as there are no more frontiers in the map, as it is, for example, described in [3],
[0006] Problems that generally exist with these prior approaches include that the stopping criteria are set before mapping and cannot be changed while performing mapping. Additionally, the mapping requires prior knowledge about an expected size of the environment, and cannot be adapted if the map grows beyond the expected size. Moreover, prior mapping approaches require a long time to complete mapping of an environmentbecause the stopping criteria is not adaptable, or the bounding volume is not operationally efficient if the map grows. Without some previous knowledge about the environment, it is not operationally feasible to define the sizeof the bounding volume. Too large of a bounding volume results in an unacceptably long mapping, while too small of a bounding volume results in incomplete mapping of the environment.SUMMARY
[0007] Various embodiments of the present disclosure are directed to overcoming one or more of the problems associated with prior approaches. More specifically, it is an object of the invention to enable a more efficient mapping of an environment by a mobile device.
[0008] Some embodiments disclosed herein are directed to a method of stopping generation of a map of an environment being sensed by a sensor transported by a mobile device. The method includes measuring distances from the sensor to objects located in the environment based on data from the sensor. The environment includes measured cells and unmeasured cells within bounding volumes of the environment. The method further includes identifying frontier cells in a bounding volume of the environment. The frontier cells are measured cells that are unoccupied and border at least one unmeasured cell. The method further includes for a group of the frontier cells in the environment, performing at least one of: generating a new bounding volume, where the new bounding volume overlaps a portion of the bounding volume and includes at least one additional unmeasured cell in the environment; and expanding the bounding volume to include at least one additional unmeasured cell in the environment. The bounding volume contains the at least one unmeasured cell in the environment that is bordering the group of the frontier cells. The method further includes determining a stopping criterion based on at least a relationship between sizes of the measured and unmeasured cells. The method further includes selectively stopping the generation of the map of the environment based on the determined stopping criterion becoming satisfied.
[0009] Some other related embodiments disclosed herein are directed to a mobile device that includes at least one processor and at least one memory storing instruction executable by the at least one processor to perform operations. The operations measure distances from a sensor, transported by the mobile device, to objects located in an environment based on data from the sensor. The environment includes measured cells and unmeasured cells within bounding volumes of the environment. The operations identify frontier cells in a bounding volume of the environment. The frontier cells are measured cells that are unoccupied and border at leastone unmeasured cell. The operations further include, for a group of the frontier cells in the environment, to perform at least one of: generate a new bounding volume, where the new bounding volume overlaps a portion of the bounding volume and includes at least one additional unmeasured cell in the environment; and to expand the bounding volume to include at least one additional unmeasured cell in the environment. The bounding volume contains the at least one unmeasured cell in the environment that is bordering the group of the frontier cells. The operations determine a stopping criterion based on at least a relationship between sizes of the measured and unmeasured cells. The operations selectively stop generation of a map of the environment based on the determined stopping criterion becoming satisfied.
[0010] Some other related embodiments disclosed herein are directed to a computer program product including a non-transitory computer readable medium storing program instructions executable by at least one processor to perform operations. The operations include to measure distances from a sensor, transported by the mobile device, to objects located in an environment based on data from the sensor. The environment includes measured cells and unmeasured cells within the bounding volumes of the environment. The operations identify frontier cells in a bounding volume of the environment. The frontier cells are measured cells that are unoccupied and border at least one unmeasured cell. The operations further include for a group of the frontier cells in the environment, to perform at least one of: generate a new bounding volume, where the new bounding volume overlaps a portion of the bounding volume and includes at least one additional unmeasured cell in the environment; and to expand the bounding volume to include at least one additional unmeasured cell in the environment. The bounding volume contains the at least one unmeasured cell in the environment that is bordering the group of the frontier cells. The operations determine a stopping criterion based on at least a relationship between sizes of the measured and unmeasured cells. The operations selectively stop generation of a map of the environment based on the determined stopping criterion becoming satisfied.
[0011] Potential advantages that may be provided by embodiments presently disclosed herein include overcoming one of the above-described problems with prior approaches. An additional or alternative advantage may include that the mapping of an environment is selectively stopped based on a stopping criterion which can be determined based on several independent bounding volumes being used to track progress of the mapping. An additional or alternative advantage may include that since the stopping criteria is determined based on at least a relationship between sizes of the measured and unmeasured cells, the generation of anew bounding volume and / or expansion of one of the existing bounding volumes results in changes to the stopping criterion. These changes to the stopping criterion, by the generation of the new bounding volume and / or expansion of one of the existing bounding volumes, affect how the mobile device selectively continues its mapping of the environment.
[0012] Other methods and mobile devices according to embodiments will be or become apparent to one with skill in the art upon review of the following drawings and detailed description. It is intended that all such methods and mobile devices be included within this description, be within the scope of the present disclosure, and be protected by the accompanying claims. Moreover, it is intended that all embodiments disclosed herein can be implemented separately or combined in any way and / or combination.BRIEF DESCRIPTION OF THE DRAWINGS
[0013] Aspects of the present disclosure are illustrated by way of example and are not limited by the accompanying drawings. In the drawings:
[0014] Figures 1 A-C illustrate example operations by a mobile device for mapping an environment in accordance with some embodiments of the present disclosure;
[0015] Figures 2A-B illustrate other example operations by a mobile device for mapping an environment in accordance with some other embodiments of the present disclosure;
[0016] Figures 3 A-B illustrate more example operations by a mobile device for mapping an environment in accordance with some other embodiments of the present disclosure;
[0017] Figure 4 illustrates a flowchart of operations that can be performed by a mobile device for mapping an environment in accordance with some embodiments;
[0018] Figure 5 illustrates another related flowchart of operations that can be performed by a mobile device for mapping an environment in accordance with some alternative or additional embodiments relative to those of Figure 4; and
[0019] Figure 6 illustrates a block diagram of components of a system that includes a mobile device, and which are configured to operate in accordance with some embodiments of the present disclosure.DETAILED DESCRIPTION
[0020] Inventive concepts will now be described more fully hereinafter with reference to the accompanying drawings, in which examples of embodiments of inventive concepts are shown. Inventive concepts may, however, be embodied in many different forms and should not be construed as limited to the embodiments set forth herein. Rather, these embodimentsare provided so that this disclosure will be thorough and complete, and will fully convey the scope of various present inventive concepts to those skilled in the art. It should also be noted that these embodiments are not mutually exclusive. Components from one embodiment may be tacitly assumed to be present / used in another embodiment.
[0021] Various embodiments of the present disclosure are directed to selectively stopping the generation of a map of an environment which is being sensed by a sensor transported by a mobile device.
[0022] The exploration algorithm in [3] defines boxes around frontiers. Although [3] illustrates such boxes around frontiers, the boxes are used only to predict how the environment may look in an unknown area. This information is then used to choose where a robot should navigate to. The exploration algorithm in [3] does not use prediction to affect the stopping criterion.
[0023] In accordance with some embodiments of the present disclosure, operations can use bounding volumes to track the progress of how much of an environment has been mapped, and which may be performed independent of the physical size of the environment and / or how much time has elapsed during the mapping. By maintaining more than one bounding volume, a potential advantage may include that more of the environment can be explored compared to a single bounding volume approach due to the stopping criterion allowing different coverages for each bounding volume. For example, new bounding volumes can be generated for identified frontiers and the stopping criterion can be determined based on the newly generated bounding volumes and, for example, whether each new bounding volume has been explored by a desired threshold.
[0024] The term "bounding volume" is used herein in a general sense to refer to any two- or three-dimensional space.
[0025] Possible advantages of various embodiments of the present disclosure may include one or more of the following: no prior knowledge is required about the environment; no time limit is necessarily imposed on the mapping operation, e.g., mapping is stopped when enough coverage is reached; the stopping criteria can be adapted based on the coverage of each of the individual bounding volumes so that increased mapping coverage of the environment can be obtained compared to when the stopping criteria is based on a single fixed bounding volume approach; and enables room-based coverage metrics when room segmentation is available.
[0026] In some embodiments, a mobile device autonomously maps an environment, while it explores the environment. The map may be used to allow the mobile device to autonomously navigate the environment. For example, the map may be stored in the mobile device to allowthe mobile device to navigate the environment. Additionally, or alternatively, the map may be transmitted to a networked computing device and the mobile device may receive instructions from the computing device for use in navigating the environment. The mobile device may be, for example, a ground-based vehicle, an aerial vehicle (e.g., a drone), a robot, or other device capable of mapping the environment using a sensor that can directly or indirectly sense, derive, or otherwise measure distances between the one or more sensors and objects in the environment.
[0027] The mobile device may also explore an environment based on user input or a combination of user input and autonomous exploration. In some embodiments, the mobile device may include a phone, tablet, extended reality (XR) device (e.g., XR glasses), and other devices that provide user interface(s) and may comprise a sensor(s) configured to measure distances to objects in an environment.
[0028] In some embodiments, the sensor(s) may comprise at least one of: a camera, a Light Detection and Ranging (LiDAR) sensor, a sonic sensor, a radar sensor, or any type of sensor that is capable of measuring distances between the sensor and objects in the environment. The term "sensor" can correspond to a single sensor or a plurality of sensors which may be a combination of the same type of sensor (e.g., stereo cameras) or a combination of different types of sensors (e.g., combination of camera(s) and LiDAR).
[0029] Figure 4 illustrates a flowchart of operations that can be performed by the mobile device for mapping an environment in accordance with some embodiments. Figure 5 illustrates another related flowchart of operations that can be performed by the mobile device for mapping an environment in accordance with some alternative or additional embodiments of Figure 4. The operations of Figures 4 and 5 are now explained with reference to nonlimiting example scenarios illustrated in Figures 1 A through 3B of the mobile device, such as a robot, which moves through the environment. This operational description with respect to the illustrated scenarios is provided for completeness of disclosure, although the scope of those operations is not limited to the illustrated scenarios.
[0030] Figure 1 A illustrates operations by the mobile device for mapping an environment in accordance with some embodiments of the present disclosure. The environment may include measured cells (i.e., cells that have been measured using the sensor of the mobile device) and unmeasured cells (i.e., cells that have not been measured using the sensor of the mobile device). The measured cells may include unoccupied cells (i.e., cells that are measured and determined to not contain object(s)) and occupied cells (i.e., cells that are measured and determined to contain object(s)). In some embodiments, the different cells may be square andhave an edge length of 5cm. In other embodiments, the size / dimensions of the different cells may vary based on, for example, predefined criteria, user input, mobile device computational capability, sensor capability, speed of the mobile device, etc. Each cell in the environment may be the same size / dimension or different sizes / dimensions.
[0031] In some embodiments, the generated map is a grid map such as that illustrated in Figure 1A.
[0032] In Figure 1 A, the mobile device moves in the environment and measures the environment. The mobile device is illustrated as being present in cell Pl and has measured distances to objects in the environment based on data from the sensor. In this example, the mobile device has determined (through sensor measurements) that some cells are occupied cells, illustrated by diagonal patterned cells in Figure 1 A, which have one or more objects within each such cell (e.g., a wall, window, door, table, chair, plant, etc). The mobile device has also determined (through sensor measurements) that some other cells are unoccupied cells, illustrated as blank cells, between the mobile device's present position (cell Pl) and the occupied cells.
[0033] The mobile device also identifies frontier cells in the environment. The frontier cells are measured cells that are unoccupied and border at least one unmeasured cell (e.g., unmeasured cells U1-U4). In Figure 1A, the mobile device has identified sixteen frontier cells including four frontier cells Fl in a bounding volume Bl, four frontier cells F2 in a bounding volume B2, four frontier cells F3 in a bounding volume B3, and four frontier cells F4 in a bounding volume B4. For example, the mobile device identified the four frontier cells F3 based on being measured by the sensor, determined to be unoccupied cells, and determined to border at least one of the unmeasured cells Ul-4.
[0034] In some embodiments, the mobile device may determine that the frontier cell borders at least one of the unmeasured cells Ul-4 based on the mobile device determining that the frontier cells are unoccupied and determining that the unoccupied cell may be bordering an area that has not been measured.
[0035] Optionally, the mobile device may determine a group of frontier cells based on grouping frontier cells that are spaced apart by distances satisfying a grouping criterion. In some embodiments, the grouping criterion may be a threshold distance between frontier cells or may be a defined condition such as a frontier cell must border another frontier cell. For example, if the distance between a frontier cell and another frontier cell does not exceed a threshold distance (e.g., 1 meter) or a frontier cell borders another frontier cell, then the mobile device may group the frontier cell with the another frontier cell. For example, inFigure 1 A, the four frontier cells F3 border one another, which satisfies a grouping criterion to cause the mobile device to group the four frontier cells F3.
[0036] The mobile device may generate a bounding volume based on frontier cells or grouped frontier cells. For example, in Figure 1 A, the mobile device previously generated bounding volumes Bl -4 based on the frontier cells Fl -4 or the grouped frontier cells Fl -4, respectively. The bounding volume (e.g., B3) includes at least one unmeasured cell (e.g., Ul- 4) in the environment that borders the group of frontier cells (e.g., frontier cells F4). In Figure 1A, the bounding volume B3 includes unmeasured cells Ul-4 and more unmeasured cells depicted by the open space within the bounding volume B3 that border the group of frontier cells F4.
[0037] Referring to Figure IB, the mobile device has moved (step 402) to cell P2, where one of the frontier cells F3 of Figure 1 A was located. The mobile device measures (steps 404, 502) distances from the sensor to objects located in the environment (e.g., measure in at least a portion of bounding volume B3) based on data from the sensor.
[0038] In some embodiments, the mobile device identifies (steps 406, 504) frontier cells in the bounding volume of the environment, where the frontier cells are measured cells that are unoccupied and border at least one unmeasured cell. For example, in Figure IB, the mobile device identifies frontier cells F5 in the bounding volume B3 of the environment that border unmeasured cells U5-U9.
[0039] Optionally, the mobile device may determine (step 408) a group of frontier cells based on grouping frontier cells that are spaced apart by distances satisfying the grouping criterion. In some embodiments, the grouping criterion may be a threshold (e.g., a distance between frontier cells) or may be a condition (e.g., frontier cell that borders another frontier cell). For example, in Figure IB, the five frontier cells F5 that border one another may be grouped together.
[0040] In some embodiments, the mobile device may, for a group of the frontier cells in the environment, perform (step 506) an operation to generate (steps 410, 508) a new bounding volume. The new bounding volume may overlap a portion of the bounding volume and include at least one additional unmeasured cell in the environment. For example, in Figure IB, the mobile device may, for the group of frontier cells F5 in the environment, perform the operation to generate a new bounding volume B5, where the new bounding volume B5 overlaps a portion of the bounding volume B3 and includes at least one additional unmeasured cell U10 in the environment.
[0041] In some embodiments, the mobile device may determine (steps 412, 512) a stopping criterion based on at least a relationship between sizes of the measured and unmeasured cells in the environment. The determined stopping criterion may be a new stopping criterion or an update to an existing stopping criterion. The relationship can be defined as a mathematical relationship, e.g., which configures the stopping criterion as a programmatically coded relationship between the sizes of the measured and unmeasured cells. In one embodiment, the determination (steps 412, 512) of the stopping criterion comprises computing a ratio of the size of the measured cells to the size of a combination of the measured and unmeasured cells in the environment.
[0042] In Figure IB, a value of the stopping criterion may be computed to indicate that 66.7% of bounding volume B3 has been covered (i.e., mapped / explored by the mobile device), 14.6% of B5 has been covered, and 16.7% of each of bounding volumes Bl, B2, and B4, have been covered. In another example, in Figure IB, a value of the stopping criterion may be computed to indicate that 20% of the environment has been covered by the mobile device.
[0043] In some embodiments, the stopping criterion is for the environment and is determined continuously as the mobile device measures the environment, is periodically determined based on determining whether a time limit has expired, or is determined after the mobile device generates or expands a bounding volume. For example, in Figure IB, a value of the stopping criterion may be computed to indicate that 20% of the environment has been covered by the mobile device.
[0044] In the embodiments when the determination (steps 412, 512) of the stopping criterion includes determining whether a time limit (e.g., timer) has expired, the duration of the time limit can be increased based on the size of the new bounding volume or increased based on increased size of the expanded bounding volume. Thus, when a new bounding volume is generated the time limit can be increased, e.g., proportionally increased, based on the size of the new bounding volume. Similarly, when the existing bounding volume is expanded the timer can be increased, e.g., proportionally increased, based on size of the expanded part of the existing bounding volume. The operations can stop generation of the map responsive to expiration of the time limit.
[0045] In some embodiments, after the bounding volume(s) are generated or expanded as described in the previous step(s), the stopping criterion is determined. Given the set of bounding volumes B = {B ^i , where Nb is the number of bounding volumes, the stoppingcriterion is determined such that the stopping criterion is that for each BiG , the covered volume of Bi is X% of the total volume of Bi. In these embodiments, the stopping criterion is determined for each bounding volume and the selectively stopping (steps 414, 416, 514, 516), discussed further below, is based on each bounding volume exceeding a threshold. In other embodiments, the stopping criterion is determined for the environment and the selectively stopping (steps 414, 416, 514, 516), discussed further below, is based on the determined stopping criterion for the environment exceeding a threshold.
[0046] In some embodiments, the mobile device may selectively stop (steps 414, 416, 514, 516) the map generation of the environment based on the determined stopping criterion being satisfied. In some embodiments, if the stopping criterion is not satisfied, the mobile device moves (step 402) to a new position in the environment and repeats at least the measuring (steps 404,502) distances from the sensor to objects, the identifying (steps 406,504) of frontier cells, the performing (step 506), the determining (steps 412,512), and the selectively stopping (steps 414,416,514,516). For example, in Figure IB, if a value (that indicates coverage of the bounding volume / environment) of the stopping criterion is determined to be 66.7% and a threshold of the stopping criterion is 60%, then the stopping criterion is satisfied and the mobile device would stop (step 516) the map generation of the environment. If the value of the stopping criterion is determined to be 66.7% and the threshold of the stopping criterion is 70%, then the stopping criterion is not satisfied and the mobile device would move (step 402) to a new position in the environment and repeat at least the measuring (steps 404,502) distances from the sensor to objects, the identifying (steps 406,504) of frontier cells, the performing (step 506), the determining (steps 412,512), and the selectively stopping (steps 414,416,514,516). In some embodiments, the value is computed as a ratio, discussed in more detail below.
[0047] In some embodiments, a bounding volume stopping criterion is determined for each bounding volume and the mobile device selectively stops the generation of the map of the environment or the bounding volume based on the determined bounding volume stopping criterion becoming satisfied. The bounding volume stopping criterion is based on at least a relationship between sizes of the measured and unmeasured cells in the bounding volume. In these embodiments the threshold is the same for all the bounding volumes. In some alternative embodiments, the threshold is different for each or at least two of the bounding volumes. The determination of the bounding volume stopping criterion may include computing a ratio of the size of the measured cells in the bounding volume to the size of a combination of the measured and unmeasured cells in the bounding volume.
[0048] In some embodiments, if the bounding volume stopping criterion is greater than a threshold, the mobile device moves to map a different bounding volume (e.g., a bounding volume that has a stopping criterion that does not satisfy a threshold), or if all bounding volumes have been mapped the mobile device stops mapping the environment.
[0049] The mobile device may generate a map based on the measured distances from the sensor to the objects in the environment.
[0050] In Figure 1C, all of bounding volume B3 have been measured. In this example, occupied cells (e.g., a wall or other object(s)) neighbour the unmeasured cells in bounding volume B5. This results in no frontier cells in bounding volume B5 and causes bounding volume B5 to be adjusted (e.g., decreased insize). In some embodiments, the bounding volume B5 may be adjusted such that the bounding volume stopping criterion for bounding volume B5 is satisfied, which causes the mobile device to stop mapping bounding volume B5. In this manner, adjustment of the bounding volume B5 and determining the bounding volume stopping criteria based thereon, causes the mobile device to stop mapping of the bounding volume which avoids further use of time and computational processing relating to mapping bounding volume B5.
[0051] Referring to Figure 2A, the mobile device has determined that the bounding volume stopping criteria for bounding volume B3 and / or bounding volume B5 is satisfied, and has moved to cell P3 which is located at one of the frontier cells F4 illustrated in Figure 1C.
[0052] The mobile device identifies (steps 406, 504) frontier cell F6 and frontier cells F7 in bounding volume B4.
[0053] Optionally, the mobile device determines (step 408) a group of frontier cells based on grouping frontier cells that are spaced apart by distances satisfying the grouping criterion. In this example, frontier cells F7 may be grouped together. Additionally, frontier cell F6 may be considered by the mobile device as a group and the mobile device may perform the generation (step 410, 508) of a new bounding volume and / or expanding (step 410 / 510) the bounding volume for the frontier cell F6, as discussed in more detail below.
[0054] Referring to Figure 2B, the mobile device may, for the group of frontier cells F7, operate to generate (steps 410, 508) a new bounding volume B7 and / or to expand (steps 410, 510) the bounding volume B4 to include at least one additional unmeasured cell (e.g., unmeasured cell U11) in the environment. The operation to generate (step 410, 508) a new bounding volume B7 may overlap a portion of bounding volume B4 and include at least one additional unmeasured cell (e.g., unmeasured cell U12) in the environment.
[0055] In another example, assuming that Nf new frontiers (e.g., frontier cell(s) or a group of frontier cell(s)) where identified, when the mobile device performs both an operation to generate (steps 410, 508) and to expand (steps 410,510), the mobile device may create at least Nb<Nf-l new bounding volumes (e.g., bounding volume B7), while it will expand at least one of the previous bounding volume (e.g., bounding volume B4). Assuming for simplicity that all Nf new frontiers are in one bounding volume (e.g., bounding volume B4), in this bounding volume, the operations may choose NeG { 1 , . . . ,Nf} frontiers around which the bounding volume will be expanded. Expanding the bounding volume adds a new unmeasured cell(s) around the Nefrontiers. These new unmeasured cell(s) may decrease the coverage of the bounding volume, which may cause the mobile device to prioritize exploring that bounding volume more and, therefore, also approach the area with the frontier cell (e.g., frontier cell F6).
[0056] In some embodiments, the operation to expand (steps 410,510) an existing bounding volume is performed responsive to a number of frontier cells in the group not exceeding a threshold. For example, in Figure 2B, the threshold may be two frontier cells and since the group of frontier cells F6 includes one frontier cell, the mobile device may expand (step 410,510) an existing bounding volume B4.
[0057] In some embodiments, for the remaining Nf-Nefrontier cell(s) or group of frontier cell(s), a new bounding volume is generated (steps 410, 508). For example, for the remaining frontier cells F7 a new bounding volume B7 is generated.
[0058] Alternatively, in some embodiments, the operation to generate (steps 410, 508) a new bounding volume (e.g., bounding volume B7) is performed responsive to a number of frontier cells in the group exceeding a threshold. For example, in Figure 2B, if the threshold was three frontier cells and the group of frontier cells F7 included five frontier cells, then the mobile device may generate a new bounding volume B7.
[0059] In some embodiments, the mobile device may determine (steps 412, 512) a stopping criterion based on at least a relationship between size of the measured and unmeasured cells in the environment. In one embodiment, the determination (steps 412, 512) of the stopping criterion comprises computing a ratio of the size of the measured cells to the size of a combination of the measured and unmeasured cells.
[0060] In some embodiments, the determination of the stopping criterion includes updating an existing stopping criterion based on the generation of a new bounding volume and / or expanding an existing bounding volume. For example, in Figure 2B, an existing value for thestopping criterion (for the environment or for bounding volume B4) may be at 66.7% and then is reduced from 66.7% to 60% due to the expansion of the bounding volume B4.
[0061] In some embodiments, the mobile device selectively stops (Steps 414, 416, 514, 516) the map generation of the environment based on the determined stopping criterion becoming satisfied.
[0062] In other embodiments, the mobile device selectively stops the map generation of the bounding volumes (e.g., new bounding volume B7 and / or expanded bounding volume B4) based on the determined bounding volume stopping criterion becoming satisfied. For example, the selectively stopping for the new bounding volume B7 may be based on the determined bounding volume stopping criterion for the new bounding volume B7, and the selectively stopping for the expanded bounding volume B4 may be based on the determined bounding volume stopping criterion for the expanded bounding volume B4.
[0063] For both the operation to generate (step 410, 508) and the operation to expand (steps 410, 510), the size of the bounding volumes to be added is determined based on various criteria. In some embodiments, size of the generated new bounding volume or the expanded bounding volume is determined based on a combined size of the frontier cells in the group.
[0064] In some embodiments, size of the generated new bounding volume or the expanded bounding volume is determined based on at least one of a speed of the mobile device or a range capability of the sensor. Basing the size of the bounding volume on the speed or distance sensing range capability may avoid having a bounding volume that is fully mapped too quickly by the mobile device. For example, the bounding volume size may be defined to be larger for a mobile device that has a higher speed and / or further distance sensing range capability of the sensor. In this example, if the mobile device is traveling at a first speed, the size of the generated new bounding volume may be a square with first length edges. In another example, if the mobile device is traveling at a second speed greater than the first speed, the size of the generated new bounding volume may be a square with second length edges which are proportionally larger than the first length edges based on the speed difference. While a square is described in this example, it should be noted that the bounding volume may be any shape. In preferred embodiments, the bounding volume is a rectangle.
[0065] It may be advantageous when determining size of expansion of the bounding volume to be sufficiently large that the mobile device does not measure the expanded bounding volume is less than a threshold time duration and / or utilizing less than a threshold amount of computational resources. In some embodiments, expanding a bounding volume proportional to the group of frontier cell size might not be the best option if it would result in only thesmallest group of frontier cells for the expansion. In some embodiments, the size of the expanded bounding volume is increased in unmeasured cells in a manner proportional to a number of measured cells in the bounding volume. For example, in Figure 2B, the expanded bounding volume B4 may be expanded based on a number of measured cells in the bounding volume B4.
[0066] In some embodiments, when multiple groups of frontier cell(s) are chosen for expansion, the mobile device may restrict the expansion of unmeasured cells to be not more than a defined proportion of the number of currently measured cells in the corresponding bounding volume, or each group of frontier cells of the bounding volume can be expanded by a number of cells that is proportional to the number of currently measured cells.
[0067] In some embodiments, the size of the generated new bounding volume or the expanded bounding volume is based on semantic information related to the group of frontier cells. For example, in Figure 3B, sizes of the generated new bounding volumes B1-B3 are determined based on semantic information related to the group of frontier cells. In Figures 3 A-3B, the mobile device is present in cell P4.
[0068] In some embodiments, the semantic information is determined based on at least one of: prior knowledge of unmeasured cells beyond the group of frontier cells, recognizing a spatial pattern of the frontier cells in the group, and proximity of the group of frontier cells to other frontier cells having a prior defined classification. In some embodiments, the mobile device may label frontier cells, or a group of frontier cells based on the semantic information.
[0069] In some embodiments, prior knowledge of unmeasured cells beyond the group of frontier cells may include a schematic plan or prior mapping of the environment that gives the mobile device information about the size of the area beyond the frontier cells. For example, in Figure 3B, a schematic plan or prior mapping may indicate to the mobile device that the frontier cells F3 lead to a corridor and may further indicate a size of the corridor (e.g., the three-dimensional volume of the corridor or the two-dimensional area of the corridor). The mobile device may determine semantic information based on prior knowledge, use the semantic information to generate a bounding volume B3 (Figure 3 A), use the semantic information to expand the bounding volume B3 (Figure 3B), and / or use the semantic information to label the group of frontier cells F3 as corridor 302A.
[0070] In some embodiments, recognizing a spatial pattern of the frontier cells in the group may include recognizing that frontier cells or a group of frontier cells of a certain size, position, and / or orientation, have resulted in spaces beyond the frontier cells having a certain size. For example, in Figure 3B, a group of frontier cells F2 having a certain size (e.g., threefrontier cells in space) may be recognized by the mobile device as a spatial pattern that results in the space beyond the frontier cells having a defined size of bounding volume B2 and which may correspond to a room. The mobile device may determine semantic information based on the recognized spatial pattern of the frontier cells F2, use the semantic information to generate a bounding volume B2 (Figure 3 A), use the semantic information to expand the bounding volume B2 (Figure 3B), and use the semantic information to label the group of frontier cells F2 as room 304.
[0071] In some embodiments, the mobile device may determine semantic information based on the proximity of the group of frontier cells to other frontier cells having a prior defined classification (e.g., room, doorway, corridor, closet, stairway, etc.). For example, if frontier cells Fl are proximately located to frontier cells F2 and F3 that have defined classifications (e.g., labelling) of room 304 and corridor 302 A, respectively, then the mobile device may determine semantic information based on the proximity of the frontier cells Fl to frontier cells F2 and F3. Therefore, based on frontier cells Fl being within a threshold distance of frontier cells F2 and F3, the mobile device may determine semantic information for frontier cells Fl, use the semantic information to generate a bounding volume Bl (Figure 3 A), use the semantic information to expand the bounding volume Bl (Figure 3B), and use the semantic information to label frontier cells Fl as corridor 302B (Figure 3B).
[0072] In some embodiments, the mobile device may merge the new bounding volume with the bounding volume or another bounding volume responsive to the new bounding volume overlapping with the bounding volume or another bounding volume by at least a threshold amount. Thus, for example, the mobile device may merge the new bounding volume with the bounding volume responsive to the new bounding volume overlapping with the bounding volume by at least a threshold amount. Similarly, the mobile device may merge the new bounding volume with another bounding volume responsive to the new bounding volume overlapping with the other bounding volume by at least a threshold amount.
[0073] In some embodiments, the mobile device may remove unmeasured cells, from the new bounding volume or the expanded bounding volume, that have not been measured within a threshold time, a threshold number of attempts, or are determined to be not measurable by the sensor. The determination of whether unmeasured cells cannot be measured by the sensor may be made by, for example, determining that the sensor is blocked from sensing objects within the unmeasured cells, such as by a wall that encloses the unmeasured cells creating a non-measurable volume therein.
[0074] For example, in Figure 3B, after the bounding volumes B1-B3 are generated or expanded, the bounding volumes with a large overlap could be merged and areas in the bounding volumes that are not reachable (e.g., negative space 300) may be counted as empty space (e.g., removed from the bounding volume). In some embodiments, for the merging the mobile device may use an Intersection over Union metric. In some embodiments, when this metric exceeds a threshold or otherwise satisfies a rule for two bounding volumes they are merged. By merging overlapping bounding volumes not only is the number of bounding volumes decreased but it may also benefit the operational maintenance of fewer small bounding volumes. In some embodiments, areas that are unreachable or unmeasurable (e.g., negative space 300) in a bounding volume are also counted as negative space such that it contributes negatively to the determined stopping criterion calculation for the bounding volume that the negative space is in. In some embodiments, an area may be counted as negative space if the mobile device has discovered occupied cells surrounding an area as shown Figure 3B. Removing the unmeasured cells may prevent the mobile device from exploring infinitely long in instances the bounding volume contains an unreachable / unmeasurable area such that the desired coverage or stopping criteria cannot be reached.
[0075] In some embodiments, the size of the generated new bounding volume or the expanded bounding volume may be based on the mathematical analysis discussed below.
[0076] The size of the generated new bounding volume or the expanded bounding volume may be the minimum number (amount) of unmeasured cells to be added to a bounding volume B during the generation or expansion step described above. The bounding volume may have a total of CT cells and out of these c0cells have been measured (observed), while CU=CT-CO cells are still unobserved. Let x— G [0,1] be the coverage, then the coverage after Cladding cnnew unobserved cells to the bounding volume is given byc° . For a desired cT+ cn minimum coverage of zG [0, x), we obtain that cn=y — cTnew cells need to be added to B. Therefore, one could fix that the desired coverage after expansion to z. However, this may require that z<x, which means that the expansion may not be possible if the current coverage of the bounding volume is below z. Accordingly, one option to design the expansion of a bounding volume is to only expand when then coverage is larger than x and if it is expanded in such a way that the coverage reduces to z.
[0077] In some embodiments, another option is to make the expansion proportional to either the number of measured or unmeasured cells. Here, it may be assumed that the amount ofnew unmeasured cells is proportional to the number of measured cells, that is, cn=yc0, where y>0. Note that this may be without loss of generality since y could be y=^-, where w>0. The co new stopping criterion is given by f(x)~c° , which is an increasing function in x and cT+cni+yx yx2decreasing in y. The difference in stopping criterion is g(x)=x-f(x)= . It may be shown1+yx that g(x)<min(x, y) for all y>0. Hence, the difference in coverage by expanding B with a fraction y of the observed cells may never exceed the coverage x before the expansion, nor the fraction y.
[0078] Figure 6 illustrates a block diagram of components of a system that are configured to operate in accordance with some embodiments of the present disclosure. Referring to Figure 6, a mobile device 110 includes at least one sensor 112 ("sensor"), at least one processor 114 ("processor"), at least one memory 116 ("memory") storing program code executable by the processor 114, and at least one wireless transceiver 118 ("wireless transceiver") to communicate with a radio access network 130 and other networks 132, e.g., public (e.g., Internet) and / or private networks and a computer program product (111) comprising a non-transitory computer readable medium storing program instructions executable by at least one processor to perform a method in accordance with one or more embodiments of the present disclosure. Sensor 112 may passively or actively sense distances to objects located in an environment, such as by analyzing camera images containing objects and / or by measuring time-of-flight for bouncing a laser (e.g., Lidar), RF signal (e.g., radar), and / or sound (e.g., ultrasonic sensor) off objects. The memory 116 may include a sensor measurement repository 105 operable to store sensor measurements, mapping code 106 operable to perform mapping operations, and stopping criterion code 107 operable to determine stopping criterion which are used to selectively stop mapping by the module 106. The program code 106-108 is executed by processor 114 to perform corresponding operations according to one or more of the embodiments disclosed herein. The memory may further include an exploration code 108 that is operable to control movement of the mobile device 110 to explore an environment using the map being generated.Further Definitions and Embodiments:
[0079] In the above description of various embodiments of present inventive concepts, it is to be understood that the terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of present inventive concepts. Unlessotherwise 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 present inventive concepts 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 this specification and the relevant art and will not be interpreted in an idealized or overly formal sense expressly so defined herein.
[0080] When an element is referred to as being "connected", "coupled", "responsive", or variants thereof to another element, it can be directly connected, coupled, or responsive to the other element or intervening elements may be present. In contrast, when an element is referred to as being "directly connected", "directly coupled", "directly responsive", or variants thereof to another element, there are no intervening elements present. Like numbers refer to like elements throughout. Furthermore, "coupled", "connected", "responsive", or variants thereof as used herein may include wirelessly coupled, connected, or responsive. As used herein, the singular forms "a", "an" and "the" are intended to include the plural forms as well, unless the context clearly indicates otherwise. Well-known functions or constructions may not be described in detail for brevity and / or clarity. The term "and / or" includes any and all combinations of one or more of the associated listed items.
[0081] It will be understood that although the terms first, second, third, etc. may be used herein to describe various elements / operations, these elements / operations should not be limited by these terms. These terms are only used to distinguish one element / operation from another element / operation. Thus, a first element / operation in some embodiments could be termed a second element / operation in other embodiments without departing from the teachings of present inventive concepts. The same reference numerals or the same reference designators denote the same or similar elements throughout the specification.
[0082] As used herein, the terms "comprise", "comprising", "comprises", "include", "including", "includes", "have", "has", "having", or variants thereof are open-ended, and include one or more stated features, integers, elements, steps, components or functions but does not preclude the presence or addition of one or more other features, integers, elements, steps, components, functions or groups thereof. Furthermore, as used herein, the common abbreviation "e.g.,", which derives from the Latin phrase "exempli gratia," may be used to introduce or specify a general example or examples of a previously mentioned item, and is not intended to be limiting of such item. The common abbreviation "i.e.,", which derives from the Latin phrase "id est," may be used to specify a particular item from a more general recitation.
[0083] Example embodiments are described herein with reference to block diagrams and / or flowchart illustrations of computer-implemented methods, apparatus (systems and / or devices) and / or computer program products. It is understood that a block of the block diagrams and / or flowchart illustrations, and combinations of blocks in the block diagrams and / or flowchart illustrations, can be implemented by computer program instructions that are performed by one or more computer circuits. These computer program instructions may be provided to a processor circuit of a general purpose computer circuit, special purpose computer circuit, and / or other programmable data processing circuit to produce a machine, such that the instructions, which execute via the processor of the computer and / or other programmable data processing apparatus, transform and control transistors, values stored in memory locations, and other hardware components within such circuitry to implement the functions / acts specified in the block diagrams and / or flowchart block or blocks, and thereby create means (functionality) and / or structure for implementing the functions / acts specified in the block diagrams and / or flowchart block(s).
[0084] These computer program instructions may also be stored in a tangible computer- readable medium that can direct a computer or other programmable data processing apparatus to function in a particular manner, such that the instructions stored in the computer-readable medium produce an article of manufacture including instructions which implement the functions / acts specified in the block diagrams and / or flowchart block or blocks. Accordingly, embodiments of present inventive concepts may be embodied in hardware and / or in software (including firmware, resident software, micro-code, etc.) that runs on a processor such as a digital signal processor, which may collectively be referred to as "circuitry," "a module" or variants thereof.
[0085] It should also be noted that in some alternate implementations, the functions / acts noted in the blocks may occur out of the order noted in the flowcharts. For example, two blocks shown in succession may in fact be executed substantially concurrently or the blocks may sometimes be executed in the reverse order, depending upon the functionality / acts involved. Moreover, the functionality of a given block of the flowcharts and / or block diagrams may be separated into multiple blocks and / or the functionality of two or more blocks of the flowcharts and / or block diagrams may be at least partially integrated. Finally, other blocks may be added / inserted between the blocks that are illustrated, and / or blocks / operations may be omitted without departing from the scope of inventive concepts. Moreover, although some of the diagrams include arrows on communication paths to show aprimary direction of communication, it is to be understood that communication may occur in the opposite direction to the depicted arrows.
[0086] Many variations and modifications can be made to the embodiments without substantially departing from the principles of the present inventive concepts. All such variations and modifications are intended to be included herein within the scope of present inventive concepts. Accordingly, the above disclosed subject matter is to be considered illustrative, and not restrictive, and the appended examples of embodiments are intended to cover all such modifications, enhancements, and other embodiments, which fall within the spirit and scope of present inventive concepts. Thus, to the maximum extent allowed by law, the scope of present inventive concepts is to be determined by the broadest permissible interpretation of the present disclosure including the following examples of embodiments and their equivalents, and shall not be restricted or limited by the foregoing detailed description.
[0087] The following listing of documents are referenced herein by their bracketed number:[1] Placed, J. A., Strader, J., Carrillo, H., Atanasov, N., Indelman, V., Carlone, L. and Castellanos, J. A., 2022. A survey on active simultaneous localization and mapping: State of the art and new frontiers. arXiv preprint arXiv:2207.00254.[2] Placed, J. A. and Castellanos, J.A., 2022. Enough is Enough: Towards Autonomous Uncertainty-driven Stopping Criteria. arXiv preprint arXiv: 2204.10631.[3] Pimentel, J.M., Alvim, M.S., Campos, M.F. and Macharet, D.G., 2018. Information-driven rapidly-exploring random tree for efficient environment exploration. Journal of Intelligent & Robotic Systems, 91(2), pp.313-331.
Claims
CLAIMS:
1. A method of stopping generation of a map of an environment being sensed by a sensor transported by a mobile device, the method comprising: measuring (404,502) distances from the sensor to objects located in the environment based on data from the sensor, wherein the environment comprises measured cells and unmeasured cells within bounding volumes of the environment; identifying (406,504) frontier cells in a bounding volume of the environment, wherein the frontier cells are measured cells that are unoccupied and border at least one unmeasured cell; for a group of the frontier cells in the environment, performing (506) at least one of: generating (410,508) a new bounding volume, wherein the new bounding volume overlaps a portion of the bounding volume and includes at least one additional unmeasured cell in the environment; and expanding (410,510) the bounding volume to include at least one additional unmeasured cell in the environment; wherein the bounding volume contains the at least one unmeasured cell in the environment that is bordering the group of the frontier cells; determining (412,512) a stopping criterion based on at least a relationship between sizes of the measured and unmeasured cells; and selectively stopping (414, 416, 514, 516) the generation of the map of the environment based on the determined stopping criterion becoming satisfied.
2. The method of Claim 1, wherein the determining (412, 512) of the stopping criterion comprises computing a ratio of the size of the measured cells to the sizeof a combination of the measured and unmeasured cells.
3. The method of any of Claims 1 to 2, wherein the determining (412, 512) of the stopping criterion comprises determining whether a time limit has expired, wherein duration of the time limit is increased based on a size of the new bounding volume or increased based on increased size of the expanded bounding volume.
4. The method of any of Claims 1 to 3, wherein the method of selectively stopping generation of the map, comprises: wherein if the stopping criterion is not satisfied, moving (402) the mobile device to a new position in the environment, and repeating the measuring (404,502) distances from the sensor to objects, the identifying (406,504) of frontier cells, the performing (506), the determining (412,512), and the selectively stopping (414,416,514,516).
5. The method of any of Claims 1 to 4, wherein the method of generation of the map, comprises: generating the map based on the measured distances from the sensor to the objects in the environment.
6. The method of any of Claims 1 to 5, comprising: determining (408) the group of frontier cells based on grouping frontier cells that are spaced apart by distances satisfying a grouping criterion.
7. The method of any of Claims 1 to 6, wherein the generating (410,508) a new bounding volume is performed responsive to a number of frontier cells in the group exceeding a threshold.
8. The method of any of Claims 1 to 7, wherein the expanding (410,510) the bounding volume is performed responsive to a number of frontier cells in the group not exceeding a threshold.
9. The method of any of Claims 1 to 8, wherein a size of the generated new bounding volume or the expanded bounding volume is controlled based on a combined size of frontier cells in the group.
10. The method of any of Claims 1 to 9, wherein a size of the generated new bounding volume or the expanded bounding volume is controlled based on at least one of a speed of the mobile device or a distance sensing range capability of the sensor.
11. The method of any of Claims 1 to 9, wherein a size of the generated new bounding volume or the expanded bounding volume is controlled based on semantic information related to the group of the frontier cells.
12. The method of Claim 11, wherein the semantic information is determined based on at least one of: prior knowledge of unmeasured cells beyond the group of frontier cells, recognizing a spatial pattern of the frontier cells in the group, and proximity of the group of frontier cells to other frontier cells having a prior defined classification.
13. The method of any of Claims 1 to 12, wherein the method of selectively stopping generation of the map, comprises: merging the new bounding volume with the bounding volume or another bounding volume responsive to the new bounding volume overlapping with the bounding volume or the another bounding volume by at least a threshold amount.
14. The method of any of Claims 1 to 13, wherein the method of selective stopping generation of the map, comprises: removing unmeasured cells, from the new bounding volume or the expanded bounding volume, that have not been measured within a threshold time, a threshold number of attempts, or are determined to be not measurable by the sensor.
15. A computer program product (111) comprising a non-transitory computer readable medium storing program instructions executable by at least one processor to perform the method of any of Claims 1 to 14.
16. A mobile device (110) comprising: at least one processor (114); and at least one memory (116) storing instruction executable by the at least one processor (114) to perform operations comprising to: measure distances from a sensor, transported by the mobile device (110), to objects located in an environment based on data from the sensor, wherein the environment comprises measured cells and unmeasured cells within bounding volumes of the environment; identify frontier cells in a bounding volume of the environment, wherein the frontier cells are measured cells that are unoccupied and border at least one unmeasured cell; andfor a group of the frontier cells in the environment, perform at least one of: generate a new bounding volume, wherein the new bounding volume overlaps a portion of the bounding volume and includes at least one additional unmeasured cell in the environment; and expand the bounding volume to include at least one additional unmeasured cell in the environment; wherein the bounding volume contains the at least one unmeasured cell in the environment that is bordering the group of the frontier cells; determine a stopping criterion based on at least a relationship between sizes of the measured and unmeasured cells; and selectively stop generation of a map of the environment based on the determined stopping criterion becoming satisfied.
17. The mobile device (110) of Claim 16, wherein the determination of the stopping criterion comprises computing a ratio of the size of the measured cells to the size of a combination of the measured and unmeasured cells.
18. The mobile device (110) of any of Claims 16 to 17, wherein the operations to determine the stopping criterion comprise to determine whether a time limit has expired, wherein duration of the time limit is increased based on a size of the new bounding volume or increased based on increased size of the expanded bounding volume.
19. The mobile device (110) of any of Claims 16 to 18, wherein the operations to selectively stop generation of a map, comprises to: wherein if the stopping criterion is not satisfied, move the mobile device to a new position in the environment, and repeat the measuring distances from the sensor to objects, the identifying of frontier cells, the performing, the determining, and the selectively stopping.
20. The mobile device (110) of any of Claims 16 to 19, wherein the at least one processor (114) is further operable to: generate the map based on the measured distances from the sensor to the objects in the environment.
21. The mobile device (110) of any of Claims 16 to 20, wherein the operations to selectively stop generation of the map, comprise to: determine the group of frontier cells based on grouping frontier cells that are spaced apart by distances satisfying a grouping criterion.
22. The mobile device (110) of any of Claims 16 to 21, wherein the generation of a new bounding volume is performed responsive to a number of frontier cells in the group exceeding a threshold.
23. The mobile device (110) of any of Claims 16 to 22, wherein the expansion of an existing bounding volume is performed responsive to a number of frontier cells in the group not exceeding a threshold.
24. The mobile device (110) of any of Claims 16 to 23, wherein a size of the generated new bounding volume or the expanded bounding volume is controlled based on combined size of frontier cells in the group.
25. The mobile device (110) of any of Claims 16 to 23, wherein a size of the generated new bounding volume or the expanded bounding volume is controlled based on at least one of a speed of the mobile device or a distance sensing range capability of the sensor.
26. The mobile device (110) of any of Claims 16 to 25, wherein a size of the generated new bounding volume or the expanded bounding volume is controlled based on semantic information related to the group of frontier cells.
27. The mobile device (110) of Claim 26, wherein the semantic information is determined based on at least one of: prior knowledge of unmeasured cells beyond the group of frontier cells, recognizing a spatial pattern of the frontier cells in the group, and proximity of the group of frontier cells to other frontier cells having a prior defined classification.
28. The mobile device (110) of any of Claims 16 to 27, wherein the operations to selectively stop the generation of the map, comprises to:merge the new bounding volume with the bounding volume or another bounding volume responsive to the new bounding volume overlapping with the bounding volume or the another bounding volume by at least a threshold amount.
29. The mobile device (110) of any of Claims 16 to 28, wherein the operations to selectively stop the generation of the map, comprises to: remove unmeasured cells, from the new bounding volume or the expanded bounding volume, that have not been measured within a threshold time, a threshold number of attempts, or are determined to be not measurable by the sensor.
30. A computer program product (111) comprising a non-transitory computer readable medium storing program instructions executable by at least one processor to perform operations comprising to: measure distances from a sensor, transported by the mobile device, to objects located in an environment based on data from the sensor, wherein the environment comprises measured cells and unmeasured cells within the bounding volumes of the environment; identify frontier cells in a bounding volume of the environment, wherein the frontier cells are measured cells that are unoccupied and border at least one unmeasured cell; and for a group of the frontier cells in the environment, perform at least one of: generate a new bounding volume, wherein the new bounding volume overlaps a portion of the bounding volume and includes at least one additional unmeasured cell in the environment; and expand the bounding volume to include at least one additional unmeasured cell in the environment; wherein the bounding volume contains the at least one unmeasured cell in the environment that is bordering the group of the frontier cells; determine a stopping criterion based on at least a relationship between sizes of the measured and unmeasured cells; and selectively stop generation of a map of the environment based on the determined stopping criterion becoming satisfied.
Citation Information
Patent Citations
Robot mapping method, system, device and equipment and storage medium
CN114608552A
Method and apparatus for performing grid-based localization of a mobile body
EP3926434A1
Autonomous moving apparatus
US20100049391A1
System and Method for Complete Coverage of Unknown Environments
US20190354106A1
Method and apparatus for simultaneous localization and mapping of mobile robot environment
WO2011026119A2
