This description relates to identifying stopping places for an autonomous vehicle.
As shown in
The autonomous driving capability of an AV typically is supported by an array of technology 18, 20 including hardware, software, and stored and real time data that we together sometimes refer to as an AV system 22. Some or all of the technology is onboard the AV and some of the technology may be at a server, for example, in the cloud. Most AV systems include some or all of the following basic components:
1. Sensors 24 able to measure or infer or both properties of the AV's state and condition, such as the vehicle's position, linear and angular velocity and acceleration, and heading (i.e., orientation of the leading end of the AV). Such sensors include but are not limited to, e.g., GPS, inertial measurement units that measure both vehicle linear accelerations and angular rates, individual wheel speed sensors and derived estimates of individual wheel slip ratios, individual wheel brake pressure or braking torque sensors, engine torque or individual wheel torque sensors, and steering wheel angle and angular rate sensors.
2. Sensors 26 able to measure properties of the vehicle's surroundings. Such sensors include but are not limited to, e.g., LIDAR, RADAR, monocular or stereo video cameras in the visible light, infrared, or thermal spectra, ultrasonic sensors, time-of-flight (TOF) depth sensors, as well as temperature and rain sensors.
3. Devices 28 able to communicate the measured or inferred or both properties of other vehicles' states and conditions, such as other vehicles' positions, linear and angular velocities, and accelerations, and headings. These devices include Vehicle-to-Vehicle (V2) and Vehicle-to-Infrastructure (V2I) communication devices, and devices for wireless communications over point-to-point or ad-hoc networks or both. The devices can operate across the electromagnetic spectrum (including radio and optical communications) or other media (e.g., acoustic communications).
4. Data sources 30 providing historical, real-time, or predictive information or combinations of them about the local environment, including traffic congestion updates and weather conditions. Such data may be stored on a memory storage unit 32 on the vehicle or transmitted to the vehicle by wireless communication from a remotely located database 34.
5. Data sources 36 providing digital road map data drawn from GIS databases, potentially including high-precision maps of the roadway geometric properties, maps describing road network connectivity properties, maps describing roadway physical properties (such as the number of vehicular and cyclist travel lanes, lane width, lane traffic direction, lane marker type and location), and maps describing the spatial locations of road features such as crosswalks, traffic signs of various types (e.g., stop, yield), and traffic signals of various types (e.g., red-yellow-green indicators, flashing yellow or red indicators, right or left turn arrows). Such data may be stored on a memory storage unit on the AV or transmitted to the AV by wireless communication from a remotely located database.
6. Data sources 38 providing historical information about driving properties (e.g., typical speed and acceleration profiles) of vehicles that have previously traveled along the local road section at a similar time of day. Such data may be stored on a memory storage unit on the AV or transmitted to the AV by wireless communication from a remotely located database.
7. A computer system 40 located on the AV that is capable of executing algorithms (e.g., processes 42) for the on-line (that is, real-time on board) generation of control actions based on both real-time sensor data and prior information, allowing an AV to execute its autonomous driving capability.
8. A display device 44 that is connected to the computer system to provide information and alerts of various types to occupants of the AV.
9. A wireless communication device 46 to transmit data from a remotely located database 34 to the AV and to transmit vehicle sensor data or data related to driver performance to a remotely located database 34.
10. Functional devices and features 48 of the AV that are instrumented to receive and act on commands for driving (e.g., steering, acceleration, deceleration, gear selection) and for auxiliary functions (e.g., turn indicator activation) from the computer system.
11. A memory 32.
In general, in an aspect, a vehicle is caused to drive autonomously through a road network toward a defined goal position. Current information is analyzed about potential stopping places in the vicinity of the goal position, to make a choice of a currently selected stopping place that is acceptable and feasible. The vehicle is caused to drive autonomously toward the currently selected stopping place. The activities are repeated until the vehicle stops at a currently selected stopping place.
Implementations may include one or a combination of two or more of the following features. The analyzing of current information includes analyzing a combination of static information that is known prior to the vehicle beginning to drive autonomously through the road network and information that is obtained during the autonomous driving. The analyzing of current information about potential stopping places includes continuously analyzing information from sensors on the vehicle or information from one or more other sources or both. The analyzing of current information about potential stopping places includes applying a predefined strategy for choosing a currently selected stopping place. The strategy includes stopping at the first feasible stopping place in the vicinity of the goal position. The strategy includes stopping at the most desirable among the currently feasible stopping places in the vicinity of the goal position. The strategy includes, if the vehicle has not stopped at a currently selected stopping place within a specified period of time, stopping at the first available stopping place in the vicinity of the goal position. The strategy includes trading off between choosing a best possible stopping place and a cost incurred in continuing to analyze current information to make a choice. If the vehicle has not stopped at a currently selected stopping place, the activities are repeated using a relaxed threshold for acceptability, a relaxed threshold for feasibility, or both. If the vehicle has not stopped at a currently selected stopping place that is acceptable and feasible, the activities are repeated based on a redefined goal position. If the vehicle has not stopped at a currently selected stopping place, the activities are repeated based on an expanded vicinity of the goal position. If the vehicle has not stopped at a currently selected stopping place, the activities are repeated during an extended period of time beyond the specified amount of time. If the vehicle has not stopped at a currently selected stopping place, the vehicle is enabled to be controlled from a remote location. If the vehicle has not stopped at a currently selected stopping place, the stop is aborted. If the vehicle has not stopped at a currently selected stopping place, a threshold for acceptability is relaxed, the goal position is redefined, or the stop is aborted the stop, based on information provided by a passenger. If the vehicle has not stopped at a currently selected stopping place, a threshold for acceptability is automatically relaxed, the goal position is automatically redefined, or the stop is automatically aborting. The analyzing of current information includes analyzing map data about the road network. The analyzing of current information includes analyzing information about features in the vicinity of the goal position as perceived by sensors. The sensors are on the vehicle. The analyzing of current information includes analyzing distances of respective stopping places from the goal position. The analyzing of current information includes analyzing information about respective positions of the vehicle at the potential stopping places. The analyzing of current information includes analyzing information about whether the vehicle can legally stop at the potential stopping places. The analyzing of current information includes analyzing relative desirability of potential stopping places. The analyzing relative desirability of potential stopping places includes applying a statistical model to predict an expected feasibility state of a stopping place based on historical statistics of level of demand for parking and current traffic volumes. The analyzing of current information includes identifying a set of potential stopping places that are within a proximity region in the vicinity of the goal position. The analyzing of current information includes removing potential stopping places from the set that are not feasible stopping places for the vehicle. If no potential stopping places remain after the removing, the proximity region is enlarged. There may be no stopping place that is currently acceptable. Current information is analyzed about additional potential stopping places in the vicinity of the goal position to make a choice of a currently selected stopping place that is acceptable and feasible. The additional potential stopping places lie within a larger vicinity of the goal position. The larger vicinity is determined based on information provided by a passenger of the vehicle. The larger vicinity is determined automatically based on pre-specified rules. The size of the larger vicinity is less than a predetermined upper limit.
In general, in an aspect, and autonomous vehicle includes steering, acceleration, and deceleration devices that respond to signals from an autonomous driving control system to drive the vehicle autonomously on a specified route through a road network defined by map data and toward a specified goal position. Sensors on the vehicle perceive characteristics of potential stopping places in the vicinity of the goal position. A communication feature sends the currently perceived characteristics to the autonomous driving control system and receives from the autonomous driving control system current information indicative of commands for the steering, acceleration, and deceleration devices to cause the vehicle to drive to and stop at a currently selected stopping place.
Implementations may include one or a combination of two or more of the following features. The autonomous driving control system includes elements onboard the vehicle. The autonomous driving control system includes elements remote from the vehicle. The sensors on the vehicle include video capture, LIDAR, or RADAR devices. The current information received from the autonomous driving control system includes a continuously updated choice of a selected stopping place.
In general, in an aspect, a planning process is associated with an autonomous vehicle. The planning process has inputs including static map data and dynamic data from sensors on the autonomous vehicle and outputs including a route to be driven through a road network to reach a goal position, a continually updated choice of a currently selected stopping place in the vicinity of the goal position, and a trajectory to be executed through a road network to reach the currently selected stopping place. A communication element communicates information about the updated choice of a currently selected stopping place to a device of a passenger, receives from the device of the passenger information about the goal position, and delivers the information to the planning process as an input.
Implementations may include one or a combination of two or more of the following features. The currently selected stopping place is updated based on non-feasibility of a currently selected stopping place. The planning process updates the selection of a stopping place based on the information from the device of the passenger about the stopping place. The communication element communicates to the device of the passenger that the planning process has selected a stopping place. The information received from the device of the passenger includes an indication that a stopping place farther from the goal position would be acceptable. The information received from the device of the passenger includes an indication of a maximum acceptable distance. The information received from the device of the passenger includes an indication of a new goal position to be considered by the planning process. The information received from the device of the passenger includes an indication that further time spent searching for an acceptable stopping place would be acceptable to the passenger.
In general, in an aspect, stored data is maintained indicative of potential stopping places that are currently feasible stopping places for a vehicle within a region. The potential stopping places are identified as part of static map data for the region. Current signals are received from sensors or one or more other sources current signals representing perceptions of actual conditions at one or more of the potential stopping places. The stored data is updated based on changes in the perceptions of actual conditions. The updated stored data is exposed to a process that selects a stopping place for the vehicle from among the currently feasible stopping places.
Implementations may include one or a combination of two or more of the following features. The potential stopping places are initialized as all of the potential stopping places identified as part of the static map data for the region. The potential stopping places are discretized as a finite number of points within the region corresponding to potential stopping places. A potential stopping place is defined as a shape containing one of the points, the shape corresponding to a footprint of the vehicle. An orientation is attributed to the shape, the orientation corresponding to a direction of traffic flow. The potential stopping places are initialized as potential stopping places expected to be feasible based on prior signals from sensors representing perceptions of actual conditions at one or more of the potential stopping places. The sensors include sensors located on the vehicle.
The sensors include sensors located other than on the vehicle. Information is included in the updated stored data about how recently the updating occurred, or the reason for the indication that a potential stopping place is feasible or not feasible. The current signals received from sensors are received through V2V or V2I communication. The one or more other sources include crowd-sourced data sources. The vehicle is part of a fleet of vehicles managed from a central server and the method includes the server distributing information received from sensors at one of the vehicles to other vehicles of the fleet.
In general, in an aspect, a vehicle is caused to drive autonomously through a road network toward a defined goal position, and, if no potential stopping place that is in the vicinity of the goal position and is acceptable and feasible can be identified, a human operator not onboard the vehicle is enabled to drive the vehicle to a stopping place.
Implementations may include one or a combination of two or more of the following features. information is provided for presenting to the human operator a view associated with a state of the vehicle. The human operator is enabled to provide inputs to the steering, throttle, brake, or other actuators of the vehicle. The human operator is enabled to directly control a trajectory planning process for the vehicle by manually selecting a goal position for the vehicle or influencing the planned trajectory to the goal position. A passenger in the vehicle is informed or consent by a passenger in the vehicle is requested for the human operator to drive the vehicle to the stopping place.
In general, in an aspect, a vehicle is caused to drive autonomously through a road network toward a defined goal position at which a stopped activity is to occur. A set of acceptable stopping places is identified in the vicinity of the goal position. The identifying of the set includes: identifying a proximity region in the vicinity of the goal position, identifying a goal region within the proximity region, discretizing the goal region to identify acceptable stopping places given characteristics of the vehicle and of the stopped activity analyzing current information about potential stopping places in the goal region in the vicinity of the goal position to make a choice of a currently selected stopping place that is acceptable and feasible. Current information is analyzed about the potential stopping places, to make a choice of a currently selected stopping place that is acceptable and feasible the vehicle is caused to drive autonomously toward the currently selected stopping place. The activities are repeated until the vehicle stops at a currently selected stopping place.
Implementations may include one or a combination of two or more of the following features. The analyzing of current information includes analyzing a combination of static information that is known prior to the vehicle beginning to drive autonomously through the road network and information that is obtained during the autonomous driving. The analyzing of current information about potential stopping places includes continuously analyzing information from sensors on the vehicle or information from one or more other sources or both. If the vehicle has not stopped at a currently selected stopping place that is acceptable and feasible within a specified amount of time and within specified thresholds for acceptability and feasibility, activities are repeated using a relaxed threshold for acceptability, a relaxed threshold for feasibility, or both. The analyzing of current information includes analyzing map data about the road network. The analyzing of current information includes analyzing information about features in the vicinity of the goal position as perceived by sensors. The analyzing of current information includes analyzing distance of respective stopping places from the goal position. The analyzing of current information includes analyzing information about respective positions of the vehicle at the potential stopping places. The analyzing of current information includes analyzing information about whether the vehicle can legally stop at the potential stopping places. The analyzing of current information includes analyzing relative desirability of potential stopping places. The analyzing of current information includes identifying a set of potential stopping places that are within a proximity region in the vicinity of the goal position. The analyzing of current information includes removing potential stopping places from the set that are not feasible stopping places for the vehicle.
These and other aspects, features, implementations, and advantages, and combinations of them, can be expressed as methods, systems, components, apparatus, program products, methods of doing business, means and steps for performing functions, and in other ways.
Other aspects, features, implementations, and advantages will become apparent from the following description and from the claims.
The use of the following terms in this description are intended broadly and meant to include, for example, what is recited after each of the terms.
Annotated map data—conventional road network map data used, for example, for autonomous driving systems that has been augmented with data associated with potential stopping places. Conventional road network map data can include some or all of the data mentioned in item 5. under the Background heading above.
Autonomous vehicle (AV)—a vehicle that has autonomous driving capability.
Autonomous driving capability—an ability to safely and reliably drive through a road environment to a goal position while avoiding vehicles, pedestrians, cyclists, and other obstacles and obeying the rules of the road.
Coordinates—geographic longitude and latitude.
Acceptable—satisfies one or more criteria for evaluating the appropriateness of a stopping place as a place where, for example, the pick up or drop-off or other stopped activity can be done safely or legally or conveniently or expeditiously, among other criteria.
Stop—come to a halt for a limited period of time with the intention of completing a stopped activity.
Stopped activity—an action that may occur at a stopping place (other than, for example, a stop made in the course of driving such as at a stop sign or a traffic light), such as picking up or dropping off a passenger or parcel, or other action.
AV system—a set of elements or components or processes located on an autonomous vehicle or at other locations, or a combination of them, and that together do the things that must be done in order to enable an autonomous vehicle to operate.
Passenger—a human being who is to be picked up or dropped off at a stopping place by an autonomous vehicle and (for convenience and simplicity in the prose) a human being who wants to have a parcel picked up or dropped off by an autonomous vehicle.
Stopping place—an area that the vehicle occupies (identified by a defined shape, typically a rectangle, at a defined location in the world) and a direction in which a vehicle is facing when stopped at the stopping place.
Acceptable stopping place—a stopping place that is acceptable because it is safe, legal, and convenient for the passenger.
Potential stopping place—a stopping place that is under consideration by an AV system.
Feasible stopping place—a stopping place that is possible for the AV to reach and stop at.
Currently selected stopping place—a stopping place that is currently selected by an AV system.
Actual stopping place—a stopping place where an AV actually stops.
Availability layer—a layer of annotated road data that identifies potential stopping places included in the road data.
Goal position—a position that is an intended destination, is identified by coordinates on a road network, and has been specified by a passenger or an element of an AV system.
Proximity region—a region defined around or in the vicinity of the goal position and entirely within a fixed configurable distance of a point within the region (e.g., its center). The proximity region need not be round because the distance metric employed in calculation of the region may be defined in a non-Euclidean metric space.
Goal region—a region defined around or in the vicinity of the goal position such that any stopping place within the goal region is an acceptable stopping place for the AV.
Sub-region—a portion of a region.
As shown in
At least the following complexities must be taken into account in determining and updating a selected stopping place:
1. The AV's goal position is often specified directly as geographic coordinates (latitude and longitude) or indirectly by an address or some other form of identifier that can be translated into geographic coordinates. Sometimes the goal position is specified by a passenger who wants to be picked up or dropped off by the AV roughly at that position, or by a user who wants to load a parcel onto the AV at that position for delivery to another location, or unload a parcel. For simplicity we use the word passenger to refer not only to a human rider but also to a user who is to load or unload a parcel even though that user may not be a rider in the AV.
As shown in
2. Even when the specified goal position is on a road or other drivable feature, the coordinates may correspond to a location on the road that is not an acceptable stopping place (e.g., because it is not a safe or legal stopping place), such as a stopping place in the middle of the road or at the side of a busy highway. We use the term “acceptable” broadly to refer to satisfying one or more criteria for evaluating the appropriateness of a stopping place as a place where, for example, the pick up or drop-off or other stopped activity can be done safely or legally or conveniently or expeditiously, among other criteria.
3. The coordinates of the goal position may correspond to an acceptable stopping place 130 on a road or other drivable feature where, for example, it is normally safe and legal for the AV to stop (e.g., a taxi stand or a reserved parking space). Yet for a variety of reasons such as the temporary presence of a parked vehicle or other obstacle or construction works 132, it may be temporarily impossible for the AV to stop there. In other words, such an acceptable stopping place is not a feasible stopping place.
4. The coordinates of the goal position may correspond to an acceptable stopping place where a road or driveway exists, but the AV may not have map information sufficient to enable it to determine that the goal position represents such an acceptable stopping place. This circumstance may occur on private roads or grounds, such as private residences, shopping malls, corporate campuses, or other private sites. In other words, such an acceptable stopping place is not a feasible stopping place.
5. The coordinates of the goal position may correspond to an acceptable stopping place that would require passing through a feature that the AV cannot navigate. For example, the acceptable stopping place may lie beyond the entrance of a parking structure that requires human interaction (e.g., to retrieve a parking ticket), beyond a guard post or checkpoint, or beyond a road region that the AV has otherwise identified as impassable (e.g., due to the presence of road construction). In such circumstances, the otherwise acceptable stopping place is not a feasible stopping place.
In all of these cases and others, the AV needs to find a stopping place on the road that is not only acceptable but is also a feasible stopping place.
Although we have been discussing considerations in selecting an acceptable and feasible stopping place that is in the vicinity of a goal position that has been specified by a passenger, circumstances may sometimes require that the AV stop in the vicinity of a goal position that is not a passenger-specified goal position. For example, in the event of a passenger medical emergency, the AV may be automatically re-directed to the closest medical center. Another example is that of a centrally coordinated service, where a central optimization algorithm asks an idle AV to reposition itself (for example, in expectation of higher passenger or freight demand around the new location). The techniques that we describe here are applicable to such other goal positions as well. Thus, we use the term “goal position” broadly to include, for example, any position on the road network to which the AV is driving for the purpose of stopping.
Although we often refer to a goal position as a single specific location defined by geographic coordinates, a goal region 140 of a configurable size and geometry can be defined around or in the vicinity of the goal position coordinates. A goal region is the region within which it would be acceptable for the AV to stop to engage in stopped activities, for a goal position located at the specified coordinates. If the AV were to stop at any stopping place within the goal region, it would be considered to have stopped acceptably near to the goal position, that is, at an acceptable stopping place.
All potential stopping places that are acceptable (and therefore within the goal region) and feasible may not be equally desirable. For example, some of those feasible stopping places may be closer to the goal position than others, making them more desirable.
Given an AV that has an autonomous driving capability, the techniques and systems that we describe here enable the AV to select and then drive to a selected stopping place within the goal region that is acceptable, feasible, and desirable.
Data from road map data sources that was mentioned earlier is typically used for the purpose of AV routing and autonomous navigation. We assume, to the extent necessary for the techniques and systems mentioned here to function, that the data is augmented (if necessary) to include the following annotated map data:
1. Data about areas that contain potential stopping places where it is legal for the AV to stop including the direction in which it is legal for the AV to stop there, restrictions on how long the AV can stop there, restrictions on what type of vehicles can stop there, restrictions on what activities stopped vehicles can engage in (e.g., loading zones) and any other relevant information. For example, on busy roads it might only be legal to stop at the very edge of the road, adjacent to the curb. However, on a quiet residential street, it might be acceptable to double park and stop in the travel lane itself. On certain roads, stopping might be completely disallowed (except during emergencies). On certain roads, it may not be legal to park during snow emergencies.
2. Data about areas that include potential stopping places where AVs might not normally drive, but nevertheless are allowed to stop (e.g., parking lots, driveways) and restrictions associated with those areas. These areas are specifically identified in the data to ensure that the AV system does not use these areas for any purpose other than stopping.
3. Data about areas that contain potential stopping places where it is not legal for a vehicle to stop in any situation (e.g., no stopping zones, in front of certain buildings such as fire stations, etc.) and any exceptions to those rules (e.g., a loading zone might permit cargo drop-offs but not passenger drop-offs.)
The process of gathering the annotated map data normally happens offline before the data is in active use by the AV or may be streamed to the vehicle wirelessly as it travels. Also, some of this data may be gathered in real-time using data from the AV's perception system.
Given an AV that has access to the annotated map data and has an autonomous driving capability, the process shown in
1. As shown in
a. A passenger indicates a point on a map or an address 206 as the goal position of the AV. This could be done on a mobile app, a kiosk, a notebook, a tablet, or a workstation 207, to name a few examples. The map or address is communicated wirelessly to and received by a communication element 208 of the AV system 202.
b. The AV system itself sets a goal position based on one or more processes, for example, an emergency response process 210 that routes a vehicle to the nearest hospital or a vehicle re-balancing process 212 that routes the vehicle to a different goal position in a city, etc.
2. As shown in
As shown in
The proximity region is defined to be within, for example, a fixed, configurable distance 218 from the goal position. The center of this proximity region could be the goal position itself, or a point 222 on the drivable area of the map that is near (e.g., “nearest”) to the goal position, or something similar.
This fixed configurable distance could be calculated by the AV system in a number of ways, including but not restricted to one or a combination of:
1. Straight line distance (i.e., all points within a specific radius from the center).
2. Manhattan or grid distance.
3. Walking distance (i.e., all points within a specific walking distance from the center).
4. Points that are within line of sight of the goal position (based on appropriate sightline data).
5. Other non-Euclidean distance measures
This allows the proximity region to take a variety of shapes beyond that of a circle. We note that the actual shape of the proximity region is not important, as long as it is well-defined.
The goal region is then determined by excluding from the proximity region sub-regions where stopping is not allowed, and retaining the sub-regions where stopping is allowed, given the nature of the stopped activity, expected duration of stopping, nature of the AV, time of the day, etc. This can be done, for example, by determining the intersection of the areas in the annotated map data where stopping is allowed (given the nature of the stopped activity, expected duration of stopping, nature of the AV, time of the day, etc.) with the proximity region. Such geospatial intersections may be performed using available commercial or open-source software, for example ArcGIS, MongoDB.
Examples of such sub-regions include one or more of the following:
a. Certain areas such as loading zones might be used for cargo (we sometimes use the word cargo interchangeably with parcel) pickups and drop-offs, but not for passengers. Similarly, certain driveways might be usable for passengers but not for cargo. Such restrictions could be part of the annotated map data. Therefore, depending on the purpose of the stopped activity (which could be provided by the passenger or the AV system or another source), certain sub-regions can be excluded from the proximity region.
b. Some sub-regions might be excluded because the allowed stopping time in the stopping places in that sub-region is not sufficient to carry out the stopped activity. The estimated duration of the stopped activity can be influenced by a number of factors including one or more of the following. A pickup is generally slower than a drop-off as the passenger might need first to locate the AV and confirm his identity to the AV. Cargo stops might be slower than for passengers because of time needed to load or unload. Multiple passengers getting in or out of the AV might be slower than a single passenger. Certain sub-regions of the goal region might have restrictions (captured in the annotated map data) on how long a vehicle can stop there and therefore might not be suitable for some stopped activities. Independent configurable time parameters can be defined that relate to the expected time required for a pickup, drop-off, loading of cargo, unloading of cargo, and loading and unloading of one or multiple passengers or for other stopped activities. Certain sub-regions can then be excluded from the proximity region if the allowed stopping time in that sub-region is less than the expected stopping time of the stopping activity.
c. Some vehicle types (e.g., trucks or buses) might not be allowed to stop in certain zones. The vehicle type is known to the AV system. Certain sub-regions can then be removed from the proximity region if they correspond to zones where the AV is not allowed to stop.
d. Some large vehicles 240 (e.g., trucks or buses) might not physically fit into a certain zone, depending on the shape and size of the vehicle relative to that of the zone. To ascertain this, an AV footprint area (normally a rectangle) 242 is defined by the AV system corresponding to the footprint of the AV with a margin added in each dimension to account for overhangs and errors and provide a safety margin. Any sub-region of the proximity region that is unable to fully contain this AV footprint area is then excluded from the proximity region.
e. Even though some part of the proximity region, say a parking space at a particular stopping place, is able to accommodate the AV configuration area, the driving approaches to reach that space may be too small for the AV footprint area. In other words, the stopping place is not a feasible stopping place because no feasible path exists for the AV to reach that stopping place. This situation is accommodated as part of the trajectory planning process described later.
A proximity region in the vicinity of the road network can be annotated to exclude sub-regions that relate to the particular stopped activity, the AV, or the time of day.
An example of a goal region 250 is shown in a checkerboard pattern in
Although the goal region or the proximity region can be defined as a mathematical set having potentially an infinite number of potential stopping places 252, in some implementations this can be discretized into a set having a finite number of potential stopping places using a number of well-known discretization strategies (e.g., random sampling, uniform sampling). These sampling strategies would yield a finite number of points within the proximity region. A stopping place could be constructed around each of these sampled points, for example, by drawing a rectangle corresponding to the AV's footprint around the sampled point. The sampled point could be the centroid of the rectangle. The size of the rectangle would have to be sufficient to accommodate the footprint of the AV including space for overhangs or a safety buffer on all sides. The orientation of the rectangle would be determined by the direction of the traffic flow at that point. For example, if the sampled point is on a traffic lane, the vehicle would have to stop in the direction of the traffic flow. The rectangle would be oriented accordingly and would be characterized both by its size, boundaries and its orientation. If the rectangle thus specified falls entirely within the proximity region, the stopping place that it represents would be considered to be a part of the proximity region.
As mentioned above, each potential stopping place in the goal region is associated with a direction in which it is legal for the leading end of the AV to point when stopped. This direction is inferred from the annotated map data which specifies legal driving directions for all parts of the roads and other drivable features, including traffic lanes.
As noted before, all stopping places within the goal region are considered acceptable stopping places, though they may not all be feasible stopping places or equally desirable.
If the goal region has no acceptable stopping places, i.e., it is empty, then the system may expand the size of the proximity region and re-calculate the goal region. This expansion may be done automatically by the AV system, or by presenting the option to the passenger through the user interface, or by a combination of both.
As shown in
The expansion may be subject to some upper limit on the size of the proximity region. It is possible that despite expansion up to the upper limit, the goal region may still be empty. This could happen, for example, if the goal position is in the middle of a large field or a military installation. In these cases, the passenger will be informed through the user interface that no acceptable stopping places may be found in the vicinity of the goal position, and the passenger may be requested to select a different goal position.
Not all stopping places are equally desirable for stopping. The desirability of a stopping place depends on, for example, quantifiable factors such as, but not limited to, the following:
1. Walking distance to the goal position from the stopping place. This distance 256 (
2. Covered walking distance to a goal position from the stopping place (i.e., walking distance with protection from the weather). Again, this covered distance 258 can be computed using one or a combination of distance metrics, such as the Euclidean distance, Manhattan distance, or another metric. Generally, a stopping place that has a shorter covered distance is more desirable. In some scenarios a covered walking path or data about the coverage of walking paths might not exist.
3. Clear sightline to the goal position, because it is generally desirable for a passenger at the goal position to be able to see a stopped AV based on its stopping place. The presence of a clear sightline 260 from the stopping place under consideration to a passenger at the goal position can be inferred given a 3D model of the local environment that includes the dimensions and locations of buildings and other objects, such as is available from sources such as Google Earth.
4. Distance from the curb. Stopping place that are closer to curbs are generally preferred as they allow the passenger to access the AV more easily. Information about curbs may be part of the annotated map data or may be perceived by sensors on the AV.
5. Type of road. Generally, it is desirable for the AV to stop on a road that has fewer lanes or has a lower speed limit or both. The lane configuration and speed limit information may be part of the annotated map data.
6. Expected or actual traffic. Generally, it is desirable for the AV to pick up or drop off a passenger or parcel on a road that is less trafficked as determined, for example, by AV system analysis of historical traffic data or data 270 collected by sensors mounted on the AV or both.
7. Designated stopping area. Generally, it is desirable for the AV to stop at a pre-defined stopping zone such as a taxi stand, a hotel pick-up and drop-off zone, a loading zone or other pre-defined stopping zone, compared to stopping in the travel lane of a road.
Given that the desirability of a stopping place depends on a variety of factors of different types, it is useful to combine them in a way that facilitates comparisons of the relative desirability of different stopping places. One or a combination of two or more of the following approaches can be used by the AV system in taking account of the factors:
1. The AV system creates a generalized cost or utility function 274 for stopping places that normalizes all factors (using calibrated weights or scaling factors) to create a single cost or utility value 276 associated with each stopping place. These costs or utilities, being numbers, can then be directly compared. The cost function can be continuous (e.g., the Euclidean distance from the stopping place to the goal position) or binary (e.g., a certain non-zero cost if a sightline between the stopping place and destination point does not exist, and a cost of zero if a sightline does exist). The cost can also depend on the type of stopped activity, e.g., whether it is a pickup or drop-off of a passenger, multiple passengers, or a parcel.
2. The AV system converts each factor to a 0-1 range and applies fuzzy logic rules to compare stopping places.
3. The AV system uses a prioritized comparison, in which factors that are defined to be more important are compared before factors that are less important. This kind of prioritized comparison can also impose minimum and maximum values on each factor to ensure that the selected stopping place meets the maximum and minimum requirements for each factor.
4. The AV system creates ranks such that a stopping place with a higher rank is more desirable than a stopping place with a lower rank. The goal region might be subdivided into sub-regions each with its own rank, and all stopping places within a sub-region could share the same rank, i.e., desirability.
As shown in
The AV system also maintains what we term an availability layer 282 that can be thought of as an overlay on the map's potential stopping places. This availability layer of the annotated map data identifies to the AV system, for each potential stopping place, whether the potential stopping place is a feasible stopping place.
If no prior information on the feasibility of stopping places is available, the availability layer can be initialized by assuming that all potential stopping places are feasible stopping places. Prior data about stopping places 284, if available, for example, from previous trips or from other vehicles or from sensor infrastructure, can be used to initialize the layer with stopping places expected to be feasible, while identifying those are not expected to be feasible.
The availability layer is continually updated in real time as, for example, the AV perceives new information from its sensors. This information can come, for example, from a variety of sensors such as LIDAR, Radar, ultrasonic, video camera, IR, etc., which allow the AV to determine the shape and position of objects in its environment.
For example, LIDAR data allows an AV to find other vehicles in its environment. The areas occupied by those vehicles (along with a buffer assumed to be around each of the vehicles to account for sensing error or vehicle overhangs) can then be removed from the availability layer as these areas are not available to the AV for stopping. Similarly, objects such as traffic cones or road signs (denoting construction work) can be detected using a combination of LIDAR and video cameras. Sometimes an object can be detected but cannot be classified, for example, a fallen tree or construction debris. In these cases, the AV system may note that the related area is not available and therefore remove it from the availability layer. In some cases, an object may be detected but does not represent an obstacle to stopping (for example, a moving pedestrian). In those cases, the corresponding stopping places can be retained in the availability layer.
The availability layer is updated frequently, using both the AV's own perception data and external information. The frequent updating is important because the AV can stop only at a stopping place 308 that it is currently perceiving as being feasible. A stopping place that was assumed to be feasible (because of previous perception or information from another vehicle, etc.) might not actually be available (e.g., feasible) when the AV approaches that stopping place and sees for “itself”. Similarly, a stopping place that was previously thought to be unavailable (and therefore infeasible) might actually be available (and therefore feasible) when the AV perceives it directly.
In addition to the last known feasibility status, the availability layer in the annotated map data could also store, for each potential stopping place:
1. The time of the most recent update of the stopping place status 310, as it is a measure of the current accuracy of the information. A stopping place that was reported being infeasible two minutes ago is more likely to remain unfeasible than a stopping place that was reported being infeasible twenty minutes ago.
2. The reason for the stopping place's infeasibility 312. For example, if the stopping place was infeasible because of the presence of another car, then the AV system might expect it to become available later. On the other hand, if the stopping place was infeasible because of construction works, the AV system might not expect that stopping place to become feasible for the rest of the day or for several days. Potentially the AV system could modify the map to reflect that circumstance.
The likelihood that a stopping place that is marked as infeasible in the availability layer might become feasible by the time the AV reaches that stopping place (and vice versa) depends on several factors, including among others: freshness of the information (time elapsed since last update); historical statistics on the level of demand for parking relative to supply in that area at that time of the day; the reason for the infeasibility of that stopping place; and the current traffic volumes around that stopping place (derived from the AV's perception system, potentially supplemented by information from other AVs or sensors). The AV system could use a statistical model 314 that predicts the expected feasibility state of a stopping place (or a similar metric), given some or all of the data points, along with a confidence bound for that estimate. Such a metric could contribute to the calculation of the desirability value of a potential stopping place. A stopping place that is more likely to be available is more desirable than an equivalent stopping place that is less likely to be available.
The availability layer can be updated using information received from other AVs (either directly or through a central cloud server). Therefore, as part of an interconnected fleet of AVs or manually driven vehicles that are equipped with V2V (vehicle-to-vehicle) communication capabilities, the AV might have foreknowledge of which stopping places are available without the AV actually having seen them. The availability layer can also be updated using information from sensors that are fixed (e.g., sensors inside parking garages or sensors monitoring city parking spaces), from crowd-sourced data (e.g., apps such as Waze on which people report construction work, etc.) and from a variety of other sources.
Typically, the AV system executes a trajectory planning process 326 as part of its autonomous capability, which attempts to identify a trajectory from the AV's current position to a specified destination on the drivable area of a map. The result of the trajectory planning process is a continuously updated selected stopping place in the goal region, and a feasible trajectory to reach the currently selected stopping place, if one exists. We emphasize that the trajectory planning process routes the vehicle to the currently selected stopping place, and not the goal position specified by the user or the system, as that may not represent an acceptable and feasible stopping place.
If no feasible trajectory exists to the currently selected stopping place, the trajectory planning process updates its choice of selected stopping place. This may happen, for example, if the approaches to the currently selected stopping place are blocked or cannot accommodate the AV. This trajectory planning process continues as long as the AV has not stopped at the currently selected stopping place.
The trajectory planning process is executed simultaneously and asynchronously with the AV's perception process 328. As the perception process updates the availability layer, the currently selected stopping places may become unfeasible, for example, because some other vehicle has now occupied one of the stopping places. In addition, it is possible that a more desirable stopping place within the goal region that was previously unavailable, is now available and therefore feasible. Therefore, the trajectory planning process may be forced to update its selected stopping place and the corresponding trajectory to that selected stopping place, multiple times.
The stopping place in the goal region that is selected by the trajectory planning process depends on: (1) feasibility of the acceptable stopping places within the goal region, as determined in real-time by the availability layer via the perception process, (2) the relative desirability of the acceptable stopping places within the goal region, as computed by static or real-time data or both, and (3) the optimization objective of the algorithm that determines the trade-off between coming to a stop sooner versus spending more time to find a more desirable stopping place. Some examples of strategies are:
1. Stop at the first feasible stopping place in the goal region (often called the “greedy” approach).
2. Stop at the most desirable among the currently feasible stopping places in the goal region.
3. If the AV has not stopped at a stopping place within a specified amount of time, stop searching for the most desirable stopping place, and instead find the first available stopping place in the goal region and stop there.
These objectives can be used to effect a trade-off between selecting the best possible stopping place and the time and effort spent in searching for it.
As shown in
The user input may be optional, in that the AV system may automatically choose a stopping place if the user does not make a choice within a specified amount of time. When the AV system chooses a stopping place automatically, the selected stopping place may be communicated to the passenger, for example, on a map-based interface on the passenger's mobile device or on a display located in the vehicle. Further, the passenger may be given the choice of changing the system-selected stopping place to one of the passenger's own choosing through an interface, such as the one described for
As the AV system explores the goal region to select a stopping place, the AV system can revisit stopping places that had been perceived as unfeasible in the hope that they might now be feasible.
The trajectory planning process can communicate with a passenger to keep her informed of the AV's progress. A passenger can be informed that the AV has found an acceptable stopping place or informed when the AV has stopped at a stopping place, or both.
If the AV is unable to stop at an acceptable, feasible stopping place within a specified amount of time, the AV system may adopt strategies to deal with that situation.
1. Expand the goal region around the goal position with the understanding that this might require the passenger to walk a greater distance. This may be done automatically by the AV system. The AV system may have stored a specified maximum distance from the goal position that is acceptable for the goal region. The initial proximity region (and goal regions) might include stopping places that are significantly closer to the goal position than this specified maximum distance to enable the AV system to find as close a stopping place as possible. If the initial search does not yield a feasible stopping place, the proximity region (and correspondingly the goal region) may incrementally be expanded to include more stopping places that are farther away from the goal position, but still within the specified maximum distance from the goal position. The passenger may provide information or choices that control the increasing of the size of the proximity region (and correspondingly the goal region) in response to requests posed to the passenger through the user interface (such as a smartphone or a tablet, located in the car or belonging to the user). One of the pieces of information that may be specified by the user, for example, is the maximum distance (or other distance measure) from the goal position that is acceptable to the user. If the system is unable to find a stopping place within this distance, the user may be prompted to increase the specified distance, subject to some specified limit. In some implementations a combination of processes running on the AV system and input from the passenger can be used to control the expansion of the regions.
2. Search the existing goal region again for a specified amount of time in the hope that a stopping space that was previously unavailable is now available. The user may be given the option via a user interface located in the car or on a device belonging to the user, to allow the AV more time to search the goal region, subject to some specified limit.
3. Change the AV's goal position to a new goal position where an acceptable, feasible stopping place may be more easily found. This may be done by the passenger using a user interface similar to what was used to specify the initial goal position. The passenger may have, for example, the option of dropping a pin on a map or typing out an address or searching a location service such as Google Maps.
4. The AV may switch to a tele-operation or remote operation mode in which the control of the operation of the AV switches, partially or fully, from the AV system to a human operator typically located at a central operations control center. Tele-operation systems typically stream live data from the AV to a remote location using wireless transmitters located on the AV. This data may include, but is not limited to, some combination of: (1) raw data from the sensors onboard the AV (for example, a live video stream from the on-board cameras), (2) processed data from the computers on board the AV (for example, data about detected and classified objects, or a rendering of the world around the AV that has been created by fusing data from multiple sensors), (3) data from other systems (for example, outputs from the trajectory planning process), (4) data about the actuators on the AV (such as the throttle, brake, steering), (5) data about the current position, speed, acceleration and orientation of the car from the localization system, and (6) data from the AV's health monitoring system (for example, sensor health, battery status, etc.). This data is typically viewed by a tele-operator or other remote operator who is located at a central operations control center and who can then decide how to drive and otherwise control the AV. The tele-operator may have the ability to control the AV by directly providing inputs to the steering, throttle, brake and other actuators (for example, in the manner in which driver training simulators function). The tele-operator may have the ability to directly control the trajectory planning process by manually selecting a goal position for the vehicle, or influencing the trajectory to the goal position (by specifying the entire trajectory, or providing waypoints, or by some other method). The transition from autonomous to tele-operation mode should be handled with care. Such a transition would normally take place when the AV is not moving, although the AV may not be stopped at an acceptable stopping place. If there is a passenger in the AV, the passenger may be informed about or asked to approve the remote operation. This passenger communication may take place through a user interface in a smartphone belonging to the passenger, or a smartphone or tablet located in the AV, or some other such device.
5. Providing the passenger the option of switching the AV from an autonomous mode to a partially or fully manual mode (if there is a passenger in the AV who is legally authorized and willing to drive it seated in the driver's seat and the AV has a manual mode) so that the passenger may locate an acceptable, feasible stopping place. The transition from autonomous to manual mode should be handled with care. A transition would normally take place when the AV is not moving, although the AV may not be stopped at an acceptable stopping place. The passenger may be informed about the option, and her approval sought, through a user interface in a smartphone belonging to the passenger, or a smartphone or tablet located in the AV, or some other such device. Furthermore, the passenger may be required to ensure that the stopping place chosen manually is one from which the AV can resume autonomous operation after the passenger has exited the AV. A tele-operator may take control of the AV after the passenger has exited the AV, and bring the AV to a position at which autonomous mode may be engaged.
6. In the case of a passenger in the AV, returning toward the known start position and offering to stop at the first feasible stopping place as it travels back toward the start position. This stopping place may or may not be within the goal region.
7. In the case of a parcel in the AV, returning towards the known start position and alerting the sender of the package to unload the package from the AV. Or giving the sender, through a user interface such as a smartphone app, the option of specifying an alternative time when the delivery would be attempted.
8. Aborting the stop. If the stopped activity involves a pickup, the AV system may inform the passenger that a stopping place cannot be found and that the pickup request has been canceled.
Other implementations are also within the scope of the following claims.
This disclosure is a continuation of and claims priority to U.S. patent Ser. No. 15/298,936, filed Oct. 20, 2016, the entire contents of which are incorporated herein by reference.
Number | Date | Country | |
---|---|---|---|
Parent | 15298936 | Oct 2016 | US |
Child | 16894754 | US |