TWI769833B - Parking aid system - Google Patents

Parking aid system Download PDF

Info

Publication number
TWI769833B
TWI769833B TW110119262A TW110119262A TWI769833B TW I769833 B TWI769833 B TW I769833B TW 110119262 A TW110119262 A TW 110119262A TW 110119262 A TW110119262 A TW 110119262A TW I769833 B TWI769833 B TW I769833B
Authority
TW
Taiwan
Prior art keywords
vehicle
parking
parking space
processor unit
path
Prior art date
Application number
TW110119262A
Other languages
Chinese (zh)
Other versions
TW202246092A (en
Inventor
黃均如
梅漢軒
李波前
胡聰賢
Original Assignee
輝創電子股份有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 輝創電子股份有限公司 filed Critical 輝創電子股份有限公司
Priority to TW110119262A priority Critical patent/TWI769833B/en
Priority to CN202110736685.6A priority patent/CN115402296A/en
Application granted granted Critical
Publication of TWI769833B publication Critical patent/TWI769833B/en
Publication of TW202246092A publication Critical patent/TW202246092A/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/06Automatic manoeuvring for parking

Abstract

A parking aid system includes a range unit for detecting a parking space to obtain spatial information of the parking space. A parking assist module for tracking a parking path through a trajectory tracking algorithm to generate a plurality of turning curvature sequentially. A processor unit receives a parking signal from a vehicle and converts each of the turning curvature to a steering angle of the vehicle when the parking space has enough space for parking the vehicle. The processor unit controls the rotation of the steering wheel of the vehicle so that the rotation amplitude of the steering wheel is correspond to the plurality of steering angle sequentially to drive the vehicle into the parking space.

Description

停車輔助系統 Parking assist system

本發明係關於一種車用輔助系統,尤其是一種用以導引車輛駛入停車位的停車輔助系統。 The present invention relates to a vehicle auxiliary system, in particular to a parking assistance system for guiding a vehicle into a parking space.

對於許多駕駛者而言,不論是倒車入庫或是路邊停車,由於必須同時控制油門踏板、煞車踏板及方向盤等操作,因此,如何能快速且準確地將車輛停入至停車位中,對於停車技術不熟練的駕駛者而言乃是一大考驗。甚至,時常會看到有許多駕駛者即使在路邊找到停車位,卻因為駕駛經驗不足,而無法判斷該車輛是否能夠停放在該停車位當中,以及經由多次來回挪移車輛,仍無法將該車輛停放至該停車位內。 For many drivers, whether it is reversing into the garage or parking on the road, because the accelerator pedal, brake pedal and steering wheel must be controlled at the same time, how to quickly and accurately park the vehicle into the parking space, for parking It is a big test for unskilled drivers. Even, it is often seen that many drivers find a parking space on the side of the road, but because of their lack of driving experience, they cannot judge whether the vehicle can be parked in the parking space, and even after moving the vehicle back and forth many times, they are still unable to park the vehicle. The vehicle is parked in the parking space.

然而,車輛駕駛在挪移車輛的過程中,可能會因為旋轉方向盤的幅度不足、過大,或是控制該方向盤轉向、回正的時間點欠佳,導致駕駛者無法順利地將車輛停在該停車位內。 However, in the process of moving the vehicle, the driver may not be able to park the vehicle smoothly in the parking space due to insufficient or excessive rotation of the steering wheel, or poor timing of controlling the steering wheel to turn and return to alignment. Inside.

有鑑於此,確實有必要提供一種停車輔助系統,以解決上述之問題。 In view of this, it is indeed necessary to provide a parking assist system to solve the above problems.

為解決上述問題,本發明的目的是提供一種停車輔助系統,係能夠用以導引車輛駛入停車位者。 In order to solve the above-mentioned problems, the purpose of the present invention is to provide a parking assistance system, which can be used to guide a vehicle into a parking space.

本發明的次一目的是提供一種停車輔助系統,係能夠在停車過程中分析出該停車位的空間資訊產生改變,並重新規劃二次停車路徑,以供該車輛依據該二次停車路徑駛入該停車位者。 Another object of the present invention is to provide a parking assistance system, which can analyze the change in the spatial information of the parking space during the parking process, and re-plan the secondary parking path for the vehicle to enter according to the secondary parking path. the parking space.

本發明的又一目的是提供一種停車輔助系統,係能夠在停車過程中分析出該停車位的空間資訊產生改變時,計算將該車輛根據該二次停車路徑駛入該停車位所需花費的時間,且通知該車輛的駕駛者,以供駕駛者決定是否仍要把車輛駛入該停車位者。 Another object of the present invention is to provide a parking assistance system, which can calculate the cost of driving the vehicle into the parking space according to the secondary parking path when the spatial information of the parking space is changed during the parking process. time, and notify the driver of the vehicle for the driver to decide whether to drive the vehicle into the parking space anyway.

本發明全文所述方向性或其近似用語,例如「前」、「後」、「左」、「右」、「上(頂)」、「下(底)」、「內」、「外」、「側面」等,主要係參考附加圖式的方向,各方向性或其近似用語僅用以輔助說明及理解本發明的各實施例,非用以限制本發明。 The directionality or similar terms used throughout the present disclosure, such as "front", "back", "left", "right", "top (top)", "bottom (bottom)", "inside", "outside" , "side surface", etc., mainly refer to the directions of the attached drawings, each directionality or its similar terms are only used to assist the description and understanding of the various embodiments of the present invention, and are not intended to limit the present invention.

本發明全文所記載的元件及構件使用「一」或「一個」之量詞,僅是為了方便使用且提供本發明範圍的通常意義;於本發明中應被解讀為包括一個或至少一個,且單一的概念也包括複數的情況,除非其明顯意指其他意思。 The use of the quantifier "a" or "an" for the elements and components described throughout the present invention is only for convenience and provides a general meaning of the scope of the present invention; in the present invention, it should be construed as including one or at least one, and a single The concept of also includes the plural case unless it is obvious that it means otherwise.

本發明全文所述之「微控制器或處理器單元(Processor Unit)」,係指任何具有資料儲存、運算及訊號產生功能的電子晶片,或具有該電子晶片的電子設備。舉例而言,該電子晶片可以為中央處理單元(CPU)、微控制器(MCU)、數位訊號處理器(DSP)、現場可程式化邏輯閘陣列(FPGA)或系統單晶片(SoC);該電子設備可以為可程式邏輯控制器(PLC)或Arduino UNO,本領域中具有通常知識者可以依據運算效能、價格、體積限制或功能需求等予以選擇者。 The "microcontroller or processor unit" mentioned in the whole of the present invention refers to any electronic chip with functions of data storage, calculation and signal generation, or an electronic device having the electronic chip. For example, the electronic chip can be a central processing unit (CPU), a microcontroller (MCU), a digital signal processor (DSP), a field programmable logic gate array (FPGA), or a system-on-chip (SoC); the The electronic device can be a Programmable Logic Controller (PLC) or Arduino UNO, which can be selected by those with ordinary knowledge in the art based on computing performance, price, volume constraints or functional requirements.

本發明的一停車輔助系統,包含:一測距單元,供裝設於一車輛,該測距單元用以朝一停車位的方向偵測,以取得該停車位的一空間資訊; 一泊車輔助模組,供裝設於該車輛,該泊車輔助模組用以透過一軌跡追蹤演算法對一停車路徑追蹤,以依序產生數個迴轉曲率,該停車路徑係為供該車輛駛入該停車位的導引路徑;及一處理器單元,供裝設於該車輛且耦接該測距單元及該泊車輔助模組,該處理器單元接收到一停車訊號時,控制該測距單元運作,並將取得的空間資訊與該車輛的一車身數據進行判斷,以判斷該停車位是否具有足夠的空間供停放該車輛,若判斷結果為是,該處理器單元控制該泊車輔助模組運作,以取得該數個迴轉曲率,並將各該迴轉曲率轉換成該車輛的一轉向角度,該處理器單元產生並發送包含該數個轉向角度的一轉向訊號至該車輛的一車載電腦,使該車載電腦控制該車輛的方向盤旋轉,並使該方向盤的旋轉幅度依序符合該數個轉向角度,以將該車輛駛入該停車位中;該處理器單元接收到該停車訊號,並且該車輛正處於駛入該停車位的過程時,該車輛位於一第一定點位置,若有另一車輛停放於該停車位後方,則該處理器單元根據該測距單元取得該另一車輛相對於該車輛的數個第一相對座標,當該車輛持續根據該停車路徑駛入該停車位,使該車輛位於一第二定點位置時,該第二定點位置係根據該第一定點位置及該車輛的移動距離取得,該處理器單元根據該測距單元取得該另一車輛相對於該車輛的數個第二相對座標,並將該數個第二相對座標與該數個第一相對座標相互比對,以評估出該另一車輛是朝該停車位方向前進,或朝遠離該停車位方向後退,該處理器單元根據該數個第二相對座標更新該停車位的空間資訊,並判斷更新後的空間資訊是否有足夠的空間供停放該車輛,若判斷結果為是,則進一步確認該車輛是否可沿著原本的停車路徑駛入該停車位,若確認結果為否,則該處理器單元產生並發送一駛離訊號至該車載電腦,使該車載電腦控制該車輛移出該停車位,並控制該泊車輔助模組根據更新後的空間資訊運算,以重新規劃產生一二次停車路徑,並控制該車載電腦操控該車輛根據該二次停車路 徑駛入該停車位中。 A parking assistance system of the present invention includes: a ranging unit for installation in a vehicle, the ranging unit is used for detecting the direction of a parking space to obtain a spatial information of the parking space; a parking assistance module for being installed on the vehicle, the parking assistance module is used for tracking a parking path through a trajectory tracking algorithm to sequentially generate a plurality of gyration curvatures, and the parking path is used for the vehicle A guide path for driving into the parking space; and a processor unit for being installed in the vehicle and coupled to the ranging unit and the parking assist module, the processor unit controls the parking signal when receiving a parking signal The ranging unit operates and judges the obtained spatial information and a body data of the vehicle to judge whether the parking space has enough space for parking the vehicle. If the judgment result is yes, the processor unit controls the parking The auxiliary module operates to obtain the plurality of gyration curvatures and convert each of the gyration curvatures into a steering angle of the vehicle, the processor unit generates and sends a turn signal including the steering angles to a turn signal of the vehicle an on-board computer, enabling the on-board computer to control the rotation of the steering wheel of the vehicle, and making the rotation range of the steering wheel conform to the several steering angles in sequence, so as to drive the vehicle into the parking space; the processor unit receives the parking signal , and the vehicle is in the process of entering the parking space, the vehicle is located at a first fixed point position, if another vehicle is parked behind the parking space, the processor unit obtains the other vehicle according to the distance measuring unit. Several first relative coordinates of a vehicle relative to the vehicle, when the vehicle continues to drive into the parking space according to the parking path, so that the vehicle is located at a second fixed point position, the second fixed point position is based on the first fixed point The point position and the moving distance of the vehicle are obtained, the processor unit obtains a plurality of second relative coordinates of the other vehicle relative to the vehicle according to the ranging unit, and compares the plurality of second relative coordinates with the plurality of first relative coordinates A relative coordinate is compared with each other to evaluate whether the other vehicle is moving toward the parking space or retreating away from the parking space, and the processor unit updates the spatial information of the parking space according to the plurality of second relative coordinates , and determine whether the updated spatial information has enough space for parking the vehicle. If the determination result is yes, then further confirm whether the vehicle can enter the parking space along the original parking path. If the confirmation result is no, then The processor unit generates and sends a departure signal to the in-vehicle computer, so that the in-vehicle computer controls the vehicle to move out of the parking space, and controls the parking assistance module to calculate according to the updated spatial information to re-plan to generate one or two the secondary parking path, and control the on-board computer to control the vehicle according to the secondary parking path drive into the parking space.

本發明的另一停車輔助系統,包含:一測距單元,供裝設於一車輛,該測距單元用以朝一停車位的方向偵測,以取得該停車位的一空間資訊;一泊車輔助模組,供裝設於該車輛,該泊車輔助模組用以透過一軌跡追蹤演算法對一停車路徑追蹤,以依序產生數個迴轉曲率,該停車路徑係為供該車輛駛入該停車位的導引路徑;及一處理器單元,供裝設於該車輛且耦接該測距單元及該泊車輔助模組,該處理器單元接收到一停車訊號時,控制該測距單元運作,並將取得的空間資訊與該車輛的一車身數據進行判斷,以判斷該停車位是否具有足夠的空間供停放該車輛,若判斷結果為是,該處理器單元控制該泊車輔助模組運作,以取得該數個迴轉曲率,並將各該迴轉曲率轉換成該車輛的一轉向角度,該處理器單元產生並發送包含該數個轉向角度的一轉向訊號至該車輛的一車載電腦,使該車載電腦控制該車輛的方向盤旋轉,並使該方向盤的旋轉幅度依序符合該數個轉向角度,以將該車輛駛入該停車位中;當該車輛準備根據該停車路徑駛入該停車位時,該處理器單元透過該測距單元偵測該停車位內是否有障礙物存在,並於偵測到該障礙物時開始計時,以產生一等待時間,該處理器單元計算該等待時間是否超過一時間門檻,若計算結果為是,則發送一駛離訊號至該車載電腦,使該車載電腦控制該車輛駛離當下位置。 Another parking assistance system of the present invention includes: a ranging unit for installation in a vehicle, the ranging unit is used for detecting the direction of a parking space to obtain a spatial information of the parking space; a parking assistance a module for being installed on the vehicle, the parking assistance module is used for tracking a parking path through a trajectory tracking algorithm to sequentially generate a plurality of turning curvatures, the parking path is for the vehicle to drive into the a guidance path of a parking space; and a processor unit for being installed in the vehicle and coupled to the ranging unit and the parking assist module, the processor unit controls the ranging unit when receiving a parking signal It operates and judges the obtained spatial information and a body data of the vehicle to judge whether the parking space has enough space for parking the vehicle. If the judgment result is yes, the processor unit controls the parking assist module operate to obtain the plurality of gyration curvatures and convert each of the gyration curvatures into a steering angle of the vehicle, the processor unit generates and sends a turn signal including the plurality of steering angles to an on-board computer of the vehicle, Make the on-board computer control the rotation of the steering wheel of the vehicle, and make the rotation amplitude of the steering wheel conform to the steering angles in sequence, so as to drive the vehicle into the parking space; when the vehicle is ready to drive into the parking space according to the parking path The processor unit detects whether there is an obstacle in the parking space through the ranging unit, and starts timing when the obstacle is detected to generate a waiting time, and the processor unit calculates the waiting time Whether it exceeds a time threshold, if the calculation result is yes, send a departure signal to the on-board computer, so that the on-board computer controls the vehicle to drive away from the current position.

據此,本發明的停車輔助系統,係能夠透過該泊車輔助模組對一停車路徑進行追蹤,以產生數個迴轉曲率,該處理器單元接收到一停車訊號時,發送一轉向訊號至車輛的車載電腦,使該車載電腦控制該車輛之方向盤旋轉,使該方向盤之旋轉幅度依序符合該數個迴轉曲率,以控制該車輛自動駛入該停車格中,再且,本發明的測距單元、泊車輔助模組及處理器單元皆可以為該車輛本身即有的裝置,不需額外配置加裝。如此,本發明的停車 輔助系統,係具有提升停車便利性及降低車輛成本的功效。此外,本發明的停車輔助系統,可在該車輛駛入至該停車位的過程中,判斷位於該停車位後方的車輛是否正在朝該停車位方向前進,或朝遠離該停車位方向後退的功效。另,該處理器單元計算該等待時間的判斷,能夠避免駕駛者花費太多時間在等待該障礙物離開的功效。 Accordingly, the parking assistance system of the present invention can track a parking path through the parking assistance module to generate several turning curvatures, and the processor unit sends a turn signal to the vehicle when receiving a parking signal the on-board computer, so that the on-board computer controls the rotation of the steering wheel of the vehicle, so that the rotation amplitude of the steering wheel conforms to the several gyration curvatures in sequence, so as to control the vehicle to automatically drive into the parking space. Moreover, the distance measurement of the present invention The unit, the parking assist module and the processor unit can all be devices that the vehicle itself has, and no additional configuration is required. In this way, the parking of the present invention The auxiliary system has the effect of improving the convenience of parking and reducing the cost of the vehicle. In addition, the parking assist system of the present invention has the effect of determining whether the vehicle behind the parking space is moving toward the parking space or retreating away from the parking space during the process of the vehicle entering the parking space. . In addition, the processor unit calculates the judgment of the waiting time, which can avoid the effect of the driver spending too much time waiting for the obstacle to leave.

其中,該處理器單元將該數個第一相對座標依序相連,以形成一第一車頭虛擬線,以及將該數個第二相對座標依序相連,以形成一第二車頭虛擬線,該處理器單元對該第一車頭虛擬線與該第二車頭虛擬線進行分析,若該第一車頭虛擬線較接近該停車位的方向,即表示該另一車輛正朝遠離該停車位方向後退,若該第二車頭虛擬線較接近該停車位的方向,即表示該另一車輛正朝該停車位方向前進。如此,係具有判斷位於該停車位後方的車輛是否正在朝該停車位方向前進,或朝遠離該停車位方向後退的功效。 Wherein, the processor unit sequentially connects the plurality of first relative coordinates to form a first virtual front line, and sequentially connects the plurality of second relative coordinates to form a second virtual front line, the The processor unit analyzes the first virtual line and the second virtual line. If the first virtual line is closer to the parking space, it means that the other vehicle is moving backwards away from the parking space. If the second virtual line in front of the vehicle is closer to the direction of the parking space, it means that the other vehicle is heading toward the parking space. In this way, the system has the effect of judging whether the vehicle behind the parking space is moving toward the parking space or retreating away from the parking space.

其中,當該等待時間未超過該時間門檻時,該處理器單元透過該測距單元偵測取得該障礙物的尺寸及位置,並估算該障礙物的尺寸是否符合一限制條件,若估算結果為是,則該處理器單元控制該泊車輔助模組根據該空間資訊及該障礙物的尺寸及位置,以重新規劃產生一二次停車路徑,該處理器單元控制該車載電腦操控該車輛根據該二次停車路徑駛入該停車位。如此,該車輛係能夠根據該二次停車路徑,迴避該停車位中的該障礙物,並將該車輛駛入該停車位中,係具有自動迴避障礙物的功效。 Wherein, when the waiting time does not exceed the time threshold, the processor unit detects and obtains the size and position of the obstacle through the ranging unit, and estimates whether the size of the obstacle meets a restriction condition, if the estimation result is Yes, then the processor unit controls the parking assist module to re-plan and generate a secondary parking path according to the spatial information and the size and position of the obstacle, and the processor unit controls the on-board computer to control the vehicle according to the The secondary parking path drives into the parking space. In this way, the vehicle can avoid the obstacle in the parking space according to the secondary parking path, and drive the vehicle into the parking space, which has the function of automatically avoiding the obstacle.

其中,該限制條件係為該障礙物相對於該停車格之寬度尺寸的徑向長度,必須小於該車體寬度之1/3,且該障礙物的位置係位於該停車位遠離該車輛的一側。如此,係能夠使該車輛在不超出該停車位範圍太多的前提下,將該車輛停駛於該停車位的功效。 Wherein, the restriction condition is that the radial length of the obstacle relative to the width dimension of the parking space must be less than 1/3 of the width of the vehicle body, and the position of the obstacle is located at a distance of the parking space away from the vehicle. side. In this way, the vehicle can be stopped in the parking space under the premise that the vehicle does not exceed the range of the parking space too much.

其中,當該處理器單元控制該泊車輔助模組重新規劃產生該二 次停車路徑時,該處理器單元預估該車輛根據該二次停車路徑駛入該停車位所需花費的時間,以產生一停車時間,該處理器單元控制該泊車輔助模組發出一通知訊號,以告知該車輛的駕駛者,該車輛停駛入該停車位的預估時間為該停車時間。如此,係具有提供駕駛者評估是否要直接駛離該當下位置,或花費該停車時間等待該車輛駛入該停車位中的功效。 Wherein, when the processor unit controls the parking assist module to re-plan to generate the two When the secondary parking path is used, the processor unit estimates the time it takes for the vehicle to enter the parking space according to the secondary parking path to generate a parking time, and the processor unit controls the parking assistance module to issue a notification A signal to inform the driver of the vehicle that the estimated time for the vehicle to stop into the parking space is the parking time. In this way, the system has the effect of providing the driver with an assessment of whether to drive directly away from the current position, or to spend the parking time waiting for the vehicle to drive into the parking space.

〔本發明〕 〔this invention〕

1:測距單元 1: Ranging unit

2:泊車輔助模組 2: Parking assistance module

3:處理器單元 3: Processor unit

B:障礙物 B: Obstacle

C1,C2:車輛 C1,C2: Vehicles

L1:第一定點位置 L1: The first fixed point position

L2:第二定點位置 L2: The second fixed point position

P:停車位 P: parking space

R1:第一相對座標 R1: The first relative coordinate

R2:第二相對座標 R2: The second relative coordinate

V1:第一車頭虛擬線 V1: The first virtual line

V2:第二車頭虛擬線 V2: virtual line of the second front

〔第1圖〕本發明一較佳實施例的系統方塊圖。 [FIG. 1] A system block diagram of a preferred embodiment of the present invention.

〔第2圖〕本發明一較佳實施例的車輛根據該停車路徑駛入停車位的狀態示意圖。 [FIG. 2] A state diagram of a vehicle entering a parking space according to the parking path according to a preferred embodiment of the present invention.

〔第3圖〕本發明一較佳實施例的該停車位後方的車輛,朝該停車位方向前進的狀態示意圖。 [FIG. 3] A schematic diagram of a state in which a vehicle behind the parking space moves toward the parking space according to a preferred embodiment of the present invention.

〔第4圖〕本發明一較佳實施例的泊車輔助模組重新規劃二次停車路徑的狀態示意圖。 [FIG. 4] A schematic diagram of the state of re-planning the secondary parking path of the parking assistance module according to a preferred embodiment of the present invention.

〔第5圖〕本發明一較佳實施例的車輛停駛於具有該障礙物的該停車位中的狀態示意圖。 [FIG. 5] A schematic diagram of a state in which a vehicle is parked in the parking space with the obstacle according to a preferred embodiment of the present invention.

為讓本發明之上述及其他目的、特徵及優點能更明顯易懂,下文特舉本發明之較佳實施例,並配合所附圖式,作詳細說明如下:請參照第1圖所示,其係本發明停車輔助系統的一較佳實施例,係包含一測距單元1、一泊車輔助模組2及一處理器單元3,該測距單元1及該泊車輔助模組2耦接該處理器單元3。 In order to make the above-mentioned and other objects, features and advantages of the present invention more obvious and easy to understand, the preferred embodiments of the present invention are exemplified below, and are described in detail as follows in conjunction with the accompanying drawings: please refer to Figure 1, It is a preferred embodiment of the parking assistance system of the present invention, and includes a ranging unit 1 , a parking assistance module 2 and a processor unit 3 , and the ranging unit 1 and the parking assistance module 2 are coupled to each other. The processor unit 3.

該測距單元1供裝設於一車輛,該測距單元用以朝一停車位的方向偵測,以取得該停車位的一空間資訊,該空間資訊係可以包含該停車位的一長度尺寸、一寬度尺寸及座標。具體而言,該測距單元1係可以由一影像設備與一微控制器所組成,或著是可以為整合一射頻晶片、一數位訊號處理器、一訊號放大器及一微控制器的一單晶片系統(SoC),例如但不限制地,該射頻晶片係可以為使用24GHz、77GHz或79GHz的毫米波雷達(RADAR)、光達(LiDAR)或超聲波,該測距單元1的微控制器係可以透過三角測量或合成孔徑(synthetic aperture)方式計算取得該空間資訊。 The distance measuring unit 1 is installed in a vehicle, and the distance measuring unit is used for detecting the direction of a parking space to obtain a spatial information of the parking space, and the spatial information may include a length dimension of the parking space, A width dimension and coordinates. Specifically, the ranging unit 1 may be composed of an imaging device and a microcontroller, or may be a single unit integrating a radio frequency chip, a digital signal processor, a signal amplifier and a microcontroller A system-on-chip (SoC), for example, but not limited to, the radio frequency chip system may be a millimeter-wave radar (RADAR), a LiDAR (LiDAR) or an ultrasonic using 24GHz, 77GHz or 79GHz, the microcontroller system of the ranging unit 1 The spatial information can be obtained by triangulation or synthetic aperture calculation.

該測距單元1的安裝位置係可以依設計需求而予以調整,例如:該測距單元1係可以安裝於該車輛的右側、左側、前側或/及後側,係本發明所屬技術領域中具有通常知識者可以理解,在本實施例中,該測距單元1的數量可以為四個,並分別安裝於該車輛的後右角側、後右中側、後左角側及後左中側等位置,以具有對該車輛行進方向的障礙物進行偵測的作用。 The installation position of the distance measuring unit 1 can be adjusted according to design requirements. For example, the distance measuring unit 1 can be installed on the right side, left side, front side or/and rear side of the vehicle. A person with ordinary knowledge can understand that, in this embodiment, the number of the ranging units 1 can be four, and they are respectively installed on the rear right corner side, the rear right middle side, the rear left corner side and the rear left middle side of the vehicle, etc. position, so as to have the function of detecting obstacles in the traveling direction of the vehicle.

該泊車輔助模組2供裝設於該車輛,該泊車輔助模組2用以透過一軌跡追蹤演算法對一停車路徑追蹤,以依序產生數個迴轉曲率,該停車路徑係為供該車輛駛入該停車位的導引路徑。舉例而言,該泊車輔助模組2係可以具有語音及顯示等功能,並可以透過一純追蹤演算法(Pure Pursuit Algorithm)或其他追蹤算法對該停車路徑進行追蹤,在本實施例中,該停車路徑的停車方案係以車尾先行進入該停車位的平行停車方式。 The parking assistance module 2 is installed in the vehicle, and the parking assistance module 2 is used for tracking a parking path through a trajectory tracking algorithm to generate a plurality of turning curvatures in sequence, and the parking path is provided for The vehicle enters the guidance path of the parking space. For example, the parking assistance module 2 can have functions such as voice and display, and can track the parking path through a Pure Pursuit Algorithm or other tracking algorithms. In this embodiment, The parking scheme of the parking path is a parallel parking method in which the rear of the vehicle enters the parking space first.

詳言之,該泊車輔助模組2設定一起點座標,並根據該空間資訊獲得一終點座標,該泊車輔助模組2根據該起點座標與該終點座標規劃該停車路徑,且將該停車路徑依序分為數個路徑區段,該泊車輔助模組2係可以根據該停車路徑及該車輛的一車身數據產生該車輛依序移動至各該路徑區段的數個迴轉曲率。 In detail, the parking assistance module 2 sets a starting point coordinate, and obtains an end point coordinate according to the spatial information. The parking assistance module 2 plans the parking path according to the start point coordinate and the end point coordinate, and the parking The path is divided into several path sections in sequence, and the parking assistance module 2 can generate several gyration curvatures for the vehicle to sequentially move to each of the path sections according to the parking path and a body data of the vehicle.

該處理器單元3供裝設於該車輛且耦接該測距單元1及該泊車輔助模組2,該處理器單元3接收到一停車訊號時,控制該測距單元1運作,並將取得的空間資訊與該車輛的一車身數據進行判斷,以判斷該停車位是否具有足夠的空間供停放該車輛,若判斷結果為是,該處理器單元3控制該泊車輔助模組2運作,以取得該數個迴轉曲率,並將各該迴轉曲率轉換成該車輛的一轉向角度;若判斷結果為否,該處理器單元3係可以發送一駛離訊號至該車載電腦,使該車載電腦控制該車輛駛離當下位置。其中,該車身數據係可以包含一車身長度、一車身寬度、一前軸中心點座標、一後軸中心點座標、一軸距及一輪距等資訊,以供該泊車輔助模組2建立該停車路徑,以及對該停車路徑進行追蹤時的計算公式使用。 The processor unit 3 is installed in the vehicle and is coupled to the ranging unit 1 and the parking assist module 2. When the processor unit 3 receives a parking signal, the processor unit 3 controls the operation of the ranging unit 1 and sends The obtained spatial information and a body data of the vehicle are determined to determine whether the parking space has enough space for parking the vehicle. If the determination result is yes, the processor unit 3 controls the operation of the parking assistance module 2, to obtain the plurality of gyration curvatures, and convert each of the gyration curvatures into a steering angle of the vehicle; if the judgment result is no, the processor unit 3 can send a departure signal to the on-board computer, so that the on-board computer Control the vehicle to move away from the current position. The vehicle body data system may include information such as a vehicle body length, a vehicle body width, a front axle center point coordinate, a rear axle center point coordinate, a wheelbase and a wheelbase, etc., for the parking assist module 2 to establish the The parking path, and the calculation formula used when tracking the parking path.

該處理器單元3產生並發送包含該數個轉向角度的一轉向訊號至該車輛的一車載電腦,使該車載電腦控制該車輛的方向盤旋轉,並使該方向盤的旋轉幅度依序符合該數個轉向角度,以將該車輛駛入該停車位中。其中,該處理器單元3與該車載電腦係可以為集中式(Centralized)、分散式(Distributed)或結合上述兩者,該車載電腦控制該車輛移動的自動駕駛技術,係本發明所屬技術領域中具有通常知識者可以理解,在此不多加贅述。 The processor unit 3 generates and sends a turn signal including the steering angles to an on-board computer of the vehicle, so that the on-board computer controls the rotation of the steering wheel of the vehicle and makes the rotation amplitude of the steering wheel conform to the number of rotations in sequence. Steering angle to drive the vehicle into the parking space. Wherein, the processor unit 3 and the on-board computer can be centralized (Centralized), distributed (Distributed) or a combination of the above two. The on-board computer controls the automatic driving technology of the vehicle movement, which belongs to the technical field of the present invention. Those with ordinary knowledge can understand it, so I won't go into details here.

請參照第2~3圖所示,當一車輛C1欲以車尾先行進入一停車位P的方式進行路邊停車時,駕駛者係可以透過操控一啟動按鈕,使發出一停車訊號至該處理器單元3;該車輛C1正處於駛入該停車位P的過程中,該車輛C1位於一第一定點位置L1,若有另一車輛C2停放於該停車位P後方,則該處理器單元3係可以根據該測距單元1取得該另一車輛C2相對於該車輛C1的數個第一相對座標R1。 Please refer to Figures 2 to 3, when a vehicle C1 wants to park on the roadside by entering a parking space P with the rear of the vehicle first, the driver can control a start button to send a stop signal to the processing The processor unit 3; the vehicle C1 is in the process of entering the parking space P, the vehicle C1 is located at a first fixed point position L1, if another vehicle C2 is parked behind the parking space P, the processor unit The 3 Series can obtain several first relative coordinates R1 of the other vehicle C2 with respect to the vehicle C1 according to the ranging unit 1 .

當該車輛C1持續根據該泊車輔助模組2所產生的停車路徑駛入該停車位P,使該車輛C1位於一第二定點位置L2時,該第二定點位置L2 係可以根據該第一定點位置L1及該車輛C1的移動距離取得;其中,該車輛C1的移動距離係可以根據該車輛C1輪胎的轉動圈數取得,惟不以此為限。該處理器單元3根據該測距單元1取得該另一車輛C2相對於該車輛C1的數個第二相對座標R2,並將該數個第二相對座標R2與該數個第一相對座標R1相互比對,以評估出該另一車輛C2是朝該停車位P方向前進,或朝遠離該停車位P方向後退。 When the vehicle C1 continues to drive into the parking space P according to the parking path generated by the parking assistance module 2, so that the vehicle C1 is located at a second fixed point position L2, the second fixed point position L2 It can be obtained according to the first fixed point position L1 and the moving distance of the vehicle C1; wherein, the moving distance of the vehicle C1 can be obtained according to the rotation number of the tires of the vehicle C1, but not limited thereto. The processor unit 3 obtains a plurality of second relative coordinates R2 of the other vehicle C2 relative to the vehicle C1 according to the ranging unit 1, and compares the plurality of second relative coordinates R2 with the plurality of first relative coordinates R1 By comparing with each other, it is estimated that the other vehicle C2 is moving in the direction of the parking space P, or retreating in the direction away from the parking space P.

具體而言,該處理器單元3係可以在該車輛C1泊入該停車位P的過程中,根據該數個第二相對座標R2更新該停車位的空間資訊,並判斷更新後的空間資訊是否有足夠的空間供停放該車輛,若判斷結果為是,則可以進一步確認該車輛C1是否可沿著原本的停車路徑駛入該停車位P,若確認結果為是,則該車載電腦控制該車輛C1沿著該停車路徑繼續移動;若確認結果為否,則該處理器單元3產生並發送一駛離訊號至該車載電腦,使該車載電腦控制該車輛C1移出該停車位P,並控制該泊車輔助模組2根據更新後的空間資訊運算,以重新規劃產生一二次停車路徑,並控制該車載電腦操控該車輛C1根據該二次停車路徑駛入該停車位中;若判斷結果為否,則該車載電腦直接控制該車輛C1駛離該停車位。 Specifically, the processor unit 3 can update the spatial information of the parking space according to the plurality of second relative coordinates R2 during the process of parking the vehicle C1 into the parking space P, and determine whether the updated spatial information is not There is enough space for parking the vehicle. If the determination result is yes, it can be further confirmed whether the vehicle C1 can drive into the parking space P along the original parking path. If the confirmation result is yes, the on-board computer controls the vehicle. C1 continues to move along the parking path; if the confirmation result is no, the processor unit 3 generates and sends a departure signal to the on-board computer, so that the on-board computer controls the vehicle C1 to move out of the parking space P, and controls the The parking assistance module 2 calculates according to the updated spatial information to re-plan and generate a secondary parking path, and controls the on-board computer to control the vehicle C1 to drive into the parking space according to the secondary parking path; if the judgment result is No, the on-board computer directly controls the vehicle C1 to leave the parking space.

另一方面,該處理器單元3係可以將該數個第一相對座標R1依序相連,以形成一第一車頭虛擬線V1,以及將該數個第二相對座標R2依序相連,以形成一第二車頭虛擬線V2;該處理器單元3係可以對該第一車頭虛擬線V1與該第二車頭虛擬線V2進行分析,若該第一車頭虛擬線V1較接近該停車位P的方向,即表示該另一車輛C2正朝遠離該停車位P方向後退;若該第二車頭虛擬線V2較接近該停車位P的方向,即表示該另一車輛C2正朝該停車位P方向前進;若該第一車頭虛擬線V1與該第二車頭虛擬線V2重疊,即表示該另一車輛C2正處於靜止不動的狀態。 On the other hand, the processor unit 3 can connect the plurality of first relative coordinates R1 in sequence to form a first virtual line V1, and connect the plurality of second relative coordinates R2 in sequence to form a first virtual line V1 A second front virtual line V2; the processor unit 3 can analyze the first front virtual line V1 and the second front virtual line V2, if the first front virtual line V1 is closer to the direction of the parking space P , which means that the other vehicle C2 is moving backward in the direction away from the parking space P; if the second virtual line V2 is closer to the direction of the parking space P, it means that the other vehicle C2 is moving in the direction of the parking space P ; If the first front virtual line V1 and the second front virtual line V2 overlap, it means that the other vehicle C2 is in a stationary state.

該處理器單元3係可以根據該第一車頭虛擬線V1及該第二車頭虛擬線V2更新該停車位P的空間資訊,並判斷更新後的空間資訊是否有足夠的空間供停放該車輛C1,若判斷結果為是,則可以進一步確認該車輛C1是否可沿著原本的停車路徑駛入該停車位P,若確認結果為是,則該車載電腦控制該車輛C1沿著原本的停車路徑繼續移動;若確認結果為否,則該處理器單元3產生並發送一駛離訊號至該車載電腦,使該車載電腦控制該車輛C1移出該停車位P,並控制該泊車輔助模組2根據更新後的空間資訊運算,以重新規劃產生一二次停車路徑。該處理器單元3控制該車載電腦操控該車輛C1根據該二次停車路徑駛入該停車位P中;若判斷結果為否,則該車載電腦直接控制該車輛C1駛離該停車位。 The processor unit 3 can update the spatial information of the parking space P according to the first virtual line V1 and the second virtual line V2, and determine whether the updated spatial information has enough space for parking the vehicle C1, If the determination result is yes, it can be further confirmed whether the vehicle C1 can enter the parking space P along the original parking path; if the determination result is yes, the on-board computer controls the vehicle C1 to continue to move along the original parking path ; If the confirmation result is no, the processor unit 3 generates and sends a departure signal to the on-board computer, so that the on-board computer controls the vehicle C1 to move out of the parking space P, and controls the parking assistance module 2 according to the update The subsequent spatial information operation is used to re-plan to generate the primary and secondary parking paths. The processor unit 3 controls the in-vehicle computer to control the vehicle C1 to drive into the parking space P according to the secondary parking path; if the judgment result is no, the in-vehicle computer directly controls the vehicle C1 to leave the parking space.

另一方面,當該車輛C1準備根據該停車路徑駛入該停車位P時,該處理器單元3係可以透過該測距單元1一併偵測該停車位P內是否有障礙物B存在,並於偵測到該障礙物B時開始計時,以產生一等待時間;該處理器單元3計算該等待時間是否超過一時間門檻,若計算結果為是,則該處理器單元3係可以發送一駛離訊號至該車載電腦,使該車載電腦控制該車輛C1駛離當下位置;若計算結果為否,則該車載電腦控制該車輛C1沿著該停車路徑繼續移動。 On the other hand, when the vehicle C1 is about to enter the parking space P according to the parking path, the processor unit 3 can also detect whether there is an obstacle B in the parking space P through the ranging unit 1 , And start timing when the obstacle B is detected to generate a waiting time; the processor unit 3 calculates whether the waiting time exceeds a time threshold, if the calculation result is yes, then the processor unit 3 can send a The departure signal is sent to the on-board computer, so that the on-board computer controls the vehicle C1 to drive away from the current position; if the calculation result is no, the on-board computer controls the vehicle C1 to continue moving along the parking path.

請參照第4~5圖所示,較佳地,當該等待時間未超過該時間門檻時,該處理器單元3係可以透過該測距單元1偵測取得該障礙物B的尺寸及位置,並估算該障礙物B的尺寸是否符合一限制條件,若估算結果為是,則該處理器單元3控制該泊車輔助模組2根據該空間資訊及該障礙物B的尺寸及位置,以重新規劃產生一二次停車路徑;該處理器單元3控制該車載電腦操控該車輛C1根據該二次停車路徑駛入該停車位;若估算結果為否,則該處理器單元3係可以發送一駛離訊號至該車載電腦,使該車載電腦控制該車 輛C1駛離當下位置。在本實施例中,該限制條件係為該障礙物B相對於該停車格之寬度尺寸的徑向長度,必須小於該車體寬度之1/3,且該障礙物B的位置係位於該停車位P遠離該車輛C1的一側。其中,該時間門檻的時間設定係可以依使用需求予以調整,不以此作為本發明之限制。 Referring to Figures 4 to 5, preferably, when the waiting time does not exceed the time threshold, the processor unit 3 can detect and obtain the size and position of the obstacle B through the ranging unit 1, And it is estimated whether the size of the obstacle B meets a restriction condition. If the estimated result is yes, the processor unit 3 controls the parking assistance module 2 to re-configure the parking aid module 2 according to the spatial information and the size and position of the obstacle B. Planning to generate a secondary parking path; the processor unit 3 controls the on-board computer to control the vehicle C1 to drive into the parking space according to the secondary parking path; if the estimation result is no, the processor unit 3 can send a driving Leave the signal to the on-board computer, so that the on-board computer can control the car Vehicle C1 drives away from its current position. In this embodiment, the restriction condition is that the radial length of the obstacle B relative to the width dimension of the parking compartment must be less than 1/3 of the width of the vehicle body, and the position of the obstacle B is located in the parking space Bit P is away from the side of the vehicle C1. Wherein, the time setting of the time threshold can be adjusted according to usage requirements, which is not a limitation of the present invention.

另外說明的是,當該處理器單元3控制該泊車輔助模組2重新規劃產生該二次停車路徑時,該處理器單元3係可以預估該車輛C1根據該二次停車路徑駛入該停車位P所需花費的時間,以產生一停車時間。該處理器單元3係可以控制該泊車輔助模組2發出一通知訊號,以告知該車輛C1的駕駛者,該車輛C1停駛入該停車位P的預估時間為該停車時間,如此,係具有供該駕駛者評估是否要直接駛離該當下位置,或花費該停車時間等待該車輛C1駛入該停車位中的作用。 In addition, when the processor unit 3 controls the parking assistance module 2 to re-plan to generate the secondary parking path, the processor unit 3 can estimate that the vehicle C1 enters the secondary parking path according to the secondary parking path. The time it takes for a parking space P to generate a parking time. The processor unit 3 can control the parking assistance module 2 to issue a notification signal to inform the driver of the vehicle C1 that the estimated time for the vehicle C1 to stop and enter the parking space P is the parking time, so, The system has the function for the driver to evaluate whether to drive directly away from the current position, or to spend the parking time waiting for the vehicle C1 to drive into the parking space.

綜上所述,本發明的停車輔助系統,係能夠透過該泊車輔助模組對一停車路徑進行追蹤,以產生數個迴轉曲率,該處理器單元接收到一停車訊號時,發送一轉向訊號至車輛的車載電腦,使該車載電腦控制該車輛之方向盤旋轉,使該方向盤之旋轉幅度依序符合該數個迴轉曲率,以控制該車輛自動駛入該停車格中,再且,本發明的測距單元、泊車輔助模組及處理器單元皆可以為該車輛本身即有的裝置,不需額外配置加裝。如此,本發明的停車輔助系統,係具有提升停車便利性及降低車輛成本的功效。 To sum up, the parking assistance system of the present invention can track a parking path through the parking assistance module to generate several turning curvatures, and the processor unit sends a turn signal when receiving a parking signal to the on-board computer of the vehicle, so that the on-board computer controls the rotation of the steering wheel of the vehicle, so that the rotation amplitude of the steering wheel sequentially conforms to the several curvatures of rotation, so as to control the vehicle to automatically drive into the parking compartment. The ranging unit, the parking assist module and the processor unit can all be devices that are already present in the vehicle, and do not require additional configuration and installation. In this way, the parking assistance system of the present invention has the functions of improving the convenience of parking and reducing the cost of the vehicle.

雖然本發明已利用上述較佳實施例揭示,然其並非用以限定本發明,任何熟習此技藝者在不脫離本發明之精神和範圍之內,相對上述實施例進行各種更動與修改仍屬本發明所保護之技術範疇,因此本發明之保護範圍當視後附之申請專利範圍所界定者為準。 Although the present invention has been disclosed by the above-mentioned preferred embodiments, it is not intended to limit the present invention. Any person skilled in the art can make various changes and modifications relative to the above-mentioned embodiments without departing from the spirit and scope of the present invention. Therefore, the scope of protection of the present invention should be determined by the scope of the patent application attached hereto.

1:測距單元 1: Ranging unit

2:泊車輔助模組 2: Parking assistance module

3:處理器單元 3: Processor unit

Claims (6)

一種停車輔助系統,包含:一測距單元,供裝設於一車輛,該測距單元用以朝一停車位的方向偵測,以取得該停車位的一空間資訊;一泊車輔助模組,供裝設於該車輛,該泊車輔助模組用以透過一軌跡追蹤演算法對一停車路徑追蹤,以依序產生數個迴轉曲率,該停車路徑係為供該車輛駛入該停車位的導引路徑;及一處理器單元,供裝設於該車輛且耦接該測距單元及該泊車輔助模組,該處理器單元接收到一停車訊號時,控制該測距單元運作,並將取得的空間資訊與該車輛的一車身數據進行判斷,以判斷該停車位是否具有足夠的空間供停放該車輛,若判斷結果為是,該處理器單元控制該泊車輔助模組運作,以取得該數個迴轉曲率,並將各該迴轉曲率轉換成該車輛的一轉向角度,該處理器單元產生並發送包含該數個轉向角度的一轉向訊號至該車輛的一車載電腦,使該車載電腦控制該車輛的方向盤旋轉,並使該方向盤的旋轉幅度依序符合該數個轉向角度,以將該車輛駛入該停車位中;其中,該處理器單元接收到該停車訊號,並且該車輛正處於駛入該停車位的過程時,該車輛位於一第一定點位置,若有另一車輛停放於該停車位後方,則該處理器單元根據該測距單元取得該另一車輛相對於該車輛的數個第一相對座標,當該車輛持續根據該停車路徑駛入該停車位,使該車輛位於一第二定點位置時,該第二定點位置係根據該第一定點位置及該車輛的移動距離取得,該處理器單元根據該測距單元取得該另一車輛相對於該車輛的數個第二相對座標,並將該數個第二相對座標與該數個第一相對座標相互比對,以評估出該另一車輛是朝該停車位方向前進,或朝遠離該停車位方向後退,該處理器單元根據該數個第二相對座標更新該停車位的空間資訊,並判斷更新後 的空間資訊是否有足夠的空間供停放該車輛,若判斷結果為是,則進一步確認該車輛是否可沿著原本的停車路徑駛入該停車位,若確認結果為否,則該處理器單元產生並發送一駛離訊號至該車載電腦,使該車載電腦控制該車輛移出該停車位,並控制該泊車輔助模組根據更新後的空間資訊運算,以重新規劃產生一二次停車路徑,並控制該車載電腦操控該車輛根據該二次停車路徑駛入該停車位中。 A parking assistance system, comprising: a ranging unit for installation in a vehicle, the ranging unit is used for detecting the direction of a parking space to obtain a spatial information of the parking space; a parking assistance module for Installed on the vehicle, the parking assistance module is used for tracking a parking path through a trajectory tracking algorithm to sequentially generate a plurality of turning curvatures, and the parking path is a guide for the vehicle to enter the parking space. a guide path; and a processor unit for being installed in the vehicle and coupled to the ranging unit and the parking assist module, the processor unit controls the operation of the ranging unit when receiving a parking signal, and sends The obtained spatial information and a body data of the vehicle are determined to determine whether the parking space has enough space for parking the vehicle. If the determination result is yes, the processor unit controls the operation of the parking assistance module to obtain The plurality of gyration curvatures are converted into a steering angle of the vehicle, and the processor unit generates and sends a turn signal including the steering angles to an on-board computer of the vehicle, so that the on-board computer Control the rotation of the steering wheel of the vehicle, and make the rotation amplitude of the steering wheel conform to the steering angles in sequence, so as to drive the vehicle into the parking space; wherein, the processor unit receives the parking signal, and the vehicle is During the process of entering the parking space, the vehicle is located at a first fixed point position. If another vehicle is parked behind the parking space, the processor unit obtains the relative position of the other vehicle relative to the parking space according to the ranging unit. Several first relative coordinates of the vehicle, when the vehicle continues to drive into the parking space according to the parking path, so that the vehicle is located at a second fixed point position, the second fixed point position is based on the first fixed point position and the vehicle The processor unit obtains a plurality of second relative coordinates of the other vehicle relative to the vehicle according to the distance measuring unit, and compares the plurality of second relative coordinates with the plurality of first relative coordinates with each other Yes, to evaluate whether the other vehicle is moving toward the parking space or moving backwards away from the parking space, the processor unit updates the spatial information of the parking space according to the plurality of second relative coordinates, and judges that after the update whether there is enough space for parking the vehicle, if the determination result is yes, further confirm whether the vehicle can drive into the parking space along the original parking path; And send a departure signal to the on-board computer, so that the on-board computer controls the vehicle to move out of the parking space, and controls the parking assistance module to calculate according to the updated spatial information to re-plan and generate a secondary parking path, and The on-board computer is controlled to control the vehicle to drive into the parking space according to the secondary parking path. 如請求項1之停車輔助系統,其中,該處理器單元將該數個第一相對座標依序相連,以形成一第一車頭虛擬線,以及將該數個第二相對座標依序相連,以形成一第二車頭虛擬線,該處理器單元對該第一車頭虛擬線與該第二車頭虛擬線進行分析,若該第一車頭虛擬線較接近該停車位的方向,即表示該另一車輛正朝遠離該停車位方向後退,若該第二車頭虛擬線較接近該停車位的方向,即表示該另一車輛正朝該停車位方向前進。 The parking assistance system of claim 1, wherein the processor unit connects the plurality of first relative coordinates in sequence to form a first virtual line of the front of the vehicle, and connects the plurality of second relative coordinates in sequence, so as to A second front virtual line is formed, the processor unit analyzes the first front virtual line and the second front virtual line, if the first front virtual line is closer to the direction of the parking space, it means the other vehicle Reversing in the direction away from the parking space, if the virtual line of the second front of the vehicle is closer to the direction of the parking space, it means that the other vehicle is moving in the direction of the parking space. 一種停車輔助系統,包含:一測距單元,供裝設於一車輛,該測距單元用以朝一停車位的方向偵測,以取得該停車位的一空間資訊;一泊車輔助模組,供裝設於該車輛,該泊車輔助模組用以透過一軌跡追蹤演算法對一停車路徑追蹤,以依序產生數個迴轉曲率,該停車路徑係為供該車輛駛入該停車位的導引路徑;及一處理器單元,供裝設於該車輛且耦接該測距單元及該泊車輔助模組,該處理器單元接收到一停車訊號時,控制該測距單元運作,並將取得的空間資訊與該車輛的一車身數據進行判斷,以判斷該停車位是否具有足夠的空間供停放該車輛,若判斷結果為是,該處理器單元控制該泊車輔助模組運作,以取得該數個迴轉曲率,並將各該迴轉曲率轉換成該車輛的一轉向角度,該處理器單元產生並發送包含該數個轉向角度的一轉向訊號至該車輛的一車載電 腦,使該車載電腦控制該車輛的方向盤旋轉,並使該方向盤的旋轉幅度依序符合該數個轉向角度,以將該車輛駛入該停車位中;其中,當該車輛準備根據該停車路徑駛入該停車位時,該處理器單元透過該測距單元偵測該停車位內是否有障礙物存在,並於偵測到該障礙物時開始計時,以產生一等待時間,該處理器單元計算該等待時間是否超過一時間門檻,若計算結果為是,則發送一駛離訊號至該車載電腦,使該車載電腦控制該車輛駛離當下位置。 A parking assistance system, comprising: a ranging unit for installation in a vehicle, the ranging unit is used for detecting the direction of a parking space to obtain a spatial information of the parking space; a parking assistance module for Installed on the vehicle, the parking assistance module is used for tracking a parking path through a trajectory tracking algorithm to sequentially generate a plurality of turning curvatures, and the parking path is a guide for the vehicle to enter the parking space. a guide path; and a processor unit for being installed in the vehicle and coupled to the ranging unit and the parking assist module, the processor unit controls the operation of the ranging unit when receiving a parking signal, and sends The obtained spatial information and a body data of the vehicle are determined to determine whether the parking space has enough space for parking the vehicle. If the determination result is yes, the processor unit controls the operation of the parking assistance module to obtain The plurality of gyration curvatures are converted into a steering angle of the vehicle, and the processor unit generates and sends a turn signal including the steering angles to an on-board electric vehicle of the vehicle brain, make the on-board computer control the rotation of the steering wheel of the vehicle, and make the rotation amplitude of the steering wheel conform to the several steering angles in sequence, so as to drive the vehicle into the parking space; wherein, when the vehicle prepares according to the parking path When driving into the parking space, the processor unit detects whether there is an obstacle in the parking space through the ranging unit, and starts timing when the obstacle is detected to generate a waiting time, the processor unit Calculate whether the waiting time exceeds a time threshold, and if the calculation result is yes, send a departure signal to the on-board computer, so that the on-board computer controls the vehicle to drive away from the current position. 如請求項3之停車輔助系統,其中,當該等待時間未超過該時間門檻時,該處理器單元透過該測距單元偵測取得該障礙物的尺寸及位置,並估算該障礙物的尺寸是否符合一限制條件,若估算結果為是,則該處理器單元控制該泊車輔助模組根據該空間資訊及該障礙物的尺寸及位置,以重新規劃產生一二次停車路徑,該處理器單元控制該車載電腦操控該車輛根據該二次停車路徑駛入該停車位。 The parking assist system of claim 3, wherein when the waiting time does not exceed the time threshold, the processor unit detects and obtains the size and position of the obstacle through the ranging unit, and estimates whether the size of the obstacle is not A constraint condition is met. If the estimation result is yes, the processor unit controls the parking assistance module to re-plan and generate a secondary parking path according to the spatial information and the size and position of the obstacle. The processor unit The on-board computer is controlled to control the vehicle to drive into the parking space according to the secondary parking path. 如請求項4之停車輔助系統,其中,該限制條件係為該障礙物相對於該停車格之寬度尺寸的徑向長度,必須小於該車體寬度之1/3,且該障礙物的位置係位於該停車位遠離該車輛的一側。 The parking assist system of claim 4, wherein the restriction condition is that the radial length of the obstacle relative to the width dimension of the parking compartment must be less than 1/3 of the width of the vehicle body, and the position of the obstacle is On the side of the parking space away from the vehicle. 如請求項1或4之停車輔助系統,其中,當該處理器單元控制該泊車輔助模組重新規劃產生該二次停車路徑時,該處理器單元預估該車輛根據該二次停車路徑駛入該停車位所需花費的時間,以產生一停車時間,該處理器單元控制該泊車輔助模組發出一通知訊號,以告知該車輛的駕駛者,該車輛停駛入該停車位的預估時間為該停車時間。 The parking assistance system of claim 1 or 4, wherein when the processor unit controls the parking assistance module to re-plan to generate the secondary parking path, the processor unit estimates that the vehicle will drive according to the secondary parking path The time it takes to enter the parking space is used to generate a parking time, and the processor unit controls the parking assistance module to issue a notification signal to inform the driver of the vehicle that the vehicle will stop entering the parking space. The estimated time is the parking time.
TW110119262A 2021-05-27 2021-05-27 Parking aid system TWI769833B (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
TW110119262A TWI769833B (en) 2021-05-27 2021-05-27 Parking aid system
CN202110736685.6A CN115402296A (en) 2021-05-27 2021-06-30 Parking assist system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW110119262A TWI769833B (en) 2021-05-27 2021-05-27 Parking aid system

Publications (2)

Publication Number Publication Date
TWI769833B true TWI769833B (en) 2022-07-01
TW202246092A TW202246092A (en) 2022-12-01

Family

ID=83439589

Family Applications (1)

Application Number Title Priority Date Filing Date
TW110119262A TWI769833B (en) 2021-05-27 2021-05-27 Parking aid system

Country Status (2)

Country Link
CN (1) CN115402296A (en)
TW (1) TWI769833B (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW201111206A (en) * 2009-09-29 2011-04-01 Automotive Res & Testing Ct Multiple-turn automatic parking device
CN104228829A (en) * 2013-06-11 2014-12-24 株式会社万都 parking control method, device and system
US20190329761A1 (en) * 2015-08-12 2019-10-31 Hyundai Motor Company Automatic parking system and automatic parking method

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW201111206A (en) * 2009-09-29 2011-04-01 Automotive Res & Testing Ct Multiple-turn automatic parking device
CN104228829A (en) * 2013-06-11 2014-12-24 株式会社万都 parking control method, device and system
US20190329761A1 (en) * 2015-08-12 2019-10-31 Hyundai Motor Company Automatic parking system and automatic parking method

Also Published As

Publication number Publication date
CN115402296A (en) 2022-11-29
TW202246092A (en) 2022-12-01

Similar Documents

Publication Publication Date Title
US11338798B2 (en) Full-automatic parking method and system
KR101915166B1 (en) Automatically parking system and automatically parking method
KR102060070B1 (en) Device for automatically parking vehicle and method for controlling the same
US8825262B2 (en) System and method of deriving parking trajectory for vehicle
JP6361567B2 (en) Automated driving vehicle system
US10532737B2 (en) Cooperative park assist
CN108928343A (en) A kind of panorama fusion automated parking system and method
WO2022007655A1 (en) Automatic lane changing method and apparatus, and device and storage medium
Jeong et al. Low cost design of parallel parking assist system based on an ultrasonic sensor
WO2018098998A1 (en) Automatic control system for driverless bus
CN108068800B (en) Automatic parking control system, probe module, vehicle and automatic parking control method
US10370031B2 (en) Assistant system and assistant method for backward driving of vehicle
WO2007013489A1 (en) Parking assistance device
US10421394B2 (en) Driving assistance device, and storage medium
CN112046501A (en) Automatic driving device and method
JP2014054912A (en) Parking support system
JP2022502642A (en) How to evaluate the effect of objects around the means of transportation on the driving operation of the means of transportation
JP5983276B2 (en) Parking assistance device
EP4046883B1 (en) Automated valet parking system, control method of automated valet parking system, and autonomous driving vehicle
US11364952B2 (en) System for recognizing trailer of vehicle and method thereof
CN109144071A (en) AGV traffic control method in a kind of narrow lane
CN114132305A (en) Method and system for planning vertical and inclined parking paths, storage medium and vehicle
KR101747820B1 (en) Method for parking right angle and apparatus
TWI769833B (en) Parking aid system
TWI747651B (en) Autonomous driving assistant system