TWI809614B - UAV control method and system and remote controller for remote control of UAV - Google Patents
UAV control method and system and remote controller for remote control of UAV Download PDFInfo
- Publication number
- TWI809614B TWI809614B TW110147999A TW110147999A TWI809614B TW I809614 B TWI809614 B TW I809614B TW 110147999 A TW110147999 A TW 110147999A TW 110147999 A TW110147999 A TW 110147999A TW I809614 B TWI809614 B TW I809614B
- Authority
- TW
- Taiwan
- Prior art keywords
- uav
- joystick
- control
- drone
- teaching
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0423—Input/output
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/25—Pc structure of the system
- G05B2219/25257—Microcontroller
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Selective Calling Equipment (AREA)
- Train Traffic Observation, Control, And Security (AREA)
Abstract
本發明提供無人機控制方法和系統以及用於遙控無人機的遙控器。無人機控制方法包括:使用遙控器控制示教無人機飛行,並將示教無人機在飛行過程中有關航行的資料即時地進行採集並回饋到無人機控制裝置;無人機控制裝置對接收的資料進行處理並保存;以及無人機控制裝置根據所保存的資料向至少一個無人機發送控制指令以控制至少一個無人機的飛行。 The invention provides a UAV control method and system and a remote controller for remote control of the UAV. The UAV control method includes: using the remote control to control the flight of the teaching UAV, and collecting the relevant navigation data of the teaching UAV during the flight process and feeding it back to the UAV control device; processing and storing; and the UAV control device sends a control command to at least one UAV according to the saved data to control the flight of at least one UAV.
Description
本發明涉及無人機技術領域,尤其涉及無人機控制方法和系統以及用於遙控無人機的遙控器。 The invention relates to the technical field of drones, in particular to a control method and system for drones and a remote controller for remote control of drones.
隨著無人機技術的發展,無人機的使用範圍也更加廣泛。無人機燒寫也逐漸成為青少年燒寫的重要一環。當前無人機燒寫的方式有燒寫語言式燒寫和圖形化式燒寫這兩種方式。燒寫語言式燒寫需要有扎實的數學知識、對各種工程控制理論有深刻的理解和很強的三維空間的運動思維,而且實現無人機的動作和航線需要的時間很長。圖形化式燒寫是一種簡單的拖拽式燒寫方式,但只能控制無人機做一些簡單的動作和航線,而對於複雜的場景控制,圖形化燒寫很難實現或需要很長的時間才能實現。 With the development of drone technology, the scope of use of drones is also wider. Drone programming has gradually become an important part of youth programming. Currently, there are two ways of programming UAVs: programming language programming and graphical programming. Programming Language-style programming requires solid mathematical knowledge, a deep understanding of various engineering control theories, and a strong three-dimensional space movement thinking, and it takes a long time to realize the actions and routes of the drone. Graphical programming is a simple drag-and-drop programming method, but it can only control the drone to do some simple actions and routes. For complex scene control, graphical programming is difficult or takes a long time in order to achieve.
根據本發明的一方面,提供了一種無人機控制方法,包括:使用遙控器控制示教無人機飛行,並將示教無人機在飛行過程中有關航行的資料即時地進行採集並回饋到無人機控制裝置;無人機控制裝置對接收的資料進行處理並保存;以及無人機控制裝置根據所保存的資料向至少一個無人機發送控制指令以控制至少一個無人機的飛行。 According to one aspect of the present invention, a method for controlling a drone is provided, including: using a remote controller to control the flight of the teaching drone, and collecting and feeding back to the drone in real time the information about the navigation of the teaching drone during the flight The control device; the UAV control device processes and saves the received data; and the UAV control device sends control instructions to at least one UAV to control the flight of at least one UAV according to the saved data.
根據本發明的另一方面,提供一種無人機控制系統,包括:遙控器;和無人機控制裝置,其中,遙控器被配置為控制示教無人機飛行,並將示教無人機在飛行過程中有關航行的資料即時地進行採集並回饋到無人機控制裝置;並且無人機控制裝置被配置為對接收的資料進行處理並保存,並且根據所保存的資料向至少一個無人機發送控制指令以控制所述至少一個無人機的飛行。 According to another aspect of the present invention, a drone control system is provided, including: a remote controller; and a drone control device, wherein the remote controller is configured to control the flight of the teaching drone, and will teach the drone to fly during the flight. The data related to navigation are collected in real time and fed back to the UAV control device; and the UAV control device is configured to process and save the received data, and send control instructions to at least one UAV according to the saved data to control the UAV. Describe the flight of at least one drone.
根據本發明的又一方面,提供一種用於遙控無人機的遙控器,包括:搖桿;和處理器,其中處理器被配置為將遙控器的搖桿變化量轉化成對於無人機輸出的目標空間向量,以便無人機根據目標空間向量來進行位置控制。 According to yet another aspect of the present invention, there is provided a remote controller for remote control of a drone, including: a rocker; and a processor, wherein the processor is configured to convert the amount of change of the rocker of the remote controller into an output target for the drone Space vector, so that the UAV can perform position control according to the target space vector.
根據本發明實施例的無人機控制方法和系統以及用於遙控無人機的遙控器,通過遙控器控制示教無人機飛行,使採集的有關航行的資料回饋到無人機控制裝置,無人機控制裝置對資料進行處理並保存,然後可以根據這些資料對至少一個無人機進行燒寫控制,實現重複重播無人機的飛行航線。通過無人機控制裝置對資料進行處理和優化,使得控制無人機的位移增量擺脫從遙控器向無人機控制裝置之間的無線傳輸信號干擾而造成的無人機偏離航線的影響,因此可以應用到更加複雜的場景控制中。此外,根據本發明實施例的無人機控制方法和系統和遙控器,對無人機的燒寫方式簡單,可以快速實現無人機燒寫控制。 According to the UAV control method and system of the embodiment of the present invention and the remote controller used to remotely control the UAV, the remote controller controls the flight of the teaching UAV, so that the collected navigational data is fed back to the UAV control device, and the UAV control device The data is processed and saved, and then at least one drone can be programmed and controlled according to the data, so as to realize the repeated replay of the flight route of the drone. The data is processed and optimized by the drone control device, so that the displacement increment of the control drone can get rid of the influence of the drone's deviation from the route caused by the interference of the wireless transmission signal from the remote controller to the drone control device, so it can be applied to In more complex scene control. In addition, according to the drone control method and system and the remote controller of the embodiments of the present invention, the programming method for the drone is simple, and the programming control of the drone can be quickly realized.
100:無人機控制方法 100: UAV control method
103,400:處理 103,400: processing
S1031:無人機控制裝置為多個無人機分別設置對應的標識符 S1031: The drone control device sets corresponding identifiers for multiple drones respectively
S1032:無人機控制裝置向多個無人機發送控制指令和對應的標識符以控制多個無人機的飛行 S1032: The drone control device sends control instructions and corresponding identifiers to multiple drones to control the flight of multiple drones
500:無人機控制系統 500: UAV control system
501:遙控器 501: remote control
502:無人機控制裝置 502: UAV control device
600:計算裝置 600: computing device
601:處理器 601: Processor
602:記憶體 602: memory
603:大容量存儲裝置 603: mass storage device
604:輸入/輸出(I/O)裝置 604: Input/Output (I/O) device
605:通信介面 605: communication interface
606:系統匯流排 606: System bus bar
607:搖桿 607: Joystick
H:飛行高度 H: flying height
S101,S102,S103:步驟 S101, S102, S103: steps
S401:判斷所接收到的標識符是否是該無人機的標識符 S401: Determine whether the received identifier is the identifier of the drone
S402:在所接收到的標識符是該無人機的標識符的情況下,根據所接收的控制指令調整該無人機的飛行 S402: In the case that the received identifier is the identifier of the drone, adjust the flight of the drone according to the received control instruction
S403:在所接收到的標識符不是該無人機的標識符的情況下,維持該無人機的當前的飛行 S403: In the case that the received identifier is not the identifier of the drone, maintain the current flight of the drone
T:時間 T: time
通過參考圖式會更加清楚地理解本發明的特徵和優點,圖式是示意性的而不應理解為對本發明進行任何限制,在圖式中: The features and advantages of the present invention will be more clearly understood by reference to the drawings, which are schematic and should not be construed as limiting the invention in any way, in which:
圖1示出根據本發明實施例的一種無人機控制方法的流程圖; Fig. 1 shows the flow chart of a kind of unmanned aerial vehicle control method according to the embodiment of the present invention;
圖2示出無人機的示教飛行與複現飛行的部分高度路徑的對比示意圖; Fig. 2 shows the comparative schematic diagram of the partial height path of the teaching flight and the recurring flight of the unmanned aerial vehicle;
圖3示出了根據本發明實施例的無人機控制裝置向多個無人機發送控制指令的處理的流程圖; Fig. 3 shows the flow chart of the process of sending a control command to a plurality of drones by a drone control device according to an embodiment of the present invention;
圖4示出多個無人機在接收到無人控制裝置發送的控制指令後的處理的流程圖; Fig. 4 shows the flowchart of the processing of multiple unmanned aerial vehicles after receiving the control instruction sent by the unmanned control device;
圖5示出根據本發明實施例的一種無人機控制系統的框圖;以及 Fig. 5 shows the block diagram of a kind of unmanned aerial vehicle control system according to the embodiment of the present invention; And
圖6示出根據本發明實施例可以實現無人機控制裝置的計算裝置的框圖。 FIG. 6 shows a block diagram of a computing device that can implement a drone control device according to an embodiment of the present invention.
根據本發明實施例,提供了一種示教式無人機控制方法和系統以及用於遙控無人機的遙控器,其對無人機的燒寫控制簡單,易於實施,而且也可以應用於複雜的控制場景中。下面將參考圖式來詳細描述根據本發明實施例的無人機控制方法和系統以及用於遙控無人機的遙控器。 According to the embodiments of the present invention, a teaching-type drone control method and system and a remote controller for remote control of drones are provided. The programming control of the drone is simple, easy to implement, and can also be applied to complex control scenarios middle. A method and system for controlling a drone and a remote controller for controlling a drone according to embodiments of the present invention will be described in detail below with reference to the drawings.
下面將詳細描述本發明各個方面的特徵和示例性實施例。下面的描述涵蓋了許多具體細節,以便提供對本發明的全面理解。但是,對於本領域技術人員來說顯而易見的是,本發明可以在不需要這些具體細節中的一些細節 的情況下實施。下面對實施例的描述僅僅是為了通過示出本發明的示例來提供對本發明的技術方案的更清楚的理解。本發明絕不限於下面所提出的任何具體配置,而是在不脫離本發明的精神的前提下覆蓋了相關特徵、結構、操作等的任何修改、替換和改進。 Features and exemplary embodiments of various aspects of the invention will be described in detail below. The following description covers numerous specific details in order to provide a thorough understanding of the present invention. It will be apparent, however, to one skilled in the art that the present invention may be implemented without some of these specific details. implemented under the circumstances. The following description of the embodiments is only to provide a clearer understanding of the technical solutions of the present invention by illustrating examples of the present invention. The present invention is by no means limited to any specific configuration set forth below, but covers any modifications, substitutions and improvements of related features, structures, operations, etc. without departing from the spirit of the present invention.
圖1示出根據本發明實施例的一種無人機控制方法的流程圖。如圖1所示,根據本發明實施例的一種無人機控制方法100包括步驟S101-S103。
Fig. 1 shows a flow chart of a UAV control method according to an embodiment of the present invention. As shown in FIG. 1 , a
在步驟S101處,使用遙控器控制示教無人機飛行,並將示教無人機在飛行過程中有關航行的資料即時地進行採集並回饋到無人機控制裝置。 At step S101, the remote control is used to control the flight of the teaching UAV, and the relevant navigation data during the flight of the teaching UAV are collected in real time and fed back to the UAV control device.
在一些實施例中,使用遙控器控制示教無人機飛行包括:將遙控器的遙桿的變化量轉換為對於無人機輸出的目標空間向量;以及無人機接收目標空間向量以進行位置控制。 In some embodiments, using the remote controller to control the flight of the teaching UAV includes: converting the variation of the joystick of the remote controller into a target space vector output by the UAV; and the UAV receives the target space vector for position control.
傳統無人機遙控控制方式是將遙控器的搖桿變化量變成控制無人機的速度增量。根據本發明實施的無人機控制方法,將遙控器的搖桿變化量轉化成無人機在三維空間(X、Y、Z)的目標空間向量(包括X、Y方向上的位置和Y方向上的高度)。也就是說,遙控器的控制對無人機輸出的是目標空間向量。 The traditional UAV remote control method is to change the change of the joystick of the remote control into the speed increment of controlling the UAV. According to the UAV control method implemented in the present invention, the amount of change of the rocking stick of the remote controller is converted into the target space vector (comprising the position on the X, Y direction and the position on the Y direction) of the UAV in three-dimensional space (X, Y, Z). high). That is to say, the output of the remote control to the UAV is the target space vector.
具體地,示教無人機的目標空間向量被確定為示教無人機的當前位置加上通過遙桿的測量值轉化而得到的增量位移,其中,該增量位移根據遙桿的測量值、遙桿的遙桿值規範化到飛行速率的係數以及鬆放搖桿時示教無人機刹車的補償值而確定。 Specifically, the target space vector of the teaching UAV is determined as the current position of the teaching UAV plus the incremental displacement obtained by converting the measured value of the remote stick, wherein the incremental displacement is based on the measured value of the remote stick, The joystick value of the joystick is normalized to the coefficient of the flight speed and the compensation value of the taught drone brake when the joystick is released.
更具體地,搖桿變化量根據如下公式(1)被轉換為無人機的目標空間向量: More specifically, the change amount of the joystick is converted into the target space vector of the UAV according to the following formula (1):
其中,P x 、P y 、P z 為無人機在X、Y方向中的目標位置和在Z方向的目標高度,P x0、P y0、P z0為無人機在X、Y方向中的當前位置和在Z方向的當前高度,R x 、R y 、R z 為搖桿在X、Y、Z方向中的測量值,λ為將遙桿的搖桿 值規範化到飛行速率的係數,dt為搖桿有輸出的時間,並且、為鬆搖桿時無人機刹車的漸變補償值。 Among them, P x , P y , P z are the target position of the UAV in the X and Y directions and the target height in the Z direction, P x 0 , P y 0 , P z 0 are the UAVs in the X and Y directions The current position of and the current altitude in the Z direction, R x , R y , R z are the measured values of the joystick in the X, Y, and Z directions, λ is the coefficient that normalizes the joystick value to the flight speed, dt is the time when the joystick has output, and , It is the gradual compensation value of drone braking when the stick is released.
根據上述公式(1),通過對遙桿測量值進行規範化處理和積分,轉化為對於無人機當前位置的位移增量,來確定無人機的目標空間向量。通過對無人機刹車的進行刹車補償,使無人機刹車時軌跡更平滑,位置更精準。 According to the above formula (1), the target space vector of the UAV is determined by normalizing and integrating the measurement value of the remote rod, and converting it into the displacement increment of the current position of the UAV. By performing brake compensation on the drone's brakes, the trajectory of the drone is smoother and the position is more accurate when braking.
在一些實施例中,鬆放搖桿時示教無人機刹車的補償值通過以下方式來確定:通過在鬆放遙桿時遙桿的測量值小於用於區分遙桿是否搖動的閾值的情況下,對示教無人機飛行過程時間積分得到的刹車距離進行刹車時間內微分並漸變累加。 In some embodiments, the compensation value for teaching the UAV to brake when the joystick is released is determined in the following manner: when the measured value of the joystick is less than the threshold value used to distinguish whether the joystick is shaking when the joystick is released , the braking distance obtained by time integration during the flight process of the teaching UAV is differentiated within the braking time and gradually accumulated.
具體地,鬆放搖桿時示教無人機刹車的補償值可通過以下公式(2)確定: Specifically, when the joystick is released, the compensation value for teaching the UAV brake can be determined by the following formula (2):
其中,A為區分搖桿是否搖動的閾值,B為限制刹車距離,C為限制刹車時間,T為刹車時間,|ʃ(kR x )dt|為在X方向的刹車距離,|ʃ(kR y )dt|為在Y方向的刹車距離。 Among them, A is the threshold for distinguishing whether the joystick is shaking, B is the limit braking distance, C is the limit braking time, T is the braking time, |ʃ( kR x ) dt | is the braking distance in the X direction, |ʃ( kR y ) dt | is the braking distance in the Y direction.
從以上公式(2)可以看出,、僅在鬆搖桿|R x |<A和|R y |<A時,對飛行過程時間dt積分得到的刹車距離進行刹車時間T內微分,並漸變累加,使刹車平滑過渡,減少無人機由於飛行速度過快導致過沖現象,也保證目標空間向量的實現。 From the above formula (2), it can be seen that, , Only when the rocker is loose | R x |< A and | R y |< A , the braking distance obtained by integrating the flight time dt is differentiated within the braking time T, and gradually accumulated to make the braking smooth transition and reduce the UAV due to Too fast flight speed leads to overshoot phenomenon, which also ensures the realization of the target space vector.
在一些實施例中,示教無人機根據目標空間向量來進行位置控制包括:將目標空間向量與示教無人機的實際空間向量作差並利用串級函數進行控制運算,以得到示教無人機的目標姿態和目標垂直速率。 In some embodiments, the position control of the teaching drone according to the target space vector includes: making a difference between the target space vector and the actual space vector of the teaching drone and using a cascade function to perform control operations to obtain the teaching drone The target attitude and target vertical velocity of .
具體地,無人機按照以下公式(3)來進行位置控制: Specifically, the UAV performs position control according to the following formula (3):
其中,T x_angle 、T y_angle 、T z_height 分別為無人機目標姿態和目標垂直速率輸出,P x 、P y 、P z 分別為無人機在X、Y方向中的目標位置和在Y方向中的目標高度,P x_real 、P y_real 、P z_real 分別為無人機在X、Y方向中的實際位置和高度,PID u PID ()為串級運算函數。 Among them, T x_angle , Ty_angle , T z_height are the UAV target attitude and target vertical rate output respectively, P x , P y , P z are the target position of the UAV in the X and Y directions and the target in the Y direction respectively Height, P x_real , P y_real , P z_real are the actual position and height of the UAV in the X and Y directions respectively, and PID u PID () is a cascade operation function.
通過上述方法,可以使得無人機在懸停切換到飛行移動狀態或者在飛行狀態切換到懸停狀態時提高切換動作的平滑性。在移動情況下,可準確實現飛行移動過程中的各種動作和速度,對後續自主航線規劃及動作控制提供較高精度的位移及過程的流暢性。 Through the above method, the smoothness of the switching action can be improved when the drone is switched from hovering to flying moving state or from flying state to hovering state. In the case of movement, it can accurately realize various actions and speeds in the flight movement process, and provide high-precision displacement and process fluency for subsequent autonomous route planning and action control.
在步驟S102處,無人機控制裝置對接收的資料進行處理並保存。 At step S102, the UAV control device processes and saves the received data.
在一些實施例中,遙控器和無人控制裝置之間採用無線傳輸來傳輸資料。基於無線傳輸的特性,無人控制裝置的接收率(收包率)會隨環境的信號干擾和傳輸的距離呈現非線性變化,即信號干擾越低和傳輸距離越近,接收率(收包率)越高,信號干擾越高和傳輸距離越遠,接收率(收包率)越低。無人控制裝置接收的資料會受此特性的影響,直觀體現為接收率(收包率)越低,複現的航線完整性就越差,即無法完成控制無人機按照既定的線路路徑和動作進行飛行。 In some embodiments, wireless transmission is used to transmit data between the remote controller and the unmanned control device. Based on the characteristics of wireless transmission, the receiving rate (receiving rate) of unmanned control devices will show nonlinear changes with the signal interference of the environment and the transmission distance, that is, the lower the signal interference and the closer the transmission distance, the higher the receiving rate (receiving rate) The higher the value, the higher the signal interference and the farther the transmission distance, the lower the receiving rate (receiving rate). The data received by the unmanned control device will be affected by this characteristic. It is intuitively reflected that the lower the reception rate (packet collection rate), the worse the integrity of the reproduced route, that is, it is impossible to control the UAV to follow the established route path and action. flight.
結合此特性,在一些實施例中,無人機控制裝置對接收的資料進行處理包括:從所接收到的資料剔除不完整資料和變化超過預期的資料並進行資料補償;或者通過所接收到的資料中的心跳包判斷是否有丟失的資料,並且在有丟失的資料的情況下進行補償。 In combination with this feature, in some embodiments, the processing of the received data by the UAV control device includes: removing incomplete data and data with changes exceeding expectations from the received data and performing data compensation; or using the received data The heartbeat packet in judges whether there is missing data, and compensates if there is missing data.
在一些實施例中,無人機控制裝置僅對所接收的資料中的無人機的空間位置和控制動作進行保存。資料的完整性可以通過空間位置的變化來確定。 In some embodiments, the UAV control device only saves the spatial position and control actions of the UAV in the received data. Data integrity can be determined by changes in spatial location.
通過上述方法進行補償後,無人控制裝置在接收率(收包率)只有82%左右的情況下,實際飛行的航線和示教複現的飛行航線位移基本一致。圖2示出無人機的示教(實際)飛行與複現飛行的部分高度路徑的對比示意圖。在圖2中,橫坐標表示時間T,縱坐標表示飛行高度H,實際飛行與複現飛行曲線如圖中箭頭所示。從圖2中可以清楚地得知,時間偏差在約3%之內,也就是說,根據本發明實施例的方法能夠獲得對無人機飛行的良好複現性。 After compensation by the above method, when the reception rate (packet collection rate) of the unmanned control device is only about 82%, the displacement of the actual flight route is basically the same as that of the teaching and reproduction flight route. Fig. 2 shows a schematic diagram of the comparison of part of the altitude path between the teaching (actual) flight and the recurring flight of the drone. In Fig. 2, the abscissa represents the time T, and the ordinate represents the flight height H, and the actual flight and recurring flight curves are shown by the arrows in the figure. It can be clearly seen from FIG. 2 that the time deviation is within about 3%, that is to say, the method according to the embodiment of the present invention can obtain good reproducibility of flying the UAV.
在本發明的實施例中,有關航行的資料可以包括示教無人機的空間向量和姿態動作。無人機控制裝置可以對所保存的資料中的空間向量進行調整,以便調整飛行航線。 In an embodiment of the present invention, the information related to navigation may include teaching the space vector and attitude actions of the UAV. The UAV control device can adjust the space vector in the saved data, so as to adjust the flight route.
經上述方式可以將無人機的飛行航線進行保存,並且可以較高的精度還原真實的軌跡位移和動作情況,同時可以重複實現已設定的飛行航線軌跡,也可以簡單的對航線軌跡進行修改。 Through the above method, the flight path of the UAV can be saved, and the real trajectory displacement and action can be restored with high precision. At the same time, the set flight path trajectory can be repeatedly realized, and the path trajectory can also be simply modified.
在步驟S103處,無人機控制裝置根據所保存的資料向至少一個無人機發送控制指令以控制至少一個無人機的飛行。 At step S103, the UAV control device sends a control command to at least one UAV to control the flight of at least one UAV according to the stored data.
根據本發明實施例的方法,能夠實現無人機多機編隊和航線軌跡的發送。因此,在一些實施例中,所述至少一個無人機包括多個無人機。在此情況中,無人機控制裝置根據所保存的資料向所述至少一個無人機發送控制指令以控制所述至少一個無人機的飛行可以如3所示。圖3示出了根據本發明實施例的無人機控制裝置向多個無人機發送控制指令的處理的流程圖。如圖3所示,無人機控制裝置根據所保存的資料向多個無人機發送控制指令的處理S103可以包括:S1031,無人機控制裝置為多個無人機分別設置對應的標識符;以及S1032,無人機控制裝置向多個無人機發送控制指令和對應的標識符以控制多個無人機的飛行。 According to the method of the embodiment of the present invention, it is possible to realize multi-machine formation of UAVs and sending of route trajectories. Thus, in some embodiments, the at least one drone includes a plurality of drones. In this case, the UAV control device sends a control instruction to the at least one UAV according to the saved information to control the flight of the at least one UAV, as shown in 3 . Fig. 3 shows a flow chart of the process of sending control instructions to multiple drones by the drone control device according to an embodiment of the present invention. As shown in FIG. 3 , the processing S103 of the UAV control device sending control instructions to a plurality of UAVs according to the saved data may include: S1031, the UAV control device respectively sets corresponding identifiers for the plurality of UAVs; and S1032, The drone control device sends control instructions and corresponding identifiers to the multiple drones to control the flight of the multiple drones.
在一些實施例中,無人機控制裝置向多個無人機發送相同或不同的控制指令。在一些實施例中,無人機控制裝置向多個無人機發送相同的控制指令時,採取分時發送,以防止出現通信堵塞的情況。 In some embodiments, the UAV control device sends the same or different control instructions to multiple UAVs. In some embodiments, when the UAV control device sends the same control instruction to multiple UAVs, it uses time-sharing to prevent communication congestion.
圖4示出多個無人機在接收到無人控制裝置發送的控制指令後的處理的流程圖。如圖4所示,多個無人機在接收到無人控制裝置發送的控制指令後的處理400包括:S401,判斷所接收到的標識符是否是該無人機的標識符;S402,在所接收到的標識符是該無人機的標識符的情況下,根據所接收的控制指令調整該無人機的飛行;並且S403,在所接收到的標識符不是該無人機的標識符的情況下,維持該無人機的當前的飛行。
Fig. 4 shows a flow chart of the processing of multiple drones after receiving the control instruction sent by the unmanned control device. As shown in Figure 4, the
通過根據本發明實施例的上述方法,使用遙控器控制無人機飛行航線軌跡,再由無人機控制系統將軌跡資料進行保存,然後系統將自動控制無人機再現航線軌跡。這種方式實現無人機航線的燒寫,可以大大減低對使用者 的技術水準要求和開發週期,實現許多複雜的航線規劃再現,並且可以通過修改航線資料的方式簡單的對航線軌跡進行修改。此外,通過根據本發明實施例的上述方法,還能夠在保證無人機航線完整性和即時性前提下增加了多機編隊的功能,可以實現多台無人機飛行不同的航線或者飛行相同的航線。 Through the above method according to the embodiment of the present invention, use the remote controller to control the flight route trajectory of the UAV, and then save the trajectory data by the UAV control system, and then the system will automatically control the UAV to reproduce the route trajectory. In this way, the programming of UAV routes can be realized, which can greatly reduce the burden on users. According to the technical level requirements and development cycle, many complicated route planning can be reproduced, and the route trajectory can be easily modified by modifying route data. In addition, through the above-mentioned method according to the embodiment of the present invention, the function of multi-machine formation can also be added under the premise of ensuring the integrity and immediacy of the drone route, and multiple drones can fly different routes or fly the same route.
以上描述了根據本發明實施例的無人機控制方法,下面將參考圖式來描述根據本發明實施例的無人機控制系統。圖5示出根據本發明實施例的一種無人機控制系統的框圖。如圖5所示,根據本發明實施例的無人機控制系統500包括:遙控器501;和無人機控制裝置502。遙控器501被配置為控制示教無人機飛行,並將示教無人機在飛行過程中有關航行的資料即時地進行採集並回饋到無人機控制裝置;並且無人機控制裝置被配置為對接收的資料進行處理並保存,並且根據所保存的資料向至少一個無人機發送控制指令以控制至少一個無人機的飛行。
The drone control method according to the embodiment of the present invention has been described above, and the drone control system according to the embodiment of the present invention will be described below with reference to the drawings. Fig. 5 shows a block diagram of a UAV control system according to an embodiment of the present invention. As shown in FIG. 5 , a
具體地,遙控器501被配置為將該遙控器的搖桿變化量轉化成對於示教無人機輸出的目標空間向量,以便示教無人機根據目標空間向量來進行位置控制。在一些實施例中,遙控器501被配置為將示教無人機的目標空間向量確定為示教無人機的當前位置加上通過遙桿的測量值轉化而得到的增量位移,其中,該增量位移根據遙桿的測量值、遙桿的遙桿值規範化到飛行速率的係數以及鬆放搖桿時示教無人機刹車的補償值而確定。
Specifically, the
在一些實施例中,遙控器501被配置為通過以下方式來確定鬆放搖桿時所述示教無人機刹車的補償值:通過在鬆放遙桿時遙桿的測量值小於用於區分遙桿是否搖動的閾值的情況下,對示教無人機飛行過程時間積分得到的刹車距離進行刹車時間內微分並漸變累加。
In some embodiments, the
圖6示出根據本發明實施例可以實現遙控器和無人機控制裝置的計算裝置的框圖。如圖所示,計算裝置600可包括一個或多個處理器或處理器601和記憶體602。對於本發明(包括申請專利範圍)而言,術語“處理器”和“處理器核心”可被視為同義詞,除非上下文明確地另有要求。處理器601可包括任何類型的處理器,例如中央處理單元、微處理器,等等。處理器601可被實現為具有多核心的積體電路,例如,多核心微處理器。在實施例中,記憶體602可以是系統記憶體。在一些實施例中,記憶體602可與處理器601集成。計
算裝置600可包括大容量存儲裝置603(例如,磁片、硬碟驅動器、揮發性記憶體(例如,動態隨機存取記憶體(dynamic random access memory,DRAM)、光碟唯讀記憶體(compact disc read-only memory,CD-ROM)、多用途數位光碟(digital versatile disk,DVD),等等)。一般而言,記憶體602和/或大容量存儲裝置603可以是任何類型的臨時性和/或持久性存儲,包括但不限於揮發性和非揮發性記憶體、光學、磁性和/或固態大型存放區,等等。揮發性記憶體可包括但不限於靜態和/或動態隨機訪問記憶體。非揮發性記憶體可包括但不限於電可擦除可燒寫唯讀記憶體、相變記憶體、電阻式記憶體,等等。
FIG. 6 shows a block diagram of a computing device that can implement a remote controller and a drone control device according to an embodiment of the present invention. As shown,
計算裝置600還可包括輸入/輸出(I/O)裝置604(例如,顯示器(例如,觸控式螢幕顯示器)、鍵盤、游標控制、遙控器、遊戲控制器、圖像捕捉裝置,等等)和通信介面605(例如網路介面卡、數據機、紅外接收器、無線電接收器(例如,藍牙),等等)。通信介面605可以以有線或無線地方式與其他設備進行通信以交換資料。例如,通過該通信介面605,遙控器501可以把資料發送給無人機和/或無人機控制裝置502,或者無人機控制可以將控制指令發送給至少一個無人機。
上述計算裝置600的元素可經由系統匯流排606相互耦合,系統匯流排606表示一個或多個匯流排。在多個匯流排的情況下,它們可由一個或多個匯流排橋(未示出)來橋接。這些元素的每一者可執行本領域中已知的其傳統功能。具體地,可以採用記憶體602和大容量存儲裝置603來存儲用於遙控裝置和無人機控制裝置的操作的燒寫指令的工作拷貝和永久拷貝。各種元素可由(一個或多個)處理器601所支援的彙編指令或者可被編譯成這種指令的高級別語言來實現。燒寫指令的永久拷貝可在工廠被放入大容量存儲裝置603中,或者在現場通過例如分發介質(未示出)(比如光碟(Compact Disc,CD)),或者通過通信介面605(從分佈伺服器(未示出))來分發。因此,在一些實施例中,本發明提供一種電腦可讀存儲介質,存儲有指令,所述指令在被處理器執行時使得處理器執行上述遙控對示教無人機的控制,或者使得處理器執行無人機控制裝置對至少一個無人機的控制。
The elements of
應理解,圖中示出了遙控器和無人機控制裝置的通用部分,作為遙控器的實現方式,其還包括搖桿607(在圖6中以虛線示出)以用於做出飛
行指示。在一些實施例中,一種用於遙控無人機的遙控器,包括:遙桿607;和處理器601,其中處理器601被配置為將遙控器的搖桿607變化量轉化成對於無人機輸出的目標空間向量,以便無人機根據目標空間向量來進行位置控制。在一些實施例中,處理器601被配置為將無人機的目標空間向量確定為無人機的當前位置加上通過遙桿607的測量值轉化而得到的增量位移,其中,該增量位移根據607遙桿的測量值、遙桿的遙桿值規範化到飛行速率的係數以及鬆放搖桿607時所述無人機刹車的補償值而確定。在一些實施例中,處理器601被配置為通過以下方式來確定鬆放搖桿607時無人機刹車的補償值:通過在鬆放遙桿607時遙桿607的測量值小於用於區分遙桿607是否搖動的閾值的情況下,對無人機飛行過程時間積分得到的刹車距離進行刹車時間內微分並漸變累加。
It should be understood that the common parts of the remote controller and the UAV control device are shown in the figure, and as the implementation of the remote controller, it also includes a joystick 607 (shown in dotted line in FIG. 6 ) for making a flight.
line instructions. In some embodiments, a remote controller for remote control of a drone includes: a
在圖6中,各元件的數目、能力和/或容量可以有變化,這取決於計算裝置600是被用作固定的計算裝置,還是被用作移動計算裝置。在各種實現方式中,計算裝置600可包括膝上型電腦、小筆電、筆記本、超極致筆電、智慧型電話、平板設備、個人數位助理(personal digital assistant,PDA)、超級移動電腦、行動電話或者數碼相機的一個或多個元件。在另外的實現方式中,計算裝置600可以是任何其他處理資料的電子裝置。
In FIG. 6, the number, capability, and/or capacity of the various elements may vary depending on whether
以上對本發明的實施例的詳細描述涵蓋了許多具體細節,以便提供對本發明的全面理解。但是,對於本領域技術人員來說顯而易見的是,本發明可以在不需要這些具體細節中的一些細節的情況下實施。上面對實施例的描述僅僅是為了通過示出本發明的示例來提供對本發明更清楚的理解。本發明絕不限於下面所提出的任何具體配置和方法步驟,而是在不脫離本發明的教導的前提下覆蓋了相關元素、部件和方法步驟的任何修改、替換和改進。 The above detailed description of the embodiments of the present invention covers numerous specific details in order to provide a thorough understanding of the present invention. It will be apparent, however, to one skilled in the art that the present invention may be practiced without some of these specific details. The above description of the embodiments is only to provide a clearer understanding of the present invention by showing examples of the present invention. The present invention is by no means limited to any specific configuration and method steps set forth below, but covers any modification, substitution and improvement of related elements, components and method steps without departing from the teaching of the present invention.
應當注意,在申請專利範圍中,單詞“包含”或“包括”並不排除存在未列在請求項中的元件或元件。位於元件或元件之前的冠詞“一”或“一個”也並不排除存在多個這樣的元件或元件的情況。 It should be noted that in the scope of claims, the word "comprises" or "includes" does not exclude the presence of elements or components not listed in the claims. The article "a" or "an" preceding an element or elements also does not exclude the presence of a plurality of such elements or elements.
此外,還應當注意,本說明書中使用的語言主要是為了可讀性和教導的目的而選擇的,而不是為了解釋或者限定本發明的主題而選擇的。因此,在不偏離所附申請專利範圍的範圍和精神的情況下,對於本技術領域的普通技術人員來說許多修改和變更都是顯而易見的。關於本發明的範圍,說明書中所 做的描述都是說明性的,而非限制性的,本發明的範圍由所附申請專利範圍限定。 In addition, it should be noted that the language used in the specification has been chosen primarily for the purpose of readability and instruction rather than to explain or delimit the inventive subject matter. Accordingly, many modifications and alterations will be apparent to those of ordinary skill in the art without departing from the scope and spirit of the appended claims. Regarding the scope of the present invention, the The descriptions made are illustrative rather than restrictive, and the scope of the present invention is defined by the appended claims.
100:無人機控制方法 100: UAV control method
S101,S102,S103:步驟 S101, S102, S103: steps
Claims (14)
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111288351.3A CN114063496B (en) | 2021-11-02 | 2021-11-02 | Unmanned aerial vehicle control method and system and remote controller for remote control of unmanned aerial vehicle |
CN202111288351.3 | 2021-11-02 |
Publications (2)
Publication Number | Publication Date |
---|---|
TW202319857A TW202319857A (en) | 2023-05-16 |
TWI809614B true TWI809614B (en) | 2023-07-21 |
Family
ID=80236439
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW110147999A TWI809614B (en) | 2021-11-02 | 2021-12-21 | UAV control method and system and remote controller for remote control of UAV |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN114063496B (en) |
TW (1) | TWI809614B (en) |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN203497176U (en) * | 2013-05-29 | 2014-03-26 | 山东英特力光通信开发有限公司 | Unmanned helicopter |
CN105607740A (en) * | 2015-12-29 | 2016-05-25 | 清华大学深圳研究生院 | Unmanned aerial vehicle control method and device based on computer vision |
WO2018195883A1 (en) * | 2017-04-28 | 2018-11-01 | 深圳市大疆创新科技有限公司 | Method and device for controlling unmanned aerial vehicle, and unmanned aerial vehicle |
CN109074095A (en) * | 2017-12-26 | 2018-12-21 | 深圳市大疆创新科技有限公司 | A kind of flight path original road playback method and aircraft |
CN110187716A (en) * | 2019-06-17 | 2019-08-30 | 中国地质大学(北京) | Geological exploration UAV Flight Control method and apparatus |
CN110456805A (en) * | 2019-06-24 | 2019-11-15 | 深圳慈航无人智能***技术有限公司 | A kind of UAV Intelligent tracking flight system and method |
WO2020063631A1 (en) * | 2018-09-28 | 2020-04-02 | 杭州零零科技有限公司 | Handheld remote control device and flight system kit |
CN111158290A (en) * | 2019-12-31 | 2020-05-15 | 埃游科技(深圳)有限公司 | Multi-modal control method and device for unmanned equipment |
CN111226185A (en) * | 2019-04-22 | 2020-06-02 | 深圳市大疆创新科技有限公司 | Flight route generation method, control device and unmanned aerial vehicle system |
CN112650267A (en) * | 2016-10-17 | 2021-04-13 | 深圳市大疆创新科技有限公司 | Flight control method and device for aircraft and aircraft |
US20210116944A1 (en) * | 2015-10-30 | 2021-04-22 | SZ DJI Technology Co., Ltd. | Systems and methods for uav path planning and control |
CN113074733A (en) * | 2016-11-14 | 2021-07-06 | 深圳市大疆创新科技有限公司 | Flight trajectory generation method, control device and unmanned aerial vehicle |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100591880C (en) * | 2006-12-31 | 2010-02-24 | 三一重工股份有限公司 | Intelligent cantilever crane control device |
CN105955291B (en) * | 2016-04-29 | 2021-04-27 | 深圳市哈博森科技有限公司 | Unmanned aerial vehicle flight route track recording and automatic flight control mode |
CN106774398A (en) * | 2016-12-20 | 2017-05-31 | 北京小米移动软件有限公司 | Take photo by plane method and device, unmanned plane |
CN108334102A (en) * | 2017-01-17 | 2018-07-27 | 翔升(上海)电子技术有限公司 | Unmanned plane development platform and method |
CN107314772B (en) * | 2017-07-25 | 2020-05-15 | 哈尔滨工业大学(威海) | Unmanned aerial vehicle self-learning waypoint track flight method and system thereof |
CN109927056B (en) * | 2017-12-19 | 2020-11-10 | 合肥欣奕华智能机器有限公司 | Teaching rocker, robot teaching method and robot control system |
CN108803663A (en) * | 2018-07-18 | 2018-11-13 | 上海峥航智能科技发展有限公司 | A kind of graphic programming method of unmanned aerial vehicle (UAV) control |
CN110109472A (en) * | 2019-04-25 | 2019-08-09 | 广州笨笨网络科技有限公司 | A kind of unmanned aerial vehicle (UAV) control method, system, terminal and unmanned plane |
CN110069078B (en) * | 2019-05-21 | 2021-06-01 | 深圳市道通智能航空技术股份有限公司 | Flight control method, device and system and unmanned aerial vehicle |
CN112543899A (en) * | 2019-12-26 | 2021-03-23 | 深圳市大疆创新科技有限公司 | Control method and control device for movable carrier and computer readable storage medium |
-
2021
- 2021-11-02 CN CN202111288351.3A patent/CN114063496B/en active Active
- 2021-12-21 TW TW110147999A patent/TWI809614B/en active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN203497176U (en) * | 2013-05-29 | 2014-03-26 | 山东英特力光通信开发有限公司 | Unmanned helicopter |
US20210116944A1 (en) * | 2015-10-30 | 2021-04-22 | SZ DJI Technology Co., Ltd. | Systems and methods for uav path planning and control |
CN105607740A (en) * | 2015-12-29 | 2016-05-25 | 清华大学深圳研究生院 | Unmanned aerial vehicle control method and device based on computer vision |
CN112650267A (en) * | 2016-10-17 | 2021-04-13 | 深圳市大疆创新科技有限公司 | Flight control method and device for aircraft and aircraft |
CN113074733A (en) * | 2016-11-14 | 2021-07-06 | 深圳市大疆创新科技有限公司 | Flight trajectory generation method, control device and unmanned aerial vehicle |
WO2018195883A1 (en) * | 2017-04-28 | 2018-11-01 | 深圳市大疆创新科技有限公司 | Method and device for controlling unmanned aerial vehicle, and unmanned aerial vehicle |
CN109074095A (en) * | 2017-12-26 | 2018-12-21 | 深圳市大疆创新科技有限公司 | A kind of flight path original road playback method and aircraft |
WO2020063631A1 (en) * | 2018-09-28 | 2020-04-02 | 杭州零零科技有限公司 | Handheld remote control device and flight system kit |
CN111226185A (en) * | 2019-04-22 | 2020-06-02 | 深圳市大疆创新科技有限公司 | Flight route generation method, control device and unmanned aerial vehicle system |
CN110187716A (en) * | 2019-06-17 | 2019-08-30 | 中国地质大学(北京) | Geological exploration UAV Flight Control method and apparatus |
CN110456805A (en) * | 2019-06-24 | 2019-11-15 | 深圳慈航无人智能***技术有限公司 | A kind of UAV Intelligent tracking flight system and method |
CN111158290A (en) * | 2019-12-31 | 2020-05-15 | 埃游科技(深圳)有限公司 | Multi-modal control method and device for unmanned equipment |
Also Published As
Publication number | Publication date |
---|---|
CN114063496A (en) | 2022-02-18 |
TW202319857A (en) | 2023-05-16 |
CN114063496B (en) | 2024-07-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6949719B2 (en) | Drone controller and method | |
US9399294B1 (en) | Displaying estimated image data in a user interface | |
WO2021217303A1 (en) | Method and device for controlling unmanned aerial vehicle, and unmanned aerial vehicle | |
WO2018214068A1 (en) | Flight control method, device and system, and machine readable storage medium | |
EP3696642B1 (en) | Method for controlling unmanned aerial vehicle, and terminal | |
US8947522B1 (en) | Systems and methods to adjust actions based on latency levels | |
US11927953B2 (en) | Customizable waypoint missions | |
US8478901B1 (en) | Methods and systems for robot cloud computing using slug trails | |
CN108141529A (en) | For performing the system and method for autozoom | |
WO2021088684A1 (en) | Omnidirectional obstacle avoidance method and unmanned aerial vehicle | |
WO2020011087A1 (en) | Method for storing log of unmanned aerial vehicle system, and image transmission system of unmanned aerial vehicle | |
WO2018100676A1 (en) | Camera control system, camera control method, and program | |
WO2019144286A1 (en) | Obstacle detection method, mobile platform, and computer readable storage medium | |
CN113110563A (en) | Redundancy arbitration switching method and system for unmanned aerial vehicle and computer equipment | |
WO2021189214A1 (en) | Control method and apparatus for movable platform, movable platform and storage medium | |
Zhao et al. | Web-based interactive drone control using hand gesture | |
CN113642243A (en) | Multi-robot deep reinforcement learning system, training method, device and medium | |
TWI809614B (en) | UAV control method and system and remote controller for remote control of UAV | |
CN114584494A (en) | Method for measuring actual available bandwidth in edge cloud network | |
US11620913B2 (en) | Movable object application framework | |
WO2021135823A1 (en) | Flight control method and device, and unmanned aerial vehicle | |
WO2021217408A1 (en) | Unmanned aerial vehicle system, and control method and device therefor | |
WO2023025202A1 (en) | Control method and apparatus for direction of gimbal, and terminal | |
WO2023025203A1 (en) | Zoom control method and apparatus for gimbal camera, and terminal | |
JP2023157917A (en) | Imaging method |