WO2021226908A1 - Automatic vehicle parking/retrieving method for parking lot, parking lot system, and vehicle terminal - Google Patents
Automatic vehicle parking/retrieving method for parking lot, parking lot system, and vehicle terminal Download PDFInfo
- Publication number
- WO2021226908A1 WO2021226908A1 PCT/CN2020/090154 CN2020090154W WO2021226908A1 WO 2021226908 A1 WO2021226908 A1 WO 2021226908A1 CN 2020090154 W CN2020090154 W CN 2020090154W WO 2021226908 A1 WO2021226908 A1 WO 2021226908A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- vehicle
- parking lot
- route
- parking
- driving
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/14—Traffic control systems for road vehicles indicating individual free spaces in parking areas
Definitions
- the present invention relates to the field of vehicle automatic control, in particular to a parking lot automatic parking/retrieving method, a parking lot system and a vehicle terminal adopting the parking lot automatic parking/retrieving method.
- the parking strategy in the prior art mentioned above is low in efficiency, resulting in the low parking efficiency of the prior art parking method used in parking lots; on the other hand, it increases the cost of parking lots and the vehicles themselves.
- the cost leads to the complicated structure of the prior art parking system for parking lots and the high cost.
- An object of the present invention is to provide a new type of automatic parking/retrieving method for parking lots, which is more efficient than the prior art parking/retrieving method for parking lots.
- Another object of the present invention is to provide a parking lot system and a vehicle terminal adopting the automatic parking/retrieving method of the parking lot.
- the present invention provides an automatic parking/retrieving method in a parking lot as follows, including:
- the route selection step is to identify the starting position and the target position of the vehicle based on the request of the vehicle, and select a driving route from the route connecting the two positions included in the parking lot model, the parking lot model including the parking Route information of each route between each parking space and the entrance and exit of the parking lot, the route information including the direction information of each road section and the road characteristic parameters of the marking points set up in each road section; and
- the route information sending step is to send the route information to the vehicle.
- the road feature parameters of each marking point include:
- the distance parameter which is the absolute distance along the driving route between the position corresponding to the marking point and the starting position, or the position corresponding to the marking point corresponds to the starting marking point of the road section where the marking point is located The relative distance between the locations of;
- the radius parameter which is the radius of curvature of the road at the position corresponding to the marking point.
- the request is a parking request
- the method further includes a route information adjustment step before the route information sending step, wherein the route information in the driving route is adjusted based on the driving route and the starting position, and
- the adjusted route information is sent to the vehicle.
- the parking lot model further includes a first predetermined distance along a different route between the position corresponding to each of the marking points and the predetermined position,
- the route information adjustment step includes using the relative deviation value between the starting position and the predetermined position to correct the first predetermined distance of each marking point in the driving route to obtain the absolute distance of each marking point.
- the parking lot model further includes a second predetermined distance along the road section between the position corresponding to each of the marker points and the position corresponding to the starting marker point of the road section where the marker point is located,
- the route information adjustment step includes using the relative deviation value between the starting position and the position corresponding to the starting marking point to correct the second predetermined distance of each marking point in the road section where the starting position is located, so as to obtain the The relative distance of the marked points in the road section, and the second predetermined distance is used as the relative distance of the marked points on the road sections other than the road section where the starting position is located in the driving route.
- the route information adjustment step includes obtaining the relative deviation value by identifying the distance between the correction mark corresponding to the predetermined position in the parking lot and the starting position.
- the route information further includes the correction distance corresponding to each correction mark in the driving route.
- the route information adjustment step further includes determining a correction distance corresponding to each correction mark in the travel route based on the travel route and the starting position, and
- the route information sending step further includes sending the corrected distance corresponding to the adjusted correction flag.
- the route selection step includes: among the routes from the starting position to the target position in the parking lot, excluding routes that conflict with other vehicles driving in the parking lot, Select the route with the shortest distance from the remaining routes as the driving route.
- each of the parking spaces corresponds to one of the marking points, and both ends of each of the road sections correspond to one of the marking points;
- the distances between adjacent marking points along the road section are different; and/or
- the present invention also provides a parking lot system as follows, the parking lot system includes:
- a parking lot terminal which is used to establish a parking lot model.
- the parking lot terminal can identify the starting position and the target position of the vehicle based on the request of the vehicle and connect all of the two positions in the parking lot model.
- Select a driving route in the route the route information includes the direction information of each section in the driving route and the road characteristic parameters of all the marked points, and send the route information to the vehicle;
- An auxiliary driving terminal the auxiliary driving terminal is installed in the parking lot and can be recognized by the vehicle, and the process of the vehicle automatically driving according to the route information can be corrected by using information corresponding to the auxiliary driving terminal.
- the parking lot terminal can also adjust route information based on the driving route and the starting position, and send the adjusted route information to the vehicle.
- the parking lot terminal includes:
- a master control unit which is used to store data of the parking lot model, determine the target location, select a driving route, and adjust the route information
- a roadside communication unit which is in data communication with the master control unit, and sends information to and receives information from the vehicle;
- Multiple roadside information collection units which are in data communication with the master control unit and are used to at least identify the starting position of the vehicle, the usage state of the parking space in the parking lot, and the entrance and exit of the parking lot The state of use at the predetermined location.
- the driving assistance terminal includes a plurality of correction signs, which are arranged in the straight section of the parking lot. By identifying the correction signs, the route information can be adjusted and the driving calculated by the vehicle can be corrected. distance.
- the auxiliary driving terminal includes a lane line, which is arranged in each straight section of the parking lot and extends along the extension direction of the corresponding straight section, so that the vehicle can follow the lane line in the corresponding direction. Drive automatically in the straight section of the road.
- the automatic parking/retrieving method for a parking lot of the present invention further includes:
- the route information receiving step is to receive route information of a driving route from the starting position of the vehicle to the target position, the driving route is a route selected from a parking lot model, and the parking lot model includes each parking space of the parking lot.
- the vehicle driving control step is to control the vehicle to automatically travel from the starting position to the target position along the driving route according to the route information.
- the vehicle driving control step further includes sending positioning information when the vehicle passes through the position corresponding to the marked point, and the positioning information is used to locate the position of the vehicle in the parking lot.
- the road feature parameters of each marked point include:
- the distance parameter which is the absolute distance along the driving route between the position corresponding to the marking point and the starting position of the vehicle, or the position corresponding to the marking point and the starting marking point of the road section where the marking point is located The relative distance between corresponding locations;
- the radius parameter which is the radius of curvature of the road at the position corresponding to the marking point.
- the vehicle driving control step includes:
- the actual driving distance of the vehicle is calculated based on the driving speed, wheel steering angle and driving time of the vehicle.
- the radius parameter of the mark point is used to calculate the wheel The steering angle, so as to adjust the actual steering angle of the corresponding wheel according to the steering angle of the wheel.
- the route information further includes the correction distance corresponding to each correction mark in the driving route,
- the step of controlling the vehicle travel further includes: in the case of recognizing that the vehicle has passed the correction mark in the travel route, replacing the travel distance with the correction distance corresponding to the correction mark to correct the calculated Travel distance.
- the vehicle driving control step further includes: identifying a lane line of a straight section in the driving route to assist the vehicle to travel along the straight section.
- the present invention also provides a vehicle terminal as follows, the vehicle terminal is set in the vehicle and used to make a request to the parking lot system, and the vehicle terminal can receive the start of the vehicle as determined by the parking lot system.
- the driving route is automatically driven from the starting position of the vehicle to the target position according to the route information.
- the vehicle terminal includes:
- An on-board control unit that can calculate the driving distance of the vehicle and control the execution unit to perform actions, so that the vehicle can drive automatically;
- a plurality of vehicle-mounted information collection units which are in data communication with the vehicle-mounted control unit, and are used to measure at least the speed, wheel steering angle, and driving time of the vehicle;
- the execution unit which is used to adjust the speed and wheel steering angle of the vehicle.
- the vehicle-mounted communication unit is in data communication with the vehicle-mounted control unit, and is used for receiving information from the parking lot system and sending information to the parking lot system.
- the parking lot system only needs to select the driving route and adjust the route information in the driving route ( (Optional) and sending, the route information includes the direction information of each section in the driving route and the road characteristic parameters of each marked point in the section, and the vehicle terminal realizes the path finding based on the received route information to control the automatic driving of the vehicle, thereby greatly Improved the efficiency of the automatic parking/retrieving method.
- the parking lot system corresponding to the above method omits a large number of sensors and positioning equipment, so the structure is simple and the cost is low.
- Fig. 1a shows a schematic diagram of the overall structure of a parking lot system and a vehicle terminal according to an embodiment of the present invention
- Fig. 1b shows a block diagram of the structure of the parking lot system and a vehicle terminal in Fig. 1a.
- Fig. 2 shows a working flow chart of an example of an automatic parking/retrieving method for a parking lot according to the present invention adopted in the parking lot system and vehicle terminal shown in Figs. 1a and 1b.
- vehicle 1 vehicle terminal 11
- vehicle control unit 12a camera 12b wheel speed/steering angle sensor 12c radar 13 execution unit 14 vehicle communication unit
- the vehicle terminal 1 is installed in an appropriate part of the vehicle 1A.
- the vehicle terminal 1 includes a vehicle control unit 11, a plurality of vehicle information collection units 12a to 12c, and execution Unit 13 and in-vehicle communication unit 14.
- the vehicle-mounted control unit 11 can store data (for example, data of route information in the driving route from the parking lot terminal 2, the route information including data corresponding to the direction information of each road section in the driving route and the data of each marking point 211 in each road section.
- Road feature parameters and the data corresponding to the correction mark 2A1) which can receive and temporarily store the sensing data from multiple on-board information collection units 12a to 12c (for example, the data of the correction mark 2A1 and the lane line 2A2 recognized by the camera 12a, and the wheel speed /The wheel speed and wheel steering angle sensed by the steering angle sensor 12b, and the data corresponding to other vehicles in motion sensed by the radar 12c, etc.) can be calculated based on the sensed data (for example, calculating the travel distance and wheel steering angle of the vehicle 1A) Etc.), it is possible to receive communication data from the vehicle-mounted communication unit 14 and send communication data to the vehicle-mounted communication unit 14, and can control other units including the execution unit 13 to perform operations.
- a plurality of vehicle-mounted information collection units 12a to 12c are in data communication with the vehicle-mounted control unit 11.
- the in-vehicle information collection units 12a to 12c are used to sense the correction marks 2A1 and lane lines 2A2 in the driving route selected by the parking lot terminal 2, and are used to sense the vehicle 1A including the wheel speed, wheel steering angle, and driving time of the vehicle 1A Its own parameters and are used to sense the position of other vehicles in driving, and can transmit the sensed data to the on-board control unit 11, thereby assisting the on-board control unit 11 to control the vehicle 1A to automatically travel.
- the multiple vehicle-mounted information collection units 12a to 12c include, but are not limited to, a camera 12a, a wheel speed/steering angle sensor 12b, and a radar 12c (for example, an ultrasonic radar).
- the execution unit 13 is controlled by the in-vehicle control unit 11.
- the execution unit 13 includes at least a vehicle steering/braking device, which is used to adjust the steering angle of the wheels of the vehicle 1A and the driving speed of the vehicle 1A according to the control of the on-board control unit 11.
- the in-vehicle communication unit 14 is in data communication with the in-vehicle control unit 11.
- the in-vehicle communication unit 14 is a V2X vehicle device (an in-vehicle device used for communication between the vehicle 1A and various external devices), so that the vehicle terminal 1 of the vehicle 1A can communicate with the parking lot terminal 2 of the parking lot 2A and other vehicles.
- the vehicle terminal 1 of 1A communicates.
- the parking lot system includes a parking lot terminal 2 and an auxiliary driving terminal (correction mark 2A1 and lane line 2A2) installed in a parking lot 2A.
- the parking lot terminal 2 is installed in a proper position of the parking lot 2A.
- the parking lot terminal 2 includes a master control unit 21, a roadside information collection unit 22 and a roadside communication unit 23.
- the master control unit 21 can store data (for example, pre-store the route information of all the routes in the parking lot model, the route information includes data such as the direction information corresponding to all the road sections in each route, and the road characteristic parameters of each marked point 211 in all road sections.
- the data corresponding to the calibration mark 2A1) which can receive the sensing data from multiple roadside information collection units 22 (such as the recognized starting position of the vehicle 1A and the parking space of the parking lot 2A, and the use of predetermined locations such as entrances and exits) State) and perform processing (for example, determine the target position that the vehicle 1A is expected to arrive at, select a driving route based on the starting position and target position, and optionally adjust the route information in the driving route, etc.), and be able to receive communication data from the roadside communication unit 23 And it can send communication data to the roadside communication unit 23 and control other components to work.
- roadside information collection units 22 such as the recognized starting position of the vehicle 1A and the parking space of the parking lot 2A, and the use of predetermined locations such as entrances and exits) State
- processing for example, determine the target position that the vehicle 1A is expected to arrive at, select a driving route based on the starting position and target position, and optionally adjust the route information in the driving route, etc.
- the multiple roadside information collection units 22 are in data communication with the master control unit 21.
- a plurality of roadside information collection units 22 can sense the usage status of predetermined locations such as parking spaces and entrances and exits of the parking lot 2A, and can identify where the vehicle 1A is located when the vehicle 1A requests a parking or pick-up request. Start position, and send the status information and start position information to the master control unit 21.
- the roadside communication unit 23 is in data communication with the master control unit 21.
- the roadside communication unit 23 is a V2X roadside device, so that the parking lot terminal 2 of the parking lot 2A can communicate with the vehicle terminal 1 of each vehicle 1A.
- the auxiliary driving terminal includes correction marks 2A1 set at appropriate positions in each section of the parking lot 2A and lane lines 2A2 set at each straight section of the parking lot 2A for being recognized by the vehicle 1A to use the auxiliary
- the information corresponding to the driving terminal corrects the process in which the vehicle 1A automatically travels in accordance with the route information.
- the calibration mark 2A1 can be set at the entrance of the parking lot 2A. Based on identifying the starting position of the vehicle 1A that issued the parking request, the starting position of the vehicle 1A is obtained relative to the entrance of the parking lot 2A. The relative deviation value of the correction mark 2A1 can be used to adjust the road characteristic parameter of the corresponding marking point 211 in the driving route and the correction distance of the correction mark 2A1.
- the calibration mark 2A1 can also be set at a predetermined position of each straight section in the parking lot 2A (for example, set at a position where the distance from one end of the straight section to the end of the section is 1/3 of the length of the section), which can be used
- the camera 12a of the vehicle terminal 1 recognizes the correction mark 2A1, and can use the correction distance corresponding to the correction mark 2A1 to correct the result of the travel distance of the vehicle 1A calculated by the vehicle terminal 1 during the automatic driving of the vehicle 1A, thereby eliminating the calculated vehicle 1A Cumulative error of travel distance.
- the specific method of using the calibration mark 2A1 to perform calibration will be described in detail in the following description of the automatic parking/retrieving method of the parking lot.
- the lane line 2A2 is provided in each straight section in the parking lot 2A and extends along the extending direction of the corresponding section. In the case where the vehicle 1A can recognize the lane line 2A2 with the camera 12a, the lane line 2A2 can assist the vehicle 1A to automatically travel in each straight section.
- FIG. 1a shows that a plurality of marking points 211 are set up in each section of the parking lot 2A
- the marking points 211 belong to the virtual markers set up in the process of building a model of the parking lot 2A. It does not exist physically. Therefore, the marking point 211 will be described in detail in the following description of the automatic parking/retrieving method of the parking lot.
- the working process of the automatic parking/retrieving method for the parking lot according to the present invention can be divided into two parts, one part is completed in the vehicle terminal 1, and the other part is completed in the parking lot system.
- the process of this method can be summarized as follows.
- a parking lot model corresponding to the parking lot 2A is pre-established in the parking lot terminal 2 of the parking lot system.
- the parking lot model includes all feasible routes (including route information) between each parking space of the parking lot 2A and the entrance and exit.
- the route information includes the link information of each link in the corresponding route, the road feature parameters of the multiple marking points 211 set up in each link of the parking lot 2A, and the correction distance corresponding to the correction mark 2A1.
- the parking lot terminal 2 determines the starting position of the vehicle 1A and the intended target position of the vehicle 1A from the parking lot model, and selects a driving route among all the routes connecting the two positions.
- the vehicle terminal 1 Based on the driving route and starting position, optionally adjust the direction information of each road segment in the driving route and the road characteristic parameters of all the marking points 211, and then (if adjusted, the adjusted) direction of each road segment in the driving route.
- the information and the road characteristic parameters of all the marking points 211 in each road section are sent to the vehicle terminal 1 in the form of data packets.
- the vehicle terminal 1 receives the above-mentioned data packet to obtain the direction information of each road segment in the travel route and the road characteristic parameters of all the marker points 211 in each road segment. Further, the vehicle terminal 1 controls the vehicle 1A to follow the travel route according to the direction of each road segment. The information and the road characteristic parameters of each marking point 211 are automatically driven from the starting position to the target position, so that the vehicle is parked in the corresponding parking space or the vehicle is waiting to be picked up at the exit of the parking lot 2A.
- a parking lot model is established in the parking lot terminal 2 in advance.
- the parking lot 2A includes multiple straight road sections and multiple curved road sections connected to each other. Therefore, the corresponding parking lot model includes not only all feasible routes between parking spaces and entrances and exits, but also all routes.
- the direction information in each road segment can be defined by using the marking point 211 corresponding to one of the two ends of the road segment as the starting marking point for the vehicle 1A to pass the road segment.
- Each marking point 211 includes at least two parameters, a distance parameter and a radius parameter.
- the distance parameter can be defined in two ways. In the first way, for each road section in the driving route, the distance parameter is the relative distance along the road section between the position corresponding to each mark point 211 in the road section and the position corresponding to the above-mentioned starting mark point; In one manner, for the entire driving route, the distance parameter is the absolute distance along the driving route between the position corresponding to the marking point 211 and the starting position of the vehicle 1A identified by the parking lot terminal 2. Compared with the second method, the first method is more preferable. Further, the radius parameter is the radius of curvature of the road section at the position corresponding to the marking point 211, and the radius parameter is zero when the road section is a straight road section.
- each road section contains a plurality of different marking points 211 and the distance between two adjacent marking points 211 can be different ,
- the two ends of each road section correspond to a mark point 211 respectively.
- each parking space in the parking lot 2A corresponds to a marking point 211 (it can be called a parking space marking point, which is used as the end marking point during parking and the starting point during the pick-up process) ), the following Table 3 shows the information corresponding to the straight road section containing the parking spot marking points and the correction mark 2A1.
- Table 3 since the radius parameter is zero in the straight section, the data corresponding to the radius parameter is omitted in Table 3.
- the above-mentioned parking space marking points not only correspond to each parking space as the starting marking point/ending marking point for the automatic driving of the vehicle 1A, but also can be used as the marking point corresponding to the end point of each road section, that is to say, the parking space marking point can be used To divide different road sections.
- the route information should include the correction distance corresponding to each correction mark 2A1, and the correction distance of the correction mark 2A1 is also adjusted while adjusting the road characteristic parameters of each marking point 211 as follows . It should be noted that the correction mark 2A1 set up at the entrance of the parking lot adjusts the route information based on the starting position of the vehicle 1A, and there is no need to adjust the correction distance corresponding to the correction mark 2A1.
- the parking lot terminal 2 should collect in advance the road characteristic parameters of the marking points 211 of all road sections in the parking lot 2A. This can be obtained by driving the test vehicle slowly along all sections of the parking lot 2A at a fixed speed. In the process of collecting road characteristic parameters using the test vehicle, the driving speed, wheel steering angle and travel time of the test vehicle can be measured and recorded. These parameters can be used to obtain the desired road characteristics of each marker 211 through appropriate arithmetic operations. parameter.
- the vehicle terminal 1 of the vehicle 1A makes a parking request to the parking lot terminal 2.
- the parking lot terminal 2 receives the parking request from the vehicle terminal 1 of the vehicle 1A, and performs the following operations in response to the parking request.
- the parking lot terminal 2 first identifies the starting position of the vehicle 1A that made the parking request, and at the same time, uses the multiple roadside information collection units 22 of the parking lot terminal 2 to find unoccupied One of the parking spaces (for example, the unoccupied parking space closest to the starting position) and the position corresponding to the parking space marking point 211 corresponding to the parking space is designated as the target position that the vehicle 1A is scheduled to reach (the marking Point 211 is the termination mark point).
- the parking lot is proposed for parking
- the requested vehicle 1A finds the most time-saving travel route (for example, the route with the shortest distance) without conflicting with other running vehicles 1A from all the routes connecting the starting position and the target position.
- step S23 based on the starting position and the driving route, the parking lot terminal 2 adjusts the route information, that is, adjusts the direction information of each road section in the driving route and the road characteristic parameters of all the marking points 211 in each road section and all the correction signs 2A1. Corresponding correction distance.
- the starting mark point of each road segment in the driving route is determined, so as to determine the direction information of each road segment that constitutes the driving route.
- the road feature parameters contained in each of the marked points 211 in the driving route can be adjusted by the following method.
- the distance parameter stored in the marking point 211 is the above-mentioned relative distance
- the master control unit 21 is pre-stored
- the relative distance values along the road section between the marking point 211 in each road section and the starting marking point of the road section are assigned the distance parameters of the corresponding marking point 211 respectively.
- the distance parameter stored in the marker point 211 is the above-mentioned relative distance
- the relative deviation value along the road section where it is located, and the relative deviation value is used to correct the relative distance along the road section between each mark point 211 and the start mark point in the road section pre-stored by the master control unit 21; for the driving route
- the distance parameters of the marking points 211 in the remaining road sections do not need to be corrected by the above-mentioned relative deviation value, and the distance between the marking point 211 of each road section stored by the master control unit 21 and the starting mark point of the road section is still along the road section.
- the relative distance value of is assigned to the distance parameter of the corresponding mark point 211, respectively.
- the distance parameter stored in the marking point 211 is the above-mentioned absolute distance
- the master control unit 21 is pre-stored
- the distance values along the travel route between each of the marked points 211 and the predetermined position at the entrance of the parking lot 2A are assigned distance parameters of the corresponding marked points 211, respectively.
- the distance parameter stored in the marking point 211 is the above-mentioned absolute distance
- the difference between the two positions is identified
- the relative deviation value along the driving route and the distance value along the driving route between each marked point 211 pre-stored by the master control unit 21 and the predetermined position at the entrance of the parking lot 2A are used to perform arithmetic After the calculation, the obtained result is assigned to the distance parameter of the corresponding marked point 211.
- the radius parameter of each mark point 211 may be a constant constant. That is to say, when the road section corresponding to the position corresponding to each marking point 211 is a straight road section, the radius parameter of the marking point 211 is zero; when the road section corresponding to the position corresponding to each marking point 211 is a curved road section, the marking point 211 The radius parameter of is equal to the radius of curvature of the curve section at the position corresponding to the mark point 211.
- each correction mark 2A1 in the travel route can be adjusted in the same way as the method of adjusting the distance parameter of each mark point 211 in the travel route.
- the parking lot terminal 2 then transmits the adjusted route information to the vehicle-mounted communication unit 14 of the vehicle terminal 1 of the vehicle 1A via the roadside communication unit 23.
- the in-vehicle communication unit 14 of the vehicle terminal 1 receives the adjusted route information of the traveling route from the roadside communication unit 23 of the parking lot terminal 2 and sends the information to the in-vehicle control unit 11 of the vehicle terminal 1.
- the vehicle terminal 1 controls the vehicle 1A to automatically travel from the starting position to the target position along the travel route according to the adjusted route information.
- the vehicle terminal 1 calculates the distance traveled by the vehicle 1A through the wheel speed, wheel steering angle, and travel time collected by the on-board information collection unit. That is to say, the vehicle terminal 1 always uses the vehicle's above parameters to calculate the vehicle The current distance traveled. Then, the travel distance is compared with the distance parameter in each marked point 211 in the travel route. When the driving distance is consistent with the distance parameter, it means that the vehicle 1A is driving past the corresponding mark point 211. At this time, on the one hand, the vehicle terminal 1 can use the radius parameter of the marker point 211, or use the radius parameter of the next marker point 211 of the marker point 211 in the direction of the road section, or use all the marker points in the road section.
- the corresponding radius of curvature in the interpolation curve fitted by the radius parameter of 211 calculates the new wheel steering angle and controls the execution unit 13 to adjust the steering angle of each steering wheel;
- the position information of the vehicle 1A is transmitted (corresponding to S222). Therefore, using the distance parameter in each marking point 211 in the driving route as the judgment condition, when the vehicle 1A travels the same distance as the distance parameter of each marking point 211, the vehicle 1A realizes the position where each marking point 211 is located. Accurate adjustment of the steering angle of the wheels allows the vehicle 1A to travel automatically and correctly along the driving route.
- the vehicle terminal 1 can feed back position information to the parking lot terminal 2 for reference when the parking lot terminal 2 selects a driving route for other vehicles 1A.
- the travel distance calculated by the vehicle terminal 1 will produce cumulative errors due to various factors. This cumulative error will cause the travel distance calculated by the vehicle terminal 1 to not accurately reflect the driving route of the vehicle 1A. It is necessary to use the correction distance of the correction mark 2A1 set on the travel route to correct the travel distance calculated by the vehicle terminal 1.
- the calibration mark 2A1 can be identified by the on-board information collection unit of the vehicle terminal 1.
- the on-board control unit 11 of the vehicle terminal 1 When the on-board information collection unit of the vehicle terminal 1 recognizes the corresponding correction flag 2A1, the on-board control unit 11 of the vehicle terminal 1 will replace the correction distance corresponding to the correction flag 2A1 received by the parking lot terminal 2 with the correction distance calculated by the vehicle terminal 1 The travel distance is corrected so as to correct the cumulative error generated by the vehicle terminal 1 calculating the travel distance before the correction mark 2A1 is recognized. Moreover, when a vehicle is used to drive through a curve section, the marking points 211 in each curve section should be arranged as densely as possible, so as to eliminate the cumulative error caused by inaccurate turning when the vehicle is automatically driven by the above method.
- the on-board information collection unit 22 of the vehicle terminal 1 can also identify the lane line 2A2 on the straight section, so that the vehicle 1A drives along the lane line 2A2. This has a good assisting effect on the automatic driving of the vehicle 1A along the straight section.
- the vehicle 1A reaches the target position corresponding to the termination mark point, that is, in front of the designated unoccupied parking space, and the vehicle terminal 1 controls the vehicle 1A to reverse and enter the parking space.
- the technical concept of the present invention is not limited to the realization of the above parking/retrieval, for example, when the vehicle 1A needs to move between two parking spaces in the parking lot 2A or when the vehicle 1A passes through the parking lot directly from the entrance of the parking lot 2A to arrive
- the method according to the present invention can be used at the exit of the parking lot 2A.
- the technical concept of the present invention can also be applied to places other than parking lots for vehicle scheduling.
- the execution unit 13 maintains the vehicle 1A at an appropriate driving speed (generally a lower driving speed).
- the vehicle 1A can be equipped with an adaptive cruise system, and it can be turned on to prevent a collision between the driving vehicles 1A.
- the parking lot terminal 2 after the parking lot terminal 2 receives the request sent by the vehicle terminal 1, it only needs to select the driving route, selectively adjust the route information of the driving route, and send the route information to the vehicle terminal 1, and the vehicle terminal 1 There is no need to plan a route by itself, but only need to receive the above-mentioned data from the parking lot terminal 2 and drive automatically according to the route information contained in the above-mentioned data. Therefore, the automatic parking/retrieving system according to the present invention does not need to locate the position of the vehicle 1A based on GPS, so that the automatic parking/retrieving method and system according to the present invention are also suitable for places with very weak GPS signals such as underground parking lots. .
- the vehicle terminal is sent to the vehicle terminal 1, and the vehicle terminal is corrected by the vehicle terminal 1’s on-board information collection system to identify the correction mark 2A1.
- 1 Calculated travel distance but the present invention is not limited to this.
- the corrected distance corresponding to the correction flag 2A1 is sent to the vehicle terminal 1, and the corrected distance is used to replace the travel distance calculated by the vehicle terminal 1.
- the information collection unit provided on the calibration mark 2A1 may include a millimeter wave radar sensor and/or a license plate recognition camera.
- the road section is a straight road section
- the road section is a curved road section
- the parking lot terminal 2 performs subsequent processing based on the request of the vehicle terminal 1, the present invention is not limited to this.
- the parking lot terminal 2 may recognize that the vehicle 1A is driving to the entrance of the parking lot 2A and actively push the route for navigation.
- the parking lot terminal 2 of the present invention is not limited to being set only in the parking lot 2A, and may be a remote server (cloud server). In this way, the terminal can theoretically be set at any position as long as it can realize the functions described in the present invention; and in the case of using a cloud server, it can realize the function of controlling multiple parking lots at the same time.
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
Abstract
An automatic vehicle parking/retrieving method for a parking lot (2A). In the process of automatic vehicle parking/retrieving, a parking lot system only needs to select a driving route and adjust and send route information in the driving route, the route information comprising direction information of road sections in the driving route and road feature parameters of marked points (211) in the road sections, and a vehicle terminal (1) realizes wayfinding on the basis of the route information to control a vehicle (1A) to automatically drive. Thus, the efficiency of the automatic vehicle parking/retrieving method is greatly improved. In addition, the parking lot system and the vehicle terminal (1) corresponding to the method are further provided, a large number of sensors and positioning devices are not necessary for the parking lot system, and thus the structure is simple and costs are low.
Description
本发明涉及车辆自动控制领域,具体地涉及停车场自动泊车/取车方法及采用该停车场自动泊车/取车方法的停车场系统及车辆终端。The present invention relates to the field of vehicle automatic control, in particular to a parking lot automatic parking/retrieving method, a parking lot system and a vehicle terminal adopting the parking lot automatic parking/retrieving method.
在例如公开号为CN107209518A的中国专利中说明的现有的代客泊车系统中,不仅需要中央控制单元为停车场建立精确的路线图以及在停车场内设置大量的传感器协助泊车,而且车辆需要进行自身定位并通过中央控制器进行引导以实现泊车。For example, in the existing valet parking system described in the Chinese Patent Publication No. CN107209518A, not only the central control unit is required to establish an accurate route map for the parking lot and a large number of sensors are installed in the parking lot to assist parking, but also the vehicle Need to position itself and be guided by the central controller to realize parking.
因此,一方面,上述现有技术中的泊车策略效率较低,导致现有技术的用于停车场的泊车方法的泊车效率不高;另一方面,增加了停车场和车辆本身的成本,导致现有技术的用于停车场的泊车系统的结构复杂,而且成本较高。Therefore, on the one hand, the parking strategy in the prior art mentioned above is low in efficiency, resulting in the low parking efficiency of the prior art parking method used in parking lots; on the other hand, it increases the cost of parking lots and the vehicles themselves. The cost leads to the complicated structure of the prior art parking system for parking lots and the high cost.
发明内容Summary of the invention
为了克服或至少减轻上述现有技术存在的不足而做出了本发明。本发明的一个目的在于提供一种新型的停车场自动泊车/取车方法,其相比现有技术的用于停车场的泊车/取车方法的效率更高。本发明的另一个目的在于提供一种采用该停车场自动泊车/取车方法的停车场系统及车辆终端。The present invention has been made in order to overcome or at least alleviate the above-mentioned shortcomings of the prior art. An object of the present invention is to provide a new type of automatic parking/retrieving method for parking lots, which is more efficient than the prior art parking/retrieving method for parking lots. Another object of the present invention is to provide a parking lot system and a vehicle terminal adopting the automatic parking/retrieving method of the parking lot.
为了实现上述发明目的,本发明采用如下的技术方案。In order to achieve the above-mentioned purpose of the invention, the present invention adopts the following technical solutions.
本发明提供了一种如下的停车场自动泊车/取车方法,包括:The present invention provides an automatic parking/retrieving method in a parking lot as follows, including:
路线选择步骤,基于车辆的请求识别该车辆的起始位置和目标位置,并在停车场模型所包含的连接这两个位置之间的路线中选择行驶路线,所述停车场模型包括所述停车场的各停车位与入口和出口之间的各路线的路线信息,所述路线信息包括各路段的方向信息以及各路段中设立的标记点的道路特征参数;以及The route selection step is to identify the starting position and the target position of the vehicle based on the request of the vehicle, and select a driving route from the route connecting the two positions included in the parking lot model, the parking lot model including the parking Route information of each route between each parking space and the entrance and exit of the parking lot, the route information including the direction information of each road section and the road characteristic parameters of the marking points set up in each road section; and
路线信息发送步骤,将所述路线信息发送到所述车辆。The route information sending step is to send the route information to the vehicle.
优选地,各标记点的道路特征参数包括:Preferably, the road feature parameters of each marking point include:
距离参数,其为该标记点对应的位置与所述起始位置之间的沿着所述行 驶路线的绝对距离,或者为该标记点对应的位置与该标记点所在路段的起始标记点对应的位置之间的相对距离;以及The distance parameter, which is the absolute distance along the driving route between the position corresponding to the marking point and the starting position, or the position corresponding to the marking point corresponds to the starting marking point of the road section where the marking point is located The relative distance between the locations of; and
半径参数,其为该标记点对应的位置处的道路曲率半径。The radius parameter, which is the radius of curvature of the road at the position corresponding to the marking point.
更优选地,当所述请求为泊车请求时,More preferably, when the request is a parking request,
所述方法在所述路线信息发送步骤之前还包括路线信息调整步骤,其中基于所述行驶路线和所述起始位置调整所述行驶路线中的所述路线信息,并且The method further includes a route information adjustment step before the route information sending step, wherein the route information in the driving route is adjusted based on the driving route and the starting position, and
在所述路线信息发送步骤中,将调整后的所述路线信息发送到所述车辆。In the route information sending step, the adjusted route information is sent to the vehicle.
更优选地,所述停车场模型还包括各所述标记点对应的位置与预定位置之间沿着不同路线的第一预定距离,More preferably, the parking lot model further includes a first predetermined distance along a different route between the position corresponding to each of the marking points and the predetermined position,
所述路线信息调整步骤包括利用所述起始位置与所述预定位置之间的相对偏差值修正所述行驶路线中各标记点的第一预定距离来得到各标记点的绝对距离。The route information adjustment step includes using the relative deviation value between the starting position and the predetermined position to correct the first predetermined distance of each marking point in the driving route to obtain the absolute distance of each marking point.
更优选地,所述停车场模型还包括各所述标记点对应的位置与该标记点所在路段的起始标记点对应的位置之间沿着该路段的第二预定距离,More preferably, the parking lot model further includes a second predetermined distance along the road section between the position corresponding to each of the marker points and the position corresponding to the starting marker point of the road section where the marker point is located,
所述路线信息调整步骤包括利用所述起始位置与所述起始标记点对应的位置之间的相对偏差值修正所述起始位置所在路段中各标记点的第二预定距离,以得到该路段中标记点的所述相对距离,并且采用所述第二预定距离作为所述行驶路线中除了所述起始位置所在路段之外其它路段的各标记点的所述相对距离。The route information adjustment step includes using the relative deviation value between the starting position and the position corresponding to the starting marking point to correct the second predetermined distance of each marking point in the road section where the starting position is located, so as to obtain the The relative distance of the marked points in the road section, and the second predetermined distance is used as the relative distance of the marked points on the road sections other than the road section where the starting position is located in the driving route.
更优选地,所述路线信息调整步骤包括通过识别所述停车场中对应于所述预定位置的校正标志与所述起始位置之间的距离来获得所述相对偏差值。More preferably, the route information adjustment step includes obtaining the relative deviation value by identifying the distance between the correction mark corresponding to the predetermined position in the parking lot and the starting position.
更优选地,所述路线信息还包括所述行驶路线中的各校正标志所对应的校正距离。More preferably, the route information further includes the correction distance corresponding to each correction mark in the driving route.
更优选地,所述路线信息调整步骤还包括基于所述行驶路线和所述起始位置确定所述行驶路线中的各校正标志所对应的校正距离,并且More preferably, the route information adjustment step further includes determining a correction distance corresponding to each correction mark in the travel route based on the travel route and the starting position, and
所述路线信息发送步骤还包括发送调整后的所述校正标志所对应的校正距离。The route information sending step further includes sending the corrected distance corresponding to the adjusted correction flag.
更优选地,所述路线选择步骤包括:在所述停车场内从所述起始位置到所述目标位置的各路线中,排除与所述停车场内正在行驶的其它车辆发生冲 突的路线,从其余路线中选择距离最短的路线作为所述行驶路线。More preferably, the route selection step includes: among the routes from the starting position to the target position in the parking lot, excluding routes that conflict with other vehicles driving in the parking lot, Select the route with the shortest distance from the remaining routes as the driving route.
更优选地,各所述停车位所在位置分别对应一个所述标记点,且各所述路段的两端分别对应一个所述标记点;More preferably, the location of each of the parking spaces corresponds to one of the marking points, and both ends of each of the road sections correspond to one of the marking points;
在同一所述路段中,相邻所述标记点之间沿着该路段的距离不同;并且/或者In the same road section, the distances between adjacent marking points along the road section are different; and/or
所述停车场内的弯路段的曲率半径的变化频率越大,该弯路段中的相邻所述标记点之间的距离越小。The greater the change frequency of the radius of curvature of the curved road section in the parking lot, the smaller the distance between the adjacent marking points in the curved road section.
本发明还提供了一种如下的停车场系统,所述停车场系统包括:The present invention also provides a parking lot system as follows, the parking lot system includes:
停车场终端,其用于建立停车场模型,所述停车场终端能够基于车辆的请求识别所述车辆的起始位置和目标位置并在所述停车场模型中连接这两个位置之间的所有路线中选择行驶路线,所述路线信息包括所述行驶路线中的各路段的方向信息和所有标记点的道路特征参数并将所述路线信息发送到所述车辆;以及A parking lot terminal, which is used to establish a parking lot model. The parking lot terminal can identify the starting position and the target position of the vehicle based on the request of the vehicle and connect all of the two positions in the parking lot model. Select a driving route in the route, the route information includes the direction information of each section in the driving route and the road characteristic parameters of all the marked points, and send the route information to the vehicle; and
辅助行驶终端,所述辅助行驶终端设置于所述停车场并能够被所述车辆识别,利用所述辅助行驶终端对应的信息能够修正所述车辆按照所述路线信息自动行驶的过程。An auxiliary driving terminal, the auxiliary driving terminal is installed in the parking lot and can be recognized by the vehicle, and the process of the vehicle automatically driving according to the route information can be corrected by using information corresponding to the auxiliary driving terminal.
优选地,当所述请求为泊车请求时,所述停车场终端还能够基于所述行驶路线和所述起始位置调整路线信息,并将调整后的所述路线信息发送到所述车辆。Preferably, when the request is a parking request, the parking lot terminal can also adjust route information based on the driving route and the starting position, and send the adjusted route information to the vehicle.
更优选地,所述停车场终端包括:More preferably, the parking lot terminal includes:
总控单元,其用于存储所述停车场模型的数据、确定所述目标位置、选择行驶路线并调整所述路线信息;A master control unit, which is used to store data of the parking lot model, determine the target location, select a driving route, and adjust the route information;
路侧通信单元,其与所述总控单元数据连通,并且向所述车辆发送信息以及接收来自所述车辆的信息;以及A roadside communication unit, which is in data communication with the master control unit, and sends information to and receives information from the vehicle; and
多个路侧信息采集单元,其与所述总控单元数据连通并且至少用于识别所述车辆的起始位置、所述停车场内的停车位的使用状态以及所述停车场的入口和出口处的预定位置的使用状态。Multiple roadside information collection units, which are in data communication with the master control unit and are used to at least identify the starting position of the vehicle, the usage state of the parking space in the parking lot, and the entrance and exit of the parking lot The state of use at the predetermined location.
更优选地,所述辅助行驶终端包括多个校正标志,其设置于所述停车场内的直路段中,通过识别该校正标志能够调整所述路线信息并且能够校正所述车辆计算的所述行驶距离。More preferably, the driving assistance terminal includes a plurality of correction signs, which are arranged in the straight section of the parking lot. By identifying the correction signs, the route information can be adjusted and the driving calculated by the vehicle can be corrected. distance.
更优选地,所述辅助行驶终端包括车道线,其设置于所述停车场的各直 路段并且沿着对应的所述直路段的延伸方向延伸,使得所述车辆能够按照所述车道线在对应的直路段中自动行驶。More preferably, the auxiliary driving terminal includes a lane line, which is arranged in each straight section of the parking lot and extends along the extension direction of the corresponding straight section, so that the vehicle can follow the lane line in the corresponding direction. Drive automatically in the straight section of the road.
本发明的停车场自动泊车/取车方法还包括:The automatic parking/retrieving method for a parking lot of the present invention further includes:
路线信息接收步骤,接收从车辆的起始位置到目标位置的行驶路线的路线信息,所述行驶路线是选自停车场模型中的路线,所述停车场模型包括所述停车场的各停车位与入口和出口之间的各路线的路线信息,所述路线信息包括各所述路线中各路段的方向信息以及各路段中设立的标记点的道路特征参数;以及The route information receiving step is to receive route information of a driving route from the starting position of the vehicle to the target position, the driving route is a route selected from a parking lot model, and the parking lot model includes each parking space of the parking lot. Route information of each route between the entrance and the exit, the route information including the direction information of each road section in each of the routes and the road characteristic parameters of the marking points set up in each road section; and
车辆行驶控制步骤,控制所述车辆沿着所述行驶路线按照所述路线信息从所述起始位置自动行驶到所述目标位置。The vehicle driving control step is to control the vehicle to automatically travel from the starting position to the target position along the driving route according to the route information.
优选地,所述车辆行驶控制步骤还包括所述车辆行驶通过所述标记点对应的位置时发送定位信息,所述定位信息用于定位所述车辆在所述停车场内的位置。Preferably, the vehicle driving control step further includes sending positioning information when the vehicle passes through the position corresponding to the marked point, and the positioning information is used to locate the position of the vehicle in the parking lot.
更优选地,各标记点的道路特征参数包括:More preferably, the road feature parameters of each marked point include:
距离参数,其为该标记点对应的位置与所述车辆的起始位置之间的沿着所述行驶路线的绝对距离或者为该标记点对应的位置与该标记点所在路段的起始标记点对应的位置之间的相对距离;以及The distance parameter, which is the absolute distance along the driving route between the position corresponding to the marking point and the starting position of the vehicle, or the position corresponding to the marking point and the starting marking point of the road section where the marking point is located The relative distance between corresponding locations; and
半径参数,其为该标记点对应的位置处的道路曲率半径。The radius parameter, which is the radius of curvature of the road at the position corresponding to the marking point.
更优选地,所述车辆行驶控制步骤包括:More preferably, the vehicle driving control step includes:
基于所述车辆的行驶速度、车轮转向角度和行驶时间计算所述车辆实际行驶经过的行驶距离,当所述行驶距离等于所述标记点的距离参数时,利用该标记点的半径参数计算得到车轮转向角度,从而按照该车轮转向角度调整对应车轮的实际转向角度。The actual driving distance of the vehicle is calculated based on the driving speed, wheel steering angle and driving time of the vehicle. When the driving distance is equal to the distance parameter of the mark point, the radius parameter of the mark point is used to calculate the wheel The steering angle, so as to adjust the actual steering angle of the corresponding wheel according to the steering angle of the wheel.
更优选地,所述路线信息还包括所述行驶路线中的各校正标志所对应的校正距离,More preferably, the route information further includes the correction distance corresponding to each correction mark in the driving route,
所述车辆行驶控制步骤还包括:在识别到所述车辆经过所述行驶路线中的校正标志的情况下,通过所述校正标志所对应的校正距离替换所述行驶距离,以校正计算的所述行驶距离。The step of controlling the vehicle travel further includes: in the case of recognizing that the vehicle has passed the correction mark in the travel route, replacing the travel distance with the correction distance corresponding to the correction mark to correct the calculated Travel distance.
更优选地,所述车辆行驶控制步骤还包括:识别所述行驶路线中的直路段的车道线来辅助所述车辆沿着该直路段行驶。More preferably, the vehicle driving control step further includes: identifying a lane line of a straight section in the driving route to assist the vehicle to travel along the straight section.
本发明还提供了一种如下的车辆终端,所述车辆终端设置于所述车辆并 用于向停车场系统提出请求,所述车辆终端能够接收由所述停车场系统确定的从所述车辆的起始位置到目标位置的行驶路线的路线信息,所述路线信息包括所述行驶路线中的各路段的方向信息和所有标记点的道路特征参数,所述车辆终端能够控制所述车辆沿着所述行驶路线按照所述路线信息从所述车辆的起始位置自动行驶到目标位置。The present invention also provides a vehicle terminal as follows, the vehicle terminal is set in the vehicle and used to make a request to the parking lot system, and the vehicle terminal can receive the start of the vehicle as determined by the parking lot system. The route information of the driving route from the starting position to the target position, the route information including the direction information of each section in the driving route and the road characteristic parameters of all marked points, and the vehicle terminal can control the vehicle along the The driving route is automatically driven from the starting position of the vehicle to the target position according to the route information.
优选地,所述车辆终端包括:Preferably, the vehicle terminal includes:
车载控制单元,其能够计算所述车辆的行驶距离并控制执行单元进行动作,从而使得所述车辆自动行驶;An on-board control unit that can calculate the driving distance of the vehicle and control the execution unit to perform actions, so that the vehicle can drive automatically;
多个车载信息采集单元,其与所述车载控制单元数据连通,并用于至少测量所述车辆的速度、车轮转向角度和行驶时间;A plurality of vehicle-mounted information collection units, which are in data communication with the vehicle-mounted control unit, and are used to measure at least the speed, wheel steering angle, and driving time of the vehicle;
所述执行单元,其用于调节所述车辆的速度和车轮转向角度;以及The execution unit, which is used to adjust the speed and wheel steering angle of the vehicle; and
车载通信单元,其与所述车载控制单元数据连通,并且用于接收来自所述停车场系统的信息以及向所述停车场系统发送信息。The vehicle-mounted communication unit is in data communication with the vehicle-mounted control unit, and is used for receiving information from the parking lot system and sending information to the parking lot system.
这样,通过采用上述技术方案,在利用上述停车场自动泊车/取车方法进行自动泊车/取车过程中,停车场系统仅需要进行行驶路线的选择和对行驶路线中路线信息进行调整(可选)和发送,该路线信息包括行驶路线中各路段的方向信息和路段中各标记点的道路特征参数,而由车辆终端基于接收到的路线信息实现寻路来控制车辆自动行驶,从而大大提高了自动泊车/取车方法的效率。另外,与上述方法对应的停车场系统省略了大量的传感器和定位设备,因此使得结构简单且成本较低。In this way, by adopting the above technical solution, in the process of using the above-mentioned parking lot automatic parking/retrieving method for automatic parking/retrieving, the parking lot system only needs to select the driving route and adjust the route information in the driving route ( (Optional) and sending, the route information includes the direction information of each section in the driving route and the road characteristic parameters of each marked point in the section, and the vehicle terminal realizes the path finding based on the received route information to control the automatic driving of the vehicle, thereby greatly Improved the efficiency of the automatic parking/retrieving method. In addition, the parking lot system corresponding to the above method omits a large number of sensors and positioning equipment, so the structure is simple and the cost is low.
图1a示出了根据本发明的一实施方式的停车场系统和车辆终端的整体结构示意图;图1b示出了图1a中的停车场系统和车辆终端的结构框图。Fig. 1a shows a schematic diagram of the overall structure of a parking lot system and a vehicle terminal according to an embodiment of the present invention; Fig. 1b shows a block diagram of the structure of the parking lot system and a vehicle terminal in Fig. 1a.
图2示出了在图1a和图1b中所示的停车场系统和车辆终端中采用的根据本发明的停车场自动泊车/取车方法的一示例的工作流程图。Fig. 2 shows a working flow chart of an example of an automatic parking/retrieving method for a parking lot according to the present invention adopted in the parking lot system and vehicle terminal shown in Figs. 1a and 1b.
附图标记说明Description of Reference Signs
1A车辆 1车辆终端 11车载控制单元 12a摄像机 12b车轮速度/转向角度传感器 12c雷达 13执行单元 14车载通信单元 1A vehicle 1 vehicle terminal 11 vehicle control unit 12a camera 12b wheel speed/steering angle sensor 12c radar 13 execution unit 14 vehicle communication unit
2A停车场 2A1校正标志 2A2车道线 2停车场终端 21总控单元 211标记点 22路侧信息采集单元 23路侧通信单元。2A parking lot 2A1 calibration mark 2A2 lane line 2 parking lot terminal 21 master control unit 211 marking point 22 roadside information collection unit 23 roadside communication unit.
下面参照附图描述本发明的示例性实施方式。以下将首先说明根据本发明的一实施方式的停车场系统和车辆终端的结构。Hereinafter, exemplary embodiments of the present invention will be described with reference to the drawings. Hereinafter, the structure of a parking lot system and a vehicle terminal according to an embodiment of the present invention will be explained first.
(根据本发明的停车场系统和车辆终端的结构)(Structure of parking lot system and vehicle terminal according to the present invention)
具体地,如图1a和图1b所示,在本实施方式中,车辆终端1设置于车辆1A的适当部位,该车辆终端1包括车载控制单元11、多个车载信息采集单元12a至12c、执行单元13和车载通信单元14。Specifically, as shown in Figures 1a and 1b, in this embodiment, the vehicle terminal 1 is installed in an appropriate part of the vehicle 1A. The vehicle terminal 1 includes a vehicle control unit 11, a plurality of vehicle information collection units 12a to 12c, and execution Unit 13 and in-vehicle communication unit 14.
车载控制单元11能够存储数据(例如来自停车场终端2的行驶路线中路线信息的数据,该路线信息包括行驶路线中的各路段的方向信息对应的数据和每个路段中的各标记点211的道路特征参数和校正标志2A1对应的数据),能够接收并暂存来自多个车载信息采集单元12a至12c的感测数据(例如摄像机12a所识别的校正标志2A1和车道线2A2的数据、车轮速度/转向角度传感器12b感测的车轮速度和车轮转向角度以及雷达12c所感测的行驶中的其它车辆对应的数据等),能够基于感测数据进行计算(例如计算车辆1A的行驶距离和车轮转向角度等),能够从车载通信单元14接收通信数据和向车载通信单元14发送通信数据,并且能够控制包括执行单元13在内的其它单元进行工作。The vehicle-mounted control unit 11 can store data (for example, data of route information in the driving route from the parking lot terminal 2, the route information including data corresponding to the direction information of each road section in the driving route and the data of each marking point 211 in each road section. Road feature parameters and the data corresponding to the correction mark 2A1), which can receive and temporarily store the sensing data from multiple on-board information collection units 12a to 12c (for example, the data of the correction mark 2A1 and the lane line 2A2 recognized by the camera 12a, and the wheel speed /The wheel speed and wheel steering angle sensed by the steering angle sensor 12b, and the data corresponding to other vehicles in motion sensed by the radar 12c, etc.) can be calculated based on the sensed data (for example, calculating the travel distance and wheel steering angle of the vehicle 1A) Etc.), it is possible to receive communication data from the vehicle-mounted communication unit 14 and send communication data to the vehicle-mounted communication unit 14, and can control other units including the execution unit 13 to perform operations.
多个车载信息采集单元12a至12c与车载控制单元11数据连通。车载信息采集单元12a至12c用于感测由停车场终端2选择的行驶路线中的校正标志2A1和车道线2A2,用于感测包括车辆1A的车轮转速、车轮转向角度及行驶时间的车辆1A本身的参数以及用于感测行驶中的其它车辆的位置,并且能够将感测到的数据传输到车载控制单元11,从而辅助车载控制单元11控制车辆1A自动行驶。在本实施方式中,多个车载信息采集单元12a至12c包括但不限于摄像机12a、车轮速度/转向角度传感器12b和雷达12c(例如超声雷达)。A plurality of vehicle-mounted information collection units 12a to 12c are in data communication with the vehicle-mounted control unit 11. The in-vehicle information collection units 12a to 12c are used to sense the correction marks 2A1 and lane lines 2A2 in the driving route selected by the parking lot terminal 2, and are used to sense the vehicle 1A including the wheel speed, wheel steering angle, and driving time of the vehicle 1A Its own parameters and are used to sense the position of other vehicles in driving, and can transmit the sensed data to the on-board control unit 11, thereby assisting the on-board control unit 11 to control the vehicle 1A to automatically travel. In this embodiment, the multiple vehicle-mounted information collection units 12a to 12c include, but are not limited to, a camera 12a, a wheel speed/steering angle sensor 12b, and a radar 12c (for example, an ultrasonic radar).
执行单元13受到车载控制单元11的控制。执行单元13至少包括车辆转向/制动装置,其用于根据车载控制单元11的控制来调节车辆1A的车轮转向角度以及调节车辆1A的行驶速度。The execution unit 13 is controlled by the in-vehicle control unit 11. The execution unit 13 includes at least a vehicle steering/braking device, which is used to adjust the steering angle of the wheels of the vehicle 1A and the driving speed of the vehicle 1A according to the control of the on-board control unit 11.
车载通信单元14与车载控制单元11数据连通。在本实施方式中,车载通信单元14为V2X车辆设备(用于车辆1A与外界各种设备通信的车载设备),使得车辆1A的车辆终端1能够与停车场2A的停车场终端2和其它车辆1A的车辆终端1进行通信。The in-vehicle communication unit 14 is in data communication with the in-vehicle control unit 11. In this embodiment, the in-vehicle communication unit 14 is a V2X vehicle device (an in-vehicle device used for communication between the vehicle 1A and various external devices), so that the vehicle terminal 1 of the vehicle 1A can communicate with the parking lot terminal 2 of the parking lot 2A and other vehicles. The vehicle terminal 1 of 1A communicates.
具体地,如图1a和图1b所示,在本实施方式中,停车场系统包括设置于停车场2A的停车场终端2和辅助行驶终端(校正标志2A1和车道线2A2)。Specifically, as shown in FIGS. 1a and 1b, in this embodiment, the parking lot system includes a parking lot terminal 2 and an auxiliary driving terminal (correction mark 2A1 and lane line 2A2) installed in a parking lot 2A.
停车场终端2设置于停车场2A的适当位置,该停车场终端2包括总控单元21、路侧信息采集单元22和路侧通信单元23。The parking lot terminal 2 is installed in a proper position of the parking lot 2A. The parking lot terminal 2 includes a master control unit 21, a roadside information collection unit 22 and a roadside communication unit 23.
总控单元21能够存储数据(例如预先存储停车场模型中的所有路线的路线信息,该路线信息包括各路线中所有路段对应的方向信息等数据和所有路段中各标记点211的道路特征参数和校正标志2A1对应的数据),能够接收来自多个路侧信息采集单元22的感测数据(例如所识别的车辆1A的起始位置以及停车场2A的停车位以及入口和出口等预定位置的使用状态)并进行处理(例如确定车辆1A预计到达的目标位置,基于起始位置和目标位置选择行驶路线并且可选地调整行驶路线中的路线信息等),能够接收路侧通信单元23的通信数据并且能够向路侧通信单元23发送通信数据以及控制其它部件进行工作。The master control unit 21 can store data (for example, pre-store the route information of all the routes in the parking lot model, the route information includes data such as the direction information corresponding to all the road sections in each route, and the road characteristic parameters of each marked point 211 in all road sections. The data corresponding to the calibration mark 2A1), which can receive the sensing data from multiple roadside information collection units 22 (such as the recognized starting position of the vehicle 1A and the parking space of the parking lot 2A, and the use of predetermined locations such as entrances and exits) State) and perform processing (for example, determine the target position that the vehicle 1A is expected to arrive at, select a driving route based on the starting position and target position, and optionally adjust the route information in the driving route, etc.), and be able to receive communication data from the roadside communication unit 23 And it can send communication data to the roadside communication unit 23 and control other components to work.
多个路侧信息采集单元22与总控单元21数据连通。多个路侧信息采集单元22能够感测例如停车场2A的停车位以及入口和出口等预定位置的使用状态并且在车辆1A提出泊车请求或取车请求的情况下能够识别车辆1A所在的起始位置,并将该状态信息和起始位置信息发送到总控单元21。The multiple roadside information collection units 22 are in data communication with the master control unit 21. A plurality of roadside information collection units 22 can sense the usage status of predetermined locations such as parking spaces and entrances and exits of the parking lot 2A, and can identify where the vehicle 1A is located when the vehicle 1A requests a parking or pick-up request. Start position, and send the status information and start position information to the master control unit 21.
路侧通信单元23与总控单元21数据连通。在本实施方式中,路侧通信单元23为V2X路侧设备,使得停车场2A的停车场终端2能够与各车辆1A的车辆终端1进行通信。The roadside communication unit 23 is in data communication with the master control unit 21. In this embodiment, the roadside communication unit 23 is a V2X roadside device, so that the parking lot terminal 2 of the parking lot 2A can communicate with the vehicle terminal 1 of each vehicle 1A.
在本实施方式中,辅助行驶终端包括在停车场2A的各路段的适当位置处设置的校正标志2A1以及在停车场2A的各直路段设置的车道线2A2,用于被车辆1A识别以利用辅助行驶终端对应的信息修正车辆1A按照路线信息自动行驶的过程。In this embodiment, the auxiliary driving terminal includes correction marks 2A1 set at appropriate positions in each section of the parking lot 2A and lane lines 2A2 set at each straight section of the parking lot 2A for being recognized by the vehicle 1A to use the auxiliary The information corresponding to the driving terminal corrects the process in which the vehicle 1A automatically travels in accordance with the route information.
一方面,校正标志2A1可以设置于停车场2A的入口处,基于识别发出泊车请求的车辆1A所处的起始位置,获得该车辆1A的起始位置相对于设置于停车场2A的入口处的校正标志2A1的相对偏差值,从而可以利用该相对偏差值调整行驶路线中对应的标记点211的道路特征参数和校正标志2A1的校正距离。另一方面,校正标志2A1还可以设置于停车场2A内的各直路段的预定位置(例如设置在直路段的距该路段的一端的距离为该路段长度1/3的位置)处,可以利用车辆终端1的摄像机12a识别该校正标志2A1,进而能够利用该 校正标志2A1对应的校正距离校正车辆1A自动行驶过程中车辆终端1计算的车辆1A的行驶距离的结果,从而消除计算的车辆1A的行驶距离的累计误差。对于利用该校正标志2A1进行校正的具体方法将在以下对停车场自动泊车/取车方法的说明中进行具体说明。On the one hand, the calibration mark 2A1 can be set at the entrance of the parking lot 2A. Based on identifying the starting position of the vehicle 1A that issued the parking request, the starting position of the vehicle 1A is obtained relative to the entrance of the parking lot 2A. The relative deviation value of the correction mark 2A1 can be used to adjust the road characteristic parameter of the corresponding marking point 211 in the driving route and the correction distance of the correction mark 2A1. On the other hand, the calibration mark 2A1 can also be set at a predetermined position of each straight section in the parking lot 2A (for example, set at a position where the distance from one end of the straight section to the end of the section is 1/3 of the length of the section), which can be used The camera 12a of the vehicle terminal 1 recognizes the correction mark 2A1, and can use the correction distance corresponding to the correction mark 2A1 to correct the result of the travel distance of the vehicle 1A calculated by the vehicle terminal 1 during the automatic driving of the vehicle 1A, thereby eliminating the calculated vehicle 1A Cumulative error of travel distance. The specific method of using the calibration mark 2A1 to perform calibration will be described in detail in the following description of the automatic parking/retrieving method of the parking lot.
车道线2A2设置在停车场2A内的各直路段并且沿着对应路段的延伸方向延伸。在车辆1A能够利用摄像机12a识别车道线2A2的情况下,车道线2A2能够辅助车辆1A在各直路段中自动行驶。The lane line 2A2 is provided in each straight section in the parking lot 2A and extends along the extending direction of the corresponding section. In the case where the vehicle 1A can recognize the lane line 2A2 with the camera 12a, the lane line 2A2 can assist the vehicle 1A to automatically travel in each straight section.
需要说明的是,虽然在图1a中示出了在停车场2A的各路段设立了多个标记点211,但是该标记点211属于在对停车场2A建立模型的过程中设立的虚拟的标记,并非物理存在的。因此,将在以下对停车场自动泊车/取车方法的说明中对该标记点211进行具体说明。It should be noted that although FIG. 1a shows that a plurality of marking points 211 are set up in each section of the parking lot 2A, the marking points 211 belong to the virtual markers set up in the process of building a model of the parking lot 2A. It does not exist physically. Therefore, the marking point 211 will be described in detail in the following description of the automatic parking/retrieving method of the parking lot.
以上说明了根据本发明的一实施方式的车辆终端和停车场系统的具体结构,以下将基于车辆终端和停车场系统说明根据本发明的停车场自动泊车/取车方法。The specific structure of the vehicle terminal and the parking lot system according to an embodiment of the present invention has been described above, and the automatic parking/retrieving method of the parking lot according to the present invention will be described below based on the vehicle terminal and the parking lot system.
(根据本发明的停车场自动泊车/取车方法的过程)(Process of automatic parking/retrieving method for parking lot according to the present invention)
根据本发明的停车场自动泊车/取车方法的工作过程可以分为两部分,一部分在车辆终端1中完成,另一部分在停车场系统中完成。该方法的过程可以概括如下。The working process of the automatic parking/retrieving method for the parking lot according to the present invention can be divided into two parts, one part is completed in the vehicle terminal 1, and the other part is completed in the parking lot system. The process of this method can be summarized as follows.
在停车场系统的停车场终端2中预先建立与停车场2A对应的停车场模型,该停车场模型包括停车场2A的各停车位与入口和出口之间的所有可行的路线(包括路线信息),路线信息包括对应路线中的各路段的路段信息以及在停车场2A的各路段中设立的多个标记点211的道路特征参数和校正标志2A1对应的校正距离。基于车辆终端1的请求,停车场终端2从该停车场模型中确定车辆1A的起始位置和预定到达的目标位置并在连接这两个位置之间的所有路线中选择行驶路线。基于行驶路线和起始位置可选地调整行驶路线中的各路段的方向信息和所有标记点211的道路特征参数,然后将(如果进行了调整则将调整之后的)行驶路线中各路段的方向信息和各路段中所有标记点211的道路特征参数以数据包的形式发送到车辆终端1。A parking lot model corresponding to the parking lot 2A is pre-established in the parking lot terminal 2 of the parking lot system. The parking lot model includes all feasible routes (including route information) between each parking space of the parking lot 2A and the entrance and exit. The route information includes the link information of each link in the corresponding route, the road feature parameters of the multiple marking points 211 set up in each link of the parking lot 2A, and the correction distance corresponding to the correction mark 2A1. Based on the request of the vehicle terminal 1, the parking lot terminal 2 determines the starting position of the vehicle 1A and the intended target position of the vehicle 1A from the parking lot model, and selects a driving route among all the routes connecting the two positions. Based on the driving route and starting position, optionally adjust the direction information of each road segment in the driving route and the road characteristic parameters of all the marking points 211, and then (if adjusted, the adjusted) direction of each road segment in the driving route The information and the road characteristic parameters of all the marking points 211 in each road section are sent to the vehicle terminal 1 in the form of data packets.
车辆终端1接收上述数据包,以获得行驶路线中各路段的方向信息和各路段中的所有标记点211的道路特征参数,进一步地,车辆终端1控制车辆1A沿着行驶路线按各路段的方向信息和各标记点211的道路特征参数从起始位 置自动行驶到目标位置,从而在对应的停车位进行泊车或在停车场2A的出口处待取车。The vehicle terminal 1 receives the above-mentioned data packet to obtain the direction information of each road segment in the travel route and the road characteristic parameters of all the marker points 211 in each road segment. Further, the vehicle terminal 1 controls the vehicle 1A to follow the travel route according to the direction of each road segment. The information and the road characteristic parameters of each marking point 211 are automatically driven from the starting position to the target position, so that the vehicle is parked in the corresponding parking space or the vehicle is waiting to be picked up at the exit of the parking lot 2A.
以下将以车辆1A在停车场2A的入口处并且车辆终端1提出泊车请求为例来说明根据本发明的停车场自动泊车/取车方法的具体过程。Hereinafter, the specific process of the automatic parking/retrieving method of the parking lot according to the present invention will be explained by taking the vehicle 1A at the entrance of the parking lot 2A and the vehicle terminal 1 making a parking request as an example.
如图2所示,在S20中,在停车场终端2中预先建立停车场模型。As shown in FIG. 2, in S20, a parking lot model is established in the parking lot terminal 2 in advance.
参考图1a,停车场2A包括彼此相连的多个直路段和多个弯路段,因此与之对应的停车场模型不仅包括停车位与入口和出口之间的所有可行的路线而且还包括所有路线的各路段中方向信息以及在各路段中设立的大量标记点211以及校正标志2A1对应的校正距离,各标记点211包含该标记点211所在位置的道路特征参数。如上所述,标记点211并非真实存在而仅是一组数据。Referring to Figure 1a, the parking lot 2A includes multiple straight road sections and multiple curved road sections connected to each other. Therefore, the corresponding parking lot model includes not only all feasible routes between parking spaces and entrances and exits, but also all routes. The direction information in each road section and the correction distance corresponding to a large number of marking points 211 established in each road section and the correction mark 2A1, and each marking point 211 includes the road characteristic parameter of the location where the marking point 211 is located. As described above, the marking point 211 does not actually exist but is only a set of data.
更具体地,每一个路段中的方向信息可以通过将该路段的两端中一端所对应的标记点211作为车辆1A通过该路段的起始标记点来定义。More specifically, the direction information in each road segment can be defined by using the marking point 211 corresponding to one of the two ends of the road segment as the starting marking point for the vehicle 1A to pass the road segment.
各标记点211至少包含距离参数和半径参数两个参数。针对每一辆提出泊车请求的车辆1A来说,该距离参数可以采用两种方式来定义。在第一种方式中,针对行驶路线中的每一个路段,该距离参数为路段中各标记点211对应的位置距离上述起始标记点对应的位置之间沿着该路段的相对距离;在另一种方式中,针对整个行驶路线,该距离参数为该标记点211对应的位置与停车场终端2所识别的车辆1A的起始位置之间的沿着行驶路线的绝对距离。与第二种方式相比,第一种方式更优选。进一步地,半径参数为该标记点211对应的位置处的路段的曲率半径,当路段为直路段时半径参数为零。Each marking point 211 includes at least two parameters, a distance parameter and a radius parameter. For each vehicle 1A that requests parking, the distance parameter can be defined in two ways. In the first way, for each road section in the driving route, the distance parameter is the relative distance along the road section between the position corresponding to each mark point 211 in the road section and the position corresponding to the above-mentioned starting mark point; In one manner, for the entire driving route, the distance parameter is the absolute distance along the driving route between the position corresponding to the marking point 211 and the starting position of the vehicle 1A identified by the parking lot terminal 2. Compared with the second method, the first method is more preferable. Further, the radius parameter is the radius of curvature of the road section at the position corresponding to the marking point 211, and the radius parameter is zero when the road section is a straight road section.
另外,在停车场模型中设立过程中至少应当满足以下条件。In addition, at least the following conditions should be met during the establishment of the parking lot model.
(1)当停车场模型中的路段的方向信息不同时,即使其它参数相同,也应当视为两个不同的路段。(1) When the direction information of the road sections in the parking lot model is different, even if other parameters are the same, it should be regarded as two different road sections.
(2)在设立标记点211的过程中,无论在弯路段中还是在直路段中,每一个路段均包含多个不同的标记点211且相邻的两个标记点211之间的距离可以不同,各路段的两端分别对应一个标记点211。(2) In the process of setting up the marking point 211, no matter in the curved section or in the straight section, each road section contains a plurality of different marking points 211 and the distance between two adjacent marking points 211 can be different , The two ends of each road section correspond to a mark point 211 respectively.
(3)在曲率半径变化频繁的一个弯路段上的相邻的标记点211之间的距离应尽量较小(如下表1和表2所示,表1对应采用上述第一种方式定义的标记点211,表2对应采用上述第二种方式定义的标记点211),这样能够尽可能减小车辆自动行驶过程中的累计误差。(3) The distance between adjacent marking points 211 on a curve section where the radius of curvature changes frequently should be as small as possible (as shown in Table 1 and Table 2 below, Table 1 corresponds to the marking defined in the first method above) Point 211, Table 2 corresponds to the mark point 211 defined in the second way above), which can minimize the cumulative error during the automatic driving of the vehicle.
[表1][Table 1]
[表2][Table 2]
(4)在直路段中,停车场2A中各停车位分别对应一个标记点211(可以称为停车位标记点,在泊车过程中作为终止标记点,在取车过程中作为起始标记点),以下表3示出了包含停车位标记点和校正标志2A1的直路段对应的信息。在该表3中,由于在直路段中半径参数为零,所以在表3中省略了半径参数对应的数据。(4) In the straight section, each parking space in the parking lot 2A corresponds to a marking point 211 (it can be called a parking space marking point, which is used as the end marking point during parking and the starting point during the pick-up process) ), the following Table 3 shows the information corresponding to the straight road section containing the parking spot marking points and the correction mark 2A1. In Table 3, since the radius parameter is zero in the straight section, the data corresponding to the radius parameter is omitted in Table 3.
[表3][table 3]
上述停车位标记点不仅对应于各停车位以作为车辆1A自动行驶的起始标记点/终止标记点,还可以用于作为各路段的端点对应的标记点,也就是说可以利用停车位标记点来划分不同的路段。The above-mentioned parking space marking points not only correspond to each parking space as the starting marking point/ending marking point for the automatic driving of the vehicle 1A, but also can be used as the marking point corresponding to the end point of each road section, that is to say, the parking space marking point can be used To divide different road sections.
(5)此外,在建立上述停车场模型时,路线信息应当包括对应各校正标志2A1的校正距离,在下述的调整各标记点211的道路特征参数的同时对校 正标志2A1的校正距离也进行调整。需要说明的是,设立在停车场入口处的校正标志2A1基于车辆1A的起始位置调整路线信息,而不需要不调整该校正标志2A1对应的校正距离。(5) In addition, when building the above parking lot model, the route information should include the correction distance corresponding to each correction mark 2A1, and the correction distance of the correction mark 2A1 is also adjusted while adjusting the road characteristic parameters of each marking point 211 as follows . It should be noted that the correction mark 2A1 set up at the entrance of the parking lot adjusts the route information based on the starting position of the vehicle 1A, and there is no need to adjust the correction distance corresponding to the correction mark 2A1.
为了建立上述停车场模型,停车场终端2应当预先收集停车场2A内的所有路段的标记点211的道路特征参数。这可以通过试验车辆沿着停车场2A的所有路段以固定的速度缓慢地行驶来得到。在利用试验车辆收集道路特征参数的过程中,可以测量并记录试验车辆的行驶速度、车轮转向角度和行驶时间,利用这些参数通过适当的算术运算能够得到想要得到的各标记点211的道路特征参数。In order to establish the above-mentioned parking lot model, the parking lot terminal 2 should collect in advance the road characteristic parameters of the marking points 211 of all road sections in the parking lot 2A. This can be obtained by driving the test vehicle slowly along all sections of the parking lot 2A at a fixed speed. In the process of collecting road characteristic parameters using the test vehicle, the driving speed, wheel steering angle and travel time of the test vehicle can be measured and recorded. These parameters can be used to obtain the desired road characteristics of each marker 211 through appropriate arithmetic operations. parameter.
通过采用上述方法,在建立停车场模型的过程中,将停车场2A内的任意两个位置之间的所有路线信息全部存储在停车场终端2的总控单元21内。在总控单元21选择好行驶路线之后,总控单元21将根据车辆1A的起始位置和行驶路线调整路线西西,然后通过路侧通信单元23传输到车辆终端1的车载通信单元14,进一步能够传输到车载控制单元11。By adopting the above method, in the process of establishing the parking lot model, all route information between any two locations in the parking lot 2A are all stored in the master control unit 21 of the parking lot terminal 2. After the main control unit 21 selects the driving route, the main control unit 21 will adjust the route according to the starting position and driving route of the vehicle 1A, and then transmit it to the vehicle-mounted communication unit 14 of the vehicle terminal 1 through the roadside communication unit 23 to further enable Transmitted to the on-board control unit 11.
在S11中,当车辆1A需要在停车场2A停放时,车辆1A的车辆终端1向停车场终端2提出泊车请求。In S11, when the vehicle 1A needs to be parked in the parking lot 2A, the vehicle terminal 1 of the vehicle 1A makes a parking request to the parking lot terminal 2.
在S21中,停车场终端2接收到车辆1A的车辆终端1提出的泊车请求,响应于该泊车请求进行如下作业。In S21, the parking lot terminal 2 receives the parking request from the vehicle terminal 1 of the vehicle 1A, and performs the following operations in response to the parking request.
在S221中,基于车辆终端1的泊车请求,停车场终端2首先识别提出泊车请求的车辆1A的起始位置,同时利用停车场终端2的多个路侧信息采集单元22找到未被占用的一个停车位(例如与起始位置距离最近的未被占用的停车位)并将与该停车位对应的停车位标记点211所对应的位置指定为该车辆1A预定到达的目标位置(该标记点211为终止标记点)。In S221, based on the parking request of the vehicle terminal 1, the parking lot terminal 2 first identifies the starting position of the vehicle 1A that made the parking request, and at the same time, uses the multiple roadside information collection units 22 of the parking lot terminal 2 to find unoccupied One of the parking spaces (for example, the unoccupied parking space closest to the starting position) and the position corresponding to the parking space marking point 211 corresponding to the parking space is designated as the target position that the vehicle 1A is scheduled to reach (the marking Point 211 is the termination mark point).
进一步地,在识别了上述起始位置和目标位置之后,基于该起始位置和目标位置以及S222中接收到的各行驶中的车辆1A反馈的在停车场2A内的位置信息,针对提出泊车请求的车辆1A,从连接起始位置和目标位置的所有路线中找到在不与其它行驶中的车辆1A发生冲突的情况下最节省时间的行驶路线(例如距离最短的路线)。Further, after the above-mentioned starting position and target position are identified, based on the starting position and target position and the position information in the parking lot 2A fed back by each driving vehicle 1A received in S222, the parking lot is proposed for parking The requested vehicle 1A finds the most time-saving travel route (for example, the route with the shortest distance) without conflicting with other running vehicles 1A from all the routes connecting the starting position and the target position.
在步骤S23中,基于起始位置和行驶路线,停车场终端2调整路线信息,即调整在行驶路线中各路段的方向信息以及各路段中的所有标记点211的道路特征参数和所有校正标志2A1对应的校正距离。In step S23, based on the starting position and the driving route, the parking lot terminal 2 adjusts the route information, that is, adjusts the direction information of each road section in the driving route and the road characteristic parameters of all the marking points 211 in each road section and all the correction signs 2A1. Corresponding correction distance.
对于各路段的方向信息,当已经选择行驶路线之后,确定行驶路线中各路段的起始标记点,从而确定组成行驶路线的各路段的方向信息。For the direction information of each road segment, after the driving route has been selected, the starting mark point of each road segment in the driving route is determined, so as to determine the direction information of each road segment that constitutes the driving route.
对于各路段的标记点211的道路特征参数,可以通过如下的方法调整行驶路线中各标记点211所包含的道路特征参数。For the road feature parameters of the marked points 211 of each road segment, the road feature parameters contained in each of the marked points 211 in the driving route can be adjusted by the following method.
在标记点211中存储的距离参数为上述相对距离的情况下,当提出泊车请求的车辆1A的起始位置与上述停车场2A的入口处的预定位置一致时,将总控单元21预先存储的各路段中的标记点211与该路段的起始标记点之间的沿着该路段的相对距离值分别赋予对应的标记点211的距离参数。在标记点211中存储的距离参数为上述相对距离的情况下,当提出泊车请求的车辆1A的起始位置与上述停车场2A的入口处的预定位置不一致时,识别这两个位置之间的沿着所在路段的相对偏差值并利用该相对偏差值修正总控单元21预先存储的该路段中各标记点211与起始标记点之间的沿着该路段的相对距离;对于行驶路线中其余路段中的标记点211的距离参数,不必利用上述相对偏差值进行修正而仍然将总控单元21存储的各路段中的标记点211与该路段的起始标记点之间的沿着该路段的相对距离值分别赋予对应的标记点211的距离参数即可。In the case that the distance parameter stored in the marking point 211 is the above-mentioned relative distance, when the starting position of the vehicle 1A requesting the parking is consistent with the predetermined position at the entrance of the above-mentioned parking lot 2A, the master control unit 21 is pre-stored The relative distance values along the road section between the marking point 211 in each road section and the starting marking point of the road section are assigned the distance parameters of the corresponding marking point 211 respectively. In the case where the distance parameter stored in the marker point 211 is the above-mentioned relative distance, when the starting position of the vehicle 1A requesting the parking is not consistent with the predetermined position at the entrance of the above-mentioned parking lot 2A, the difference between the two positions is identified The relative deviation value along the road section where it is located, and the relative deviation value is used to correct the relative distance along the road section between each mark point 211 and the start mark point in the road section pre-stored by the master control unit 21; for the driving route The distance parameters of the marking points 211 in the remaining road sections do not need to be corrected by the above-mentioned relative deviation value, and the distance between the marking point 211 of each road section stored by the master control unit 21 and the starting mark point of the road section is still along the road section. The relative distance value of is assigned to the distance parameter of the corresponding mark point 211, respectively.
在标记点211中存储的距离参数为上述绝对距离的情况下,当提出泊车请求的车辆1A的起始位置与上述停车场2A的入口处的预定位置一致时,将总控单元21预先存储的各标记点211与上述停车场2A的入口处的预定位置之间的沿着行驶路线的距离值分别赋予对应的标记点211的距离参数。在标记点211中存储的距离参数为上述绝对距离的情况下,当提出泊车请求的车辆1A的起始位置与上述停车场2A的入口处的预定位置不一致时,识别这两个位置之间的沿着行驶路线的相对偏差值并利用该相对偏差值与总控单元21预先存储的各标记点211与上述停车场2A的入口处的预定位置之间的沿着行驶路线的距离值进行算术运算之后,再将得到的结果赋予对应的标记点211的距离参数。In the case that the distance parameter stored in the marking point 211 is the above-mentioned absolute distance, when the starting position of the vehicle 1A requesting the parking is consistent with the predetermined position at the entrance of the above-mentioned parking lot 2A, the master control unit 21 is pre-stored The distance values along the travel route between each of the marked points 211 and the predetermined position at the entrance of the parking lot 2A are assigned distance parameters of the corresponding marked points 211, respectively. In the case where the distance parameter stored in the marking point 211 is the above-mentioned absolute distance, when the starting position of the vehicle 1A requesting the parking is not consistent with the predetermined position at the entrance of the above-mentioned parking lot 2A, the difference between the two positions is identified The relative deviation value along the driving route and the distance value along the driving route between each marked point 211 pre-stored by the master control unit 21 and the predetermined position at the entrance of the parking lot 2A are used to perform arithmetic After the calculation, the obtained result is assigned to the distance parameter of the corresponding marked point 211.
这样,无论提出泊车请求的车辆1A的起始位置是否与上述停车场2A的入口处的预定位置一致,都能够准确得到各标记点211所需的距离参数。In this way, no matter whether the starting position of the vehicle 1A requesting the parking is consistent with the predetermined position at the entrance of the parking lot 2A, the distance parameter required by each marking point 211 can be accurately obtained.
另外,由于各标记点211的半径参数与各标记点211所对应位置的路段曲率半径一致,因此各标记点211的半径参数可以为恒定的常数。也就是说,当各标记点211对应的位置对应的路段是直路段时,该标记点211的半径参数 为零;当各标记点211对应的位置对应的路段是弯路段时,该标记点211的半径参数等于弯路段的在标记点211对应的位置处的曲率半径。In addition, since the radius parameter of each mark point 211 is consistent with the radius of curvature of the road section corresponding to each mark point 211, the radius parameter of each mark point 211 may be a constant constant. That is to say, when the road section corresponding to the position corresponding to each marking point 211 is a straight road section, the radius parameter of the marking point 211 is zero; when the road section corresponding to the position corresponding to each marking point 211 is a curved road section, the marking point 211 The radius parameter of is equal to the radius of curvature of the curve section at the position corresponding to the mark point 211.
此外,可以通过与调整行驶路线中的各标记点211的距离参数的方法相同的方调整行驶路线中各校正标志2A1的校正距离。In addition, the correction distance of each correction mark 2A1 in the travel route can be adjusted in the same way as the method of adjusting the distance parameter of each mark point 211 in the travel route.
随后停车场终端2经由路侧通信单元23将调整后的路线信息发送到车辆1A的车辆终端1的车载通信单元14。The parking lot terminal 2 then transmits the adjusted route information to the vehicle-mounted communication unit 14 of the vehicle terminal 1 of the vehicle 1A via the roadside communication unit 23.
在S12中,车辆终端1的车载通信单元14接收到来自停车场终端2的路侧通信单元23的行驶路线的调整后的路线信息,并将这些信息发送到车辆终端1的车载控制单元11。In S12, the in-vehicle communication unit 14 of the vehicle terminal 1 receives the adjusted route information of the traveling route from the roadside communication unit 23 of the parking lot terminal 2 and sends the information to the in-vehicle control unit 11 of the vehicle terminal 1.
在S13中,车辆终端1沿着行驶路线根据调整后的路线信息控制车辆1A从起始位置向目标位置自动行驶。In S13, the vehicle terminal 1 controls the vehicle 1A to automatically travel from the starting position to the target position along the travel route according to the adjusted route information.
在上述自动行驶过程中,车辆终端1通过车载信息采集单元采集到的车轮转速、车轮转向角度和行驶时间计算车辆1A行驶经过的行驶距离,也就是说车辆终端1始终利用车辆的上述参数计算车辆的当前行驶经过的距离。然后,利用该行驶距离与行驶路线中的各标记点211中的距离参数进行比较。当行驶距离与距离参数一致时,表示车辆1A正行驶经过对应的标记点211。这时,一方面,车辆终端1可以利用该标记点211中的半径参数、或利用该标记点211在该路段的方向上的下一个标记点211的半径参数、或利用该路段中所有标记点211的半径参数拟合的插值曲线中对应的曲率半径计算新的车轮转向角度并控制执行单元13调整各转向车轮的转向角度;另一方面,车辆终端1经由车载通信单元14向停车场终端2发送车辆1A的位置信息(与S222对应)。因此,利用行驶路线中的各标记点211中的距离参数作为判断条件,在车辆1A行驶了与各标记点211的距离参数相同的行驶距离时,车辆1A在各标记点211所在的位置处实现精确的车轮转向角度调节,从而使得车辆1A沿着行驶路线正确地自动行驶。而且在自动行驶过程中,车辆终端1能够将位置信息反馈到停车场终端2,以供停车场终端2在为其它车辆1A选择行驶路线时进行参考。In the above-mentioned automatic driving process, the vehicle terminal 1 calculates the distance traveled by the vehicle 1A through the wheel speed, wheel steering angle, and travel time collected by the on-board information collection unit. That is to say, the vehicle terminal 1 always uses the vehicle's above parameters to calculate the vehicle The current distance traveled. Then, the travel distance is compared with the distance parameter in each marked point 211 in the travel route. When the driving distance is consistent with the distance parameter, it means that the vehicle 1A is driving past the corresponding mark point 211. At this time, on the one hand, the vehicle terminal 1 can use the radius parameter of the marker point 211, or use the radius parameter of the next marker point 211 of the marker point 211 in the direction of the road section, or use all the marker points in the road section. The corresponding radius of curvature in the interpolation curve fitted by the radius parameter of 211 calculates the new wheel steering angle and controls the execution unit 13 to adjust the steering angle of each steering wheel; The position information of the vehicle 1A is transmitted (corresponding to S222). Therefore, using the distance parameter in each marking point 211 in the driving route as the judgment condition, when the vehicle 1A travels the same distance as the distance parameter of each marking point 211, the vehicle 1A realizes the position where each marking point 211 is located. Accurate adjustment of the steering angle of the wheels allows the vehicle 1A to travel automatically and correctly along the driving route. Moreover, during the automatic driving process, the vehicle terminal 1 can feed back position information to the parking lot terminal 2 for reference when the parking lot terminal 2 selects a driving route for other vehicles 1A.
另外,在上述自动行驶过程中,车辆终端1所计算的行驶距离由于各种因素而会产生累计误差,这种累计误差将导致车辆终端1所计算的行驶距离不能准确地反映车辆1A在行驶路线上或在各路段上所经过的实际距离,因此需要利用行驶路线上设置的校正标志2A1的校正距离来校正车辆终端1所计 算的行驶距离。校正标志2A1可以通过车辆终端1的车载信息采集单元进行识别。当车辆终端1的车载信息采集单元识别了对应的校正标志2A1时,车辆终端1的车载控制单元11将从停车场终端2接收到的与该校正标志2A1对应的校正距离替换车辆终端1计算的行驶距离,从而校正在识别该校正标志2A1之前车辆终端1计算行驶距离所产生的累计误差。而且,在利用车辆行驶通过弯路段的情况下,应当使得各弯路段中的标记点211设置的尽可能地密集,从而消除由于采用上述方法导致车辆自动行驶时转弯不精确所产生的累计误差。In addition, in the above-mentioned automatic driving process, the travel distance calculated by the vehicle terminal 1 will produce cumulative errors due to various factors. This cumulative error will cause the travel distance calculated by the vehicle terminal 1 to not accurately reflect the driving route of the vehicle 1A. It is necessary to use the correction distance of the correction mark 2A1 set on the travel route to correct the travel distance calculated by the vehicle terminal 1. The calibration mark 2A1 can be identified by the on-board information collection unit of the vehicle terminal 1. When the on-board information collection unit of the vehicle terminal 1 recognizes the corresponding correction flag 2A1, the on-board control unit 11 of the vehicle terminal 1 will replace the correction distance corresponding to the correction flag 2A1 received by the parking lot terminal 2 with the correction distance calculated by the vehicle terminal 1 The travel distance is corrected so as to correct the cumulative error generated by the vehicle terminal 1 calculating the travel distance before the correction mark 2A1 is recognized. Moreover, when a vehicle is used to drive through a curve section, the marking points 211 in each curve section should be arranged as densely as possible, so as to eliminate the cumulative error caused by inaccurate turning when the vehicle is automatically driven by the above method.
进一步地,为了辅助上述自动行驶,车辆终端1的车载信息采集单元22还能够识别直路段上的车道线2A2,从而使得车辆1A沿着该车道线2A2行驶。这对车辆1A沿着直路段自动行驶产生了良好的辅助作用。Further, in order to assist the above-mentioned automatic driving, the on-board information collection unit 22 of the vehicle terminal 1 can also identify the lane line 2A2 on the straight section, so that the vehicle 1A drives along the lane line 2A2. This has a good assisting effect on the automatic driving of the vehicle 1A along the straight section.
最后,在S14中,车辆1A到达终止标记点对应的目标位置,即到达指定的未被占用的停车位的前方,车辆终端1控制车辆1A倒车进入该停车位。Finally, in S14, the vehicle 1A reaches the target position corresponding to the termination mark point, that is, in front of the designated unoccupied parking space, and the vehicle terminal 1 controls the vehicle 1A to reverse and enter the parking space.
以上已经对本发明的停车场自动泊车/取车系统和停车场自动泊车/取车方法的具体实施方式进行了详细的阐述,但是还需要进行如下的补充说明。The specific implementations of the automatic parking/retrieving system in the parking lot and the automatic parking/retrieving method of the parking lot of the present invention have been described in detail above, but the following supplementary description is required.
i.虽然在以上的具体实施方式中仅以车辆终端1提出泊车请求的泊车方法说明了根据本发明的停车场自动泊车/取车方法,但是应当理解车辆终端1提出取车请求时的取车方法与上述泊车方法实质上相同。但是应注意,当车辆1A提出取车请求而非泊车请求时,车辆1A的起始位置就是其所在停车位对应的停车位标记点,因此可以直接利用停车场模型中预先存储的从该停车位标记点到停车场出口之间的行驶路线的路线信息,不再需要对该路线信息进行调整。i. Although in the above specific embodiments, only the parking method in which the vehicle terminal 1 requests a parking request is used to illustrate the automatic parking/retrieve method for a parking lot according to the present invention, it should be understood that when the vehicle terminal 1 requests a car The method of picking up the car is essentially the same as the parking method described above. However, it should be noted that when vehicle 1A makes a request for pick-up instead of a parking request, the starting position of vehicle 1A is the parking spot mark point corresponding to its parking spot, so you can directly use the pre-stored parking lot model from the parking lot. The route information of the driving route between the location marking point and the exit of the parking lot does not need to be adjusted.
另外,本发明的技术构思不限于实现上述泊车/取车,例如当车辆1A需要在停车场2A的两个车位之间进行挪车或者在车辆1A从停车场2A的入口直接穿行停车场到达停车场2A的出口时都可以采用根据本发明的方法。In addition, the technical concept of the present invention is not limited to the realization of the above parking/retrieval, for example, when the vehicle 1A needs to move between two parking spaces in the parking lot 2A or when the vehicle 1A passes through the parking lot directly from the entrance of the parking lot 2A to arrive The method according to the present invention can be used at the exit of the parking lot 2A.
而且,本发明的技术构思还可以应用于停车场以外的其它用于车辆调度的场所。Moreover, the technical concept of the present invention can also be applied to places other than parking lots for vehicle scheduling.
ii.在整个停车场自动泊车/取车方法中,应当理解,执行单元13将车辆1A保持在适当的行驶速度(一般是较低的行驶速度)。而且可以使得车辆1A设置有自适应巡航系统,并使其处于开启状态以防止行驶中的车辆1A之间发生碰撞。ii. In the entire parking lot automatic parking/retrieving method, it should be understood that the execution unit 13 maintains the vehicle 1A at an appropriate driving speed (generally a lower driving speed). In addition, the vehicle 1A can be equipped with an adaptive cruise system, and it can be turned on to prevent a collision between the driving vehicles 1A.
iii.在上述实施方式中,由于停车场终端2收到车辆终端1发送的请求之后仅需要选择行驶路线、选择性地调整行驶路线的路线信息并将路线信息发送到车辆终端1,车辆终端1自身不需要规划路线,仅需要从停车场终端2接收上述数据并按照上述数据中包含的路线信息自动行驶即可。因此,根据本发明的自动泊车/取车系统不需要基于GPS来定位车辆1A位置,使得根据本发明的自动泊车/取车方法和系统还适用于地下停车场等GPS信号非常弱的场所。iii. In the above embodiment, after the parking lot terminal 2 receives the request sent by the vehicle terminal 1, it only needs to select the driving route, selectively adjust the route information of the driving route, and send the route information to the vehicle terminal 1, and the vehicle terminal 1 There is no need to plan a route by itself, but only need to receive the above-mentioned data from the parking lot terminal 2 and drive automatically according to the route information contained in the above-mentioned data. Therefore, the automatic parking/retrieving system according to the present invention does not need to locate the position of the vehicle 1A based on GPS, so that the automatic parking/retrieving method and system according to the present invention are also suitable for places with very weak GPS signals such as underground parking lots. .
iv.虽然在以上的具体实施方式中说明了,在将校正标志2A1对应的校正距离调整之后发送到车辆终端1,通过车辆终端1的车载信息采集系统识别校正标志2A1再利用校正距离校正车辆终端1计算的行驶距离,但是本发明不限于此。iv. Although explained in the above specific embodiments, after the correction distance corresponding to the correction mark 2A1 is adjusted, the vehicle terminal is sent to the vehicle terminal 1, and the vehicle terminal is corrected by the vehicle terminal 1’s on-board information collection system to identify the correction mark 2A1. 1 Calculated travel distance, but the present invention is not limited to this.
也可以在将校正标志2A1的校正距离调整之后不直接发送到车辆终端1而是存储在停车场终端2,通过设置于该校正标志2A1的信息采集单元来识别车辆1A,并在识别到该车辆1(例如车辆1A的车牌)之后向车辆终端1发送与该校正标志2A1对应的校正距离,再利用校正距离替换车辆终端1计算的行驶距离。在这种情况下,设置于该校正标志2A1的信息采集单元可以包括毫米波雷达传感器和/或车牌识别摄像头。It is also possible that after adjusting the correction distance of the correction mark 2A1, it is not directly sent to the vehicle terminal 1 but stored in the parking lot terminal 2, and the vehicle 1A is identified through the information collection unit provided on the correction mark 2A1, and the vehicle is recognized After 1 (for example, the license plate of the vehicle 1A), the corrected distance corresponding to the correction flag 2A1 is sent to the vehicle terminal 1, and the corrected distance is used to replace the travel distance calculated by the vehicle terminal 1. In this case, the information collection unit provided on the calibration mark 2A1 may include a millimeter wave radar sensor and/or a license plate recognition camera.
v.虽然在以上的具体实施方式中没有说明如何划分直路段和弯路段,但是应当理解,可以根据各路段的曲率半径的大小来进行划分。例如,当路段的曲率半径大于特定数值时该路段为直路段,而当路段的曲率半径例如小于或等于该特定数值时该路段为弯路段。v. Although it is not explained in the above specific embodiments how to divide the straight section and the curved section, it should be understood that the division can be carried out according to the radius of curvature of each section. For example, when the radius of curvature of the road section is greater than a specific value, the road section is a straight road section, and when the radius of curvature of the road section is less than or equal to the specific value, for example, the road section is a curved road section.
vi.虽然在以上的具体实施方式中说明了停车场终端2基于车辆终端1的请求再进行后续的处理,但是本发明不限于此。例如,停车场终端2可以识别到车辆1A行驶到停车场2A的入口处主动推送路线进行导航。另外,本发明的停车场终端2并不限于仅设定在停车场2A,可以是远程服务器(云端服务器)。这样,该终端理论上可以设置在任意位置,只要能够实现本发明所说明的功能即可;而且在采用云端服务器的情况下能够实现对多个停车场同时实现控制的功能。vi. Although it has been described in the above specific embodiments that the parking lot terminal 2 performs subsequent processing based on the request of the vehicle terminal 1, the present invention is not limited to this. For example, the parking lot terminal 2 may recognize that the vehicle 1A is driving to the entrance of the parking lot 2A and actively push the route for navigation. In addition, the parking lot terminal 2 of the present invention is not limited to being set only in the parking lot 2A, and may be a remote server (cloud server). In this way, the terminal can theoretically be set at any position as long as it can realize the functions described in the present invention; and in the case of using a cloud server, it can realize the function of controlling multiple parking lots at the same time.
Claims (23)
- 一种停车场自动泊车/取车方法,包括:An automatic parking/retrieving method in a parking lot, including:路线选择步骤,基于车辆(1A)的请求识别该车辆(1A)的起始位置和目标位置,并在停车场模型所包含的连接这两个位置之间的路线中选择行驶路线,所述停车场模型包括所述停车场(2A)的各停车位与入口和出口之间的各路线的路线信息,所述路线信息包括各路段的方向信息以及各路段中设立的标记点(211)的道路特征参数;以及The route selection step is to identify the starting position and target position of the vehicle (1A) based on the request of the vehicle (1A), and select the driving route from the route connecting the two positions included in the parking lot model, the parking The field model includes the route information of each route between each parking space of the parking lot (2A) and the entrance and exit. The route information includes the direction information of each road section and the roads of the marking points (211) set up in each road section. Characteristic parameters; and路线信息发送步骤,将所述路线信息发送到所述车辆(1A)。The route information sending step is to send the route information to the vehicle (1A).
- 根据权利要求1所述的自动泊车/取车方法,其特征在于,各标记点(211)的道路特征参数包括:The automatic parking/retrieving method according to claim 1, wherein the road characteristic parameters of each marking point (211) include:距离参数,其为该标记点(211)对应的位置与所述起始位置之间的沿着所述行驶路线的绝对距离,或者为该标记点(211)对应的位置与该标记点(211)所在路段的起始标记点对应的位置之间的相对距离;以及The distance parameter, which is the absolute distance along the driving route between the position corresponding to the marking point (211) and the starting position, or the position corresponding to the marking point (211) and the marking point (211). ) The relative distance between the positions corresponding to the starting marker points of the road section; and半径参数,其为该标记点(211)对应的位置处的道路曲率半径。The radius parameter is the road curvature radius at the position corresponding to the marking point (211).
- 根据权利要求1或2所述的停车场自动泊车/取车方法,其特征在于,当所述请求为泊车请求时,The automatic parking/retrieving method for a parking lot according to claim 1 or 2, wherein when the request is a parking request,所述方法在所述路线信息发送步骤之前还包括路线信息调整步骤,其中基于所述行驶路线和所述起始位置调整所述行驶路线中的所述路线信息,并且The method further includes a route information adjustment step before the route information sending step, wherein the route information in the driving route is adjusted based on the driving route and the starting position, and在所述路线信息发送步骤中,将调整后的所述路线信息发送到所述车辆(1A)。In the route information sending step, the adjusted route information is sent to the vehicle (1A).
- 根据权利要求3所述的停车场自动泊车/取车方法,其特征在于,所述停车场模型还包括各所述标记点(211)对应的位置与预定位置之间沿着不同路线的第一预定距离,The automatic parking/retrieving method for a parking lot according to claim 3, characterized in that the parking lot model further includes the first positions along different routes between the position corresponding to each of the marking points (211) and the predetermined position. A predetermined distance,所述路线信息调整步骤包括利用所述起始位置与所述预定位置之间的相对偏差值修正所述行驶路线中各标记点(211)的第一预定距离来得到各标记点(211)的绝对距离。The route information adjustment step includes using the relative deviation value between the starting position and the predetermined position to correct the first predetermined distance of each marking point (211) in the driving route to obtain the value of each marking point (211). Absolute distance.
- 根据权利要求3所述的停车场自动泊车/取车方法,其特征在于,所述停车场模型还包括各所述标记点(211)对应的位置与该标记点所在路段的起始标记点对应的位置之间沿着该路段的第二预定距离,The automatic parking/retrieving method for a parking lot according to claim 3, wherein the parking lot model further includes a position corresponding to each of the marking points (211) and the starting marking point of the road section where the marking point is located. The second predetermined distance between corresponding locations along the road section,所述路线信息调整步骤包括利用所述起始位置与所述起始标记点对应的位置之间的相对偏差值修正所述起始位置所在路段中各标记点(211)的 第二预定距离,以得到该路段中标记点(211)的所述相对距离,并且采用所述第二预定距离作为所述行驶路线中除了所述起始位置所在路段之外其它路段的各标记点(211)的所述相对距离。The route information adjustment step includes using the relative deviation value between the starting position and the position corresponding to the starting marking point to correct the second predetermined distance of each marking point (211) in the road section where the starting position is located, To obtain the relative distance of the marked point (211) in the road section, and use the second predetermined distance as the distance of each marked point (211) of the road section except for the road section where the starting position is located in the driving route. The relative distance.
- 根据权利要求4或5所述的停车场自动泊车/取车方法,其特征在于,所述路线信息调整步骤包括通过识别所述停车场(2A)中对应于所述预定位置的校正标志(2A1)与所述起始位置之间的距离来获得所述相对偏差值。The automatic parking/retrieving method for a parking lot according to claim 4 or 5, wherein the route information adjustment step includes identifying a correction mark ( 2A1) the distance from the starting position to obtain the relative deviation value.
- 根据权利要求1至6中任一项所述的停车场自动泊车/取车方法,其特征在于,所述路线信息还包括所述行驶路线中的各校正标志(2A1)所对应的校正距离。The automatic parking/retrieving method for a parking lot according to any one of claims 1 to 6, wherein the route information further includes the correction distance corresponding to each correction mark (2A1) in the driving route .
- 根据引用权利要求3至6中任一项的权利要求7所述的停车场自动泊车/取车方法,其特征在于,The automatic parking/retrieving method for a parking lot according to claim 7 citing any one of claims 3 to 6, characterized in that:所述路线信息调整步骤还包括基于所述行驶路线和所述起始位置确定所述行驶路线中的各校正标志(2A1)所对应的校正距离,并且The route information adjustment step further includes determining a correction distance corresponding to each correction mark (2A1) in the travel route based on the travel route and the starting position, and所述路线信息发送步骤还包括发送调整后的所述校正标志(2A1)所对应的校正距离。The route information sending step further includes sending the corrected distance corresponding to the adjusted correction mark (2A1).
- 根据权利要求1至8中任一项所述的停车场自动泊车/取车方法,其特征在于,所述路线选择步骤包括:在所述停车场(2A)内从所述起始位置到所述目标位置的各路线中,排除与所述停车场(2A)内正在行驶的其它车辆发生冲突的路线,从其余路线中选择距离最短的路线作为所述行驶路线。The automatic parking/retrieving method for a parking lot according to any one of claims 1 to 8, wherein the route selection step comprises: in the parking lot (2A) from the starting position to Among the routes of the target location, the routes that conflict with other vehicles running in the parking lot (2A) are excluded, and the route with the shortest distance is selected from the remaining routes as the driving route.
- 根据权利要求1至9中任一项所述的停车场自动泊车/取车方法,其特征在于,The automatic parking/retrieving method for a parking lot according to any one of claims 1 to 9, characterized in that,各所述停车位所在位置分别对应一个所述标记点(211),且各所述路段的两端分别对应一个所述标记点(211);The location of each parking space corresponds to one mark point (211), and both ends of each road section correspond to one mark point (211);在同一所述路段中,相邻所述标记点(211)之间沿着该路段的距离不同;并且/或者In the same road section, the distances between adjacent marking points (211) along the road section are different; and/or所述停车场内的弯路段的曲率半径的变化频率越大,该弯路段中的相邻所述标记点(211)之间的距离越小。The greater the change frequency of the radius of curvature of the curved road section in the parking lot, the smaller the distance between the adjacent marking points (211) in the curved road section.
- 一种停车场系统,所述停车场系统包括:A parking lot system, the parking lot system includes:停车场终端(2),其用于建立停车场模型,所述停车场终端(2)能够基于车辆(1A)的请求识别所述车辆(1A)的起始位置和目标位置并在所述停车场模型中连接这两个位置之间的所有路线中选择行驶路线,所述路线 信息包括所述行驶路线中的各路段的方向信息和所有标记点(211)的道路特征参数并将所述路线信息发送到所述车辆(1A);以及A parking lot terminal (2), which is used to build a parking lot model. The parking lot terminal (2) can identify the starting position and the target position of the vehicle (1A) based on the request of the vehicle (1A) and stop at the vehicle (1A). The driving route is selected from all the routes connecting these two positions in the field model, and the route information includes the direction information of each section in the driving route and the road characteristic parameters of all the marked points (211) and the route The information is sent to the vehicle (1A); and辅助行驶终端,所述辅助行驶终端设置于所述停车场并能够被所述车辆(1A)识别,利用所述辅助行驶终端对应的信息能够修正所述车辆(1A)按照所述路线信息自动行驶的过程。An auxiliary driving terminal, the auxiliary driving terminal is installed in the parking lot and can be recognized by the vehicle (1A), and the information corresponding to the auxiliary driving terminal can be used to correct the automatic driving of the vehicle (1A) according to the route information the process of.
- 根据权利要求11所述的停车场系统,其特征在于,当所述请求为泊车请求时,所述停车场终端(2)还能够基于所述行驶路线和所述起始位置调整路线信息,并将调整后的所述路线信息发送到所述车辆(1A)。The parking lot system according to claim 11, characterized in that, when the request is a parking request, the parking lot terminal (2) can also adjust route information based on the driving route and the starting position, And send the adjusted route information to the vehicle (1A).
- 根据权利要求12所述的停车场系统,其特征在于,所述停车场终端(2)包括:The parking lot system according to claim 12, wherein the parking lot terminal (2) comprises:总控单元(21),其用于存储所述停车场模型的数据、确定所述目标位置、选择行驶路线并调整所述路线信息;A master control unit (21), which is used to store data of the parking lot model, determine the target location, select a driving route, and adjust the route information;路侧通信单元(23),其与所述总控单元(21)数据连通,并且向所述车辆(1A)发送信息以及接收来自所述车辆(1A)的信息;以及A roadside communication unit (23), which is in data communication with the master control unit (21), and sends information to and receives information from the vehicle (1A); and多个路侧信息采集单元(22),其与所述总控单元(21)数据连通并且至少用于识别所述车辆(1A)的起始位置、所述停车场(2A)内的停车位的使用状态以及所述停车场(2A)的入口和出口处的预定位置的使用状态。Multiple roadside information collection units (22), which are in data communication with the master control unit (21) and are used at least to identify the starting position of the vehicle (1A) and the parking space in the parking lot (2A) The usage status of the parking lot (2A) and the usage status of the predetermined locations at the entrance and exit of the parking lot (2A).
- 根据权利要求12或13所述的停车场系统,其特征在于,所述辅助行驶终端包括多个校正标志(2A1),其设置于所述停车场(2A)内的直路段中,通过识别该校正标志(2A1)能够调整所述路线信息并且能够校正所述车辆(1A)计算的所述行驶距离。The parking lot system according to claim 12 or 13, characterized in that the auxiliary driving terminal includes a plurality of correction signs (2A1), which are set in the straight section of the parking lot (2A), by identifying the The correction flag (2A1) can adjust the route information and can correct the travel distance calculated by the vehicle (1A).
- 根据权利要求12至14中任一项所述的停车场系统,其特征在于,所述辅助行驶终端包括车道线(2A2),其设置于所述停车场(2A)的各直路段并且沿着对应的所述直路段的延伸方向延伸,使得所述车辆(1A)能够按照所述车道线(2A2)在对应的直路段中自动行驶。The parking lot system according to any one of claims 12 to 14, characterized in that the auxiliary driving terminal comprises a lane line (2A2), which is arranged in each straight section of the parking lot (2A) and along the The extension direction of the corresponding straight section extends, so that the vehicle (1A) can automatically drive in the corresponding straight section according to the lane line (2A2).
- 一种停车场自动泊车/取车方法,包括:An automatic parking/retrieving method in a parking lot, including:路线信息接收步骤,接收从车辆(1A)的起始位置到目标位置的行驶路线的路线信息,所述行驶路线是选自停车场模型中的路线,所述停车场模型包括所述停车场(2A)的各停车位与入口和出口之间的各路线的路线信息,所述路线信息包括各所述路线中各路段的方向信息以及各路段中设立的标记点(211)的道路特征参数;以及The route information receiving step is to receive route information of a driving route from the starting position of the vehicle (1A) to the target position, where the driving route is a route selected from a parking lot model, and the parking lot model includes the parking lot ( 2A) Route information of each route between each parking space and the entrance and exit, where the route information includes the direction information of each road section in each of the routes and the road characteristic parameters of the marking points (211) set up in each road section; as well as车辆行驶控制步骤,控制所述车辆(1A)沿着所述行驶路线按照所述路线信息从所述起始位置自动行驶到所述目标位置。The vehicle driving control step is to control the vehicle (1A) to automatically travel from the starting position to the target position along the driving route according to the route information.
- 根据权利要求16所述的停车场自动泊车/取车方法,其特征在于,所述车辆行驶控制步骤还包括所述车辆(1A)行驶通过所述标记点(211)对应的位置时发送定位信息,所述定位信息用于定位所述车辆(1A)在所述停车场(2A)内的位置。The automatic parking/retrieving method for a parking lot according to claim 16, characterized in that, the vehicle driving control step further comprises sending positioning when the vehicle (1A) passes through the position corresponding to the marking point (211). Information, the positioning information is used to locate the position of the vehicle (1A) in the parking lot (2A).
- 根据权利要求16或17所述的自动泊车/取车方法,其特征在于,各标记点(211)的道路特征参数包括:The automatic parking/retrieving method according to claim 16 or 17, wherein the road characteristic parameters of each marking point (211) include:距离参数,其为该标记点(211)对应的位置与所述车辆的起始位置之间的沿着所述行驶路线的绝对距离或者为该标记点(211)对应的位置与该标记点(211)所在路段的起始标记点对应的位置之间的相对距离;以及The distance parameter, which is the absolute distance along the driving route between the position corresponding to the marking point (211) and the starting position of the vehicle, or the position corresponding to the marking point (211) and the marking point ( 211) The relative distance between the positions corresponding to the starting marker points of the road section; and半径参数,其为该标记点(211)对应的位置处的道路曲率半径。The radius parameter is the road curvature radius at the position corresponding to the marking point (211).
- 根据权利要求18所述的停车场自动泊车/取车方法,其特征在于,所述车辆行驶控制步骤包括:The automatic parking/retrieving method for a parking lot according to claim 18, wherein the step of controlling the driving of the vehicle comprises:基于所述车辆(1A)的行驶速度、车轮转向角度和行驶时间计算所述车辆(1A)实际行驶经过的行驶距离,当所述行驶距离等于所述标记点(211)的距离参数时,利用该标记点(211)的半径参数计算得到车轮转向角度,从而按照该车轮转向角度调整对应车轮的实际转向角度。Calculate the actual travel distance of the vehicle (1A) based on the travel speed, wheel steering angle and travel time of the vehicle (1A). When the travel distance is equal to the distance parameter of the marking point (211), use The radius parameter of the marking point (211) is calculated to obtain the steering angle of the wheel, so as to adjust the actual steering angle of the corresponding wheel according to the steering angle of the wheel.
- 根据权利要求19所述的停车场自动泊车/取车方法,其特征在于,所述路线信息还包括所述行驶路线中的各校正标志(2A1)所对应的校正距离,The automatic parking/retrieving method for a parking lot according to claim 19, wherein the route information further includes the correction distance corresponding to each correction mark (2A1) in the driving route,所述车辆行驶控制步骤还包括:在识别到所述车辆(1A)经过所述行驶路线中的校正标志(2A1)的情况下,通过所述校正标志(2A1)所对应的校正距离替换所述行驶距离,以校正计算的所述行驶距离。The vehicle driving control step further includes: in the case of recognizing that the vehicle (1A) passes the correction mark (2A1) in the driving route, replacing the correction distance corresponding to the correction mark (2A1) Travel distance to correct the calculated travel distance.
- 根据权利要求16至20中任一项所述的停车场自动泊车/取车方法,其特征在于,所述车辆行驶控制步骤还包括:识别所述行驶路线中的直路段的车道线(2A2)来辅助所述车辆(1A)沿着该直路段行驶。The automatic parking/retrieving method for a parking lot according to any one of claims 16 to 20, wherein the vehicle driving control step further comprises: identifying a lane line (2A2) of a straight section in the driving route. ) To assist the vehicle (1A) to drive along the straight section.
- 一种车辆终端,所述车辆终端(1)设置于所述车辆(1A)并用于向停车场系统提出请求,所述车辆终端(1)能够接收由所述停车场系统确定的从所述车辆(1A)的起始位置到目标位置的行驶路线的路线信息,所述路线信息包括所述行驶路线中的各路段的方向信息和所有标记点(211)的道路特征参数,所述车辆终端(1)能够控制所述车辆(1A)沿着所述行驶 路线按照所述路线信息从所述车辆(1A)的起始位置自动行驶到目标位置。A vehicle terminal, the vehicle terminal (1) is set on the vehicle (1A) and used to make a request to the parking lot system, the vehicle terminal (1) can receive the vehicle terminal (1) determined by the parking lot system from the vehicle The route information of the driving route from the starting position to the target position of (1A), the route information includes the direction information of each section in the driving route and the road characteristic parameters of all the marking points (211), the vehicle terminal ( 1) The vehicle (1A) can be controlled to automatically drive from the starting position of the vehicle (1A) to the target position along the driving route according to the route information.
- 根据权利要求22所述的车辆终端,其特征在于,所述车辆终端(1)包括:The vehicle terminal according to claim 22, characterized in that, the vehicle terminal (1) comprises:车载控制单元(11),其能够计算所述车辆(1A)的行驶距离并控制执行单元(13)进行动作,从而使得所述车辆(1A)自动行驶;An on-board control unit (11), which can calculate the driving distance of the vehicle (1A) and control the execution unit (13) to perform actions, so that the vehicle (1A) can travel automatically;多个车载信息采集单元,其与所述车载控制单元(11)数据连通,并用于至少测量所述车辆(1A)的速度、车轮转向角度和行驶时间;A plurality of vehicle-mounted information collection units, which are in data communication with the vehicle-mounted control unit (11) and used to measure at least the speed, wheel steering angle and driving time of the vehicle (1A);所述执行单元(13),其用于调节所述车辆(1A)的速度和车轮转向角度;以及The execution unit (13), which is used to adjust the speed and wheel steering angle of the vehicle (1A); and车载通信单元(14),其与所述车载控制单元(11)数据连通,并且用于接收来自所述停车场系统的信息以及向所述停车场系统发送信息。A vehicle-mounted communication unit (14), which is in data communication with the vehicle-mounted control unit (11), and is used for receiving information from the parking lot system and sending information to the parking lot system.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2020/090154 WO2021226908A1 (en) | 2020-05-14 | 2020-05-14 | Automatic vehicle parking/retrieving method for parking lot, parking lot system, and vehicle terminal |
CN202080094759.4A CN115004276A (en) | 2020-05-14 | 2020-05-14 | Parking lot automatic parking/pickup method, parking lot system and vehicle terminal |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2020/090154 WO2021226908A1 (en) | 2020-05-14 | 2020-05-14 | Automatic vehicle parking/retrieving method for parking lot, parking lot system, and vehicle terminal |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2021226908A1 true WO2021226908A1 (en) | 2021-11-18 |
Family
ID=78526186
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/CN2020/090154 WO2021226908A1 (en) | 2020-05-14 | 2020-05-14 | Automatic vehicle parking/retrieving method for parking lot, parking lot system, and vehicle terminal |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN115004276A (en) |
WO (1) | WO2021226908A1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114670819A (en) * | 2022-04-07 | 2022-06-28 | 广州小鹏自动驾驶科技有限公司 | Parking route list generation method, device, equipment and storage medium |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115497331B (en) * | 2022-11-18 | 2023-01-13 | 北京集度科技有限公司 | Parking method, device and equipment and vehicle |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1920485A (en) * | 2005-08-26 | 2007-02-28 | 厦门雅迅网络股份有限公司 | Vehicle navigation method capable of automatically correcting navigation track |
JP2015105833A (en) * | 2013-11-28 | 2015-06-08 | 本田技研工業株式会社 | Route search system |
CN106197442A (en) * | 2016-06-24 | 2016-12-07 | 深圳市元征科技股份有限公司 | Air navigation aid and equipment |
CN107680403A (en) * | 2017-10-30 | 2018-02-09 | 中国联合网络通信集团有限公司 | Vehicle, which is led, stops method and system |
CN108734990A (en) * | 2017-04-20 | 2018-11-02 | 胡家安 | A kind of interior parking navigation method |
CN110827572A (en) * | 2019-01-25 | 2020-02-21 | 长城汽车股份有限公司 | Path planning method and device for passenger-riding parking |
-
2020
- 2020-05-14 WO PCT/CN2020/090154 patent/WO2021226908A1/en active Application Filing
- 2020-05-14 CN CN202080094759.4A patent/CN115004276A/en active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1920485A (en) * | 2005-08-26 | 2007-02-28 | 厦门雅迅网络股份有限公司 | Vehicle navigation method capable of automatically correcting navigation track |
JP2015105833A (en) * | 2013-11-28 | 2015-06-08 | 本田技研工業株式会社 | Route search system |
CN106197442A (en) * | 2016-06-24 | 2016-12-07 | 深圳市元征科技股份有限公司 | Air navigation aid and equipment |
CN108734990A (en) * | 2017-04-20 | 2018-11-02 | 胡家安 | A kind of interior parking navigation method |
CN107680403A (en) * | 2017-10-30 | 2018-02-09 | 中国联合网络通信集团有限公司 | Vehicle, which is led, stops method and system |
CN110827572A (en) * | 2019-01-25 | 2020-02-21 | 长城汽车股份有限公司 | Path planning method and device for passenger-riding parking |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114670819A (en) * | 2022-04-07 | 2022-06-28 | 广州小鹏自动驾驶科技有限公司 | Parking route list generation method, device, equipment and storage medium |
CN114670819B (en) * | 2022-04-07 | 2023-08-25 | 广州小鹏自动驾驶科技有限公司 | Parking route list generation method, device, equipment and storage medium |
Also Published As
Publication number | Publication date |
---|---|
CN115004276A (en) | 2022-09-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101901024B1 (en) | Map update determination system | |
US10048699B2 (en) | Vehicle control apparatus | |
CN107783535B (en) | vehicle control device | |
US11124163B2 (en) | Method for controlling travel of vehicle, and device for controlling travel of vehicle | |
CN107705554B (en) | Transmission necessity determination device and route planning system | |
US9550494B2 (en) | Driving assistance apparatus | |
CN101346602B (en) | Vehicle positioning information update device | |
CN111422185B (en) | Method for controlling a motor vehicle, control device and motor vehicle | |
CN105270410A (en) | Accurate curvature estimation algorithm for path planning of autonomous driving vehicle | |
CN101346603A (en) | Object Recognition Device | |
CN110422177A (en) | A kind of control method for vehicle, apparatus and system | |
JP2019079398A (en) | Cruise controller | |
JP7232100B2 (en) | Vehicle travel control device | |
JP7620440B2 (en) | Autonomous Driving Assistance System | |
WO2021226908A1 (en) | Automatic vehicle parking/retrieving method for parking lot, parking lot system, and vehicle terminal | |
CN113168762A (en) | Vehicle driving assistance method, vehicle driving assistance device, and automatic driving system | |
JPH09183383A (en) | Automatic steering controller | |
JP3457441B2 (en) | How to control an autonomous vehicle | |
CN108569284B (en) | Method for improving driving safety under complex road condition | |
CN114940172A (en) | Driving assistance device | |
CN104442810A (en) | Automobile parking assistant instrument | |
US20230003531A1 (en) | Matching coordinate systems of multiple maps, based on trajectories | |
US20220258727A1 (en) | Automated valet parking system, control method of automated valet parking system, and autonomous driving vehicle | |
CN116913131A (en) | V2X-based parking method | |
US12145574B2 (en) | Vehicle control method, vehicle control system, and vehicle control program |
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: 20935958 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 20935958 Country of ref document: EP Kind code of ref document: A1 |