TWI675214B - Signal-direction discriminating device and signal postioning and tracking system - Google Patents
Signal-direction discriminating device and signal postioning and tracking system Download PDFInfo
- Publication number
- TWI675214B TWI675214B TW107108058A TW107108058A TWI675214B TW I675214 B TWI675214 B TW I675214B TW 107108058 A TW107108058 A TW 107108058A TW 107108058 A TW107108058 A TW 107108058A TW I675214 B TWI675214 B TW I675214B
- Authority
- TW
- Taiwan
- Prior art keywords
- signal
- angle
- intensity value
- dimensional
- intensity
- Prior art date
Links
- 238000001514 detection method Methods 0.000 claims abstract description 61
- 238000004891 communication Methods 0.000 description 23
- 238000010586 diagram Methods 0.000 description 11
- 238000009434 installation Methods 0.000 description 6
- 230000015572 biosynthetic process Effects 0.000 description 4
- 230000002265 prevention Effects 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 3
- 238000011161 development Methods 0.000 description 3
- 238000000034 method Methods 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 239000013598 vector Substances 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- ZRHANBBTXQZFSP-UHFFFAOYSA-M potassium;4-amino-3,5,6-trichloropyridine-2-carboxylate Chemical compound [K+].NC1=C(Cl)C(Cl)=NC(C([O-])=O)=C1Cl ZRHANBBTXQZFSP-UHFFFAOYSA-M 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Landscapes
- Radar Systems Or Details Thereof (AREA)
- Traffic Control Systems (AREA)
Abstract
一種訊號方向判別裝置及訊號追蹤定位系統,藉由沿特定方向排列之多個訊號偵測元件同時偵測某一訊號源所發出之訊號,利用分別所測得之訊號強度,經由該等訊號強度彼此之關係計算出訊號源之方向及距離。 A signal direction discrimination device and a signal tracking and positioning system, by using a plurality of signal detection elements arranged in a specific direction to simultaneously detect a signal sent by a signal source, and using the measured signal strengths respectively, through these signal strengths The relationship between them calculates the direction and distance of the signal source.
Description
本發明係關於一種訊號方向判別裝置及訊號追蹤定位系統。 The invention relates to a signal direction discrimination device and a signal tracking and positioning system.
近數十年來,交通運輸業蓬勃發展,為提昇運輸效率及人員安全,智慧型運輸系統(Intelligent Transportation System,ITS)之概念已逐漸成型。以陸路之車輛運輸而言,除各型車輛之各種性能及其人員安全防護能力不斷提昇外,為達到智慧型運輸之目的並使資訊之傳遞能及於車內乘員,車輛與通訊系統結合已成為必然趨勢。依照發展順序及技術成熟度,車輛之通訊可概分為兩大範疇。首先為車輛與路外固定系統之通訊,又稱車用資通訊(telematics),其中高速公路電子收費(electronic toll collection,ETC)即屬此類,係藉由車輛與路外系統通訊傳遞資料以遂行特定目的(例如收費)。此一領域經多年之發展已逐漸擴展應用層面,除前述之電子收費外,尚包括交通資訊傳遞、交通道路導引、急難通報等。近年更構思將之擴及其它民生商業應用層面,例如停車位乃至餐廳與電影院之訂位等。 In recent decades, the transportation industry has developed vigorously. In order to improve transportation efficiency and personnel safety, the concept of Intelligent Transportation System (ITS) has gradually taken shape. In terms of land vehicle transportation, in addition to the various performances of various types of vehicles and the continuous improvement of their personnel safety protection capabilities, in order to achieve the purpose of intelligent transportation and enable the transmission of information to the passengers in the vehicle, the combination of vehicles and communication systems Become an inevitable trend. According to the development order and technological maturity, vehicle communication can be roughly divided into two categories. The first is the communication between the vehicle and the off-road fixed system, also known as telematics. The electronic toll collection (ETC) of the highway falls into this category. Perform a specific purpose (such as charging a fee). After years of development, this area has gradually expanded the application level. In addition to the aforementioned electronic toll collection, it also includes traffic information transmission, traffic road guidance, and emergency notification. In recent years, it has also been conceived to expand it to other aspects of commercial applications of people's livelihood, such as parking spaces and even reservations for restaurants and cinemas.
除前述之車用資通訊,亦即車輛與路外固定系統之通訊外,另一範疇則為車輛與車輛間彼此之通訊(inter-vehicle communication)。此一 領域或因交通發展史上其迫切性不如前者,故起步較晚,目前較不成熟,但近年來亦逐漸獲得重視。目前亟待技術突破者主要為因應車輛自動駕駛(automated driving)所需之短距通訊(short-range communication),應用範圍包括車輛自動編隊行駛(vehicle platooning,cooperative driving)之控制、車輛追撞之防止(pileup-crash prevention)、以及其它用途所需之資料傳遞等。 In addition to the aforementioned vehicle-to-vehicle communication, that is, the communication between the vehicle and the off-road fixed system, the other category is the inter-vehicle communication between the vehicle and the vehicle. This one The field may not be as urgent as the former in the history of transportation development, so it started late and is currently less mature, but it has gradually gained attention in recent years. At present, the technical breakthrough is in urgent need of short-range communication required for automatic driving of vehicles. The application scope includes the control of vehicle platooning, cooperative driving, and the prevention of vehicle collision. (pileup-crash prevention), and other necessary data transmission.
就自動編隊行駛而言,以高速公路為例,內側車道各車同時以道路限定之最高速等速編隊行駛,除非加入編隊或離開編隊外不變換車道,外側車道則開放供慢速車輛使用。如此則所有車輛之車道變換次數可大幅降低,亦間接提高行車安全,同時全部均以最高速行駛,迅速抵達終點。此類智慧型之駕駛需仰賴車輛彼此間之通訊,藉以傳遞車輛座標(來自各車所裝設之全球衞星定位系統,global positioning system,GPS)、速度(來自各感應器,sensor)、相對位置(來自車上雷達,可能為微波雷達(radar)或利用雷射之紅外線雷達(ladar))、甚至意圖轉向變換車道等之訊息予鄰車,以控制車輛之行駛。 In terms of automatic formation driving, taking the expressway as an example, the vehicles in the inner lane are driving at the same speed as the maximum speed defined by the road at the same time. Unless you join the formation or leave the formation without changing lanes, the outer lane is open for slow vehicles. In this way, the number of lane changes of all vehicles can be greatly reduced, which also indirectly improves driving safety, and all of them are driving at the highest speed and reach the end quickly. This type of intelligent driving relies on the communication between vehicles to transfer vehicle coordinates (from the global positioning system (GPS) installed in each vehicle), speed (from each sensor), and relative position (From the on-board radar, it may be a microwave radar (radar) or an infrared radar (ladar) using lasers), and even information intended to change lanes to the adjacent car to control the vehicle's driving.
就車輛追撞防止而言,由於高速公路行車速率甚高,當車輛快速行駛時,其煞車距離甚長,若前方車輛發生緊急事故而煞車時,目前唯一之訊號傳遞方式為煞車尾燈之警示,後方駕駛僅能憑目視獲得警覺採取應變措施。常見之場景為,緊隨而後之第二輛車雖及時煞停並未撞及前車,但接續之第三、第四等車輛卻不及反應造成多車追撞導致重大傷亡。車輛追撞之防止最主要係針對此問題,希望藉由通訊及時將前方煞車之訊息依續迅速傳送至後方車輛,特別是第三輛以後。目前之功能為提醒各駕駛及早應變,而未來則將擴展為自動駕駛,亦即提供前方煞車之資訊予控 制電腦而由自動駕駛軟體程式進行必要之處置。 As far as vehicle collision prevention is concerned, due to the high speed of the highway, when the vehicle is driving fast, the braking distance is very long. If the vehicle in front of the vehicle is in an emergency and brakes, the only signal transmission method at present is the warning of the brake tail lights. Rear driving can only be vigilant to take contingency measures. A common scenario is that although the second vehicle that followed immediately stopped in time and did not hit the front vehicle, the third and fourth vehicles following it failed to respond, causing multiple vehicles to chase and cause serious casualties. The prevention of vehicle chase is mainly aimed at this problem, and hopes that the information of the front brakes will be transmitted to the rear vehicles quickly and successively through communication, especially after the third one. The current function is to remind all drivers to respond early, and in the future, it will be extended to autonomous driving, that is, to provide information on braking in front of the control. Make the computer and perform the necessary processing by the self-driving software program.
有鑑於此,本發明之目的在於提供一種訊號追蹤定位系統及訊號方向判別裝置,藉由多個訊號偵測元件所構成之特殊幾何結構,利用此結構不同部份對同一入射訊號將產生不同接收強度之特性,比較各部位之接收訊號強度,進而獲知訊號方向,並利用幾何關係求出目標座標。若車輛均裝設本發明之訊號追蹤定位系統,即可偵測鄰近車輛之方位與相對座標,有利於達到車輛追撞防止及自動編隊行駛之目的。 In view of this, the object of the present invention is to provide a signal tracking and positioning system and a signal direction discrimination device. With a special geometric structure composed of multiple signal detection elements, different parts of this structure will generate different receptions for the same incident signal. The strength characteristic compares the strength of the received signal at each location to obtain the signal direction, and uses the geometric relationship to obtain the target coordinates. If the vehicles are equipped with the signal tracking and positioning system of the present invention, the positions and relative coordinates of neighboring vehicles can be detected, which is beneficial for the purpose of preventing vehicle collision and automatically driving in formation.
本發明之訊號方向判別裝置用以追蹤一訊號源,該訊號源發出一訊號,於一實施例中,該訊號方向判別裝置包括:一第一訊號偵測元件,相對於一基準方向呈一第一角度,用於偵測該訊號之強度並得到一第一強度值;一第二訊號偵測元件,相對於該基準方向呈一第二角度,用於偵測該訊號之強度並得到一第二強度值;以及一運算單元,接收該第一強度值與該第二強度值,並根據該第一強度值與該第二強度值計算出該訊號源之方位。 The signal direction judging device of the present invention is used to track a signal source, and the signal source sends a signal. In an embodiment, the signal direction judging device includes a first signal detecting element, which is a first signal detecting element relative to a reference direction. An angle is used to detect the intensity of the signal and obtain a first intensity value; a second signal detection element is at a second angle relative to the reference direction to detect the intensity of the signal and obtain a first Two intensity values; and an arithmetic unit that receives the first intensity value and the second intensity value, and calculates the azimuth of the signal source according to the first intensity value and the second intensity value.
在另一實施例中,該第一訊號偵測元件為一單一或數個排列之光偵測二極體;該第二訊號偵測元件為一單一或數個排列之光偵測二極體。 In another embodiment, the first signal detection element is a single or a plurality of arrayed light detection diodes; the second signal detection element is a single or a plurality of arrayed light detection diodes. .
在另一實施例中,該訊號為一紅外線訊號。 In another embodiment, the signal is an infrared signal.
在另一實施例中,該訊號為一可見光訊號。 In another embodiment, the signal is a visible light signal.
在另一實施例中,該第一角度與該第二角度分別朝向前述基準方向之兩側。 In another embodiment, the first angle and the second angle respectively face two sides of the reference direction.
在另一實施例中,該運算單元係根據以下公式計算出該訊號 源之方位:,其中θ表示該訊號之入射方向與該基準方向垂線之夾角,θt表示該第一角度,S1表示該第一強度值,S2表示該第二強度值。 In another embodiment, the operation unit calculates the position of the signal source according to the following formula: Where θ represents the angle between the incident direction of the signal and the vertical line of the reference direction, θt represents the first angle, S1 represents the first intensity value, and S2 represents the second intensity value.
本發明之訊號追蹤定位系統之一實施例包括至少二具上述之訊號方向判別裝置,該等訊號方向判別裝置在一第一方向上相隔一既定距離設置,該第一方向係與前述基準方向平行,並訂定此兩訊號方向判別裝置之位置連線中點為座標系統原點。該訊號追蹤定位系統係根據以下公式計算出該訊號源相對於原點之座標:; ,其中,d表示該既定距離之二分之一,θ1表示該等方向判別裝置其中之一所量測之該訊號源與該基準方向垂線之夾角,θ2表示該等方向判別裝置其中之另一所量測之該訊號源與該基準方向垂線之夾角,x及y表示該訊號源相對於該中點的座標值。 An embodiment of the signal tracking and positioning system of the present invention includes at least two of the above-mentioned signal direction discrimination devices. The signal direction discrimination devices are disposed at a predetermined distance in a first direction, the first direction being parallel to the aforementioned reference direction. , And set the midpoint of the position connection of the two signal direction discrimination devices as the origin of the coordinate system. The signal tracking and positioning system calculates the coordinates of the signal source relative to the origin according to the following formula: ; , Where d represents one-half of the predetermined distance, θ1 represents the angle between the signal source measured by one of the direction discrimination devices and the vertical line of the reference direction, and θ2 represents the other of the direction discrimination devices The measured angle between the signal source and the vertical line in the reference direction, x and y represent the coordinate values of the signal source relative to the midpoint.
本發明之訊號方向判別裝置之另一實施例用以追蹤一訊號源,該訊號源發出一訊號,該訊號方向判別裝置包括四組訊號偵測元件,此四組訊號偵測元件均相對於一基準面呈一傾斜角度,其中第一訊號偵測元件與該基準面上之一基準方向呈一第一角度,用以偵測該訊號並得到一第一強度值;第二訊號偵測元件與此基準方向呈一第二角度,用以偵測該訊號並得到一第二強度值;第三訊號偵測元件與該基準方向呈一第三角度,用以偵測該訊號並得到一第三強度值;另第四訊號偵測元件則與前述基準方向呈一第四角度,用以偵測該訊號並得到一第四強度值;本節所述之方向判別裝置尚包括一運算單元,接收該第一強度值、該第二強度值、 該第三強度值以及該第四強度值,並根據此四強度值計算出該訊號源之方位。 Another embodiment of the signal direction discrimination device of the present invention is used to track a signal source, the signal source sends out a signal, the signal direction discrimination device includes four sets of signal detection elements, and the four sets of signal detection elements are relative to one The reference plane is at an inclined angle, wherein the first signal detection element is at a first angle with a reference direction on the reference plane to detect the signal and obtain a first intensity value; the second signal detection element and The reference direction is at a second angle to detect the signal and obtain a second intensity value; the third signal detection element is at a third angle to the reference direction to detect the signal and obtain a third Intensity value; the fourth signal detection element is at a fourth angle to the aforementioned reference direction to detect the signal and obtain a fourth intensity value; the direction determination device described in this section further includes an arithmetic unit for receiving the First intensity value, the second intensity value, The third intensity value and the fourth intensity value, and the orientation of the signal source is calculated based on the four intensity values.
於另一實施例中,前述之第一角度、第二角度、第三角度、以及第四角度分置於平面四象限。 In another embodiment, the first angle, the second angle, the third angle, and the fourth angle are divided into four quadrants of the plane.
於另一實施例中,前述之第一角度、第二角度、第三角度、以及第四角度可為對稱式。 In another embodiment, the aforementioned first angle, second angle, third angle, and fourth angle may be symmetrical.
於另一實施例中,該運算單元係根據以下公式計算出該訊號 源之方位:; ,其中θ及Φ係依照一般球面座標(spherical coordinates)之定義,θ為俯仰角(polar angle),Φ為方位角(azimuthal angle)。Φ表示該訊號之入射平面(incident plane)與前述基準方向之夾角,θ表示該訊號入射行進方向與該基準平面垂直法線(normal)之夾角,Φt表示對稱式時前述之第一角度,θt表示該四組訊號偵測元件相對於前述基準面之傾斜角度,S1表示該第一強度,S2表示該第二強度,S3表示該第三強度,S4表示該第四強度。 In another embodiment, the operation unit calculates the position of the signal source according to the following formula: ; Where θ and Φ are in accordance with the definition of general spherical coordinates, θ is a polar angle, and Φ is an azimuthal angle. Φ represents the angle between the incident plane of the signal and the aforementioned reference direction, θ represents the angle between the incident direction of the signal and the normal normal to the reference plane, and Φt represents the aforementioned first angle when the equation is symmetrical, θt Represents the inclination angles of the four sets of signal detection elements relative to the aforementioned reference plane, S1 represents the first intensity, S2 represents the second intensity, S3 represents the third intensity, and S4 represents the fourth intensity.
於另一實施例中,該運算單元係根據以下公式計算出該訊號 源之方位:; ,其中θ、Φ、θt、及Φt之定義與前述相同。 In another embodiment, the operation unit calculates the position of the signal source according to the following formula: ; Where the definitions of θ, Φ, θt, and Φt are the same as above.
於另一實施例中,該運算單元係根據以下公式計算出該訊號 源之座標位置(x,y):;,其中h表示該方向判別裝置與該訊號源水平面之垂直高度差,x表示該方向判別裝置 與該訊號源於一第一方向上之距離,y表示該方向判別裝置與該訊號源於一第二方向上之距離,該第一方向與該第二方向係垂直,α表示該方向判別裝置相對於水平方向之俯角。 In another embodiment, the operation unit calculates the coordinate position (x, y) of the signal source according to the following formula: ; , Where h represents the vertical height difference between the direction discrimination device and the signal source horizontal plane, x represents the distance between the direction discrimination device and the signal source in a first direction, and y represents the direction discrimination device and the signal originated from a first direction The distance in two directions, the first direction is perpendicular to the second direction, and α represents the depression angle of the direction determination device with respect to the horizontal direction.
於另一實施例中,包括至少二具上述之訊號方向判別裝置,該等訊號方向判別裝置於一第一方向上相隔一既定距離,該第一方向係與前述基準面平行,其中該訊號追蹤定位系統係根據以下公式計算出該訊號源相對於該等訊號方向判別裝置之位置連線中點之三度空間座標位置(x,y, z):;; z=[(x-d)2+y 2+z 2]1/2 cos θ1;; ;z=[(x-d)2+y 2+z 2]1/2 cos θ1,其中d表示該既定距離之二分之一,θ1及Φ1表示該等方向判別裝置其中之一量測所得之該訊號源之方位,θ2及Φ2表示該等方向判別裝置其中之另一量測所得之該訊號源之方位,x,y及z表示該訊號源相對於該中點之座標值。 In another embodiment, at least two signal direction determining devices are included. The signal direction determining devices are separated by a predetermined distance in a first direction, the first direction is parallel to the aforementioned reference plane, and the signal is tracked. The positioning system calculates the three-dimensional spatial coordinate position (x, y, z) of the midpoint of the position connection of the signal source relative to the direction of the signal according to the following formula: ; ; Z = [( x - d ) 2 + y 2 + z 2 ] 1/2 cos θ 1; ; ; Z = [( x - d ) 2 + y 2 + z 2 ] 1/2 cos θ 1, where d represents one-half of the predetermined distance, and θ1 and Φ1 represent one of these direction discrimination devices. The orientation of the signal source obtained, θ2 and Φ2 represent the orientation of the signal source measured by the other of these direction discrimination devices, and x, y, and z represent the coordinate values of the signal source relative to the midpoint.
為讓本發明之上述和其他目的、特徵及優點更明顯易於瞭解,下文特舉出實施例並配合圖式進行詳細說明。 In order to make the above and other objects, features, and advantages of the present invention more comprehensible, embodiments are described below in detail with reference to the drawings.
10‧‧‧第一訊號偵測元件 10‧‧‧The first signal detection element
20‧‧‧第二訊號偵測元件 20‧‧‧Second signal detection element
30‧‧‧運算單元 30‧‧‧ Computing Unit
10’‧‧‧第一訊號偵測元件 10’‧‧‧first signal detection element
20’‧‧‧第二訊號偵測元件 20’‧‧‧Second signal detection element
30’‧‧‧第三訊號偵測元件 30’‧‧‧ the third signal detection element
40’‧‧‧第四訊號偵測元件 40’‧‧‧Fourth signal detection element
50’‧‧‧運算單元 50’‧‧‧ Computing Unit
100、100’‧‧‧訊號方向判別裝置 100, 100’‧‧‧ signal direction discrimination device
N‧‧‧法線 N‧‧‧normal
S‧‧‧入射訊號 S‧‧‧ incident signal
θ‧‧‧訊號入射之俯仰角(polar angle) θ‧‧‧ Polar angle of signal incidence
θt‧‧‧訊號偵測元件後掠傾斜角 θt‧‧‧Sweep tilt angle of signal detection element
t‧‧‧對稱式平面配置之訊號偵測元件安裝關係角度 t ‧‧‧ Symmetrical plane configuration of signal detection element installation relationship angle
‧‧‧訊號入射之方位角(azimuthal angle) ‧‧‧Azimuthal angle of signal incidence
、、、、、‧‧‧狄卡爾直角座標軸之方向單位向量 , , , , , ‧‧‧Unit direction of Cartesian coordinate axis
ρ^‧‧‧柱面座標(cylindrical coordinates)之徑向單位向量 ρ ^ ‧‧‧ radial unit vector of cylindrical coordinates
RSU‧‧‧車道通訊單元 RSU‧‧‧Lane communication unit
OBU‧‧‧車上通訊單元 OBU‧‧‧ Onboard Communication Unit
α‧‧‧車道通訊單元之安裝俯角 Installation angle of α‧‧‧ lane communication unit
β‧‧‧車上通訊單元之安裝仰角 Installation angle of β‧‧‧ communication unit on board
x、y、z‧‧‧座標值 Coordinates of x, y, z‧‧‧
h‧‧‧車道通訊單元垂直安裝高度 h‧‧‧Vertical installation height of lane communication unit
d‧‧‧兩訊號方向判別裝置間距離之二分之一 d‧‧‧half of the distance between two signal direction discrimination devices
θ1、Φ1、θ2、Φ2‧‧‧訊號源之方位角 θ 1, Φ1, θ 2, Φ2‧‧‧ azimuth angle of the signal source
第1圖為本發明之一維訊號方向判別裝置示意圖。 FIG. 1 is a schematic diagram of a dimensional signal direction discrimination device according to the present invention.
第2圖為本發明之二維訊號方向判別裝置示意圖。 FIG. 2 is a schematic diagram of a two-dimensional signal direction discrimination device of the present invention.
第3圖為訊號入射方向與本發明之訊號方向判別裝置關係示意圖。 FIG. 3 is a schematic diagram showing the relationship between the signal incident direction and the signal direction discrimination device of the present invention.
第4圖為前述訊號偵測元件對稱安裝時之示意圖,完全對稱時Φt為45°,訊號偵測元件延箭頭方向向後傾斜一角度θt。 Figure 4 is a schematic diagram of the aforementioned signal detection element when it is symmetrically mounted. When it is completely symmetrical, Φt is 45 °, and the signal detection element is inclined backward by an angle θt in the direction of the arrow.
第5A、5B圖為前述訊號入射方向(θ,Φ)與本發明之訊號方向判別裝置之座標關係圖。 Figures 5A and 5B are coordinate diagrams of the aforementioned signal incident direction (θ, Φ) and the signal direction discrimination device of the present invention.
第6圖為本發明之訊號方向判別裝置應用於車道系統之車道通訊裝置示意圖。 FIG. 6 is a schematic diagram of a lane communication device in which a signal direction discrimination device of the present invention is applied to a lane system.
第7圖為本發明之訊號追蹤定位系統利用三角定位法計算訊號源座標之示意圖。 FIG. 7 is a schematic diagram of the signal tracking and positioning system of the present invention using the triangle positioning method to calculate the signal source coordinates.
第8圖表示大型車與小型車應用本發明之訊號追蹤定位系統進行座標定位之示意圖。 FIG. 8 is a schematic diagram of coordinate positioning using a signal tracking and positioning system of the present invention for large cars and small cars.
第9圖表示車輛應用本發明之訊號追蹤定位系統進行全方位定位追蹤之示意圖。 FIG. 9 is a schematic diagram of a vehicle applying the signal tracking and positioning system of the present invention for all-directional positioning and tracking.
請參閱第1圖,該圖表示本發明之一維訊號方向判別裝置。本發明之一維訊號方向判別裝置100包括一第一訊號偵測元件10、一第二訊號偵測元件20以及一運算單元30。如第3圖所示,第一訊號偵測元件10相對於水平線向左傾斜一第一角度θt,第二訊號偵測元件20相對於水平線向右傾斜同樣角度θt而呈一第二角度。當一訊號源發出一訊號S與一維訊號方向判別裝置之法線N呈一夾角θ時,第一訊號偵測元件10偵測到該訊號並得到一第一強度S1,第二訊號偵測元件20亦偵測到同樣訊號並得到一第二強度S2。針對第一訊號偵測元件10及第二訊號偵測元件20之法線,訊號S入射第一訊號偵測元件10及第二訊號偵測元件20之方向分別為θ+θt及θ-θt,因此對此同一訊號,第一強度S1與第二強度S2將分別為:S1=S0cos(θ+θt) (1) 及S2=S0cos(θ-θt) (2)此兩式中之常數S0為針對各單一訊號偵測元件,當此訊號垂直入射時,該訊號偵測元件所接收之訊號強度。接著定義訊號差△(difference)及訊號和Σ(sum)如下△≡S2-S1=S0[cos(θ-θt)-cos(θ+θt)] (3) Please refer to FIG. 1, which shows a dimensional signal direction determining device according to the present invention. A dimensional signal direction determining device 100 according to the present invention includes a first signal detection element 10, a second signal detection element 20, and an operation unit 30. As shown in FIG. 3, the first signal detection element 10 is inclined to the left with respect to the horizontal line by a first angle θt, and the second signal detection element 20 is inclined to the right with respect to the horizontal line by the same angle θt to form a second angle. When a signal S from a signal source is at an angle θ with the normal N of the one-dimensional signal direction discrimination device, the first signal detection element 10 detects the signal and obtains a first intensity S 1 and a second signal detection The measuring element 20 also detects the same signal and obtains a second intensity S 2. For the normals of the first signal detection element 10 and the second signal detection element 20, the directions of the signal S incident on the first signal detection element 10 and the second signal detection element 20 are θ + θt and θ - θt , respectively. Therefore, for the same signal, the first intensity S1 and the second intensity S2 will be: S 1 = S 0cos ( θ + θt ) (1) and S 2 = S 0cos ( θ - θt ) (2) The constant S 0 is for each single signal detection element. When this signal is incident perpendicularly, the signal strength received by the signal detection element. Then define the signal difference △ (difference) and the signal and Σ (sum) as follows △ ≡ S 2- S 1 = S 0 [cos ( θ - θt ) -cos ( θ + θt )] (3)
Σ≡S1+S2=S0[cos(θ-θt)+cos(θ+θt)] (4)再將訊號差△除以訊號和Σ得到△/Σ=[cos(θ-θt)-cos(θ+θt)]/[cos(θ-θt)+cos(θ+θt)]=tanθ tanθt (5) 亦即(6)從方程式(6)可得知,於確定第一訊號偵測元件10與第二訊號偵測元件20之傾斜角度θt後,由兩訊號偵測元件所接收之訊號強度差△除以訊號強度和Σ之值(△/Σ)即可獲得一維之紅外線訊號入射角度θ。另外,單片模組之傾斜角θt亦扮演重要之角色,從方程式(5)可瞭解,針對相同之訊號入射方向θ,較大之模組傾斜角θt其△/Σ之值也較大,故可獲得較精準之訊號入射方向判別能力,但其視界(field of view,FOV)較窄。反之,若訊號偵測元件之傾斜角θt較小,則其精準度稍差,但優點為視界較為寬廣。運算單元30接收該第一強度S1以及該第二強度S2,並根據方程式(6)計算出該訊號源之方位θ。 Σ≡ S 1+ S 2 = S 0 [cos ( θ-θt ) + cos ( θ + θt )] (4) Divide the signal difference △ by the signal and Σ to get △ / Σ = [cos ( θ-θt ) -cos ( θ + θt )] / [cos ( θ-θt ) + cos ( θ + θt )] = tan θ tan θt (5) (6) It can be known from equation (6) that after determining the inclination angle θt of the first signal detection element 10 and the second signal detection element 20, the difference in signal strength Δ received by the two signal detection elements is divided by Δ The signal intensity and the value of Σ (△ / Σ) can obtain the one-dimensional infrared signal incident angle θ . In addition, the tilt angle θt of a single-chip module also plays an important role. As can be understood from equation (5), for the same signal incident direction θ , a larger module tilt angle θt has a larger value of Δ / Σ, Therefore, it is possible to obtain a more accurate signal direction discrimination capability, but its field of view (FOV) is narrow. Conversely, if the tilt angle θt of the signal detection element is small, its accuracy is slightly worse, but the advantage is that the field of vision is wider. The computing unit 30 receives the first intensity S1 and the second intensity S2, and calculates the orientation θ of the signal source according to equation (6).
針對車輛與車輛通訊之應用,由於車輛均於路面行駛,於絕 大多數情況下,前述之一維訊號方向判別裝置已可充份掌握接收訊號所來自之方向。針對此議題,本發明除前述之理論物理模式計算分析外,並完成兩組一維訊號方向判別裝置之實體製作及量測驗證,其傾斜後掠角分別為θt=30°及45°,獲得極佳之結果。 For the application of vehicle-to-vehicle communication, since vehicles are driving on the road, in most cases, the aforementioned one of the dimensional signal direction determination devices can fully grasp the direction from which the signal is received. For this issue, the present invention is the addition of Theoretical Physics Model Analysis calculated outside, and a complete two-dimensional signal of the direction determining and measuring entity making the verification device, which are inclined sweep angle θt = 30 ° and 45 °, to obtain Excellent results.
請參閱第2、4、5A、5B圖,此四圖表示本發明中之二維訊號方向判別裝置基本構造及二維方向判別原理。本發明之二維訊號方向判別裝置100’包括一第一訊號偵測元件10’、一第二訊號偵測元件20’、一第三訊號偵測元件30’、一第四訊號偵測元件40’以及一運算單元50’。如第4、5A、5B圖所示,為進行二維(two dimensional)之訊號方向判別,亦即同時偵測一般球面座標(spherical polar coordinates)所定義之俯仰角(polar angle,θ)及方位角(azimuthal angle,),其中一可行且數學處理較簡易之方式,如第4、5A圖所示,採對稱式。亦即相對於訊號方向判別裝置100’之中央對稱軸(z’-軸),將四片相同之第一訊號偵測元件10’、第二訊號偵測元件20’、第三訊號偵測元件30’、第四訊號偵測元件40’於x’-y’平面上分別延 t(第一角度)、π- t(第二角度)、π+ t(第三角度)、及2π- t(第四角度)方向各傾斜一角度θt’(傾斜角度)。第5A、5B圖為訊號入射方向與訊號方向判別裝置關係之示意圖,第5A圖為側視圖,第5B圖為俯視圖。訊號自一訊號源由方位角入射,亦即相對於訊號方向判別裝置100’之座標軸、、,訊號之入射平面為 ρ^-k^'面, ρ^位於x’-y’平面上,其方向與方向間之角度為,而訊號入射方向與訊號方向判別裝置100’之中央對稱軸(z’軸)間之角度則為θ,因此若以一般習用之球面座標表示,訊號入射方向相對於此訊號方向判別裝置可表示為(θ,)。此時第一訊號偵測元件10’、第二訊號偵測元件20’、第三 訊號偵測元件30’、第四訊號偵測元件40’所接收之訊號強度依象限排列依序為第一強度S1、第二強度S2、第三強度S3及第四強度S4,運算單元50’接收第一強度S1、第二強度S2、第三強度S3及第四強度S4並計算出該訊號源之方位。首先定義上下訊號差△E、左右訊號差△A、及訊號和Σ如下:△E≡(S1+S2)-(S3+S4) (7) Please refer to Figures 2, 4, 5A, and 5B. These four figures show the basic structure of the two-dimensional signal direction discrimination device and the two-dimensional direction discrimination principle in the present invention. The two-dimensional signal direction discrimination device 100 'of the present invention includes a first signal detection element 10', a second signal detection element 20 ', a third signal detection element 30', and a fourth signal detection element 40. 'And an arithmetic unit 50'. As shown in Figures 4, 5A, and 5B, two-dimensional signal direction discrimination is performed, that is, simultaneous detection of the pitch angle (polar angle, θ ) and orientation defined by general spherical coordinates Angle (azimuthal angle, ), One of the feasible and simpler methods of mathematical processing, as shown in Figures 4 and 5A, adopt a symmetrical formula. That is, relative to the central symmetry axis (z'-axis) of the signal direction discrimination device 100 ', four identical first signal detection elements 10', second signal detection elements 20 ', and third signal detection elements 30 ', the fourth signal detection element 40' extends respectively on the x'-y 'plane t (first angle), π- t (second angle), π + t (third angle), and 2 π- The t (fourth angle) directions are each inclined by an angle θt '(tilt angle). Figures 5A and 5B are schematic diagrams showing the relationship between the signal incident direction and the signal direction discrimination device. Figure 5A is a side view and Figure 5B is a top view. Signal from a signal source from azimuth Incidence, that is, the coordinate axis of the device 100 'relative to the direction of the signal , , , The incident plane of the signal is the ρ ^ -k ^ ' plane, ρ ^ is located on the x'-y' plane, and its direction is The angle between directions is And the central axis of symmetry of the signal incident direction and the signal direction discrimination device 100 ' The angle between (z 'axis) is θ . Therefore, if it is expressed in the conventional spherical coordinates, the signal incident direction can be expressed as ( θ , ). At this time, the intensity of the signals received by the first signal detection element 10 ', the second signal detection element 20', the third signal detection element 30 ', and the fourth signal detection element 40' is ranked first in the quadrant order. The intensity S1 , the second intensity S2 , the third intensity S3, and the fourth intensity S4 . The arithmetic unit 50 'receives the first intensity S1 , the second intensity S2 , the third intensity S3, and the fourth intensity S4. And calculate the bearing of the signal source. First define the upper and lower signal difference △ E, the left and right signal difference △ A, and the signal and Σ as follows: △ E≡ ( S 1+ S 2)-( S 3+ S 4) (7)
△A≡(S1+S4)-(S2+S3) (8) △ A≡ ( S 1+ S 4)-( S 2+ S 3) (8)
Σ≡S1+S2+S3+S4 (9)經過簡易之處理後可得到
若將本發明之二維訊號方向判別裝置架設於道路上方,由於車輛行駛於平面道路,當獲得訊號方向後,即可依簡單之幾何關係計算目標物座標,因此本發明之二維紅外線訊號方向判別裝置可應用於車輛與路外通訊系統,提供車道系統進行車輛座標定位,掌握車輛行進軌跡。 If the two-dimensional signal direction discriminating device of the present invention is set above a road, since the vehicle is traveling on a flat road, after obtaining the signal direction, the coordinates of the target object can be calculated according to a simple geometric relationship, so the two-dimensional infrared signal direction of the present invention The discriminating device can be applied to a vehicle and off-road communication system, providing a lane system for vehicle coordinate positioning, and grasping a vehicle's traveling trajectory.
請參閱第6圖,若路外系統(車道系統)之車道通訊單元RSU(road-side unit,RSU)安裝本發明之二維訊號方向判別裝置,其安裝俯角為α;車上通訊單元OBU(on-board unit,OBU),於此扮演紅外線訊號源之角色,其安裝仰角為β,另車輛與車道通訊單元垂直面間,亦即車道中
線,存在一橫向距離x。若訂定車道通訊單元RSU正下方為原點,車輛朝-y軸方向前進,則針對此地面座標,車輛(紅外線訊號源)及紅外線訊號方向判別裝置之位置可分別表示為(x,y,0)及(0,0,h)。此時安裝於車道上方,俯角為α之本發明訊號方向判別裝置其x'軸、y'軸、及z'軸之單位向量可利用前述地面座標表示為
j^'=-i^ (14) j ^ ' = -i ^ (14)
k^'=cosα j^-sinα k^ (15)前三式之i^、j^、及k^分別為地面座標x軸、y軸、及z軸之單位向量。於確定紅外線訊號方向判別裝置之座標軸後,車輛亦即紅外線訊號源之座標(x,y,0)與訊號方向判別裝置所偵得之訊號方向(θ,)間之關係為
於車與車通訊應用中,毫無疑問,除訊號方向外,若能進一步偵知訊號源位置,則系統功能將大幅提升。為達到此目的,可利用本發明之紅外線訊號方向判別技術,將至少二個訊號方向判別裝置沿x軸設置於相距2d之位置,以各訊號方向判別裝置所量得之訊號方向進行目標座標三角定位(target positioning by triangulation)。 In the vehicle-to-vehicle communication application, there is no doubt that in addition to the signal direction, if the position of the signal source can be further detected, the system function will be greatly improved. In order to achieve this purpose, the infrared signal direction discrimination technology of the present invention can be used to set at least two signal direction discrimination devices along the x-axis at a position 2d apart, and use the signal direction discrimination devices to determine the target coordinate triangle. Positioning (target positioning by triangulation).
如第7圖所示,將兩組本發明之一維訊號方向判別裝置分置
於車輛前緣兩端,相距2d,圖中之十字即表示前述之訊號方向判別裝置。若將車輛前緣中心點定為座標原點,則此兩訊號方向判別裝置之座標將分別為(d,0)及(-d,0),此時目標物之位置座標(x,y)與此兩訊號方向判別裝置所量得之訊號源方位θ1及θ2之關係為
一般而言,車輛均行駛於平面道路,故於絕大多數情況下前述之二維座標定位(x,y)已合乎需求。然而當大型車與小型車近距離通訊時,如第8圖所示,由於通訊模組彼此間之高低差,欲獲得座標之精確位置則需三度空間之定位,此時可利用兩只前述之二維訊號方向判別裝置。如第7圖所示,將此兩訊號方向判別裝置分置於相距2d之相同位置,除x,y兩軸之外,增加一z軸。這時訊號源之座標(x,y,z)與此兩訊號方向判別裝置分別所量得之訊號源方位(θ1,Φ1)及(θ2,Φ2)間之關係為
z=[(x-d)2+y 2+z 2]1/2 cos θ1 (24) z = [( xd ) 2 + y 2 + z 2 ] 1/2 cos θ 1 (24)
z=[(x-d)2+y 2+z 2]1/2 cos θ1 (27)此六方程式為一聯立之非線性方程組,由量測所得之目標方向(θ1,Φ1)及(θ2,Φ2)求取訊號源之座標位置(x,y,z)。 z = [( xd ) 2 + y 2 + z 2 ] 1/2 cos θ 1 (27) The six equations are a set of simultaneous nonlinear equations, and the measured target directions ( θ 1, Φ1) and ( θ 2, Φ2) Find the coordinate position ( x , y , z ) of the signal source.
若車體四角均安裝訊號方向判別裝置則可四面八方全方位360度接收訊號,判斷訊號方向及定位追蹤。第9圖為此概念之示意圖,圖中之矩形代表車輛,矩形四角之十字分別代表訊號方向判別裝置,而車輛前、後緣中間之圓點代表訊號源。利用本發明所提之三角定位將可達全方位360度定位追蹤。 If the signal direction discrimination devices are installed on all four corners of the car body, it can receive signals in all directions and 360 degrees in all directions to determine the signal direction and positioning tracking. Figure 9 is a schematic diagram of this concept. The rectangle in the figure represents the vehicle, the crosses at the four corners of the rectangle represent the signal direction discrimination device, and the dots in the middle of the front and rear edges of the vehicle represent the signal source. Utilizing the triangular positioning provided by the present invention, 360-degree positioning and tracking can be achieved in all directions.
本發明雖以實施例揭露如上,然並非用以限定本發明之範圍,任何本發明所屬技術領域中具有通常知識者,於不脫離本發明精神範圍內,當可做些許之更動與潤飾,因此本發明之保護範圍當視後附之申請專利範圍所界定者為準。 Although the present invention is disclosed as above by way of example, it is not intended to limit the scope of the present invention. Any person with ordinary knowledge in the technical field to which the present invention pertains may make some modifications and retouching without departing from the spirit of the present invention. The protection scope of the present invention shall be determined by the scope of the attached patent application.
Claims (5)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| TW107108058A TWI675214B (en) | 2018-03-09 | 2018-03-09 | Signal-direction discriminating device and signal postioning and tracking system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| TW107108058A TWI675214B (en) | 2018-03-09 | 2018-03-09 | Signal-direction discriminating device and signal postioning and tracking system |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| TW201939061A TW201939061A (en) | 2019-10-01 |
| TWI675214B true TWI675214B (en) | 2019-10-21 |
Family
ID=69023261
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| TW107108058A TWI675214B (en) | 2018-03-09 | 2018-03-09 | Signal-direction discriminating device and signal postioning and tracking system |
Country Status (1)
| Country | Link |
|---|---|
| TW (1) | TWI675214B (en) |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TW225587B (en) * | 1992-07-22 | 1994-06-21 | Hughes Aircraft Co | |
| WO1998014794A1 (en) * | 1996-09-30 | 1998-04-09 | Qualcomm Incorporated | Ambiguity resolution for ambiguous position solutions using satellite beams |
| TW201037345A (en) * | 2009-04-07 | 2010-10-16 | Chunghwa Telecom Co Ltd | Signal source tracking device and tracking method |
| TW201346309A (en) * | 2012-05-09 | 2013-11-16 | Ting-Yueh Chin | RSS-based DoA indoor location estimation system and method |
| WO2016098502A1 (en) * | 2014-12-17 | 2016-06-23 | 株式会社リコー | Coordinate detecting apparatus |
| CN106054166A (en) * | 2016-06-15 | 2016-10-26 | 广州尚云在线科技有限公司 | System and method for realizing positioning of moving target based on array antenna |
-
2018
- 2018-03-09 TW TW107108058A patent/TWI675214B/en not_active IP Right Cessation
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TW225587B (en) * | 1992-07-22 | 1994-06-21 | Hughes Aircraft Co | |
| WO1998014794A1 (en) * | 1996-09-30 | 1998-04-09 | Qualcomm Incorporated | Ambiguity resolution for ambiguous position solutions using satellite beams |
| TW201037345A (en) * | 2009-04-07 | 2010-10-16 | Chunghwa Telecom Co Ltd | Signal source tracking device and tracking method |
| TW201346309A (en) * | 2012-05-09 | 2013-11-16 | Ting-Yueh Chin | RSS-based DoA indoor location estimation system and method |
| WO2016098502A1 (en) * | 2014-12-17 | 2016-06-23 | 株式会社リコー | Coordinate detecting apparatus |
| CN106054166A (en) * | 2016-06-15 | 2016-10-26 | 广州尚云在线科技有限公司 | System and method for realizing positioning of moving target based on array antenna |
Non-Patent Citations (1)
| Title |
|---|
| )A1 * |
Also Published As
| Publication number | Publication date |
|---|---|
| TW201939061A (en) | 2019-10-01 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US7729857B2 (en) | System for and method of detecting a collision and predicting a vehicle path | |
| US12037015B2 (en) | Vehicle control device and vehicle control method | |
| CA3168740C (en) | Method for object avoidance during autonomous navigation | |
| US12181878B2 (en) | Velocity estimation and object tracking for autonomous vehicle applications | |
| TWI674984B (en) | Driving track planning system and method for self-driving vehicles | |
| US20230077837A1 (en) | Collaborative perception for autonomous vehicles | |
| US10139833B1 (en) | Six-dimensional point cloud system for a vehicle | |
| US11987245B2 (en) | Method for controlling vehicle and vehicle control device | |
| US20240134054A1 (en) | Point cloud segmentation using a coherent lidar for autonomous vehicle applications | |
| CN113743171B (en) | Target detection method and device | |
| US20190130198A1 (en) | Traveling control device | |
| US10901417B2 (en) | Autonomous vehicle operational management with visual saliency perception control | |
| US20120226411A1 (en) | Method for controlling a vehicle member | |
| CN110060467A (en) | Prediction meanss, prediction technique and storage medium | |
| CN110020504A (en) | Unmanned vehicle running environment complexity quantization method based on rear intrusion and collision time | |
| CN107830865A (en) | A kind of vehicle target sorting technique, device, system and computer program product | |
| Wang et al. | ECASS: Edge computing based auxiliary sensing system for self-driving vehicles | |
| US20220350018A1 (en) | Data driven resolution function derivation | |
| JP2017187422A (en) | Nearby article detection apparatus | |
| US11099579B2 (en) | System for determining the number of remote vehicles following a host vehicle | |
| JP7405283B2 (en) | Map generation device and map generation program | |
| CN115303276A (en) | Bend car following control method for automatic driving car | |
| JP2010218377A (en) | Vehicle control device | |
| US6184821B1 (en) | On-board GPS sensors systems | |
| US12091047B2 (en) | Driving assistance method and driving assistance device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| MM4A | Annulment or lapse of patent due to non-payment of fees |