TWI891159B - Control system and control method for flight vehicle - Google Patents
Control system and control method for flight vehicleInfo
- Publication number
- TWI891159B TWI891159B TW112148014A TW112148014A TWI891159B TW I891159 B TWI891159 B TW I891159B TW 112148014 A TW112148014 A TW 112148014A TW 112148014 A TW112148014 A TW 112148014A TW I891159 B TWI891159 B TW I891159B
- Authority
- TW
- Taiwan
- Prior art keywords
- control unit
- signal
- control
- sub
- unit
- Prior art date
Links
Landscapes
- Safety Devices In Control Systems (AREA)
Abstract
Description
本揭示關於一種載具的控制機制,特別有關於一種飛行器的控制系統與控制方法。 This disclosure relates to a vehicle control mechanism, and more particularly to an aircraft control system and control method.
為了維持載具的穩定航行,載具的控制平台中可設置兩個以上的控制單元彼此支援。當其中一個控制單元發生異常時,可無縫接軌地切換控制權至另一個控制單元,以確保載具在任何時間點都能在至少一個控制單元的掌控中,不至於發生控制中斷。 To maintain stable navigation, the vehicle's control platform can be equipped with two or more control units to support each other. If one control unit malfunctions, control can be seamlessly transferred to another unit, ensuring that the vehicle is always under the control of at least one control unit, preventing control interruptions.
對於航行於地面的車輛載具、或航行於水上的船舶載具而言,尚可容許稍微的控制中斷。但對於航行於空中的飛行器而言,些微的控制中斷都可能導致飛行器失速墜落。飛行器通常設置兩個以上的控制單元彼此支援。然而,兩個控制單元彼此可能發生過度的控制回饋,造成過度飛行校正而導致飛行器失速。 For vehicles on the ground or ships on the water, a slight interruption in control is acceptable. However, for aircraft in the air, even the slightest interruption in control can cause the aircraft to stall and crash. Aircraft typically have two or more control units supporting each other. However, excessive feedback from the two control units can cause excessive flight corrections and lead to a stall.
因此,需要一種改良的控制機制,使得飛行器的兩個控制單元能夠彼此監控協調,以確保兩個控制單元無縫接軌的切換。 Therefore, an improved control mechanism is needed to enable the two control units of an aircraft to monitor and coordinate with each other to ensure seamless switching between the two control units.
根據本揭示之一方面,提供一種控制系統,用於控 制一飛行器。控制系統包括以下元件。第一緩衝器,耦接於飛行器的馬達單元。第二緩衝器,耦接於馬達單元。主控制單元,用於產生第一制動訊號,第一制動訊號經由第一緩衝器選擇性地提供至馬達單元。副控制單元,用於產生第二制動訊號,第二制動訊號經由第二緩衝器選擇性地提供至馬達單元。邏輯判斷單元,用於產生切換控制訊號以控制該第一緩衝器與該第二緩衝器為開啟或關閉。主控制單元與副控制單元相互監控是否為正常運作,當主控單元為異常運作時,因應於切換控制訊號第二制動訊號提供至馬達單元。 According to one aspect of the present disclosure, a control system for controlling an aircraft is provided. The control system includes the following components: a first buffer coupled to a motor unit of the aircraft; a second buffer coupled to the motor unit; a primary control unit for generating a first braking signal, which is selectively provided to the motor unit via the first buffer; a secondary control unit for generating a second braking signal, which is selectively provided to the motor unit via the second buffer; and a logic determination unit for generating a switching control signal to control the first and second buffers to be on or off. The main control unit and sub-control unit monitor each other for normal operation. If the main control unit is operating abnormally, the secondary braking signal is provided to the motor unit in response to the switching control signal.
根據本揭示之另一方面,提供一種控制方法,用於控制飛行器。控制方法包括以下步驟。藉由主控制單元產生第一制動訊號。藉由第一緩衝器將第制動訊號選擇性地提供至馬達單元。藉由副控制單元產生第二制動訊號。藉由第二緩衝器將第二制動訊號選擇性地提供至馬達單元。藉由邏輯判斷單元產生切換控制訊號以控制該第一緩衝器與該第二緩衝器為開啟或關閉。主控制單元與副控制單元相互監控是否為正常運作,當主控單元為異常運作時,因應於切換控制訊號第二制動訊號提供至馬達單元。 According to another aspect of the present disclosure, a control method for controlling an aircraft is provided. The control method includes the following steps: a main control unit generates a first braking signal. A first buffer selectively provides the first braking signal to a motor unit. A sub-control unit generates a second braking signal. A second buffer selectively provides the second braking signal to the motor unit. A logic determination unit generates a switching control signal to control the first and second buffers to be on or off. The main control unit and the sub-control unit monitor each other for normal operation. When the main control unit is operating abnormally, the second braking signal is provided to the motor unit in response to the switching control signal.
透過閱讀以下圖式、詳細說明以及申請專利範圍,可見本揭示之其它方面以及優點。 Other aspects and advantages of the present disclosure will be apparent from a review of the following drawings, detailed description, and claims.
1000:控制系統 1000: Control System
2000:飛行器平台 2000: Aircraft Platform
100a,200a:飛行管理單元 100a, 200a: Flight Management Unit
100:主控制單元 100: Main control unit
200:副控制單元 200: Sub-control unit
150:第一緩衝器 150: First buffer
250:第二緩衝器 250: Second buffer
300:中繼元件 300: Relay component
310,320:反向器 310,320: Inverter
400:邏輯判斷單元 400:Logical judgment unit
410:互斥或邏輯閘 410: Mutual exclusion or logical blocking
420:反向器 420: Reverse
500:周邊元件 500: Peripheral components
510:馬達單元 510: Motor unit
520:制動器 520: Brake
530:攝影器 530: Camera
540:感測器 540:Sensor
600:輸入/輸出開關匯流排 600: Input/output switch bus
Tx1,Tx2:發射電路 Tx1, Tx2: Transmitter circuit
Rx1,Rx2:發射電路 Rx1, Rx2: Transmitter circuit
MA_RECV:第一監控訊號 MA_RECV: First monitoring signal
SL_RECV:第二監控訊號 SL_RECV: Second monitoring signal
MA_CTRL:第一控制訊號 MA_CTRL: First control signal
SL_CTRL:第二控制訊號 SL_CTRL: Second control signal
MA_SL_SWH:切換控制訊號 MA_SL_SWH: Switching control signal
MA_ACT:第一制動訊號 MA_ACT: First braking signal
SL_ACT:第二制動訊號 SL_ACT: Second braking signal
S300~S310:步驟 S300~S310: Steps
S600~S616:步驟 S600~S616: Steps
第1圖為本揭示一實施例的飛行器平台2000的方塊圖。 Figure 1 is a block diagram of an aircraft platform 2000 according to an embodiment of the present disclosure.
第2圖為第1圖的控制系統1000的詳細功能方塊圖。 Figure 2 is a detailed functional block diagram of the control system 1000 in Figure 1.
第3圖為副控制單元200對於第一監控訊號MA_RECV進行監控以判斷主控制單元100是否正常運作的流程圖。 Figure 3 is a flow chart showing how the sub-control unit 200 monitors the first monitoring signal MA_RECV to determine whether the main control unit 100 is operating normally.
第4圖為第2圖之邏輯判斷單元400的電路圖。 Figure 4 is a circuit diagram of the logic judgment unit 400 in Figure 2.
第5圖為副控制單元200確認第一監控訊號MA_RECV的電位變化之另一實施例的示意圖。 Figure 5 is a schematic diagram of another embodiment of the sub-control unit 200 confirming the potential change of the first monitoring signal MA_RECV.
第6圖為控制系統1000對於馬達單元510進行控制之流程圖。 Figure 6 is a flow chart showing how the control system 1000 controls the motor unit 510.
本說明書的技術用語係參照本技術領域之習慣用語,如本說明書對部分用語有加以說明或定義,該部分用語之解釋係以本說明書之說明或定義為準。本揭示之各個實施例分別具有一或多個技術特徵。在可能實施的前提下,本技術領域具有通常知識者可選擇性地實施任一實施例中部分或全部的技術特徵,或者選擇性地將這些實施例中部分或全部的技術特徵加以組合。 The technical terms used in this specification are based on customary terminology in the art. If this specification provides explanations or definitions for certain terms, the interpretation of such terms shall be subject to the explanations or definitions in this specification. Each embodiment disclosed herein has one or more technical features. Where feasible, a person skilled in the art may selectively implement some or all of the technical features of any embodiment, or selectively combine some or all of the technical features of these embodiments.
第1圖為本揭示一實施例的飛行器平台2000的方塊圖。如第1圖所示,飛行器平台2000包括控制系統1000與周邊元件500。飛行器平台2000設置於飛行器,用於控制飛行器的飛行功能以及周邊功能。飛行器例如是各種型式的無人機(Unmanned Aerial Vehicle,UAV),包括軍用或民用之各種尺寸的無人機。控制系統1000包括兩個飛行管理單元(Flight Management Unit,FMU)100a與200a。飛行管理單元100a與200a彼此支援以控制飛行器的飛行功能。此外,飛行管理單元100a與飛行管理單元200a也能夠輔助控制飛行器的周邊功能(例如攝影、裝卸貨物、武器控制,等等)。 Figure 1 is a block diagram of an aircraft platform 2000 according to an embodiment of the present disclosure. As shown in Figure 1, aircraft platform 2000 includes a control system 1000 and peripheral components 500. Aircraft platform 2000 is mounted on an aircraft and is used to control the aircraft's flight and peripheral functions. For example, the aircraft may be an unmanned aerial vehicle (UAV) of various types, including military or civilian drones of various sizes. Control system 1000 includes two flight management units (FMUs) 100a and 200a. FMUs 100a and 200a support each other in controlling the aircraft's flight functions. In addition, the flight management unit 100a and the flight management unit 200a can also assist in controlling the aircraft's peripheral functions (such as photography, cargo loading and unloading, weapon control, etc.).
控制系統1000更包括輸入/輸出開關匯流排(I/O switch bus)600,飛行管理單元100a與200a經由輸入/輸出開關匯流排600控制飛行器的周邊元件500。周邊元件500例如包括馬達單元510、制動器(actuator)520、攝影器530與感測器540。其中,馬達單元510是伺服馬達模組,用於提供飛行器的動力以執行飛行功能。制動器520用於調整飛行器的飛行姿態以及馬達單元510的動力輸出。此外,飛行器平台2000更可包括遙控(remote control)模組及電源(power)模組(第1圖中未顯示)。 Control system 1000 further includes an input/output switch bus (I/O switch bus) 600. Flight management units 100a and 200a control aircraft peripheral components 500 via I/O switch bus 600. Peripheral components 500 include, for example, a motor unit 510, an actuator 520, a camera 530, and a sensor 540. Motor unit 510 is a servo motor module used to provide power to the aircraft for flight. Actuator 520 is used to adjust the aircraft's flight attitude and the power output of motor unit 510. Furthermore, aircraft platform 2000 may include a remote control module and a power supply module (not shown in FIG. 1).
第2圖為第1圖的控制系統1000的詳細功能方塊圖。第2圖的控制系統1000包括主控制(master)單元100、副控制(slave)單元200、中繼元件300、反向器310與320、邏輯判斷單元400、第一緩衝器150與第二緩衝器250。控制系統1000用於控制馬達單元510(第2圖省略繪示第1圖的輸入/輸出開關匯流排600)。第2圖的主控制單元100與副控制單元200分別是第1圖的控制系統1000的兩個飛行管理單元100a與200a。 Figure 2 is a detailed functional block diagram of the control system 1000 in Figure 1. The control system 1000 in Figure 2 includes a master control unit 100, a slave control unit 200, a relay element 300, inverters 310 and 320, a logic determination unit 400, a first buffer 150, and a second buffer 250. The control system 1000 is used to control the motor unit 510 (the input/output switch bus 600 in Figure 1 is omitted in Figure 2). The master control unit 100 and slave control unit 200 in Figure 2 are the two flight management units 100a and 200a of the control system 1000 in Figure 1, respectively.
主控制單元100與副控制單元200兩者皆可以是微控制單元(micro control unit,MCU),例如是32位元的ARM架構(Advanced RISC Machine)的處理器。或者,主控制單元100 與副控制單元200皆可以是中央處理器(central processing unit,CPU)或場可程式邏輯閘陣列(field programmable gate array,FPGA)。在運作上,主控制單元100與副控制單元200彼此進行資料交換,藉以彼此監控對方是否正常運作。 Both the main control unit 100 and the sub-control unit 200 can be microcontrollers (MCUs), such as 32-bit ARM (Advanced RISC Machine) processors. Alternatively, both the main control unit 100 and the sub-control unit 200 can be central processing units (CPUs) or field programmable gate arrays (FPGAs). In operation, the main control unit 100 and the sub-control unit 200 exchange data to monitor each other's normal operation.
更具體而言,主控制單元100設置了發射電路Tx1與接收電路Rx1,對應地,副控制單元200設置了發射電路Tx2與接收電路Rx2。主控制單元100經由發射電路Tx1傳送第一監控訊號MA_RECV至副控制單元200,副控制單元200經由接收電路Rx2接收第一監控訊號MA_RECV。在本實施例中,第一監控訊號MA_RECV例如是週期性的高低電位切換之訊號,其例如是時脈(clock)訊號。當第一監控訊號MA_RECV例如是時脈訊號時,第一監控訊號MA_RECV具有第一週期P1,第一週期P1例如相等於2ms。從另一觀點說明之,第一監控訊號MA_RECV是依據第一期間T1進行高低電位切換。第一監控訊號MA_RECV每間隔第一期間T1由高電位切換至低電位、或由低電位切換至高電位。第一期間T1是第一週期P1的二分之一(即,第一期間T1例如相等於1ms)。 More specifically, the main control unit 100 is provided with a transmitting circuit Tx1 and a receiving circuit Rx1. Correspondingly, the sub-control unit 200 is provided with a transmitting circuit Tx2 and a receiving circuit Rx2. The main control unit 100 transmits a first monitoring signal MA_RECV to the sub-control unit 200 via the transmitting circuit Tx1. The sub-control unit 200 receives the first monitoring signal MA_RECV via the receiving circuit Rx2. In this embodiment, the first monitoring signal MA_RECV is, for example, a signal that periodically switches between high and low levels, such as a clock signal. When the first monitoring signal MA_RECV is a clock signal, it has a first period P1, which is, for example, equal to 2 ms. From another perspective, the first monitoring signal MA_RECV switches between high and low levels according to the first period T1. The first monitoring signal MA_RECV switches from high to low, or from low to high, every first period T1. The first period T1 is half of the first cycle P1 (i.e., the first period T1 is, for example, equal to 1 ms).
副控制單元200對於第一監控訊號MA_RECV進行監控,並依據第一監控訊號MA_RECV判斷主控制單元100是否正常運作。第3圖為副控制單元200對於第一監控訊號MA_RECV進行監控以判斷主控制單元100是否正常運作的流程圖。請同時參見第2圖與第3圖,首先,在步驟S300中,主控制單元100傳送第 一監控訊號MA_RECV至副控制單元200,第一監控訊號MA_RECV依據第一期間T1進行高低電位切換,副控制單元200接收第一監控訊號MA_RECV。 The sub-control unit 200 monitors the first monitoring signal MA_RECV and determines whether the main control unit 100 is operating normally based on the first monitoring signal MA_RECV. Figure 3 is a flow chart illustrating how the sub-control unit 200 monitors the first monitoring signal MA_RECV to determine whether the main control unit 100 is operating normally. Referring to Figures 2 and 3, first, in step S300, the main control unit 100 transmits the first monitoring signal MA_RECV to the sub-control unit 200. The first monitoring signal MA_RECV switches between high and low levels according to a first period T1, and the sub-control unit 200 receives the first monitoring signal MA_RECV.
接著,在步驟S302中,副控制單元200依據第二週期P2對於第一監控訊號MA_RECV進行監控,以確認第一監控訊號MA_RECV的電位是否發生變化。在本實施例中,第二週期P2是小於第一週期P1。例如,第二週期P2是相等於1us。副控制單元200每間隔第二週期P2對於第一監控訊號MA_RECV進行一次確認,以確認第一監控訊號MA_RECV的電位是否由高電位變化至低電位、或由低電位變化至高電位。 Next, in step S302, the sub-control unit 200 monitors the first monitoring signal MA_RECV during the second period P2 to determine whether the level of the first monitoring signal MA_RECV changes. In this embodiment, the second period P2 is shorter than the first period P1. For example, the second period P2 is equal to 1 μs. The sub-control unit 200 checks the first monitoring signal MA_RECV every second period P2 to determine whether the level of the first monitoring signal MA_RECV changes from a high level to a low level, or vice versa.
若步驟S302的確認結果為「是」(即,在第二週期P2確認到第一監控訊號MA_RECV的電位發生變化),則可判斷主控制單元100為正常運作,且接著執行步驟S304:副控制單元200將第二控制訊號SL_CTRL設定為邏輯低電位「L」以表示邏輯值「0」,並且副控制單元200經由發射電路Tx2傳送第二控制訊號SL_CTRL至主控制單元100與與邏輯判斷單元400。並且,重新執行步驟S300:主控制單元100持續傳送第一監控訊號MA_RECV至副控制單元200,第一監控訊號MA_RECV依據第一期間T1進行高低電位切換。 If the confirmation result of step S302 is "yes" (i.e., the potential change of the first monitoring signal MA_RECV is confirmed in the second period P2), it can be determined that the main control unit 100 is operating normally, and then step S304 is executed: the sub-control unit 200 sets the second control signal SL_CTRL to a logical low potential "L" to represent a logical value "0", and the sub-control unit 200 transmits the second control signal SL_CTRL to the main control unit 100 and the logic judgment unit 400 via the transmitting circuit Tx2. Furthermore, step S300 is executed again: the main control unit 100 continues to transmit the first monitoring signal MA_RECV to the sub-control unit 200, and the first monitoring signal MA_RECV switches between high and low levels according to the first period T1.
另一方面,若步驟S302的確認結果為「否」(即,在第二週期P2未確認到第一監控訊號MA_RECV的電位發生變化),則接著執行步驟S306:判斷經過第二期間T2之後第一監控 訊號MA_RECV的電位是否無變化。第二期間T2略大於第一期間T1,第二期間T2例如是是1.2ms。 On the other hand, if the result of step S302 is "No" (i.e., no change in the level of the first monitoring signal MA_RECV is detected during the second period P2), step S306 is then executed to determine whether the level of the first monitoring signal MA_RECV remains unchanged after the second period T2. The second period T2 is slightly longer than the first period T1, and is, for example, 1.2 ms.
若步驟S306的確認結果為「是」(即,超過第二期間T2第一監控訊號MA_RECV的電位仍然未發生變化),則在步驟S308判斷主控制單元100為異常運作,且接著執行步驟S310:副控制單元200將第二控制訊號SL_CTRL設定為邏輯高電位「H」以表示邏輯值「1」,並且副控制單元200經由發射電路Tx2傳送第二控制訊號SL_CTRL至主控制單元100與邏輯判斷單元400。 If the result of step S306 is "yes" (i.e., the level of the first monitoring signal MA_RECV remains unchanged for more than the second period T2), then step S308 determines that the main control unit 100 is operating abnormally. Step S310 then proceeds: the sub-control unit 200 sets the second control signal SL_CTRL to a logically high level "H" to indicate a logical value of "1." The sub-control unit 200 then transmits the second control signal SL_CTRL to the main control unit 100 and the logic determination unit 400 via the transmit circuit Tx2.
第二控制訊號SL_CTRL是直接傳送至邏輯判斷單元400(未經由中繼元件300與反向器310),邏輯判斷單元400依據第二控制訊號SL_CTRL將飛行器的主控權由主控制單元100切換至副控制單元200。 The second control signal SL_CTRL is transmitted directly to the logic determination unit 400 (without passing through the relay element 300 and the inverter 310). Based on the second control signal SL_CTRL, the logic determination unit 400 switches control of the aircraft from the main control unit 100 to the sub-control unit 200.
請再次參見第2圖,副控制單元200經由發射電路Tx2傳送第二監控訊號SL_RECV至主控制單元100在本實施例中,第二監控訊號SL_RECV是類似於第一監控訊號MA_RECV,第二監控訊號SL_RECV也是週期性的高低電位切換之時脈訊號。第二監控訊號SL_RECV的週期亦相等於第一週期P1(即,2ms)。第二監控訊號SL_RECV每間隔第一期間T1由高電位切換至低電位、或由低電位切換至高電位。 Referring again to Figure 2, the sub-control unit 200 transmits the second monitoring signal SL_RECV to the main control unit 100 via the transmitting circuit Tx2. In this embodiment, the second monitoring signal SL_RECV is similar to the first monitoring signal MA_RECV. The second monitoring signal SL_RECV is also a periodic high-low switching clock signal. The period of the second monitoring signal SL_RECV is also equal to the first period P1 (i.e., 2ms). The second monitoring signal SL_RECV switches from high to low, or from low to high, every first period T1.
主控制單元100經由接收電路Rx1接收第二監控訊號SL_RECV。主控制單元100對於第二監控訊號SL_RECV進行監控,並依據第二監控訊號SL_RECV判斷副控制單元200是否正 常運作。基於副控制單元200判斷主控制單元100是否正常運作的相同方式,主控制單元100也是依據第二週期P2對應的監控頻率對於第二監控訊號SL_RECV進行監控,以確認第二監控訊號SL_RECV的電位是否發生變化。 The main control unit 100 receives the second monitoring signal SL_RECV via the receiving circuit Rx1. The main control unit 100 monitors the second monitoring signal SL_RECV and determines whether the sub-control unit 200 is operating normally based on the second monitoring signal SL_RECV. Similar to how the sub-control unit 200 determines whether the main control unit 100 is operating normally, the main control unit 100 also monitors the second monitoring signal SL_RECV at the monitoring frequency corresponding to the second cycle P2 to confirm whether the second monitoring signal SL_RECV changes in level.
若依據第二週期P2的監控頻率確認到第二監控訊號SL_RECV的電位發生變化(未超過第二期間T2即發生電位變化),則可判斷副控制單元200為正常運作,主控制單元100將第一控制訊號MA_CTRL設定為邏輯低電位「L」以表示邏輯值「0」。第一控制訊號MA_CTRL直接傳送至副控制單元200,並且第一控制訊號MA_CTRL經由中繼元件300與反向器310傳送至邏輯判斷單元400。中繼元件300例如是中繼微處理單元(relay MCU)。反向器310可將第一控制訊號MA_CTRL的電位進行反向,並且具有緩衝器(buffer)的功能以延遲第一控制訊號MA_CTRL。 If the second monitoring signal SL_RECV changes in level (within the second period T2) based on the monitoring frequency during the second period P2, the sub-control unit 200 is determined to be operating normally. The main control unit 100 sets the first control signal MA_CTRL to a logically low level "L," indicating a logical value of "0." The first control signal MA_CTRL is transmitted directly to the sub-control unit 200 and then to the logic determination unit 400 via the relay element 300 and inverter 310. The relay element 300 is, for example, a relay microprocessor unit (MCU). The inverter 310 can invert the voltage level of the first control signal MA_CTRL and also functions as a buffer to delay the first control signal MA_CTRL.
另一方面,若超過第二期間T2第二監控訊號SL_RECV的電位仍未發生變化,則判斷副控制單元200為異常運作,此時,主控制單元100將第一控制訊號MA_CTRL設定為邏輯低電位「H」以表示邏輯值「1」。 On the other hand, if the level of the second monitoring signal SL_RECV does not change after the second period T2, the sub-control unit 200 is determined to be operating abnormally. At this time, the main control unit 100 sets the first control signal MA_CTRL to a logical low level "H" to represent a logical value "1".
第4圖為第2圖的邏輯判斷單元400的電路圖,請同時參見第2圖與第4圖以說明邏輯判斷單元400的運作。邏輯判斷單元400包括互斥或(XOR)邏輯閘410與反向器420。第二控制訊號SL_CTRL直接傳送至邏輯判斷單元400,並且第一控制訊號MA_CTRL經由中繼元件300與反向器310傳送至邏輯判斷單元 400。 Figure 4 is a circuit diagram of the logic decision unit 400 in Figure 2. Please refer to both Figures 2 and 4 for an explanation of the operation of the logic decision unit 400. The logic decision unit 400 includes an exclusive OR (XOR) logic gate 410 and an inverter 420. The second control signal SL_CTRL is transmitted directly to the logic decision unit 400, and the first control signal MA_CTRL is transmitted to the logic decision unit 400 via the relay element 300 and the inverter 310.
互斥或邏輯閘410的兩個輸入端分別接收第二控制訊號SL_CTRL與延遲並反向後的第一控制訊號MA_CTRL。互斥或邏輯閘410的輸出端產生切換控制訊號MA_SL_SWH。互斥或邏輯閘410的輸出端進行反向,且經由反向器420再次反向。當副控制單元200確認第一監控訊號MA_RECV有發生變化而判斷主控制單元100為正常運作,則第二控制訊號SL_CTRL為邏輯值「0」。並且,主控制單元100也確認第二監控訊號SL_RECV有發生變化而判斷副控制單元200為正常運作,則第一控制訊號MA_CTRL為邏輯值「0」。此時,邏輯判斷單元400之互斥或邏輯閘410接收邏輯值「0」的第二控制訊號SL_CTRL以及邏輯值「0」的第一控制訊號MA_CTRL,因此,互斥或邏輯閘410輸出的切換控制訊號MA_SL_SWH為邏輯值「0」。邏輯值「0」的切換控制訊號MA_SL_SWH由邏輯判斷單元400輸出至第一緩衝器150與第二緩衝器250。 The two inputs of the exclusive OR logic gate 410 receive the second control signal SL_CTRL and the delayed and inverted first control signal MA_CTRL, respectively. The output of the exclusive OR logic gate 410 generates the switching control signal MA_SL_SWH. The output of the exclusive OR logic gate 410 is inverted and then inverted again by the inverter 420. When the slave control unit 200 detects a change in the first monitoring signal MA_RECV and determines that the master control unit 100 is operating normally, the second control signal SL_CTRL assumes a logical value of "0." Furthermore, the main control unit 100 confirms that the second monitoring signal SL_RECV has changed and determines that the sub-control unit 200 is operating normally. Therefore, the first control signal MA_CTRL has a logical value of "0." At this time, the exclusive OR logic gate 410 of the logic determination unit 400 receives the second control signal SL_CTRL with a logical value of "0" and the first control signal MA_CTRL with a logical value of "0." Therefore, the switching control signal MA_SL_SWH output by the exclusive OR logic gate 410 has a logical value of "0." The switching control signal MA_SL_SWH with a logical value of "0" is output by the logic determination unit 400 to the first buffer 150 and the second buffer 250.
第一緩衝器150是關聯於主控制單元100,第二緩衝器250是關聯於副控制單元200。第一緩衝器150接收切換控制訊號MA_SL_SWH以及主控制單元100產生的第一制動訊號MA_ACT。第二緩衝器250接收副控制單元200產生的第二制動訊號SL_ACT,並且切換控制訊號MA_SL_SWH經由反向器320傳送至第二緩衝器250。切換控制訊號MA_SL_SWH作為第一緩衝器150與第二緩衝器250的開關控制訊號。當切換控制訊號 MA_SL_SWH為邏輯值「0」時,第一緩衝器150為開啟,第一制動訊號MA_ACT可經由第一緩衝器150提供至馬達單元510。另一方面,切換控制訊號MA_SL_SWH經由反向器320作用後形成邏輯值「1」的訊號而輸入至第二緩衝器250,使得第二緩衝器250為關閉,因此第二制動訊號SL_ACT無法經由第二緩衝器250提供至馬達單元510。此時,馬達單元510只接收來自主控制單元100的第一制動訊號MA_ACT,即,僅以主控制單元100來控制馬達單元510。 The first buffer 150 is associated with the main control unit 100, and the second buffer 250 is associated with the slave control unit 200. The first buffer 150 receives the switching control signal MA_SL_SWH and the first braking signal MA_ACT generated by the main control unit 100. The second buffer 250 receives the second braking signal SL_ACT generated by the slave control unit 200 and transmits the switching control signal MA_SL_SWH to the second buffer 250 via the inverter 320. The switching control signal MA_SL_SWH serves as the switching control signal for the first buffer 150 and the second buffer 250. When the switching control signal MA_SL_SWH is at a logical value of "0," the first buffer 150 is open, allowing the first braking signal MA_ACT to be provided to the motor unit 510 via the first buffer 150. On the other hand, the switching control signal MA_SL_SWH, after being acted upon by the inverter 320, becomes a logical value of "1" and is input to the second buffer 250, causing the second buffer 250 to be closed. Therefore, the second braking signal SL_ACT cannot be provided to the motor unit 510 via the second buffer 250. At this point, the motor unit 510 receives only the first braking signal MA_ACT from the main control unit 100. In other words, the main control unit 100 alone controls the motor unit 510.
另一方面,若超過第二期間T2第一監控訊號MA_RECV的電位仍然未發生變化,則判斷主控制單元100為異常運作,副控制單元200將第二控制訊號SL_CTRL設定為邏輯值「1」。此時,邏輯判斷單元400之互斥或邏輯閘410接收邏輯值「1」的第二控制訊號SL_CTRL以及邏輯值「0」的第一控制訊號MA_CTRL,因此,互斥或邏輯閘410輸出的切換控制訊號MA_SL_SWH為邏輯值「1」。當切換控制訊號MA_SL_SWH為邏輯值「1」時,第一緩衝器150為關閉,第一制動訊號MA_ACT無法經由第一緩衝器150提供至馬達單元510。另一方面,切換控制訊號MA_SL_SWH經由反向器320作用後形成邏輯值「0」的訊號而輸入至第二緩衝器250,使得第二緩衝器250為開啟,因此第二制動訊號SL_ACT可經由第二緩衝器250提供至馬達單元510。此時,馬達單元510只接收來自副控制單元200的第二制動訊號SL_ACT,即,僅以副控制單元200來控制馬達單元510。 On the other hand, if the level of the first monitoring signal MA_RECV remains unchanged for more than the second period T2, the main control unit 100 is determined to be operating abnormally, and the sub-control unit 200 sets the second control signal SL_CTRL to a logical value of "1." At this time, the exclusive OR logic gate 410 of the logic determination unit 400 receives the second control signal SL_CTRL with a logical value of "1" and the first control signal MA_CTRL with a logical value of "0." Therefore, the switching control signal MA_SL_SWH output by the exclusive OR logic gate 410 is a logical value of "1." When the switching control signal MA_SL_SWH is a logical value of "1," the first buffer 150 is closed, and the first braking signal MA_ACT cannot be provided to the motor unit 510 via the first buffer 150. On the other hand, the switching control signal MA_SL_SWH is converted to a logical value of "0" by the inverter 320 and input to the second buffer 250, turning the second buffer 250 on. Therefore, the second braking signal SL_ACT can be provided to the motor unit 510 via the second buffer 250. At this time, the motor unit 510 only receives the second braking signal SL_ACT from the sub-control unit 200. In other words, the sub-control unit 200 alone controls the motor unit 510.
根據上述實施方式,當主控制單元100為正常運作時,切換控制訊號MA_SL_SWH為邏輯值「0」,主控制單元100的第一制動訊號MA_ACT可經由第一緩衝器150提供至馬達單元510,副控制單元200的第二制動訊號SL_ACT不提供至馬達單元510。反之,當主控制單元100為異常運作時,切換控制訊號MA_SL_SWH為邏輯值「1」,副控制單元200的第二制動訊號SL_ACT可經由第二緩衝器250提供至馬達單元510,主控制單元100的第一制動訊號MA_ACT不提供至馬達單元510。因此,馬達單元510同一時間僅接收主控制單元100與副控制單元200其中一者的控制,而不會造成主控制單元100與副控制單元200的控制權混淆或過度控制而影響飛行器的飛行狀態。 According to the above embodiment, when the main control unit 100 is operating normally, the switching control signal MA_SL_SWH has a logical value of "0," the first braking signal MA_ACT of the main control unit 100 can be provided to the motor unit 510 via the first buffer 150, and the second braking signal SL_ACT of the slave control unit 200 is not provided to the motor unit 510. Conversely, when the main control unit 100 is operating abnormally, the switching control signal MA_SL_SWH has a logical value of "1," the second braking signal SL_ACT of the slave control unit 200 can be provided to the motor unit 510 via the second buffer 250, and the first braking signal MA_ACT of the main control unit 100 is not provided to the motor unit 510. Therefore, the motor unit 510 only receives control from either the main control unit 100 or the sub-control unit 200 at a time, preventing confusion or excessive control between the main control unit 100 and the sub-control unit 200, which could affect the aircraft's flight status.
接著,請參見第5圖,其為副控制單元200確認第一監控訊號MA_RECV的電位變化之另一實施例的示意圖。在本實施例中,副控制單元200比較第一監控訊號MA_RECV的邏輯值「1」(即,高電位)之數量及邏輯值「0」(即,低電位)之數量,以確認主控制單元100是否正常運作。例如,以第一監控訊號MA_RECV的第一期間T1(即,1ms)為一個時間單位,取五個時間單位為一個監控區間R1。在監控區間R1副控制單元200監控到第一監控訊號MA_RECV的邏輯值為「01010」,其包括三個邏輯值「0」與兩個邏輯值「1」。邏輯值「0」與「1」之數量相差一個,則判斷主控制單元100為正常運作。 Next, please refer to Figure 5, which is a schematic diagram of another embodiment of the sub-control unit 200 confirming the potential changes of the first monitoring signal MA_RECV. In this embodiment, the sub-control unit 200 compares the number of logical values "1" (i.e., high potential) and the number of logical values "0" (i.e., low potential) of the first monitoring signal MA_RECV to confirm whether the main control unit 100 is operating normally. For example, the first period T1 (i.e., 1ms) of the first monitoring signal MA_RECV is taken as one time unit, and five time units are taken as one monitoring interval R1. During monitoring interval R1, the slave control unit 200 detects that the logical value of the first monitoring signal MA_RECV is "01010," which consists of three logical values "0" and two logical values "1." If the number of logical values "0" and "1" differs by one, the master control unit 100 is determined to be operating normally.
而後,將監控區間R1移動一個時間單位而成為監控 區間R2。在監控區間R2副控制單元200監控到第一監控訊號MA_RECV的邏輯值為「10101」,其包括三個邏輯值「1」與兩個邏輯值「0」。邏輯值「0」與「1」之數量相差一個,仍然判斷主控制單元100為正常運作。依此類推,將監控區間R2移動一個時間單位而成為監控區間R3。在監控區間R3副控制單元200監控到第一監控訊號MA_RECV的邏輯值為「01010」,其包括三個邏輯值「0」與兩個邏輯值「1」。邏輯值「0」與「1」之數量相差一個,仍然判斷主控制單元100為正常運作。 Next, monitoring interval R1 is shifted by one time unit to become monitoring interval R2. During monitoring interval R2, the slave control unit 200 detects that the logical value of the first monitoring signal MA_RECV is "10101," which consists of three logical "1" values and two logical "0" values. The difference between the number of logical "0" and "1" values is only one, but the master control unit 100 is still judged to be operating normally. Similarly, monitoring interval R2 is shifted by one time unit to become monitoring interval R3. During monitoring interval R3, the slave control unit 200 detects that the logical value of the first monitoring signal MA_RECV is "01010," which consists of three logical "0" values and two logical "1" values. Although the number of logical "0" and "1" values differs by one, the master control unit 100 is still judged to be operating normally.
而後,在監控區間R(n-1)監控到第一監控訊號MA_RECV的邏輯值為「01011」,其包括三個邏輯值「1」與兩個邏輯值「0」。邏輯值「0」與「1」之數量相差一個,仍然判斷主控制單元100為正常運作。而後,在監控區間R(n)監控到第一監控訊號MA_RECV的邏輯值為「10111」,其包括四個邏輯值「1」與一個邏輯值「0」。邏輯值「0」與「1」之數量相差三個,判斷主控制單元100為異常運作。監控區間R(n)監控到的邏輯值為「10111」的最後兩個連續的邏輯值「11」表示第一監控訊號MA_RECV的電位確實沒有發生變化,主控制單元100確實為異常運作,而排除第一監控訊號MA_RECV之頻率或採樣時間的因素之誤判斷。 Then, during monitoring interval R(n-1), the first monitoring signal MA_RECV is detected to have a logical value of "01011," consisting of three logical "1" values and two logical "0" values. The number of logical "0" and "1" values differs by one, and the master control unit 100 is still judged to be operating normally. Then, during monitoring interval R(n), the first monitoring signal MA_RECV is detected to have a logical value of "10111," consisting of four logical "1" values and one logical "0." The number of logical "0" and "1" values differs by three, and the master control unit 100 is judged to be operating abnormally. The last two consecutive logical values of "11" in the monitoring interval R(n) of "10111" indicate that the potential of the first monitoring signal MA_RECV has not changed. The main control unit 100 is indeed operating abnormally, eliminating any misjudgment due to factors such as the frequency or sampling time of the first monitoring signal MA_RECV.
如上所述,藉由比較第一監控訊號MA_RECV的邏輯值「1」及邏輯值「0」之數量的機制,可正確地判斷主控制單元100是否異常運作,能排除頻率或採樣時間的因素之誤判斷。若 設定的監控區間是五倍的第一期間T1,則判斷比較結果的閥值可設定為「三」。當邏輯值「0」與「1」之數量之差值大於或等於閥值「三」時,副控制單元200判斷主控制單元100為異常運作。類似的,當主控制單元100對於第二監控訊號SL_RECV的電位變化進行確認時,亦可使用上述機制。 As described above, by comparing the number of logical values "1" and "0" of the first monitoring signal MA_RECV, it is possible to accurately determine whether the main control unit 100 is operating abnormally, eliminating misjudgments due to factors such as frequency or sampling time. If the monitoring interval is set to five times the first period T1, the threshold for determining the comparison result can be set to "3." When the difference between the number of logical values "0" and "1" is greater than or equal to the threshold value "3," the sub-control unit 200 determines that the main control unit 100 is operating abnormally. Similarly, the above mechanism can also be used when the main control unit 100 confirms changes in the potential of the second monitoring signal SL_RECV.
接著,請參見第6圖,其為控制系統1000對於馬達單元510進行控制之流程圖。首先,在步驟S600,啟動兩個飛行控制單元100a與200a(即,啟動主控制單元100與副控制單元200)。接著,在步驟S602,主控制單元100監控副控制單元200產生的第二監控訊號SL_RECV,且副控制單元200也監控主控制單元100產生的第一監控訊號MA_RECV。 Next, please refer to Figure 6, which is a flow chart illustrating the control system 1000 controlling the motor unit 510. First, in step S600, the two flight control units 100a and 200a are activated (i.e., the main control unit 100 and the sub-control unit 200 are activated). Next, in step S602, the main control unit 100 monitors the second monitoring signal SL_RECV generated by the sub-control unit 200, and the sub-control unit 200 also monitors the first monitoring signal MA_RECV generated by the main control unit 100.
接著,在步驟S604,主控制單元100確認第二監控訊號SL_RECV的電位是否發生變化,且副控制單元200確認第一監控訊號MA_RECV的電位是否發生變化。若確認結果為「是」,則回到步驟S602。若確認結果為「否」,判斷主控制單元100或副控制單元200為異常運作,則執行步驟S606,藉由邏輯判斷單元400進行主控制單元100與副控制單元200的控制權之切換。 Next, in step S604, the main control unit 100 checks whether the level of the second monitoring signal SL_RECV has changed, and the sub-control unit 200 checks whether the level of the first monitoring signal MA_RECV has changed. If the confirmation result is "yes," the process returns to step S602. If the confirmation result is "no," it is determined that either the main control unit 100 or the sub-control unit 200 is operating abnormally, and step S606 is executed, where the logic judgment unit 400 switches control between the main control unit 100 and the sub-control unit 200.
接著,在步驟S608,主控制單元100或副控制單元200判斷其控制權之切換是否已經啟動。接著,在步驟S610,確認控制權之切換是否正確。若確認結果為「否」,則執行步驟S612:藉由中繼元件300強制切換控制權。 Next, in step S608, the master control unit 100 or slave control unit 200 determines whether the control authority switch has been activated. Next, in step S610, it confirms whether the control authority switch is correct. If the confirmation result is "no," step S612 is executed: the control authority switch is forced through the relay device 300.
若步驟S610的確認結果為「是」,則執行步驟S614:因應於邏輯判斷單元400的切換控制訊號MA_SL_SWH而開啟或關閉第一緩衝器150或第二緩衝器250。接著,在步驟S616,經由第一緩衝器150傳送第一制動訊號MA_ACT至馬達單元510,或者經由第二緩衝器250傳送第二制動訊號SL_ACT至馬達單元510。 If the result of step S610 is "yes," step S614 is executed: the first buffer 150 or the second buffer 250 is turned on or off in response to the switching control signal MA_SL_SWH from the logic judgment unit 400. Next, in step S616, the first braking signal MA_ACT is transmitted to the motor unit 510 via the first buffer 150, or the second braking signal SL_ACT is transmitted to the motor unit 510 via the second buffer 250.
雖然本揭示已以較佳實施例及範例詳細揭示如上,可理解的是,此些範例意指說明而非限制之意義。可預期的是,所屬技術領域中具有通常知識者可想到多種修改及組合,其多種修改及組合落在本揭示之精神以及後附之申請專利範圍之範圍內。 Although the present disclosure has been described in detail above with reference to preferred embodiments and examples, it should be understood that these examples are intended to be illustrative rather than restrictive. It is anticipated that those skilled in the art will be able to devise numerous modifications and combinations that fall within the spirit of the present disclosure and the scope of the appended patent applications.
1000:控制系統 2000:飛行器平台 100a,200a:飛行管理單元 500:周邊元件 510:馬達單元 520:制動器 530:攝影器 540:感測器 600:輸入/輸出開關匯流排 1000: Control System 2000: Aircraft Platform 100a, 200a: Flight Management Unit 500: Peripheral Components 510: Motor Unit 520: Brakes 530: Camera 540: Sensors 600: Input/Output Switch Bus
Claims (20)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| TW112148014A TWI891159B (en) | 2023-12-11 | 2023-12-11 | Control system and control method for flight vehicle |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| TW112148014A TWI891159B (en) | 2023-12-11 | 2023-12-11 | Control system and control method for flight vehicle |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| TW202523575A TW202523575A (en) | 2025-06-16 |
| TWI891159B true TWI891159B (en) | 2025-07-21 |
Family
ID=97224029
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| TW112148014A TWI891159B (en) | 2023-12-11 | 2023-12-11 | Control system and control method for flight vehicle |
Country Status (1)
| Country | Link |
|---|---|
| TW (1) | TWI891159B (en) |
Citations (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5809220A (en) * | 1995-07-20 | 1998-09-15 | Raytheon Company | Fault tolerant distributed control system |
| WO2015157883A1 (en) * | 2014-04-17 | 2015-10-22 | SZ DJI Technology Co., Ltd. | Flight control for flight-restricted regions |
| CN105334863A (en) * | 2015-11-23 | 2016-02-17 | 杨珊珊 | Multi-control end unmanned aerial vehicle as well as consoles and control switching method thereof |
| CN107848623A (en) * | 2015-05-29 | 2018-03-27 | 维里蒂工作室股份公司 | Aircraft |
| CN111386217A (en) * | 2019-03-08 | 2020-07-07 | 深圳市大疆创新科技有限公司 | Techniques for switching between manual and autonomous control of a movable object |
| CN112173078A (en) * | 2019-07-04 | 2021-01-05 | 通用电气捷克航空有限责任公司 | Propeller assembly and pitch control unit |
| WO2021212325A1 (en) * | 2020-04-21 | 2021-10-28 | 深圳市大疆创新科技有限公司 | Dual-flight control switching method, flight control system, and unmanned aerial vehicle |
| CN114384922A (en) * | 2020-10-19 | 2022-04-22 | 严凡非 | Unmanned aerial vehicle flight control redundancy technology |
| US20220227483A1 (en) * | 2019-06-24 | 2022-07-21 | Windracers Limited | Method of controlling an aircraft |
| US20220271854A1 (en) * | 2021-02-22 | 2022-08-25 | Hitachi, Ltd. | Redundant control system |
| EP3514644B1 (en) * | 2018-01-19 | 2022-11-09 | GE Aviation Systems LLC | Autopilot control system for unmanned air vehicles |
| US20230149762A1 (en) * | 2021-11-15 | 2023-05-18 | Arena Innovation Corp. | Redundant control circuit for an exercise device |
-
2023
- 2023-12-11 TW TW112148014A patent/TWI891159B/en active
Patent Citations (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5809220A (en) * | 1995-07-20 | 1998-09-15 | Raytheon Company | Fault tolerant distributed control system |
| WO2015157883A1 (en) * | 2014-04-17 | 2015-10-22 | SZ DJI Technology Co., Ltd. | Flight control for flight-restricted regions |
| CN107848623A (en) * | 2015-05-29 | 2018-03-27 | 维里蒂工作室股份公司 | Aircraft |
| CN105334863A (en) * | 2015-11-23 | 2016-02-17 | 杨珊珊 | Multi-control end unmanned aerial vehicle as well as consoles and control switching method thereof |
| EP3514644B1 (en) * | 2018-01-19 | 2022-11-09 | GE Aviation Systems LLC | Autopilot control system for unmanned air vehicles |
| CN111386217A (en) * | 2019-03-08 | 2020-07-07 | 深圳市大疆创新科技有限公司 | Techniques for switching between manual and autonomous control of a movable object |
| US20220227483A1 (en) * | 2019-06-24 | 2022-07-21 | Windracers Limited | Method of controlling an aircraft |
| CN112173078A (en) * | 2019-07-04 | 2021-01-05 | 通用电气捷克航空有限责任公司 | Propeller assembly and pitch control unit |
| WO2021212325A1 (en) * | 2020-04-21 | 2021-10-28 | 深圳市大疆创新科技有限公司 | Dual-flight control switching method, flight control system, and unmanned aerial vehicle |
| CN114384922A (en) * | 2020-10-19 | 2022-04-22 | 严凡非 | Unmanned aerial vehicle flight control redundancy technology |
| US20220271854A1 (en) * | 2021-02-22 | 2022-08-25 | Hitachi, Ltd. | Redundant control system |
| US20230149762A1 (en) * | 2021-11-15 | 2023-05-18 | Arena Innovation Corp. | Redundant control circuit for an exercise device |
Also Published As
| Publication number | Publication date |
|---|---|
| TW202523575A (en) | 2025-06-16 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110678375B (en) | Vehicle control device and vehicle control system | |
| CN109991841B (en) | Flight control computing system and control signal output method, device and storage medium | |
| US11136044B2 (en) | Vehicle control device | |
| US11524693B2 (en) | Vehicle control system | |
| WO2018179191A1 (en) | Control device and control system | |
| US20130067287A1 (en) | Electronic control device | |
| US11066080B2 (en) | Vehicle control device and electronic control system | |
| CN110770707A (en) | Apparatus and method for driving a vehicle module | |
| US20180167528A1 (en) | Electronic appliance | |
| TWI891159B (en) | Control system and control method for flight vehicle | |
| US11630713B2 (en) | Vehicle control device and vehicle control method | |
| KR20200110956A (en) | Redundancy system of vehicle and, apparatus and method for supplying power thereof | |
| JP7399313B2 (en) | vehicle control system | |
| EP1359057B1 (en) | Vehicle data transmission system with link redundancy | |
| US20250189993A1 (en) | Control system and control method for flight vehicle | |
| US12091107B2 (en) | Motor control device and method | |
| CN116834763A (en) | An intelligent driving communication method, intelligent driving controller and intelligent driving system | |
| US8908782B2 (en) | Method and apparatus for checking asynchronous transmission of control signals | |
| JP4755868B2 (en) | Switching control system and control unit applied thereto | |
| CN119773809B (en) | Vehicle automatic driving redundant system, control method and vehicle | |
| US20240308648A1 (en) | Fly-by-wire flight control system with back-up control in an inceptor | |
| KR20250159436A (en) | Apparatus and method for controlling vehicle | |
| CN121180234A (en) | Automated driving control systems and vehicles | |
| KR20240130497A (en) | Switch control device and battery pack including the same | |
| JP3063435B2 (en) | Instantaneous interruption redundant switching method |