TWI818361B - Dual Autopilot System with Control Transfer and Backup Aviation Sensors - Google Patents
Dual Autopilot System with Control Transfer and Backup Aviation Sensors Download PDFInfo
- Publication number
- TWI818361B TWI818361B TW110143769A TW110143769A TWI818361B TW I818361 B TWI818361 B TW I818361B TW 110143769 A TW110143769 A TW 110143769A TW 110143769 A TW110143769 A TW 110143769A TW I818361 B TWI818361 B TW I818361B
- Authority
- TW
- Taiwan
- Prior art keywords
- control
- electrically connected
- signal
- aviation
- flight
- Prior art date
Links
- 230000009977 dual effect Effects 0.000 title claims abstract description 25
- 238000012546 transfer Methods 0.000 title claims abstract description 14
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims abstract description 42
- 230000001960 triggered effect Effects 0.000 claims abstract description 4
- 239000003990 capacitor Substances 0.000 claims description 40
- 238000004891 communication Methods 0.000 claims description 31
- 230000008054 signal transmission Effects 0.000 claims description 8
- 238000012545 processing Methods 0.000 claims description 7
- 230000007774 longterm Effects 0.000 claims description 5
- 230000004044 response Effects 0.000 claims description 4
- 238000010248 power generation Methods 0.000 claims description 3
- 230000003862 health status Effects 0.000 abstract description 6
- 238000012544 monitoring process Methods 0.000 abstract description 6
- 238000010586 diagram Methods 0.000 description 12
- 238000005516 engineering process Methods 0.000 description 7
- 230000006870 function Effects 0.000 description 7
- 238000004364 calculation method Methods 0.000 description 4
- 230000036541 health Effects 0.000 description 4
- 238000013461 design Methods 0.000 description 3
- 238000007689 inspection Methods 0.000 description 3
- 238000000034 method Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 102100022148 G protein pathway suppressor 2 Human genes 0.000 description 2
- 101000900320 Homo sapiens G protein pathway suppressor 2 Proteins 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000007123 defense Effects 0.000 description 2
- 238000004146 energy storage Methods 0.000 description 2
- 230000010006 flight Effects 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000007726 management method Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000005452 bending Methods 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000003203 everyday effect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 238000004064 recycling Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000012552 review Methods 0.000 description 1
- 230000001568 sexual effect Effects 0.000 description 1
- 239000005437 stratosphere Substances 0.000 description 1
- 239000005436 troposphere Substances 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Hardware Redundancy (AREA)
- Feedback Control In General (AREA)
- Safety Devices In Control Systems (AREA)
Abstract
本發明係有關一種具控制權轉移和備用航空感測器的雙自動駕駛系統,其包括無人機、主自動駕駛系統、副自動駕駛系統及第一切換單元。自動駕駛系統用以操控飛行控制系統來驅動無人機的飛行,主自動駕駛系統包含用以發出第一觸發訊號的訊號觸發部。第一切換單元可受第一觸發訊號的觸發而選擇讓主自動駕駛系統接管操控飛行控制系統,以控制無人機飛行;當第一觸發訊號消失時,切換單元則選擇讓副自動駕駛系統接管操控飛行控制系統,以控制無人機飛行,俾能藉由雙主、副自動駕駛系統與雙航空感測系統等硬體建置,以讓平常自動飛行控制時由主自動駕駛系統負責,副自動駕駛系統負責監看主自動駕駛系統健康狀態和發揮較佳介面能力的I2C介面的感測器讀取功能,當主自動駕駛系統失能時,則由副自動駕駛系統接手自動飛行控制的工作。 The invention relates to a dual automatic driving system with control transfer and backup aviation sensors, which includes a drone, a main automatic driving system, a secondary automatic driving system and a first switching unit. The autopilot system is used to control the flight control system to drive the flight of the drone. The main autopilot system includes a signal trigger part for sending the first trigger signal. The first switching unit can be triggered by the first trigger signal and choose to let the main automatic pilot system take over the control of the flight control system to control the flight of the drone; when the first trigger signal disappears, the switch unit chooses to let the secondary automatic pilot system take over the control. The flight control system is used to control the flight of the drone, so that it can be built with hardware such as dual main and secondary autopilot systems and dual aviation sensing systems, so that the primary autopilot system is responsible for normal automatic flight control, and the secondary autopilot system is responsible for normal automatic flight control. The system is responsible for monitoring the health status of the main autopilot system and the sensor reading function of the I2C interface that exerts better interface capabilities. When the main autopilot system fails, the secondary autopilot system takes over the automatic flight control work.
Description
本發明係有關一種具控制權轉移和備用航空感測器的雙自動駕駛系統,尤指一種具備雙主、副自動駕駛系統與雙航空感測系統等硬體建置的高空長滯(HALE)太陽能無人飛機雙自動駕駛系統技術。 The present invention relates to a dual automatic driving system with control transfer and backup aviation sensors, and particularly refers to a high-altitude long-lag (HALE) system with dual main and secondary automatic driving systems and dual aviation sensing systems. Solar-powered unmanned aerial vehicle dual autopilot system technology.
按,高空長滯(HALE)太陽能無人飛機一旦升空飛行後,即可依靠太陽能電池的電力供應和電池儲能循環下,短則可飛行數日,長則可飛行數月之久,故可在空中長時間地觀測地面。可見,高空長滯(HALE)太陽能無人飛機最大的優勢在於已然可以代替衛星來執行任務。衛星科技具有國防和民生應用的需求,而高空長滯HALE(High altitude and long endurance)太陽能無人機是屬於衛星和無人機兩個領域的結合,並賦與無人飛機全新的應用和挑戰。HALE太陽能無人飛機(Solar UAV)被國際航太界認定為大氣層中的衛星,它們可飛行在20公里高的平流層,提供衛星般的服務,而製造費用低、優於衛星的照相解析度或通訊品質、具有回收可修復性。目前以Airbus的Zephyr、BAE Systems的PHASA、和Boeing的Odysseus最有成果。而韓國EAV1~3幾乎每年一台不斷的測試;瑞士AtlantikSolar翼展6米,於2015年7月締造太陽能供電81小時1000m航高的成功飛行紀錄;俄羅斯Sova翼展9.5米具有三個機身和三個controller,達到主動的機翼變形控制,以減輕突風和在惡劣天氣飛行對機翼過度彎曲的風險。 According to the press, once the high-altitude long-lag (HALE) solar-powered unmanned aircraft takes off and flies, it can rely on the power supply of solar cells and battery energy storage cycles. It can fly for a few days in a short time or for a few months in the long term, so it can Observe the ground from the air for a long time. It can be seen that the biggest advantage of high-altitude long-lag (HALE) solar-powered unmanned aircraft is that it can replace satellites to perform tasks. Satellite technology has needs for national defense and civilian livelihood applications, and HALE (High altitude and long endurance) solar-powered drones are a combination of the two fields of satellites and drones, and give unmanned aircraft new applications and challenges. HALE solar unmanned aircraft (Solar UAV) are recognized by the international aerospace community as satellites in the atmosphere. They can fly in the stratosphere at an altitude of 20 kilometers and provide satellite-like services with low manufacturing costs and better photographic resolution than satellites. Communication quality, recycling and repairability. Currently, Airbus’ Zephyr, BAE Systems’ PHASA, and Boeing’s Odysseus are the most successful. The Korean EAV1~3 is tested almost every year; the Swiss Atlantik Solar has a wingspan of 6 meters and set a successful solar-powered flight record of 81 hours at an altitude of 1000m in July 2015; the Russian Sova has a wingspan of 9.5 meters and has three fuselages and Three controllers achieve active wing deformation control to reduce the risk of excessive wing bending in gusts and bad weather flying.
高長滯空(HALE)太陽能無人機(solar UAV)的自動駕駛儀 (autopilot)必須面對飛機穿越對流層時54~80km/hr的強風(高度7~14km間)、日夜長時間航行的電能量管理、高空任務執行的飛行控制和長時間低溫低壓飛行的穩定性等,這已超乎一般UAV autopilot的功能,必須要有專屬的自主飛行系統,尤其是自動駕駛儀(autopilot)。於2013年後廣為流行的Pixhawk autopilot採用單顆ST公司32-bit單晶片來完成。不過這些晶片的計算能力與導控迴圈計算速度皆有其極限,僅是堪用的設計而已,若要增加對航空系統周邊的整合度與導控迴圈的計算速度,並兼顧未來的擴充性,甚至要導入較先進的飛控理論、國防上多機的編隊飛行、影像處理或智慧化的演算是相當受限而不可能。 Autopilot for high-altitude endurance (HALE) solar UAV (autopilot) must face strong winds of 54~80km/hr (at altitudes between 7~14km) when the aircraft travels through the troposphere, power management for long-term flights day and night, flight control for high-altitude missions, and stability of long-term low-temperature and low-pressure flights, etc. , which has exceeded the functions of general UAV autopilot and requires a dedicated autonomous flight system, especially an autopilot. Pixhawk autopilot, which became widely popular after 2013, is implemented using a single ST company's 32-bit single chip. However, the computing power and guidance loop calculation speed of these chips have their limits. They are just usable designs. If we want to increase the integration of the aviation system periphery and the guidance loop calculation speed, we should also take into account future expansion. It is quite limited and impossible to even introduce more advanced flight control theory, formation flying of multiple aircraft for national defense, image processing or intelligent calculation.
目前大區域環境監控,仍是以衛星為主,但衛星設計製作和發射佈建費用較貴,衛星每天能對台灣照相時間只有幾分鐘,只有地球同步衛星(geosynchronous satellite)才能全時停滯在任務區上空照相,衛星軌道至少400公里高以上,影像解析度或通訊延遲不如無人飛機,如能設計類衛星(Pseudo satellite)的平流層(Stratosphere)載具,利用白天太陽能發電和電池儲能的長滯空無人機,在航高(3~22km)攜帶任務酬載,類似同步衛星在任務區上空停滯數日至數月巡航。 At present, large-area environmental monitoring is still based on satellites, but the design, production, launch and deployment of satellites are relatively expensive. Satellites can only take pictures of Taiwan for a few minutes every day. Only geosynchronous satellites can stay on task full-time. To take pictures over the area, the satellite orbit is at least 400 kilometers high, and the image resolution or communication delay is not as good as that of unmanned aircraft. For example, a stratospheric vehicle similar to a satellite (Pseudo satellite) can be designed to use daytime solar power generation and battery energy storage for long-term use. The unmanned aerial vehicle carries the mission payload at an altitude (3~22km), similar to a geostationary satellite that stays in the sky above the mission area for several days to several months.
依據所知,如果要增加自動駕駛儀(autopilot)的功能,目前習知的做法是利用多板系統來和自動駕駛儀(autopilot)分工。無人機最重要的技術核心是自動駕駛儀(autopilot),它整合了航空感測與飛行紀錄系統、電能管理系統、飛行伺服控制系統和通訊與導航系統等。自動駕駛儀(autopilot)收到航空感測資料後,才能進行飛行控制和導航的演算,於此即可進一步達到自主飛行的目的,並透過無線通訊接收地面控制命令和下傳飛行狀態至地面站,所以無人飛機的主人是地面站的操作員。再者,既有之習知技 術只有單顆控制晶片和一套航空感測系統而已,這當如GPS、AHRS、空速管等重要感測模組一種失效時,飛機便無法飛行,因而造成無人機於長時間滯空飛行時的安全與不便等情事產生。 According to what we know, if you want to add the function of the autopilot, the current common practice is to use a multi-board system to divide the work with the autopilot. The most important technical core of a drone is the autopilot, which integrates aviation sensing and flight recording systems, power management systems, flight servo control systems, communication and navigation systems, etc. After the autopilot receives aviation sensing data, it can perform flight control and navigation calculations, where it can further achieve the purpose of autonomous flight, receive ground control commands through wireless communication, and transmit flight status to the ground station. , so the owner of the drone is the operator of the ground station. Furthermore, existing knowledge and skills The technology only has a single control chip and a set of aviation sensing systems. When one of the important sensing modules such as GPS, AHRS, and pitot tube fails, the aircraft will be unable to fly, resulting in the drone flying in the air for a long time. time safety and inconvenience etc. arise.
由上述得知,上述習知技術於自動駕駛系統與飛行感測系統的功能性建置確實未臻完善,因而有再改善的必要性;有鑑於此,如何開發出一種具備控制權轉移和備用航行感測器的雙自動駕駛技術,實已成為相關技術領域產學業者所亟欲挑戰與解決的技術課題;緣是,本發明人等乃經不斷的努力研發之下,終於研發出一套有別於上述習知技術的本發明。 From the above, it can be seen that the functional construction of the above-mentioned conventional technology in the automatic driving system and the flight sensing system is indeed not perfect, so there is a need for further improvement. In view of this, how to develop a system with control transfer and backup The dual-autonomous driving technology of navigation sensors has actually become a technical issue that industry and academia scholars in related technical fields are eager to challenge and solve. The reason is that after continuous efforts in research and development, the inventors finally developed a set of The present invention is different from the above-mentioned conventional technology.
本發明主要目的,在於提供一種具控制權轉移和備用航空感測器的雙自動駕駛系統,主要是藉由雙主、副自動飛行系統與雙航空感測系統等硬體建置,以讓平常自動飛行控制時由主自動飛行系統負責,副自動飛行系統負責監看主自動飛行系統健康狀態和發揮較佳介面能力的I2C介面的感測器讀取,當主自動飛行系統失能時,則由副自動飛行系統接手自動飛行控制的工作。達成本發明主要目的之技術手段,係包括太陽能無人機、主自動飛行系統、副自動飛行系統及第一切換單元。自動飛行系統用以操控飛行控制系統來驅動太陽能無人機的飛行,主自動飛行系統包含用以發出第一觸發訊號的訊號觸發部。第一切換單元可受第一觸發訊號的觸發而選擇讓主自動飛行系統接管操控飛行控制系統,以控制進太陽能無人機飛行;當第一觸發訊號消失時,切換單元則選擇讓副自動飛行系統接管操控飛行控制系統,以控制進太陽能無人機飛行。 The main purpose of the present invention is to provide a dual autopilot system with control transfer and backup aviation sensors. It is mainly constructed through hardware such as dual main and secondary automatic flight systems and dual aviation sensing systems to allow normal operation. The main automatic flight system is responsible for automatic flight control. The secondary automatic flight system is responsible for monitoring the health status of the main automatic flight system and reading the sensors of the I2C interface to exert better interface capabilities. When the main automatic flight system is disabled, the The secondary automatic flight system takes over the automatic flight control work. The technical means to achieve the main purpose of the present invention include a solar drone, a main automatic flight system, a secondary automatic flight system and a first switching unit. The automatic flight system is used to control the flight control system to drive the flight of the solar drone. The main automatic flight system includes a signal trigger part for sending out a first trigger signal. The first switching unit can be triggered by the first trigger signal and choose to let the main automatic flight system take over the control of the flight control system to control the flight of the solar drone; when the first trigger signal disappears, the switching unit chooses to let the secondary automatic flight system Take over the control of the flight control system to control the flight of the solar powered drone.
10:太陽能無人機 10:Solar-powered drone
11:飛行控制系統 11:Flight control system
110:伺服通道 110:Servo channel
12:第三航空感測系統 12:Third Aviation Sensing System
122:耗電流計 122: Current consumption meter
121:太陽光強度計 121:Sun intensity meter
120:電壓電流計 120: Voltage ammeter
20:主自動駕駛系統 20: Main autonomous driving system
21:第一航空感測系統 21:First Aviation Sensing System
210,310:空速計 210,310: airspeed meter
211,311:氣壓高度計 211,311: Barometric altimeter
212,312:三軸姿態儀 212,312: Three-axis attitude indicator
213,313:GPS定位模組 213,313:GPS positioning module
214:廣播式自動監視模組 214:Broadcast automatic surveillance module
215:酬載感測模組 215: Payload sensing module
216:飛機顯示燈 216: Aircraft display lights
217:飛行記錄卡 217:Flight record card
218:溫濕度計 218: Thermohygrometer
22:第一訊號處理器 22:First signal processor
220:訊號觸發部 220: Signal trigger part
221:第一資料輸出腳位 221: First data output pin
222:第一無線訊號輸出腳位 222: The first wireless signal output pin
30:副自動駕駛系統 30: Assistant automatic driving system
31:第二航空感測系統 31: Second aviation sensing system
32:第二訊號處理器 32: Second signal processor
320:第二資料輸出腳位 320: Second data output pin
321:第二無線訊號輸出腳位 321: Second wireless signal output pin
324:超音波風速感測器 324: Ultrasonic wind speed sensor
325:SBUS接收機 325:SBUS receiver
40:第一切換單元 40: First switching unit
41:第一數據多工器 41: First data multiplexer
42:第一訊號輸入電路 42: First signal input circuit
50:長距無線通訊模組 50:Long distance wireless communication module
51:資料接收端 51: Data receiving end
60:第二切換單元 60: Second switching unit
61:第二數據多工器 61: Second data multiplexer
62:第二訊號輸入電路 62: Second signal input circuit
70:訊號傳輸介面 70: Signal transmission interface
80:第三數據多工器 80: Third data multiplexer
C1:第一電容 C1: first capacitor
R1:第一電阻 R1: first resistor
C2:第二電容 C2: second capacitor
C3:第三電容 C3: The third capacitor
C4:第四電容 C4: The fourth capacitor
R2:第二電阻 R2: second resistor
S1,S1',S2,S2':切換選擇腳 S1, S1', S2, S2': switch selection pin
圖1係本發明具體實施的功能方塊示意圖。 Figure 1 is a functional block diagram of a specific implementation of the present invention.
圖2係本發明主自動駕駛系統核心處理與航空感測實施的架構示意圖。 Figure 2 is an architectural schematic diagram of the core processing and aviation sensing implementation of the main autonomous driving system of the present invention.
圖3係本發明主自、副動駕駛系統核心處理與航空感測實施的架構示意圖。 Figure 3 is an architectural schematic diagram of the core processing and aviation sensing implementation of the active and passive driving systems of the present invention.
圖4係本發明主、副自動駕駛系統切換控制的實施架構示意圖。 Figure 4 is a schematic diagram of the implementation architecture of switching control between the primary and secondary autonomous driving systems of the present invention.
圖5係本發明切換單元的系統切換控制實施示意圖。 Figure 5 is a schematic diagram of the system switching control implementation of the switching unit of the present invention.
圖6係本發明主自動駕駛系統向副自動駕駛系統發送讀取資料命令的通訊格式示意圖。 Figure 6 is a schematic diagram of the communication format of the main automatic driving system of the present invention sending a data reading command to the sub-automatic driving system.
圖7係本發明副自動駕駛系統對主自動駕駛系統發出要求指令的通訊格式示意圖。 Figure 7 is a schematic diagram of the communication format for the secondary automatic driving system of the present invention to issue required instructions to the main automatic driving system.
圖8係本發明重要模組的航空感測數據切換控制示意圖。 Figure 8 is a schematic diagram of aviation sensing data switching control of important modules of the present invention.
圖9係本發明副自動駕駛系統的控制流程實施示意圖。 Figure 9 is a schematic diagram of the control flow implementation of the sub-autonomous driving system of the present invention.
圖10係本發明主自動駕駛系統的控制流程實施示意圖。 Figure 10 is a schematic diagram of the control flow implementation of the main automatic driving system of the present invention.
為讓 貴審查委員能進一步瞭解本發明整體的技術特徵與達成本發明目的之技術手段,玆以具體實施例並配合圖式加以詳細說明: In order to allow your review committee to further understand the overall technical characteristics of the present invention and the technical means to achieve the purpose of the present invention, specific embodiments are described in detail with reference to the drawings:
請配合參看圖1所示,本發明一種具體實施例,係包括一高空長滯型(HALE)太陽能無人機10、一主自動駕駛系統20、一副自動駕駛系統30及一第一切換單元40等技術內容。該飛行控制系統11設置於太陽能無人機10,用以控制太陽能無人機10飛行。該主自動駕駛系統20設置於太陽能無人機10,用以操控飛行控制系統11來控制太陽能無人機10的飛行,該主自動駕駛系統20包含一用以發出第一觸發訊號的訊號觸發部
220。該副自動駕駛系統30設置於太陽能無人機10。該第一切換單元40可受第一觸發訊號的觸發而選擇讓主自動駕駛系統20接管操控飛行控制系統11,以控制太陽能無人機10飛行;當第一觸發訊號消失時,該切換單元則選擇讓副自動駕駛系統30接管操控飛行控制系統11,以控制太陽能無人機10飛行。
Please refer to FIG. 1 , a specific embodiment of the present invention includes a high-altitude long-lag (HALE)
請配合參看圖1所示,該主自動駕駛系統20包括一用以產生多種第一航行狀態數據的第一航空感測系統21及一用以解讀處理第一航行狀態數據為第一航行狀態資訊的第一訊號處理器22。該副自動駕駛系統30包括一用以產生多種第二航行狀態數據的第二航空感測系統31及一用以解讀處理第二航行狀態數據為第二航行狀態資訊的第二訊號處理器32。
Please refer to FIG. 1 . The main
請配合參看圖2、3所示,該第一航空感測系統21與第二航空感測系統31各自包含一用以產生空速感測數據的空速計210,310、一用以產生氣壓高度感測數據的氣壓高度計211,311、一用以產生三軸姿態感測數據的三軸姿態儀212,312、一用以產生定位訊號的GPS定位213,313及其他重要的飛行感測器。
Please refer to Figures 2 and 3. The first
再請配合參看圖2、3所示,本發明更包含一由主自動駕駛系統20及副自動駕駛系統30共用且共同電性連接的第三航空感測系統12,該第三航空感測系統12包含一用以感測太陽能無人機10之耗電流的耗電流計122、一用以感測太陽光強度的太陽光強度計121及一用以感測設於太陽能無人機10的一太陽能發電系統、飛行控制系統11耗電量的電壓電流計120及其感測器。
Please refer to Figures 2 and 3 again. The present invention further includes a third
請配合參看圖1、5所示,本發明實施例中,該第一切換
單元40包含一第一數據多工器41(Mux)及一第一訊號輸入電路42,該第一數據多工器41包含二輸入部、一切換部及一輸出部,其一輸入部與第一訊號處理器22用以輸出控制飛行控制系統11之第一控制指令的複數第一資料輸出腳位221(TX)電性連接,其二輸入部與第二訊號處理器32用以輸出控制飛行控制系統11之第二控制指令的複數第二資料輸出腳位320(TX)電性連接,該切換部與第一訊號輸入電路42之輸出端電性連接,該切換部之輸入端與第一訊號處理器22作為訊號觸發部220的切換選擇腳S2電性連接,該輸出部與飛行控制系統11之複數伺服通道110電性連接;當切換選擇腳S2產生第一觸發訊號時,則經第一訊號輸入電路42輸入至第一數據多工器41的切換部,該第一數據多工器41則使複數第一資料輸出腳位221(TX)與複數伺服通道110電性導通,用以使第一訊號處理器22的第一控制指令傳輸至複數伺服通道110;當切換選擇腳S2無第一觸發訊號時(如故障;或當機時),該第一數據多工器41則使複數第二資料輸出腳位320(TX)與複數伺服通道110電性導通,用以使第二訊號處理器32的第二控制指令傳輸至複數伺服通道110。
Please refer to Figures 1 and 5. In the embodiment of the present invention, the first switching
The
具體的,如圖5所示,該第一訊號輸入電路42包含一第一電容C1、一第一電阻R1及一第三電容C3,該第一電容C1一端作為輸入端而與切換選擇腳S2電性連接,該第一電容C1另端與第一電阻R1的一端電性連接,該第一電阻R1另端與第三電容C3一端電性連接,該第一電阻R1與第三電容C3電性連接的接點與切換部電性連接,該第三電容C3另端則接地,該第二訊號處理器32之一切換選擇腳S2'則電性連接於第一電阻R1與第三電容C3電性連接的接點上。
Specifically, as shown in FIG. 5 , the first signal input circuit 42 includes a first capacitor C1 , a first resistor R1 and a third capacitor C3 . One end of the first capacitor C1 serves as an input terminal and is connected to the switching selection pin S2 Electrically connected, the other end of the first capacitor C1 is electrically connected to one end of the first resistor R1, the other end of the first resistor R1 is electrically connected to one end of the third capacitor C3, the first resistor R1 is electrically connected to the third capacitor C3 The contact point of the sexual connection is electrically connected to the switching part, the other end of the third capacitor C3 is grounded, and a switching selection pin S2' of the
請配合參看圖2~4所示,本發明更包含一用以與一地面站
進行長距無線通訊的長距無線通訊模組50及一第二切換單元60,該第二切換單元60包含一第二數據多工器61及一第二訊號輸入電路62,該第二數據多工器61包含二輸入部、一切換部及一輸出部,其一該輸入部與第一訊號處理器22用以輸出無線訊號的一第一無線訊號輸出腳位222(TX)電性連接,其二輸入部與第二訊號處理器32用以輸出無線訊號的一第二無線訊號輸出腳位321(TX)電性連接,該切換部與第二訊號輸入電路62之輸出端電性連接,該切換部之輸入端與第一訊號處理器22之切換選擇腳S1電性連接,該輸出部與長距無線通訊模組50的一資料接收端51電性連接;當切換選擇腳S1產生第二觸發訊號(即方波)時,則經第二訊號輸入電路62輸入至第二數據多工器61的切換部,該第二數據多工器61則使第一無線訊號輸出腳位222與資料接收端51電性導通,用以使第一訊號處理器22與地面站進行長距離的無線通訊;當切換選擇腳S1無第二觸發訊號時,該第二數據多工器61則使第二無線訊號輸出腳位321與資料接收端51電性導通,用以使第二訊號處理器32與地面站進行長距離的無線通訊。
Please refer to Figures 2 to 4. The present invention further includes a device for communicating with a ground station
A long-distance wireless communication module 50 for long-distance wireless communication and a second switching unit 60. The second switching unit 60 includes a second data multiplexer 61 and a second signal input circuit 62. The second data multiplexer 61 The processor 61 includes two input parts, a switching part and an output part. One of the input parts is electrically connected to a first wireless signal output pin 222 (TX) of the
具體的,請配合參看圖5所示,該第二訊號輸入電路62包含一第二電容C2、一第二電阻R2及一第四電容C4,該第二電容C2一端作為輸入端而與切換選擇腳S1電性連接,該第二電容C2另端電性連接第二電阻R2的一端,該第二電阻R2另端與第四電容C4一端電性連接,該第二電阻R2與第四電容C4電性連接的接點與切換部電性連接,該第四電容C4另端則接地,該第二訊號處理器32之一切換選擇腳S1'則電性連接於第二電阻R2與第四電容C4電性連接的接點上。
Specifically, please refer to FIG. 5 . The second signal input circuit 62 includes a second capacitor C2, a second resistor R2 and a fourth capacitor C4. One end of the second capacitor C2 serves as an input terminal and is connected to the switching selection. The pin S1 is electrically connected, the other end of the second capacitor C2 is electrically connected to one end of the second resistor R2, the other end of the second resistor R2 is electrically connected to one end of the fourth capacitor C4, the second resistor R2 and the fourth capacitor C4 The electrically connected contact is electrically connected to the switching part, the other end of the fourth capacitor C4 is grounded, and the switching selection pin S1' of the
請配合參看圖1、3、4所示,該主自動駕駛系統20係透過
一訊號傳輸介面70(如12C通訊介面)與副自動駕駛系統30資訊連結,於太陽能無人機10飛行時,該副自動駕駛系統30會於預設之固定間隔時間透過訊號傳輸介面70發出回覆正常的要求指令給主自動駕駛系統20,當主自動駕駛系統20接收到要求指令時,該主自動駕駛系統20則透過訊號傳輸介面70發出狀況正常的回覆訊號給副自動駕駛系統30。當副自動駕駛系統30未收到回覆訊號時,則持續重覆發出要求指令,當要求指令持續發出時間達到一預設時間時,該副自動駕駛系統30則判斷主自動駕駛系統20故障,並透過一切換電路(本圖式例未示;如電晶體或繼電器)使第一觸發訊號斷開而消失,以讓副自動駕駛系統30接管操控飛行控制系統11。
Please refer to Figures 1, 3, and 4. The main
本發明自動駕駛(autopilot)硬體系統與各航空感測系統確實可以實現雙晶片與雙航空感測系統redundancy的自動駕駛(autopilot)硬體架構。其中,雙晶片係採master和slave分工,平常自動駕駛(autopilot)由運算能力強的第一訊號處理器22;master(三核心32位元)負責,第二訊號處理器32;slave(單核心16位元)負責監看master的健康狀態和發揮較佳介面能力的I2C通通訊介面感測器讀取,並將第二套航空感測系統和風向風速資料分享給master,而如果有發現和確認master已經失能時,則接手自動駕駛(autopilot)的大部分工作,結束任務返航和降落檢查。而slave的健康狀態則由自己的看門狗(watchdog)來維持,雙晶片則使用I2C通訊介面來溝通。
The autopilot hardware system and various aviation sensing systems of the present invention can indeed realize the redundancy autopilot hardware architecture of dual chips and dual aviation sensing systems. Among them, the dual-chip system adopts master and slave division of labor. Normal autonomous driving (autopilot) is responsible for the
較佳的,本發明第一訊號處理器22(即主晶片)係採用第一代AURIXTM三核心TC275T晶片,具有1440DMIPS@200MHz整合空速計、氣壓高度計、三軸姿態、GPS等航空感測器和Micro SD飛行紀錄卡,並增加太陽能無人機10所需的太陽光強度計、溫溼度計、電壓計、電流計等,然後輸出8個PWM伺服通道110來控制馬達和翼面伺服器,並透過(P900)
遠距無線通訊模組50進行上下鏈路的資料無線傳輸。
Preferably, the first signal processor 22 (ie, the main chip) of the present invention adopts the first-generation AURIX TM three-core TC275T chip, which has 1440DMIPS@200MHz integrated airspeed meter, barometric altimeter, three-axis attitude, GPS and other aviation sensing controller and Micro SD flight record card, and add the solar intensity meter, temperature and humidity meter, voltmeter, ammeter, etc. required by the
較佳的,本發明第二訊號處理器32(即次晶片)係選擇較便宜的Microchip 16-bit disPIC33單核心晶片。在第一訊號處理器22程式發展環境下,首先設計航空感測系統的介面讀取driver和感測器資料fusion整合程式,整合空速計210,310(airspeed)、氣壓高度計211,311(altimeter)、三軸姿態儀212,312(AHRS)、GPS定位模組213,313等感測器和Micro SD飛行紀錄卡217,並增加太陽能無人機10所需的太陽光強度計121(BPW34)、溫濕度計218(SHT35)、電壓電流計120(WCS1800)等。但由於TC275T週邊的驅動driver並不容易修改,目前UART介面和AD轉換使用上較沒有問題,但I2C通訊介面和直接記憶體存取(DMA)的使用較受限於示例代碼(sample code)無法修改為本發明需要的功能。而以I2C為介面的感測器眾多,所以本發明係使用修改I2C和DMA程式較方便的dsPIC33EP的晶片系列,做為主晶片(master)TC275T的次晶片(slave)晶片,具有自動駕駛(autopilot)的冗餘(redundancy)訊號處理器功能。dsPIC33EP晶片使用I2C2收集感測器的資料和處理後,再經另一個I2C1或者UART介面傳給TC275T。本發明將較重要的GPS定位模組213,313、三軸姿態儀212,31態(AHRS)、氣壓高度計211,311和空速計210,310,讓TC275T和dsPIC33EP晶片都各有一套,讓航空感測系統具有redundancy的規劃。
Preferably, the second signal processor 32 (ie, sub-chip) of the present invention is a cheaper Microchip 16-bit disPIC33 single-core chip. In the development environment of the
如圖2、3所示,該第一訊號處理器22電性連接一廣播式自動監視模組214(ADS-B)、酬載感測模組215(payload)、飛機顯示燈216(LIGHT)及飛行記錄卡217(MICRO SD);該第二訊號處理器32電性連接一超音波風速感測器324(FT205)及一SBUS接收機325。其中,ADS-B是一種飛機監視技術,飛機通過衛星導航系統確定其位置,並進行定期廣播,使其可被追蹤。FT205是新一代輕量級超音波風速感測器。SBUS接收機是
目視範圍手動遙控器RC的接收機,除了維持運作之基本系統外,其餘之荷重稱為酬載。此外,酬載通常係以重量表示之,在飛機上(包括民用機、軍用機或無人駕駛飛機)是指可消耗,可運送或可做為達成某些專門任務目的之負荷,如相機或基地台等。
As shown in Figures 2 and 3, the
從圖3得知,主晶片與次晶片共用的周邊有自動駕駛(autopilot)的耗電流計122(ACS724)、量測太陽能發電和飛行控制系統11耗電的電壓電流計120(WCS1800)、量測太陽光強度的太陽光強度計121(BPW34)皆為電壓輸出,直接接到兩顆晶片的A/D轉換輸入,並不需要切換電路。而長距無線通訊模組50(P900)的TX腳位也可以直接接到兩顆晶片通用異步收發介面(UART)的RX腳位,至於長距無線通訊模組50(P900)的接收端51(RX)則是對地面站無線傳輸,所以需要一個通道切換的機能設置,主要是由第二切換選擇腳(S1)來選取是由主晶片發送還是次晶片發送。而8個伺服通道110(servo)也需要通道切換的機能設置,並由選取切換選擇腳S2,是由主晶片或是次晶片執行飛行控制與導航。如圖5所示,本發明設計主晶片的主程式會產生方波訊號至切換選擇腳S2和切換選擇腳S1。切換選擇腳S1經過第二電容C2和第二電阻R2再到切換選擇腳S1’;或切換選擇腳S2經過第一電容C1和第一電阻R1再到切換選擇腳S2’。此時切換選擇腳S1’和S2’是高電位,選擇伺服器是由主晶片TC275T控制;而當主晶片失能時這一方波就不會產生,所以切換選擇線自動變為低電位,選擇飛行控制系統11之伺服器是由次晶片(dsPIC33EP)控制。
It can be seen from Figure 3 that the peripherals shared by the main chip and the secondary chip include the current consumption meter 122 (ACS724) of the autopilot, the voltage and current meter 120 (WCS1800) that measures the power consumption of the solar power generation and
本發明於主晶片失能時,係由次晶片接收控制飛機飛回地面站和降落(RC遙控或自動降落)。次晶片接手控制飛機時,必須擁有最基本的航空感測與伺服控制的能力,所以GPS2、AHRS2、空速計和氣壓高度計等基本感測器都直接電性連接在次晶片上,無須主晶片提供。唯一要再說 明的是,長距通訊模組50(P900)的RX和伺服通道110的切換訊號。話說主晶片已經失能,又如何能產生切換訊號?本發明設計主晶片的主程式會產生方波訊號,經過電容再到切換選擇線和接地電阻,此時切換選擇線是高電位,選擇伺服器是由主晶片控制;而當主晶片失能時這一方波就不會產生,所以切換選擇線為低電位,選擇伺服器是由次晶片控制。次晶片如何能知道主晶片失能,可以有下列三個方法步驟: In this invention, when the main chip is disabled, the secondary chip receives and controls the aircraft to fly back to the ground station and land (RC remote control or automatic landing). When the secondary chip takes over the control of the aircraft, it must have the most basic aviation sensing and servo control capabilities. Therefore, basic sensors such as GPS2, AHRS2, airspeed meter and barometric altimeter are directly electrically connected to the secondary chip without the need for a main chip. supply. The only thing I have to say again What is clear is the switching signal of the RX of the long-distance communication module 50 (P900) and the servo channel 110. If the main chip is disabled, how can it generate a switching signal? The main program of the main chip designed in this invention will generate a square wave signal, which passes through the capacitor and then to the switching selection line and the ground resistor. At this time, the switching selection line is at a high potential, and the selection server is controlled by the main chip; when the main chip is disabled This square wave will not be generated, so the select line is switched low and the select servo is controlled by the subchip. How can the secondary chip know that the main chip is disabled? There are three steps:
(1)連續讀取S1’或S2’的訊號為0時。 (1) When the signal of S1’ or S2’ is continuously read as 0.
(2)次晶片重複透過雙晶片通訊送出health請求,如主晶片在一定時間內都沒有回覆,就代表主晶片失能。 (2) The secondary chip repeatedly sends health requests through dual-chip communication. If the main chip does not reply within a certain period of time, it means that the main chip is disabled.
(3)如果次晶片收到主晶片的health內容是屬於不正常的health狀態。 (3) If the secondary chip receives the health content of the main chip, it is in an abnormal health state.
以圖9的次晶片軟體流程圖實現感測主晶片處於失能的狀態。當次晶片感測到主晶片失能,可以先嘗試重置主晶片,再不行就要接手飛機的控制和導航工作,結束任務將太陽能無人機10飛回地面站降落檢查。至於次晶片自己健康狀態的維護,是靠本身的看門狗(watchdog)。此外,如果次晶片要強制接手太陽能無人機10的控制,是可以把平時設定為輸入的S1’和S2’改為輸出腳位,強制把通道切換為次晶片dsPIC33EP使用。由於次晶片平常需將所收集的航空感測資料處理,和第二套的GPS2和AHRS2定期傳送給主晶片,達到重要航空感測器的redundancy,同時主晶片的健康狀態也需要次晶片透過本通道監控。本發明為增加可用UART的數量,選擇以I2C1做為雙晶片的通訊介面。當然也可以選擇CAN bus,但本發明已選擇無CAN bus的dsPIC33EP晶片,以節省成本和耗電。目前選擇此I2C的通訊架構為主晶片是master和次晶片為slave及address是33h。此I2C的通訊協定為圖6~7所示。
The secondary chip software flow chart in Figure 9 is used to realize sensing that the main chip is in a disabled state. When the secondary chip senses that the main chip is disabled, it can first try to reset the main chip. If it fails, it will take over the control and navigation of the aircraft. After completing the mission, the
對固定翼飛機來說,能維持飛行的基本航空感測器就是重要模組,包括GPS、AHRS、airspeed、氣壓高度計等。如圖3、8所示,本發明在主和次晶片上都各自接一套重要的第一、第二航空感測系統21,31。平常是由主晶片掌管飛機的飛控和導航任務執行,當主晶片上的某個重要模組不正常時,主晶片就會採用次晶片平常一直在傳送另一套重要模組的資料,維持任務的執行或者結束返航檢查和更換。這就是本發明的重要模組redundancy設計。從上一節雙晶片的通訊協定,次晶片透過I2C或者UART一直以20Hz的更新率,傳送a、g、p和t四個sentence給主晶片,這四個sentencc包括了GPS、AHRS、airspeed等重要資訊,達到維持基本飛行的航空感測資料,如圖8所示係以第三數據多工器80的硬體或者如圖10的軟體流程圖來選擇切換第一或第二航空感測系統21,31的航空感測數據。
For fixed-wing aircraft, the basic aviation sensors that can maintain flight are important modules, including GPS, AHRS, airspeed, barometric altimeter, etc. As shown in Figures 3 and 8, the present invention connects a set of important first and second
再者,圖9所示係為本發明副自動駕駛系統的軟體控制流程實施示意圖。而圖10所示則為本發明主自動駕駛系統的軟體控制流程實施示意圖。 Furthermore, FIG. 9 shows a schematic diagram of the software control flow of the sub-autonomous driving system of the present invention. Figure 10 shows a schematic diagram of the software control process of the main automatic driving system of the present invention.
經上述具體實施例的詳細說明后,本發明確實可以藉由雙主、副自動飛行系統與雙航空感測系統等硬體建置,以讓平常自動飛行控制時由主自動飛行系統負責,副自動飛行系統負責監看主自動飛行系統健康狀態和發揮較佳介面能力的I2C介面的感測器讀取,當主自動飛行系統失能時,則由副自動飛行系統接手自動飛行控制的工作。 After the detailed description of the above specific embodiments, the present invention can indeed be implemented by hardware such as dual main and secondary automatic flight systems and dual aviation sensing systems, so that the main automatic flight system is responsible for normal automatic flight control, and the secondary automatic flight control system is responsible for normal automatic flight control. The automatic flight system is responsible for monitoring the health status of the main automatic flight system and reading the sensors of the I2C interface for better interface capabilities. When the main automatic flight system fails, the secondary automatic flight system takes over the automatic flight control work.
以上所述,僅為本發明之可行實施例,並非用以限定本發明之專利範圍,凡舉依據下列請求項所述之內容、特徵以及其精神而為之其他變化的等效實施,皆應包含於本發明之專利範圍內。本發明所具體界定於請求項之結構特徵,未見於同類物品,且具實用性與進步性,已符合發明專利要件,爰依法具文提出申請,謹請 鈞局依法核予專利,以維護本 申請人合法之權益。 The above are only possible embodiments of the present invention and are not intended to limit the patent scope of the present invention. Any equivalent implementation of other changes based on the content, features and spirit described in the following claims shall be considered included in the patent scope of the present invention. The structural features specifically defined in the claim of the present invention have not been found in similar articles, and are practical and progressive. They have met the requirements for an invention patent. I file an application in accordance with the law. I sincerely request the Jun Bureau to approve the patent in accordance with the law to protect this invention. The legitimate rights and interests of the applicant.
10:太陽能無人機 10:Solar-powered drone
11:飛行控制系統 11:Flight control system
12:第三航空感測系統 12:Third Aviation Sensing System
20:主自動駕駛系統 20: Main autonomous driving system
21:第一航空感測系統 21:First Aviation Sensing System
22:第一訊號處理器 22:First signal processor
220:訊號觸發部 220: Signal trigger part
30:副自動駕駛系統 30: Assistant automatic driving system
31:第二航空感測系統 31: Second aviation sensing system
32:第二訊號處理器 32: Second signal processor
70:訊號傳輸介面 70: Signal transmission interface
Claims (9)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| TW110143769A TWI818361B (en) | 2021-11-24 | 2021-11-24 | Dual Autopilot System with Control Transfer and Backup Aviation Sensors |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| TW110143769A TWI818361B (en) | 2021-11-24 | 2021-11-24 | Dual Autopilot System with Control Transfer and Backup Aviation Sensors |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| TW202321851A TW202321851A (en) | 2023-06-01 |
| TWI818361B true TWI818361B (en) | 2023-10-11 |
Family
ID=87803732
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| TW110143769A TWI818361B (en) | 2021-11-24 | 2021-11-24 | Dual Autopilot System with Control Transfer and Backup Aviation Sensors |
Country Status (1)
| Country | Link |
|---|---|
| TW (1) | TWI818361B (en) |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TWI590987B (en) * | 2015-05-05 | 2017-07-11 | 經緯航太科技股份有限公司 | The control system of fail-safe device and method for unmanned aerial vehicle |
| TW201823899A (en) * | 2016-08-01 | 2018-07-01 | 高通公司 | System and method for dynamically controlling parameters for processing sensor output data for collision avoidance and path planning |
| TWI697443B (en) * | 2019-02-01 | 2020-07-01 | 中強光電股份有限公司 | Unmanned aerial vehicle and fail-safe method thereof |
| US20200218288A1 (en) * | 2017-02-24 | 2020-07-09 | Flir Detection, Inc. | Control systems for unmanned aerial vehicles |
-
2021
- 2021-11-24 TW TW110143769A patent/TWI818361B/en active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TWI590987B (en) * | 2015-05-05 | 2017-07-11 | 經緯航太科技股份有限公司 | The control system of fail-safe device and method for unmanned aerial vehicle |
| TW201823899A (en) * | 2016-08-01 | 2018-07-01 | 高通公司 | System and method for dynamically controlling parameters for processing sensor output data for collision avoidance and path planning |
| US20200218288A1 (en) * | 2017-02-24 | 2020-07-09 | Flir Detection, Inc. | Control systems for unmanned aerial vehicles |
| TWI697443B (en) * | 2019-02-01 | 2020-07-01 | 中強光電股份有限公司 | Unmanned aerial vehicle and fail-safe method thereof |
Also Published As
| Publication number | Publication date |
|---|---|
| TW202321851A (en) | 2023-06-01 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN201000576Y (en) | Flight control system for unmanned plane | |
| CN102033546B (en) | Low-altitude airship flight control system and flight control method thereof | |
| Li et al. | Design and implementation of UAV intelligent aerial photography system | |
| CN101515178B (en) | Master-slave redundant unmanned aircraft autopilot based on CAN bus | |
| CN202230330U (en) | Physical simulation experimental platform for civil fixed-wing unmanned aerial vehicle | |
| CN205229810U (en) | Many unmanned aerial vehicle low latitude monitored control system based on mobile communication network | |
| CN104615142A (en) | Flight controller for civil small UAV (Unmanned Aerial Vehicle) | |
| CN105334861A (en) | Unmanned plane flight control module, unmanned plane flight control system and unmanned plane | |
| CN203376646U (en) | Low-altitude remote sensing monitoring system based on combination of 3S technology and unmanned aerial vehicle | |
| CN105652883A (en) | Unmanned plane self-driving instrument realizing single board modularization and high reliability | |
| CN202372174U (en) | Miniaturized low-altitude airborne remote sensing system | |
| CN104331086A (en) | Flight control system of small multi-rotor for power line patrol | |
| CN104808558A (en) | Multi-task loading system applicable to special and general airplanes | |
| CN110727290A (en) | Avionics system method and architecture of light unmanned helicopter | |
| CN102183941A (en) | Civil-mobile-phone-network-based ultra-long-range unmanned aerial vehicle control system | |
| KR20110066401A (en) | Unmanned aerial vehicle navigation system design | |
| CN112148031A (en) | Intelligent management control platform system supporting unmanned aerial vehicle flight | |
| CN105974494A (en) | Radio-sondage system based on dual-redundancy fixed wing unmanned aerial vehicle | |
| CN105589467A (en) | Low-cost expansion flight attitude sensor module | |
| CN105915275B (en) | A kind of wide area cooperates with accurate remote sensing platform and its remote sensing technique | |
| CN108445822B (en) | Multi-member aircraft avionics system | |
| US12498719B2 (en) | On-board redundant controller and standby aviation sensors in-flight reconfigurable autonomous flight system | |
| CN206741310U (en) | Multiple no-manned plane communication control system | |
| CN106292713A (en) | A kind of multi-rotor aerocraft control system | |
| Rajathanakodi et al. | MAD-STORM: Maneuverable Autonomous Drone with Sensing Technologies for Observing Rainfall and Meteorology in Northern Ireland |