[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

WO2020211934A1 - Procédé de guidage d'un véhicule dans une configuration spatiale souhaitée - Google Patents

Procédé de guidage d'un véhicule dans une configuration spatiale souhaitée Download PDF

Info

Publication number
WO2020211934A1
WO2020211934A1 PCT/EP2019/059908 EP2019059908W WO2020211934A1 WO 2020211934 A1 WO2020211934 A1 WO 2020211934A1 EP 2019059908 W EP2019059908 W EP 2019059908W WO 2020211934 A1 WO2020211934 A1 WO 2020211934A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
spatial configuration
positioning
previous
local area
Prior art date
Application number
PCT/EP2019/059908
Other languages
English (en)
Inventor
Daniel Persson
Original Assignee
Volvo Truck Corporation
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Volvo Truck Corporation filed Critical Volvo Truck Corporation
Priority to PCT/EP2019/059908 priority Critical patent/WO2020211934A1/fr
Publication of WO2020211934A1 publication Critical patent/WO2020211934A1/fr

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/10—Position of receiver fixed by co-ordinating a plurality of position lines defined by path-difference measurements, e.g. omega or decca systems
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60D—VEHICLE CONNECTIONS
    • B60D1/00—Traction couplings; Hitches; Draw-gear; Towing devices
    • B60D1/24—Traction couplings; Hitches; Draw-gear; Towing devices characterised by arrangements for particular functions
    • B60D1/245—Traction couplings; Hitches; Draw-gear; Towing devices characterised by arrangements for particular functions for facilitating push back or parking of trailers
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60D—VEHICLE CONNECTIONS
    • B60D1/00—Traction couplings; Hitches; Draw-gear; Towing devices
    • B60D1/58—Auxiliary devices
    • B60D1/62—Auxiliary devices involving supply lines, electric circuits, or the like
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/14—Determining absolute distances from a plurality of spaced points of known location
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/028—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20—Instruments for performing navigational calculations

Definitions

  • the present disclosure relates to methods, control units, vehicles and logistics terminals for positioning and guiding vehicles.
  • the invention can be applied with heavy-duty vehicles, such as trucks, semi-trailers, construction equipment and cargo transport vehicles in general.
  • heavy-duty vehicles such as trucks, semi-trailers, construction equipment and cargo transport vehicles in general.
  • trucks semi-trailers
  • cargo transport vehicles in general.
  • the invention will be described mainly with respect to a semi-trailer vehicle, the invention is not restricted to this particular vehicle, but may also be used in other types of vehicles.
  • Logistics terminal truck paths include reversing maneuvers, e.g., when docking at a loading bay, or when refueling, charging, or parking.
  • reversing may be part of a multi-turn strategy for arriving with the vehicle in the right direction at a given place between buildings and other obstacles, i.e., in a desired vehicle spatial configuration.
  • the path planning is a challenge.
  • Maneuvers may need to be precise and may be challenging even for experienced drivers with long multi-articulation angle combinations.
  • US 9,862,413 B2 relates to control of an articulated vehicle based on positioning information.
  • GNSS Global Navigation Satellite Systems
  • GPS Global Positioning System
  • GNSS Global Navigation Satellite Systems
  • the application of global navigation satellite systems is limited.
  • GNSS when using GNSS in an area which comprises many obstacles, such as buildings and similar, it cannot be guaranteed that the recipient receives the four signals necessary for three dimensional position estimation.
  • multipath propagation can degrade performance. Therefore, a global navigation satellite system may have a too low accuracy to be used for path following within a crowded terminal or at a terminal with narrow passages.
  • the method comprises estimating a spatial configuration of the vehicle, wherein the spatial configuration of the vehicle is at least partly estimated based on a pre-determined number of line-of-sight (LOS) wireless links between the vehicle and positioning transceivers deployed over the local area.
  • the method also comprises obtaining the desired spatial configuration of the vehicle.
  • the method furthermore comprises determining a planned path for maneuvering the vehicle from the spatial configuration into the desired spatial configuration and guiding the vehicle into the desired spatial configuration based on the planned path.
  • LOS line-of-sight
  • wireless positioning If wireless positioning is accurate and robust enough, it can allow the truck to reverse according to recorded paths at logistics terminals. Non-accurate positioning will cause the reversing to malfunction by becoming unstable or not following the path accurately. It is therefore of high importance that the wireless positioning system is accurate and robust.
  • the disclosed method builds on the guaranteed availability of a pre-determined number of LOS wireless links between the vehicle and positioning transceivers, which enables precise and robust positioning of the vehicle.
  • the methods described herein avoid the GNSS problem of satellite occlusion and multipath propagation in the local area. This improves wireless positioning locally in a traffic area such as at a logistics terminal. This will in turn help drivers with advanced maneuvers, in particular maneuvers including reversing. Such maneuvers are known to be complicated even among experienced drivers.
  • the method increases efficiency at terminals, reduces driver-perceived maneuvering problems, and contributes to traffic area safety.
  • the method is cost-efficient compared to installing sensors on trailers, where the trailers are switched often.
  • the method can also be integrated in an existing system, in particular in an existing terminal and in an existing vehicle.
  • the vehicle is an articulated vehicle comprising a towing vehicle and one or more towed vehicles.
  • N EXTRA is a positive integer to account for robustness against link failures and to increase positioning accuracy.
  • the positioning transceivers are according to the present disclosure deployed in order to deterministically provide the required number of LOS wireless links at any given location throughout the local area. Example methods for performing this deployment will be discussed below.
  • estimating the spatial configuration comprises discarding any non- line-of-sight (NLOS) wireless links between the vehicle and positioning transceivers deployed over the local area.
  • NLOS line-of-sight
  • the NLOS wireless links can be discarded since enough LOS links are always available at any given location throughout the local area. NLOS wireless links are associated with larger distance measurement errors compared to LOS links. Thus, discarding NLOS links may lead to increased positioning accuracy and robustness, which is an advantage.
  • estimating the spatial configuration of the vehicle may comprise estimating one or more vehicle headings and/or one or more vehicle articulation angles. This way the geometrical configuration of the vehicle with respect to the surrounding environment can be established, which is an advantage. Vehicle combinations comprising any number of headings and articulation angles can be accounted for by the disclosed methods, which is an advantage.
  • estimating the spatial configuration of the vehicle is based on additional sensor data from any of, a vision sensor, a radar sensor, a lidar sensor, a sonar sensor, a photo-detector, and/or magnetic sensor.
  • This additional sensor data may be used to further increase positioning accuracy and/or robustness, which is an advantage.
  • the desired spatial configuration of the vehicle corresponds to a spatial configuration adapted for any of; a reversing maneuver, docking at a loading bay, refueling at a refueling station, charging at an electrical charging station, vehicle parking, truck to boat on-loading and/or off-loading, truck to train on-loading and/or off-loading, and/or truck to plane on-loading and/or off-loading. Consequently, the disclosed methods are very versatile and can be used for many different applications and in many different scenarios, which is an advantage,
  • determining the planned path comprises retrieving a previously recorded path traversed by a vehicle from an initial spatial configuration into the desired spatial configuration.
  • the previously recorded path is known to be suitable for maneuvering the vehicle into the desired position and is therefore naturally a robust and efficient path choice.
  • Retrieving a previously recorded path is also computationally efficient compared to determining new paths each time, which is an advantage.
  • determining the planned path comprises generating a plurality of candidate maneuver paths and evaluating a performance metric for each candidate maneuver path and selecting the candidate maneuver path associated with highest performance metric as the planned path.
  • determining the planned path comprises accounting for other vehicles in the local area.
  • logistics efficiency in the local area can be improved, which is an advantage.
  • guiding the vehicle into the desired spatial configuration comprises transmitting data associated with the planned path to the vehicle over a wireless link.
  • path data By downloading path data, the vehicle obtains guidance on how to maneuver into the desired spatial configuration in an efficient manner.
  • guiding the vehicle into the desired spatial configuration comprises transmitting maneuver commands to the vehicle over a wireless link. This means that the vehicle is at least partly remotely controlled into the desired spatial configuration, which reduces the strain on a vehicle on-board computer.
  • Both path and maneuver command transmission provide for a centralized multi-vehicle control which can be optimized for increased efficiency throughout the local area, which is an advantage.
  • the method also comprises triggering a warning signal in case a vulnerable road user is detected in a vicinity of the planned path.
  • control units, computer programs, computer readable media, computer program products, vehicles and logistics terminals associated with the above discussed advantages.
  • all terms used in the claims are to be interpreted according to their ordinary meaning in the technical field, unless explicitly defined otherwise herein.
  • All references to "a/an/the element, apparatus, component, means, step, etc.” are to be interpreted openly as referring to at least one instance of the element, apparatus, component, means, step, etc., unless explicitly stated otherwise.
  • Figure 1 schematically illustrates a vehicle for cargo transport
  • Figure 2 illustrates guiding a vehicle into a desired spatial configuration
  • Figure 3 illustrates examples of line-of-sight and non-line-of-sight wireless links
  • Figure 4 exemplifies positioning based on round-trip time measurements
  • Figure 5 is a flow chart illustrating methods
  • Figure 6 schematically illustrates a control unit
  • Figure 7 illustrates a vehicle traversing a local area
  • Figure 8 shows an example computer program product.
  • Figure 1 shows a schematic articulated vehicle combination 1 comprising a towing vehicle 2 and two towed vehicles 3, 4.
  • the towing vehicle may be a regular truck adapted for commercial highway use or a tractor having a fifth wheel but may also be an off-road truck, a bus, or a recreational vehicle.
  • the first towed vehicle or trailer 3 is in the shown example a dolly having a drawbar connected to the trailer coupling of the truck.
  • the dolly is provided with two wheel-axles 7.
  • the second towed vehicle or trailer 4 is a semitrailer, which is provided with a kingpin 8 that is connected to the fifth wheel of the dolly.
  • This example shows a common type of a longer vehicle combination, but it is also possible to use other types of vehicle combinations having other types of towing vehicles and other types and numbers of towed vehicles.
  • Different vehicle combinations may include a truck with a regular trailer, a truck with a center axle trailer, a truck with a dolly and a semitrailer, a tractor with a semitrailer, a tractor with a B-link and a semitrailer, a tractor with a semitrailer and a regular trailer or a tractor with a semitrailer dolly and a semitrailer.
  • the effective wheelbase Leq1 of the towing vehicle i.e. the truck, is the length from the front axle 12 to the virtual axle 13 of the truck.
  • the effective wheelbase Leq2 of the first towed vehicle i.e. the dolly
  • the effective wheelbase Leq3 of the second towed trailer extends from the king pin 8 to the to the virtual rear axle 9 of the trailer 4.
  • a vehicle combination 1 is at times referred to as a vehicle for simplicity.
  • vehicle units such as a trailer unit 4 or the towing vehicle 2 may also simply be referred to as vehicles.
  • the towing vehicle 2 may be provided with various autonomous or semi-autonomous driving functions such as an automatic reverse assistance function, in which the steering of the vehicle combination is automated during reversing and where the speed of the vehicle combination may be controlled by the driver.
  • the methods disclosed herein provide input data to such functions.
  • Figure 1 further shows semitrailer axles 10, and an equivalent axle position 11.
  • FIG. 2 schematically illustrates a local area 210, such as a logistics terminals or the like.
  • the local area is monitored and at least in part controlled by a control unit 600. It is appreciated that the disclosed methods are applicable with a wide range of different local areas.
  • the local area comprises obstructing objects 230a, 230b, 230c, such as, e.g., buildings.
  • a vehicle 1 has entered the local area 210 at an initial spatial configuration A.
  • vehicle spatial configuration describes where the vehicle is located and optionally also how the vehicle is oriented, i.e., in which direction it is facing and if the vehicle is in an articulated state or not.
  • vehicle spatial configuration comprises at least position, i.e., coordinates in two or three dimensions.
  • the vehicle spatial configuration may also comprise headings, and articulation angles for various types of vehicle combinations, such as the vehicle combination 1.
  • the vehicle 1 may become distanced (C) from a planned track T.
  • the track T may be followed while passing through intermediate desired spatial vehicle configurations along the track.
  • Other vehicles T may also be located in the local area 210. These vehicles may be guided at the same time as the vehicle 1 , or they may simply represent obstacles to be avoided.
  • the vehicle 1 decides its position with line-of-sight (LOS) signals from positioning transceivers 220a, 220b, 220c.
  • the vehicle is then moved according to paths or maneuver commands, e.g., front road wheel angle, communicated from the terminal, and path planning, based on the vehicle’s current and desired positions.
  • LOS line-of-sight
  • a traffic area is to be understood as an area in which a vehicle can be moved.
  • the traffic area is a truck terminal or part of the terminal such as the local area 210.
  • the area comprises buildings 230a, 230b, 230c which screen global navigation satellite system’s signals from the vehicle.
  • the path T can be partly indoors as well. In such a scenario, GPS signals are completely blocked.
  • the terminal and vehicle have communication transceivers.
  • the terminal communication transceivers can be arranged at a terminal entrance. Communication starts when a vehicle enters the traffic area through the entrance.
  • a planned track T from an initial location (A) to a target location (B) is followed, possibly taking desired constraints associated with the vehicle configurations along T into account.
  • a control algorithm may be used to follow the planned track T. Control algorithms can be based on a plurality of known tracking filter methods, such as Kalman filters, extended Kalman filters, and variants of a particle filter. A number of control algorithms are known and will therefore not be discussed in more detail herein.
  • Paths or maneuver commands may be communicated from the terminal to the vehicle. These suggestions are possibly complemented with path planning based on the vehicle’s current and desired positions.
  • a vehicle maneuver can be a parking movement. In this example, moving the vehicle according to the predetermined vehicle maneuver means that the vehicle is moved in order to park the vehicle in a predetermined way at the parking spot.
  • the terminal transmits maneuver commands, the terminal has to continuously be aware of the vehicle’s spatial configuration. Additional terminal infrastructure, such as a camera, can be used to analyze whether the parking spot is free and to further support positioning.
  • a map containing different terminal points of interest, and routes and maneuver commands for these spots, can be communicated from the terminal to the vehicle as well. Route suggestions and maneuver command suggestions can be based on cargo or vehicle numbers communicated from the vehicle.
  • the vehicle can be steered.
  • Different steering functions and controllers can be executed.
  • the algorithms can be of advanced driver-assistance systems (ADAS) or autonomous drive (AD) type.
  • ADAS advanced driver-assistance systems
  • AD autonomous drive
  • a challenging task for the vehicle controller where the terminal-communicated path, path planning, and enhanced position is useful, is a multi-turn maneuver including reversing between buildings.
  • FIG. 3 shows some example details 300 of the local area 210.
  • the first three positioning transceivers 220a, 220b, 220c, and 310 provide direct unobstructed LOS wireless links to the vehicle 1.
  • the fourth positioning transceiver 310 is in a NLOS situation with respect to the vehicle, since the direct path link is blocked by the building 230c.
  • a distance estimated based on this NLOS wireless link will be associated with an error, specifically a positive bias.
  • a first example positioning algorithm for positioning the vehicle 1 will now be described. This first positioning algorithm can be used to position the vehicle 1 based on the wireless links to the positioning transceivers deployed throughout the local area 210.
  • the main steps of the first position estimation algorithm are as follows;
  • the positioning transceivers 220a, 220b, 220c send pseudorandom noise sequences (PRNSs), the positioning transceivers positions, and their transmission times, to the vehicle 1.
  • PRNSs pseudorandom noise sequences
  • the vehicle 1 detects the PRNSs.
  • the vehicle 1 can now formulate and solve a trilateration problem. Trilateration can be done by any variants of the traditional time of arrival, or time difference of arrival techniques.
  • the vehicle clock times corresponding to the detection of the PRNSs, the positioning transceivers’ transmission times, and positions, are employed.
  • a minimization problem is solved for the vehicle position.
  • Vehicle clock offset can be extracted as an option.
  • FIG. 4 Solving a trilateration problem is schematically illustrated in Figure 4.
  • a scenario 400 comprising three positioning transceivers 220a, 220b, and 220c and one vehicle 1 is shown.
  • the distances from each positioning transceiver to the vehicle are shown as circles 410, 420, 430.
  • the point 440 where all three circles intersect represents a solution to the trilateration problem.
  • Vehicle heading may also be extracted.
  • the vehicle heading can, e.g., be extracted from position by recording a position with the same antenna or transceiver at two time instants and taking the difference, wherein the two time instants are relatively close in time compared to the vehicle dynamics.
  • the vehicle heading can be extracted by recording position with two antennas or transceivers at different vehicle positions at the same time and taking the difference.
  • the position estimate can be improved by considering previously calculated positions, information about local terminal obstacles, air temperature, signal phases, and communication transceivers time synchronization support.
  • the first positioning algorithm can also be carried out by the vehicle sending a PRNS which is received by the positioning transceivers, the terminal solving the trilateration problem, and communicating the vehicle position and heading to the vehicle.
  • This second positioning algorithm can also be used to position the vehicle 1 based on the wireless links to the positioning transceivers 220a, 220b, and 220c deployed throughout the local area 210.
  • a first positioning transceiver call it positioning transceiver A, sends a PRNS MA to the vehicle 1 which is received by a vehicle positioning transceiver V.
  • the vehicle positioning transceiver V sends a PRNS MV back to positioning transceiver A as soon as it receives MA.
  • Transceiver A measures the round trip time (RTT).
  • the terminal obtains the terminal positioning transceiver-vehicle distances for several positioning transceivers.
  • the trilateration step of, e.g., the first positioning algorithm can be employed.
  • the benefit of the second positioning algorithm compared to the first positioning algorithm is that no terminal positioning transceiver synchronization step is needed.
  • the second positioning algorithm can be improved by considering previously calculated positions, information of local terminal obstacles, air temperature, and signal phases.
  • the second positioning algorithm can also be carried out by the vehicle 1 sending PRNSs to the positioning transceivers 220a, 220b, and 220c, the positioning transceivers sending PRNSs back to the vehicle 1 , the vehicle 1 calculating the vehicle-terminal positioning transceiver distances through the corresponding RTTs, and finally solving the trilateration problem.
  • FIG. 5 is a flow chart illustrating methods corresponding to the discussions above in connection to Figures 1-4.
  • the method comprises estimating S3 a spatial configuration C of the vehicle 1 , wherein the spatial configuration C of the vehicle 1 is at least partly estimated based on a pre-determined number of LOS wireless propagation times between the vehicle 1 and positioning transceivers 220a, 220b, 220c, 310 deployed over the local area 210.
  • the local area 210 and the vehicle 1 have positioning transceivers 220a, 220b, 220c.
  • LOS positioning signals are sent to the vehicle 1.
  • the LOS positioning signals are emitted by positioning transceivers.
  • the positioning transceivers are distributed over the local area 210 in a way that allows LOS signal flow from two or more of the positioning transceivers to areas where the vehicle 1 moves.
  • the LOS wireless links enable robust and accurate positioning of the vehicle 1. This way advanced maneuver guidance is enabled.
  • the desired spatial configuration B of the vehicle 1 corresponds to a spatial configuration adapted for any of; a reversing maneuver, docking at a loading bay, refueling at a refueling station, charging at an electrical charging station, vehicle parking, truck to boat on-loading and/or off-loading, truck to train on-loading and/or off-loading, and/or truck to plane on-loading and/or off-loading.
  • deploying the positioning transceivers 220a, 220b, 220c, 310 comprises configuring S1 1 the positioning transceivers to transmit pseudorandom noise sequences (PRNS), respective positioning transceiver positions, and transmission times, to the vehicle 1.
  • PRNS pseudorandom noise sequences
  • the method also comprises obtaining S4 information about the desired spatial configuration B of the vehicle 1.
  • the desired spatial configuration may, e.g., be a spatial configuration adapted to loading or unloading cargo at a loading dock or the like.
  • the method further comprises determining S5 a planned path T for maneuvering the vehicle 1 from the spatial configuration C into the desired spatial configuration B, and guiding S6 the vehicle 1 into the desired spatial configuration B based on the planned path T.
  • the vehicle 1 is an articulated vehicle comprising a towing vehicle 2 and one or more towed vehicles 3, 4.
  • An example of this type of vehicle was discussed above in connection to Figure 1.
  • the placement of the positioning transceivers has to be chosen systematically. This can be accomplished in different ways. For example, terminal 3D-models including buildings can be used. In the 3D-model, the transceivers can be positioned at different terminal locations, and rays can be traced between the positioning transceiver and relevant vehicle locations. In this way, it can be verified that no obstacles are between the positioning transceiver and the relevant vehicle location.
  • An optimization algorithm can be used as follows;
  • a suitable number of positioning transceivers is chosen. Thereafter, the transceivers are moved around the local area until an optimized LOS coverage is found. If the obtained LOS coverage is not meeting specifications, additional transceivers can be added, and the algorithm is re-run. If the optimized LOS coverage on the other hand is better than the specification, the algorithm can be re-run with fewer positioning transceivers.
  • Various constraints such as power supply, especially important areas, mounting difficulties, as well as moving and sometimes occluding objects, e.g., other vehicles, can also be taken into account.
  • the placement of the positioning transceivers can also be determined as follows. When the antennas are mounted, installation personnel judge various locations. For example, service personnel can manually aim from a potential transceiver site to a relevant location for the vehicle and see if there are obstacles. Service personnel mark the findings on a map. By repeating this procedure for several potential transceiver locations, a decision on final transceiver locations can be taken, involving human and/or computer decisions.
  • installation personnel may carry portable transceivers to measure the signal propagation between relevant vehicle areas and potential positioning transceiver locations.
  • the measurements may investigate line-of-sight by, e.g., angle-of-arrival, as well as propagation time, and signal strength.
  • the method also comprises synchronizing S2 the positioning transceivers 220a, 220b, 220c, 310 deployed over the local area 210.
  • Some positioning algorithms require that the transceivers are synchronized. Synchronization is carried out via a wired or wireless network. This can be done by, e.g., positioning transceiver A sending a PRNS MA to another positioning transceiver B. At the time of transmission, positioning transceiver As clock has time tA. Positioning transceiver B sends a PRNS MB back to positioning transceiver A as soon as it receives MA. The positioning transceiver B’s transmit time tB is sent together with MB. Transceiver A measures the round trip time RTT.
  • all positioning transceivers can be synchronized. Versions of the setup are possible, e.g., by including better clocks at some nodes, and connecting several positioning transceivers to the same clock.
  • estimating the spatial configuration C comprises detecting and discarding S31 any non-line-of-sight, NLOS, wireless links between the vehicle 1 and positioning transceivers 310 deployed over the local area 210.
  • NLOS wireless links are associated with larger distance measurement errors compared to LOS links.
  • discarding NLOS links may lead to increased positioning accuracy and robustness, which is an advantage.
  • NLOS links can avoided by removing links with large position errors from the calculation. Moreover, based on historical positions and prior information about the terminal geometry, some received links can be removed directly as NLOS links. In other words, according to some aspects, the NLOS detecting and discarding is performed S311 based on historical positions and/or based on prior information about the local area 210.
  • estimating the spatial configuration C of the vehicle 1 comprises measuring S33 round-trip time (RTT), or time-of flight (TOF), 410, 420, 430 and estimating a position 440 of the vehicle 1 based on the RTT or TOF measurements 410, 420,430.
  • RTT round-trip time
  • TOF time-of flight
  • estimating the spatial configuration C of the vehicle 1 comprises measuring S32 time-difference-of-arrival (TDOA), and estimating a position 440 of the vehicle 1 based on the TDOA measurements.
  • TDOA time-difference-of-arrival
  • estimating the spatial configuration C of the vehicle 1 comprises estimating S34 vehicle position conditioned on knowing the pre-determined number N LOS of available LOS wireless links.
  • estimating the spatial configuration C of the vehicle 1 comprises estimating S35 one or more vehicle headings and/or one or more vehicle articulation angles.
  • estimating the spatial configuration C of the vehicle 1 is based on S36 additional sensor data from any of, a vision sensor, a radar sensor, a lidar sensor, a sonar sensor, a photo-detector, and/or magnetic sensor.
  • the estimated position and heading data can be combined with other sensor data, e.g., yaw rate and articulation angles, in a Kalman-type filter to estimate various parameters, e.g., the vehicle unit positions, such as a towing vehicle position and one or more trailer vehicle positions.
  • vehicle/terminal radar/lidar/camera/sonar sensors can be used as follows;
  • the sensors are mounted at the terminal, they can position the vehicle and transmit the information to the vehicle.
  • the sensors can be used for monitoring free areas, e.g., to plan routes and protect vulnerable road users.
  • determining the planned path T comprises retrieving S51 a previously recorded path traversed by a vehicle 1 from an initial spatial configuration A into the desired spatial configuration B.
  • determining the planned path T comprises generating S52 a plurality of candidate maneuver paths and evaluating a performance metric for each candidate maneuver path and selecting the candidate maneuver path associated with highest performance metric as the planned path T.
  • the planned path T may include taking desired intermediate spatial configurations along the track into account.
  • Predetermined vehicle maneuvers may be obtained by track simulation and/or real-world experiments. For simulation, a vehicle dynamic model and an area map with objects are used. The following algorithm can be used both in the experiment and the simulator. For a specific vehicle location of interest where a maneuver is to be chosen, different paths are suggested to the controller. For each path, the vehicle control program is run. The resulting maneuvers are evaluated, and finally the most suitable maneuver is chosen. Maneuvers may be obtained for different sized vehicles, loaded/unloaded vehicles, and different weather situations.
  • determining the planned path T comprises executing S53 a path finding algorithm.
  • the vehicle or terminal may also perform path planning depending on current and desired vehicle position and orientation, and surrounding buildings. Standard known path finding algorithms such as Dijkstra’s algorithm can be applied. The algorithm uses costs for different route segments as inputs. Moreover, different turning strategies may be used for route optimization, e.g. arbitrating between turning 180 degrees by encircling large buildings versus reversing 90 degrees around a corner, and then forwarding the vehicle while turning 90 degrees more.
  • determining the planned path T comprises accounting S54 for other vehicles 1’ in the local area 210. In order to avoid traffic jams within the traffic area, multi-vehicle co-planning can be used. For example, vehicles can take different paths to closely situated desired positions. Furthermore, crowded paths may be considered during path planning, so that another less crowded route is preferred over the more crowded ones.
  • guiding the vehicle 1 into the desired spatial configuration B comprises transmitting S61 data associated with the planned path T to the vehicle 1 over a wireless link. This way path data can be downloaded to the vehicle, which then can efficiently and conveniently maneuver into the desired position.
  • guiding the vehicle 1 into the desired spatial configuration B comprises transmitting S62 maneuver commands, such as desired front road wheel angle, to the vehicle 1 over a wireless link.
  • S62 maneuver commands such as desired front road wheel angle
  • the positioning and communication systems disclosed herein can also be used to warn vulnerable road users of approaching vehicles.
  • a blinking and/or sounding street sign can warn vulnerable road users about that a not yet visible vehicle is arriving from behind a corner.
  • the method comprises triggering S7 a warning signal in case a vulnerable road user is detected in a vicinity of the planned path T.
  • FIG. 6 schematically illustrates, in terms of a number of functional units, the components of a control unit 600 according to embodiments of the discussions herein.
  • This control unit 600 may be comprised in the articulated vehicle 1 and/or be deployed in one or more locations in connection to the local traffic area 210.
  • Processing circuitry 610 is provided using any combination of one or more of a suitable central processing unit CPU, multiprocessor, microcontroller, digital signal processor DSP, etc., capable of executing software instructions stored in a computer program product, e.g. in the form of a storage medium 630.
  • the processing circuitry 610 may further be provided as at least one application specific integrated circuit ASIC, or field programmable gate array FPGA.
  • the processing circuitry 610 is configured to cause the control unit 600 to perform a set of operations, or steps, such as the methods discussed in connection to Figure 8.
  • the storage medium 630 may store the set of operations
  • the processing circuitry 610 may be configured to retrieve the set of operations from the storage medium 630 to cause the control unit 600 to perform the set of operations.
  • the set of operations may be provided as a set of executable instructions.
  • the processing circuitry 610 is thereby arranged to execute methods as herein disclosed.
  • the storage medium 630 may also comprise persistent storage, which, for example, can be any single one or combination of magnetic memory, optical memory, solid state memory or even remotely mounted memory.
  • the control unit 600 may further comprise an interface 620 for communications with at least one external device.
  • the interface 620 may comprise one or more transmitters and receivers, comprising analogue and digital components and a suitable number of ports for wireline or wireless communication.
  • the processing circuitry 610 controls the general operation of the control unit 600, e.g., by sending data and control signals to the interface 620 and the storage medium 630, by receiving data and reports from the interface 620, and by retrieving data and instructions from the storage medium 630.
  • Other components, as well as the related functionality, of the control node are omitted in order not to obscure the concepts presented herein.
  • the control unit 600 optionally comprises a heading detection unit 640, such as a compass module.
  • the control unit may also comprise any of an IMU 650, a wheel speed sensor 660, and an articulation angle sensor 670.
  • a steering wheel angle sensor 680 and/or a yaw rate sensor 690 may optionally also be provided.
  • control unit 600 may be adapted to guide a vehicle 1 to a desired spatial configuration B in a local area 210.
  • the control unit comprises processing circuitry 610 configured to;
  • the spatial configuration C of the vehicle 1 is at least partly estimated based on a pre-determ ined number of LOS, wireless links between the vehicle 1 and positioning transceivers 220a, 220b, 220c, 310310 deployed over the local area 210,
  • the control unit 600 may according to other aspects comprise processing circuitry 610 configured to;
  • the spatial configuration C of the vehicle 1 is at least partly estimated based on a pre-determined number of LOS wireless links between the vehicle 1 and positioning transceivers 220a, 220b, 220c, 310 deployed over the local area 210,
  • control unit is indicated in Figure 1 and in Figure 7 as comprised in the vehicle.
  • the control unit is also indicated in Figure 2 as deployed in connection to the local area 210.
  • a logistics terminal and vehicles comprising the control unit 600 discussed herein. It is appreciated that both the vehicle and the logistics terminal may comprise control units 600, 600’ operating together as shown in Figure 7.
  • Figure 7 shows a vehicle 1 traversing a local area 700.
  • a vehicle 1 traversing a local area 700.
  • the techniques and methods disclosed herein are applied through positioning transceivers 720a, 720b, such that the vehicle 1 can be accurately and robustly positioned.
  • both the vehicle 1 and the local area 700 comprise control units 600, 600’ according to the present teachings.
  • Figure 8 illustrates a computer readable medium 810 carrying a computer program comprising program code means 820 for performing the methods illustrated in Figure 8, when said program product is run on a computer.
  • the computer readable medium and the code means may together form a computer program product 800.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Traffic Control Systems (AREA)

Abstract

La présente invention concerne un procédé de positionnement et de guidage d'un véhicule (1) vers une configuration spatiale souhaitée (B) dans une zone locale (210), le procédé consistant : à estimer une configuration spatiale (C) du véhicule (1), la configuration spatiale (C) du véhicule (1) étant au moins partiellement estimée sur la base d'un nombre préétabli de liaisons sans fil de ligne de visée (LOS) entre le véhicule (1) et des émetteurs-récepteurs de positionnement (220a, 220b, 220c, 310) déployés sur la zone locale (210), à obtenir la configuration spatiale souhaitée (B) du véhicule (1), à déterminer un trajet planifié (T) pour manœuvrer le véhicule (1) à partir de la configuration spatiale (C) dans la configuration spatiale souhaitée (B), et à guider le véhicule (1) dans la configuration spatiale souhaitée (B) suivant le trajet planifié (T).
PCT/EP2019/059908 2019-04-17 2019-04-17 Procédé de guidage d'un véhicule dans une configuration spatiale souhaitée WO2020211934A1 (fr)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/EP2019/059908 WO2020211934A1 (fr) 2019-04-17 2019-04-17 Procédé de guidage d'un véhicule dans une configuration spatiale souhaitée

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/EP2019/059908 WO2020211934A1 (fr) 2019-04-17 2019-04-17 Procédé de guidage d'un véhicule dans une configuration spatiale souhaitée

Publications (1)

Publication Number Publication Date
WO2020211934A1 true WO2020211934A1 (fr) 2020-10-22

Family

ID=66484003

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/EP2019/059908 WO2020211934A1 (fr) 2019-04-17 2019-04-17 Procédé de guidage d'un véhicule dans une configuration spatiale souhaitée

Country Status (1)

Country Link
WO (1) WO2020211934A1 (fr)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102022101137A1 (de) 2022-01-19 2023-07-20 Zf Cv Systems Global Gmbh Verfahren zum Anzeigen einer Umgebung eines Eigenfahrzeuges auf einer Anzeigeeinrichtung, Verarbeitungseinheit und Eigenfahrzeug

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5548516A (en) * 1989-12-11 1996-08-20 Caterpillar Inc. Multi-tasked navigation system and method for an autonomous land based vehicle
US9862413B2 (en) 2013-05-15 2018-01-09 Volvo Truck Company Method for assisting the reversal of an articulated vehicle
WO2019042958A1 (fr) * 2017-08-30 2019-03-07 Assa Abloy Entrance Systems Ab Systèmes de guidage de véhicule et procédés associés destinés à être utilisés dans des cours d'opérations logistiques et dans d'autres emplacements

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5548516A (en) * 1989-12-11 1996-08-20 Caterpillar Inc. Multi-tasked navigation system and method for an autonomous land based vehicle
US9862413B2 (en) 2013-05-15 2018-01-09 Volvo Truck Company Method for assisting the reversal of an articulated vehicle
WO2019042958A1 (fr) * 2017-08-30 2019-03-07 Assa Abloy Entrance Systems Ab Systèmes de guidage de véhicule et procédés associés destinés à être utilisés dans des cours d'opérations logistiques et dans d'autres emplacements

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
PRETAP MISRA; PER ENGE: "Global positioning system, signals, measurements, and performance", 2012, GANGA-JAMUNA PRESS

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102022101137A1 (de) 2022-01-19 2023-07-20 Zf Cv Systems Global Gmbh Verfahren zum Anzeigen einer Umgebung eines Eigenfahrzeuges auf einer Anzeigeeinrichtung, Verarbeitungseinheit und Eigenfahrzeug

Similar Documents

Publication Publication Date Title
JP7124117B2 (ja) トレーラの検出および自律的なヒッチング
EP3790745B1 (fr) Dispositif de suivi d'objet visuel
US10759428B2 (en) Use of laser scanner for autonomous truck operation
CN109278672B (zh) 用于辅助各种操纵的无线汽车拖车的方法、设备和系统
CN110626343B (zh) 在车辆队列中自动横向引导跟随车辆的方法
EP3380392B1 (fr) Procédé d'auto-accostage pour application dans des poids-lourds
US9403413B2 (en) Systems and methods to assist in coupling a vehicle to a trailer
US10730521B2 (en) System for autonomous lane merging
JP7421569B2 (ja) 連結車両の許容可能な車両の状態空間を決定する方法
JP2019532292A (ja) 車両位置特定の自律走行車両
CN107091647B (zh) 港口集装箱水平搬运无人车导航方法
EP3265849A1 (fr) Système de mise en correspondance d'occupation en temps réel pour des véhicules autonomes
US12124267B2 (en) Driver aid and autonomous tractor-trailer parking and loading dock alignment system
US11585945B2 (en) Method for the satellite-supported determination of a position of a vehicle
US20190383950A1 (en) Method and arrangement for improving global positioning performance of a road vehicle
CN112638668A (zh) 用于使用车辆相机校准运动估计算法的系统和方法
WO2020211934A1 (fr) Procédé de guidage d'un véhicule dans une configuration spatiale souhaitée
JP7114746B2 (ja) 車両パラメータを求めるための方法および装置
US11945439B2 (en) AD or ADAS aided maneuvering of a vehicle
US20220242415A1 (en) Dynamically-localized sensors for vehicles
CN113661112B (zh) 确定铰接式车辆的可允许的车辆状态空间的方法

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19723318

Country of ref document: EP

Kind code of ref document: A1

DPE2 Request for preliminary examination filed before expiration of 19th month from priority date (pct application filed from 20040101)
NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19723318

Country of ref document: EP

Kind code of ref document: A1