[go: up one dir, main page]

TWI818361B - Dual Autopilot System with Control Transfer and Backup Aviation Sensors - Google Patents

Dual Autopilot System with Control Transfer and Backup Aviation Sensors Download PDF

Info

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
Application number
TW110143769A
Other languages
Chinese (zh)
Other versions
TW202321851A (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 TW110143769A priority Critical patent/TWI818361B/en
Publication of TW202321851A publication Critical patent/TW202321851A/en
Application granted granted Critical
Publication of TWI818361B publication Critical patent/TWI818361B/en

Links

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

具控制權轉移和備用航空感測器的雙自動駕駛系統 Dual Autopilot System with Control Transfer and Backup Aviation Sensors

本發明係有關一種具控制權轉移和備用航空感測器的雙自動駕駛系統,尤指一種具備雙主、副自動駕駛系統與雙航空感測系統等硬體建置的高空長滯(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) solar drone 10 , a main automatic driving system 20 , a secondary automatic driving system 30 and a first switching unit 40 and other technical content. The flight control system 11 is provided on the solar drone 10 to control the flight of the solar drone 10 . The main autopilot system 20 is installed on the solar drone 10 and is used to control the flight control system 11 to control the flight of the solar drone 10. The main autopilot system 20 includes a signal triggering part for issuing a first trigger signal. 220. The sub-autonomous driving system 30 is installed on the solar drone 10 . The first switching unit 40 can be triggered by the first trigger signal to select the main automatic driving system 20 to take over the control of the flight control system 11 to control the flight of the solar drone 10; when the first trigger signal disappears, the switching unit selects Let the sub-autopilot system 30 take over the control of the flight control system 11 to control the flight of the solar drone 10 .

請配合參看圖1所示,該主自動駕駛系統20包括一用以產生多種第一航行狀態數據的第一航空感測系統21及一用以解讀處理第一航行狀態數據為第一航行狀態資訊的第一訊號處理器22。該副自動駕駛系統30包括一用以產生多種第二航行狀態數據的第二航空感測系統31及一用以解讀處理第二航行狀態數據為第二航行狀態資訊的第二訊號處理器32。 Please refer to FIG. 1 . The main automatic driving system 20 includes a first aviation sensing system 21 for generating a variety of first navigation status data and a first navigation status data for interpreting and processing the first navigation status data into first navigation status information. The first signal processor 22. The secondary autopilot system 30 includes a second aviation sensing system 31 for generating a variety of second navigation status data and a second signal processor 32 for interpreting and processing the second navigation status data into second navigation status information.

請配合參看圖2、3所示,該第一航空感測系統21與第二航空感測系統31各自包含一用以產生空速感測數據的空速計210,310、一用以產生氣壓高度感測數據的氣壓高度計211,311、一用以產生三軸姿態感測數據的三軸姿態儀212,312、一用以產生定位訊號的GPS定位213,313及其他重要的飛行感測器。 Please refer to Figures 2 and 3. The first aviation sensing system 21 and the second aviation sensing system 31 each include an airspeed meter 210, 310 for generating airspeed sensing data, and an airspeed meter for generating air pressure and altitude sensing data. A barometric altimeter 211,311 for measuring data, a three-axis attitude meter 212,312 for generating three-axis attitude sensing data, a GPS positioning 213,313 for generating positioning signals, and other important flight sensors.

再請配合參看圖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 aviation sensing system 12 shared by the main automatic driving system 20 and the secondary automatic driving system 30 and electrically connected together. The third aviation sensing system 12 12 includes a current consumption meter 122 for sensing the current consumption of the solar drone 10 , a solar intensity meter 121 for sensing the intensity of sunlight, and a solar power generator installed on the solar drone 10 System, flight control system 11 power consumption voltage ammeter 120 and its sensor.

請配合參看圖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 unit 40 includes a first data multiplexer 41 (Mux) and a first signal input circuit 42. The first data multiplexer 41 includes two input parts, a switching part and an output part. The first input part is connected to the first signal input circuit 42. A signal processor 22 is electrically connected to a plurality of first data output pins 221 (TX) for outputting a first control command to control the flight control system 11, and its two input parts are connected to the second signal processor 32 for outputting a flight control command. The plurality of second data output pins 320 (TX) of the second control command of the control system 11 are electrically connected, the switching part is electrically connected to the output end of the first signal input circuit 42, and the input end of the switching part is electrically connected to the first signal input circuit 42. The signal processor 22 is electrically connected to the switching selection pin S2 of the signal trigger part 220, and the output part is electrically connected to the plurality of servo channels 110 of the flight control system 11; when the switching selection pin S2 generates the first trigger signal, the output part is electrically connected through the first trigger signal. A signal input circuit 42 is input to the switching part of the first data multiplexer 41, and the first data multiplexer 41 electrically conducts the plurality of first data output pins 221 (TX) and the plurality of servo channels 110 for The first control command of the first signal processor 22 is transmitted to the plurality of servo channels 110; when the switching selection pin S2 has no first trigger signal (such as a fault; or when the machine is down), the first data multiplexer 41 uses The plurality of second data output pins 320 (TX) are electrically connected to the plurality of servo channels 110 for transmitting the second control instructions of the second signal processor 32 to the plurality of servo channels 110 .

具體的,如圖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 second signal processor 32 is electrically connected to the first resistor R1 and the third capacitor C3 electrically connected contacts.

請配合參看圖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 first signal processor 22 for outputting wireless signals. The two input parts are electrically connected to a second wireless signal output pin 321 (TX) of the second signal processor 32 for outputting wireless signals, and the switching part is electrically connected to the output end of the second signal input circuit 62. The input end of the switching part is electrically connected to the switching selection pin S1 of the first signal processor 22, and the output part is electrically connected to a data receiving end 51 of the long-distance wireless communication module 50; when the switching selection pin S1 generates the first When the second trigger signal (ie, square wave) is input to the switching part of the second data multiplexer 61 through the second signal input circuit 62, the second data multiplexer 61 connects the first wireless signal output pin 222 with The data receiving end 51 is electrically connected to enable the first signal processor 22 to conduct long-distance wireless communication with the ground station; when the switching selection pin S1 does not have a second trigger signal, the second data multiplexer 61 enables the third The two wireless signal output pins 321 are electrically connected to the data receiving end 51 to enable the second signal processor 32 to conduct long-distance wireless communication with the ground station.

具體的,請配合參看圖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 second signal processor 32 is electrically connected to the second resistor R2 and the fourth capacitor. C4 is electrically connected to the contact point.

請配合參看圖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 automatic driving system 20 is driven by A signal transmission interface 70 (such as the 12C communication interface) is information-linked to the sub-autopilot system 30. When the solar drone 10 is flying, the sub-autopilot system 30 will send a normal response through the signal transmission interface 70 at a preset fixed interval. The request command is sent to the main automatic driving system 20. When the main automatic driving system 20 receives the request command, the main automatic driving system 20 sends a normal response signal to the secondary automatic driving system 30 through the signal transmission interface 70. When the sub-autonomous driving system 30 does not receive a reply signal, it will continue to send the request command repeatedly. When the request command continues to be sent for a preset time, the sub-autonomous driving system 30 will determine that the main auto-driving system 20 is faulty, and The first trigger signal is disconnected and disappears through a switching circuit (not shown in this figure; such as a transistor or a relay), allowing the sub-autopilot system 30 to take over the control of the flight control system 11 .

本發明自動駕駛(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 first signal processor 22 master (three-core 32-bit) with strong computing power, and the second signal processor 32 slave (single core) 16-bit) is responsible for monitoring the health status of the master and reading the I2C communication interface sensor for better interface capabilities, and sharing the second set of aviation sensing systems and wind direction and speed data to the master. If any and When it is confirmed that the master has been disabled, it will take over most of the work of the autopilot, end the mission, return home and perform landing inspections. The health status of the slave is maintained by its own watchdog, and the dual chips use the I2C communication interface to communicate.

較佳的,本發明第一訊號處理器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 solar drone 10, and then output 8 PWM servo channels 110 to control the motor and wing servo. And through the (P900) long-distance wireless communication module 50, wireless transmission of data in the up and down links is performed.

較佳的,本發明第二訊號處理器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 first signal processor 22 program, the interface of the aviation sensing system is first designed to read the driver and sensor data fusion integration program, integrating the airspeed meter 210,310 (airspeed), barometric altimeter 211,311 (altimeter), and three-axis Attitude instrument 212, 312 (AHRS), GPS positioning module 213, 313 and other sensors and Micro SD flight record card 217, and add the solar intensity meter 121 (BPW34), temperature and humidity meter 218 (SHT35) required for the solar drone 10, Voltage and ammeter 120 (WCS1800), etc. However, since the driver around the TC275T is not easy to modify, there is currently no problem in using the UART interface and AD conversion, but the use of the I2C communication interface and direct memory access (DMA) is limited by the sample code. Modify to the functions required by the present invention. There are many sensors using I2C as the interface, so the present invention uses the dsPIC33EP chip series, which is more convenient for modifying I2C and DMA programs, as the slave chip of the master TC275T, which has the function of autopilot. ) redundancy signal processor function. The dsPIC33EP chip uses I2C2 to collect sensor data and process it, and then transmits it to TC275T through another I2C1 or UART interface. The invention combines the more important GPS positioning module 213,313, three-axis attitude sensor 212,31 state (AHRS), barometric altimeter 211,311 and airspeed meter 210,310, so that each of the TC275T and dsPIC33EP chips has a set, so that the aviation sensing system has redundancy planning.

如圖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 first signal processor 22 is electrically connected to an automatic broadcast surveillance module 214 (ADS-B), a payload sensing module 215 (payload), and an aircraft display light 216 (LIGHT). and flight record card 217 (MICRO SD); the second signal processor 32 is electrically connected to an ultrasonic wind speed sensor 324 (FT205) and an SBUS receiver 325. Among them, ADS-B is an aircraft surveillance technology. The aircraft determines its position through the satellite navigation system and broadcasts it regularly so that it can be tracked. FT205 is a new generation of lightweight ultrasonic wind speed sensor. SBUS receiver is In addition to the basic system that maintains operation of the receiver of the visual range manual remote control RC, the rest of the load is called the payload. In addition, payload is usually expressed in terms of weight. On an aircraft (including civil aircraft, military aircraft or unmanned aircraft), it refers to a load that can be consumed, transported or used to achieve certain specialized missions, such as a camera or a base. Taiwan etc.

從圖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 flight control system 11, and the The solar intensity meter 121 (BPW34) that measures sunlight intensity is a voltage output, directly connected to the A/D conversion input of the two chips, and does not require a switching circuit. The TX pin of the long-distance wireless communication module 50 (P900) can also be directly connected to the RX pin of the Universal Asynchronous Receiver and Transmitter Interface (UART) of the two chips. As for the receiving end 51 of the long-distance wireless communication module 50 (P900) (RX) is for wireless transmission to the ground station, so it requires a channel switching function setting, mainly using the second switching selection pin (S1) to select whether to send by the main chip or the secondary chip. The eight servo channels 110 (servo) also require channel switching function settings, and the switching selection pin S2 is selected to determine whether the main chip or the secondary chip performs flight control and navigation. As shown in Figure 5, the main program of the main chip designed in the present invention will generate a square wave signal to the switching selection pin S2 and the switching selection pin S1. The switching selection pin S1 passes through the second capacitor C2 and the second resistor R2 and then to the switching selection pin S1'; or the switching selection pin S2 passes through the first capacitor C1 and the first resistor R1 and then to the switching selection pin S2'. At this time, the switching selection pins S1' and S2' are at high potential, and the selection server is controlled by the main chip TC275T; when the main chip is disabled, this square wave will not be generated, so the switching selection line automatically changes to low potential, and the selection The server of the flight control system 11 is controlled by the secondary chip (dsPIC33EP).

本發明於主晶片失能時,係由次晶片接收控制飛機飛回地面站和降落(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 solar drone 10 will be flown back to the ground station for landing inspection. As for the maintenance of the sub-chip's own health, it relies on its own watchdog. In addition, if the secondary chip wants to forcefully take over the control of the solar drone 10, it can change S1’ and S2’ that are usually set as input pins to output pins, and force the channel to be switched to the secondary chip dsPIC33EP. Since the secondary chip usually needs to process the collected aviation sensing data, and regularly transmit the second set of GPS2 and AHRS2 to the main chip to achieve the redundancy of important aviation sensors, at the same time, the health status of the main chip also needs to be transmitted through the secondary chip. Channel monitoring. In order to increase the number of available UARTs, the present invention selects I2C1 as the dual-chip communication interface. Of course, CAN bus can also be selected, but the present invention has selected the dsPIC33EP chip without CAN bus to save costs and power consumption. The current communication architecture of this I2C is chosen as the main chip is master, the secondary chip is slave and the address is 33h. The communication protocol of this I2C is shown in Figures 6~7.

對固定翼飛機來說,能維持飛行的基本航空感測器就是重要模組,包括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 aviation sensing systems 21, 31 on both the main and secondary chips. Normally, the main chip is responsible for the flight control and navigation tasks of the aircraft. When an important module on the main chip is abnormal, the main chip will use the secondary chip to transmit data from another set of important modules to maintain normal operation. Inspection and replacement during mission execution or return home. This is the important module redundancy design of this invention. From the dual-chip communication protocol in the previous section, the secondary chip transmits four sentences a, g, p and t to the main chip at an update rate of 20Hz through I2C or UART. These four sentenccs include GPS, AHRS, airspeed and other important information to maintain aviation sensing data for basic flight. As shown in Figure 8, the hardware of the third data multiplexer 80 or the software flow chart of Figure 10 is used to select the first or second aviation sensing system 21. ,31 aerial sensing data.

再者,圖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)

一種具控制權轉移和備用航空感測器的雙自動駕駛系統,其包括:一太陽能無人機;一飛行控制系統,其設置於該太陽能無人機,用以控制該太陽能無人機飛行;一主自動駕駛系統,其設置於該太陽能無人機,用以操控該飛行控制系統來驅動該太陽能無人機的飛行,該主自動駕駛系統包含一用以發出一第一觸發訊號的訊號觸發部;一副自動駕駛系統,其設置於該太陽能無人機;及一第一切換單元,其可受該第一觸發訊號的觸發而選擇讓該主自動駕駛系統接管操控該飛行控制系統,以控制該太陽能無人機飛行;當該第一觸發訊號消失時,該切換單元則選擇讓該副自動駕駛系統接管操控該飛行控制系統,以控制該太陽能無人機飛行;其中,該主自動駕駛系統包括一用以產生多種第一航行狀態數據的第一航空感測系統及一用以解讀處理該第一航行狀態數據為第一航行狀態資訊的第一訊號處理器,該副自動駕駛系統包括一用以產生多種第二航行狀態數據的第二航空感測系統及一用以解讀處理該第二航行狀態數據為第二航行狀態資訊的第二訊號處理器。 A dual automatic driving system with control transfer and backup aviation sensors, which includes: a solar drone; a flight control system, which is installed on the solar drone to control the flight of the solar drone; a main automatic A driving system is provided on the solar drone and is used to control the flight control system to drive the flight of the solar drone. The main automatic pilot system includes a signal trigger part for sending a first trigger signal; a secondary automatic pilot system. A driving system, which is provided on the solar drone; and a first switching unit, which can be triggered by the first trigger signal and select to allow the main automatic driving system to take over control of the flight control system to control the flight of the solar drone. ; When the first trigger signal disappears, the switching unit selects to allow the secondary autopilot system to take over the control of the flight control system to control the flight of the solar drone; wherein, the main autopilot system includes a device for generating a variety of third A first aviation sensing system for navigation status data and a first signal processor for interpreting and processing the first navigation status data into first navigation status information. The secondary autopilot system includes a first navigation system for generating a variety of second navigation status information. a second aviation sensing system for status data and a second signal processor for interpreting and processing the second navigation status data into second navigation status information. 如請求項1所述之具控制權轉移和備用航空感測器的雙自動駕駛系統,其中,該第一航空感測系統與該第二航空感測系統各自包含一用以產生空速感測數據的空速計、一用以產生氣壓高度感測數據的氣壓高度計、一用以產生三軸姿態感測數據與航向的三軸姿態儀及一用以產生定位資訊與飛行速度方向的GPS定位模組。 The dual autopilot system with control transfer and backup aviation sensors as described in claim 1, wherein the first aviation sensing system and the second aviation sensing system each include an airspeed sensing system. airspeed data, a barometric altimeter used to generate pressure altitude sensing data, a three-axis attitude meter used to generate three-axis attitude sensing data and heading, and a GPS positioning used to generate positioning information and flight speed direction. Mods. 如請求項1所述之具控制權轉移和備用航空感測器的雙自動駕駛系統,其更包含一由該主自動駕駛系統及該副自動駕駛系統共用且共同電性連接的第三航空感測系統,該第三航空感測系統包含一用以感測該太陽能無人機之耗電流的耗電流計、一用以感測太陽光強度的太陽光強度計及一用以感測設於太陽能無人機的一太陽能發電系統與該飛行控制系統耗電量的電壓電流計。 The dual automatic driving system with control transfer and backup aviation sensors as described in claim 1 further includes a third aviation sensor shared by the main automatic driving system and the secondary automatic driving system and electrically connected together. The third aviation sensing system includes a current consumption meter for sensing the current consumption of the solar drone, a solar intensity meter for sensing the intensity of sunlight, and a solar intensity meter for sensing the solar power consumption of the drone. A solar power generation system of the drone and a voltage and ammeter of the power consumption of the flight control system. 如請求項1所述之具控制權轉移和備用航空感測器的雙自動駕駛系統,其中,該第一切換單元包含一第一數據多工器及一第一訊號輸入電路,該第一數據多工器包含二輸入部、一切換部及一輸出部,其一該輸入部與該第一訊號處理器用以輸出控制該飛行控制系統之第一控制指令的複數第一資料輸出腳位電性連接,其二該輸入部與該第二訊號處理器用以輸出控制該飛行控制系統之第二控制指令的複數第二資料輸出腳位電性連接,該切換部與該第一訊號輸入電路之輸出端電性連接,該切換部之輸入端與該第一訊號處理器之作為該訊號觸發部的一第一切換選擇腳電性連接,該輸出部與該飛行控制系統之複數伺服通道電性連接;當該第一切換選擇腳產生該第一觸發訊號時,則經該第一訊號輸入電路輸入至該第一數據多工器的該切換部,該第一數據多工器則使複數第一資料輸出腳位與該複數伺服通道電性導通,用以使該第一訊號處理器的該第一控制指令傳輸至該複數伺服通道;當該第一切換選擇腳無該第一觸發訊號時,該第一數據多工器則使複數第二資料輸出腳位與該複數伺服通道電性導通,用以使該第二訊號處理器的該第二控制指令傳輸至該複數伺服通道。 The dual automatic driving system with control transfer and backup aviation sensors as described in claim 1, wherein the first switching unit includes a first data multiplexer and a first signal input circuit, and the first data The multiplexer includes two input parts, a switching part and an output part. The input part and the first signal processor are used to output a plurality of first data output pins for controlling the first control command of the flight control system. The input part is electrically connected to a plurality of second data output pins of the second signal processor for outputting second control instructions for controlling the flight control system, and the switching part is electrically connected to the output of the first signal input circuit. The input end of the switching part is electrically connected to a first switching selection pin of the first signal processor as the signal triggering part, and the output part is electrically connected to a plurality of servo channels of the flight control system. ; When the first switching selection pin generates the first trigger signal, it is input to the switching part of the first data multiplexer through the first signal input circuit, and the first data multiplexer causes a plurality of first The data output pin is electrically connected to the plurality of servo channels to transmit the first control command of the first signal processor to the plurality of servo channels; when the first switching selection pin does not have the first trigger signal, The first data multiplexer electrically conducts a plurality of second data output pins and the plurality of servo channels to transmit the second control command of the second signal processor to the plurality of servo channels. 如請求項4所述之具控制權轉移和備用航空感測器的雙自動駕駛系 統,其中,該第一訊號輸入電路包含一第一電容、一第一電阻及一第三電容,該第一電容一端作為輸入端而與該切換選擇腳(S2)電性連接,該第一電容另端與該第一電阻的一端電性連接,該第一電阻另端與該第三電容一端電性連接,該第一電阻與該第三電容電性連接的接點與該切換部電性連接,該第三電容另端則接地,該第二訊號處理器之一切換選擇腳(S2')則電性連接於該第一電阻與該第三電容電性連接的該接點上。 Dual autonomous driving system with control transfer and backup aviation sensors as described in claim 4 system, wherein the first signal input circuit includes a first capacitor, a first resistor and a third capacitor, one end of the first capacitor serves as an input end and is electrically connected to the switching selection pin (S2), and the first capacitor The other end of the capacitor is electrically connected to one end of the first resistor, the other end of the first resistor is electrically connected to one end of the third capacitor, and the contact point between the first resistor and the third capacitor is electrically connected to the switching part. The other end of the third capacitor is connected to ground, and a switching selection pin (S2') of the second signal processor is electrically connected to the contact point where the first resistor and the third capacitor are electrically connected. 如請求項1所述之具控制權轉移和備用航空感測器的雙自動駕駛系統,其更包含一用以與一地面站進行長距無線通訊的長距無線通訊模組及一第二切換單元,該第二切換單元包含一第二數據多工器及一第二訊號輸入電路,該第二數據多工器包含二輸入部、一切換部及一輸出部,其一該輸入部與該第一訊號處理器用以輸出無線訊號的一第一無線訊號輸出腳位電性連接,其二該輸入部與該第二訊號處理器用以輸出無線訊號的一第二無線訊號輸出腳位電性連接,該切換部與該第二訊號輸入電路之輸出端電性連接,該切換部之輸入端與該第一訊號處理器之一第三切換選擇腳電性連接,該輸出部與該長距無線通訊模組的一資料接收端電性連接;當該第三切換選擇腳產生第二觸發訊號時,則經該第二訊號輸入電路輸入至該第二數據多工器的該切換部,該第二數據多工器則使該第一無線訊號輸出腳位與該資料接收端電性導通,用以使該第一訊號處理器與該地面站進行長距離的無線通訊;當該第三切換選擇腳無該第二觸發訊號時,該第二數據多工器則使該第二無線訊號輸出腳位與該資料接收端電性導通,用以使該第二訊號處理器與該地面站進行長距離的無線通訊。 The dual autopilot system with control transfer and backup aviation sensors as described in claim 1, which further includes a long-distance wireless communication module for long-distance wireless communication with a ground station and a second switch unit, the second switching unit includes a second data multiplexer and a second signal input circuit, the second data multiplexer includes two input parts, a switching part and an output part, one of the input part and the A first wireless signal output pin of the first signal processor for outputting wireless signals is electrically connected, and the second input part is electrically connected to a second wireless signal output pin of the second signal processor for outputting wireless signals. , the switching part is electrically connected to the output end of the second signal input circuit, the input end of the switching part is electrically connected to a third switching selection pin of the first signal processor, the output part is connected to the long-distance wireless A data receiving end of the communication module is electrically connected; when the third switching selection pin generates a second trigger signal, it is input to the switching part of the second data multiplexer through the second signal input circuit. The second data multiplexer electrically conducts the first wireless signal output pin and the data receiving end to enable long-distance wireless communication between the first signal processor and the ground station; when the third switch selects When there is no second trigger signal, the second data multiplexer makes the second wireless signal output pin electrically conductive with the data receiving end to enable the second signal processor to conduct long-term communication with the ground station. wireless communication over long distances. 如請求項6所述之具控制權轉移和備用航空感測器的雙自動駕駛系 統,其中,該第二訊號輸入電路包含一第二電容、一第二電阻及一第四電容,該第二電容一端作為輸入端而與切換選擇腳(S1)電性連接,該第二電容另端電性連接該第二電阻的一端,該第二電阻另端與該第四電容一端電性連接,該第二電阻與該第四電容電性連接的接點與該切換部電性連接,該第四電容另端則接地,該第二訊號處理器之一切換選擇腳(S1')則電性連接於該第二電阻與該第四電容電性連接的該接點上。 Dual autonomous driving system with control transfer and backup aviation sensors as described in claim 6 system, wherein the second signal input circuit includes a second capacitor, a second resistor and a fourth capacitor. One end of the second capacitor serves as an input end and is electrically connected to the switching selection pin (S1). The second capacitor The other end is electrically connected to one end of the second resistor, the other end of the second resistor is electrically connected to one end of the fourth capacitor, and the contact point of the second resistor and the fourth capacitor is electrically connected to the switching part. , the other end of the fourth capacitor is grounded, and a switching selection pin (S1') of the second signal processor is electrically connected to the contact point where the second resistor and the fourth capacitor are electrically connected. 如請求項1所述之具控制權轉移和備用航空感測器的雙自動駕駛系統,其中,該主自動駕駛系統係透過一訊號傳輸介面與該副自動駕駛系統資訊連結,於該太陽能無人機飛行時,該副自動駕駛系統會於預設之固定間隔時間透過該訊號傳輸介面發出回覆正常的要求指令給該主自動駕駛系統,當該主自動駕駛系統接收到該要求指令時,該主自動駕駛系統則透過該訊號傳輸介面發出狀況正常的回覆訊號給該副自動駕駛系統。 The dual autopilot system with control transfer and backup aviation sensors as described in claim 1, wherein the primary autopilot system is information-linked with the secondary autopilot system through a signal transmission interface, and the solar unmanned aerial vehicle is When flying, the secondary autopilot system will send a normal response command to the primary autopilot system through the signal transmission interface at a preset fixed interval. When the primary autopilot system receives the request command, the primary autopilot system will The driving system sends a normal response signal to the sub-autonomous driving system through the signal transmission interface. 如請求項8所述之具控制權轉移和備用航空感測器的雙自動駕駛系統,其中,當該副自動駕駛系統未收到該回覆訊號時,則持續重覆發出該要求指令,當該要求指令持續發出時間達到一預設時間時,該副自動駕駛系統則判斷該主自動駕駛系統故障,並透過一切換電路使該第一觸發訊號斷開,以讓該副自動駕駛系統接管操控該飛行控制系統。 The dual automatic pilot system with control transfer and backup aviation sensors as described in claim 8, wherein when the secondary automatic pilot system does not receive the reply signal, it continues to repeatedly issue the request command. When the required instruction continues to be issued for a preset time, the secondary automatic driving system determines that the main automatic driving system is faulty, and disconnects the first trigger signal through a switching circuit to allow the secondary automatic driving system to take over control of the main automatic driving system. flight control system.
TW110143769A 2021-11-24 2021-11-24 Dual Autopilot System with Control Transfer and Backup Aviation Sensors TWI818361B (en)

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)

* Cited by examiner, † Cited by third party
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

Patent Citations (4)

* Cited by examiner, † Cited by third party
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