Mobile device control with grid map occupancy determination
In a grid map, an occupancy region defined by a first contour representing a set of first points and a second contour representing a set of second points is generated. The set of first points is determined for respective rays extending from a source by determining a first point at which the respective ray intersects a distal boundary of the grid map or a proximal boundary of an occupied grid cell. The set of second points is determined for respective rays extending from the source by determining a second point at which the respective ray intersects the distal boundary of the grid map or a distal boundary of the occupied grid cell.
1 . A system, comprising a computer including a processor and a memory, the memory storing instructions executable by the processor to:
generate, in a grid map, an occupancy region defined by a first contour representing a set of first points and a second contour representing a set of second points, wherein the sets of first and second points are determined for respective rays extending from a source by:
determining a number of occupied grid cells that the respective ray intersects, wherein the number is zero, one, or more than one, wherein:
when the respective ray intersects zero occupied grid cells, then determining a point at which the respective ray intersects a distal boundary of the grid map; and
when the respective ray intersects one or more occupied grid cells, then determining a first point at which the respective ray intersects a proximal boundary of an occupied grid cell, and determining a second point at which the respective ray intersects the distal boundary of the grid map or a distal boundary of the occupied grid cell; and
control a vehicle based on the occupancy region.
2 . The system of claim 1 , wherein the instructions further include instructions to generate an occupancy interval extending along the respective ray from the first contour to the second contour, the respective occupancy intervals defining respective radial positions of the occupancy region relative to the source.
3 . The system of claim 2 , wherein the grid map includes a plurality of grid cells specifying a probability of the respective grid cell being occupied by an object and a velocity of the object.
4 . The system of claim 3 , wherein the respective occupancy intervals include an estimated occupancy based on statistical aggregation of the probabilities specified by the grid cells include in the respective occupancy interval.
5 . The system of claim 3 , wherein the respective occupancy intervals include a first velocity corresponding to the velocity of the grid cell intersected by the first contour and a second velocity corresponding to the velocity of the grid cell intersected by the second contour.
6 . The system of claim 5 , wherein the respective occupancy intervals include a velocity error determined based on a statistical aggregation of the first velocity and the second velocity.
7 . The system of claim 1 , wherein, when the first point is determined at which the respective ray intersects the boundary of the grid map, the second point is a same point as the first point.
8 . The system of claim 1 , wherein the first contour is represented by a first best fit line interpolated from the set of first points, and the second contour is represented by a second best fit interpolated from the set of second points.
9 . A method comprising:
generating, in a grid map, an occupancy region defined by a first contour representing a set of first points and a second contour representing a set of second points, wherein the sets of first and second points are determined for respective rays extending from a source by:
determining a number of occupied grid cells that the respective ray intersects, wherein the number is zero, one, or more than one, wherein:
when the respective ray intersects zero occupied grid cells, then determining a point at which the respective ray intersects a distal boundary of the grid map; and
when the respective ray intersects one or more occupied grid cells, then determining a first point at which the respective ray intersects a proximal boundary of an occupied grid cell, and determining a second point at which the respective ray intersects the distal boundary of the grid map or a distal boundary of the occupied grid cell; and
controlling a vehicle based on the occupancy region.
10 . The method of claim 9 , further comprising determining an occupancy interval extending along the respective ray from the first contour to the second contour, the respective occupancy intervals defining respective radial positions of the occupancy region relative to the sensor.
11 . The method of claim 10 , wherein the grid map includes a plurality of grid cells specifying a probability of the respective grid cell being occupied by an object and a velocity of the object.
12 . The method of claim 11 , wherein the respective occupancy intervals include an estimated occupancy based on statistical aggregation of the probabilities specified by the grid cells include in the respective occupancy interval.
13 . The method of claim 11 , wherein the respective occupancy intervals include a first velocity corresponding to the velocity of the grid cell intersected by the first contour and a second velocity corresponding to the velocity of the grid cell intersected by the second contour.
14 . The method of claim 13 , wherein the respective occupancy intervals include a velocity error determined based on a statistical aggregation of the first velocity and the second velocity.
15 . The method of claim 9 , wherein, when the first point is determined at which the respective ray intersects the boundary of the grid map, the second point is a same point as the first point.
16 . The method of claim 9 , wherein the first contour is represented by a first best fit line interpolated from the set of first points, and the second contour is represented by a second best fit interpolated from the set of second points.