Intelligent hovercar with agile configuration

By setting up the mode switching module in the cycloid rotor vehicle of the flying car, the problem that the flying car cannot directly change the yaw angle is solved, and the flat-flying turns in the air can be achieved to avoid falling off the height Phenomenon.

CN118906720AInactive Publication Date: 2024-11-08TSINGHUA UNIVERSITY
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410964615.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-18
Publication Date
2024-11-08
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

The flying car cannot directly change the yaw angle when flying in the air, resulting in a possible drop in height when reaching the desired position and the flat-flying turn behavior cannot be achieved.

Method used

Design an agile configuration intelligent flying car. By setting up a servo in a cycloid rotor aircraft, and setting a modal switching module and aerial modal control module in the control chip, the state machine and aerial state equations are used to obtain the best solution. Improve the total lift and torque to achieve flat-flying turns of flying cars.

Benefits of technology

It realizes changing the yaw angle of the flying car in the air, avoiding the phenomenon of height loss, and achieving flat-flying turns when reaching the desired position.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118906720A_ABST
    Figure CN118906720A_ABST
Patent Text Reader

Abstract

The invention provides an intelligent hovercar with an agile configuration, and relates to the technical field of hovercars. The intelligent hovercar comprises a cycloid rotor aircraft and a control chip; a steering engine is arranged in the cycloid rotor aircraft; the level-flight turning behavior is achieved by changing the yaw angle of the hovercar; a mode switching module and an air mode control module are arranged in the control chip; the air modal control module is used for solving by utilizing an air state equation based on the state parameters of the hovercar at the current moment to obtain the optimal total lift force from the current moment to the next moment and the optimal torques in three directions; and the lift force of the four rotors of the cycloid rotor aircraft from the current moment to the next moment is calculated by using a kinetic model of air flight, and the lift force of the four rotors is sent to the cycloid rotor aircraft. According to the method, the level flight turning behavior can be achieved by changing the yaw angle of the hovercar, and the phenomenon of height falling does not occur when the hovercar reaches the expected position.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the technical field of flying cars, and in particular to an intelligent flying car with an agile configuration. Background Art

[0002] When a flying car is flying in the air, it is impossible to directly change the yaw angle. Usually, the yaw angle of the flying car is changed by changing the roll angle and pitch angle. This method may cause the flying car to drop in height when reaching the desired position, and it is impossible to achieve level flight and turning behavior. Summary of the invention

[0003] In view of this, the present application provides an agile-configuration intelligent flying car to solve the above-mentioned technical problems.

[0004] The embodiment of the present application provides an agile-configuration intelligent flying car, comprising: a cycloidal rotor aircraft and a control chip; a servo is provided in the cycloidal rotor aircraft; and the servo is used to achieve a level flight turning behavior in the air by changing the yaw angle of the flying car; and a mode switching module and an air mode control module are provided in the control chip;

[0005] The mode switching module is used to respond to the mode switching instruction, use the state machine to switch the flying car mode to the air mode, and start the air mode control module;

[0006] The air mode control module is used to determine whether the behavior of the flying car is ascending, descending or level flight turning according to the starting point and target point of the preset flight path, and based on the state parameters of the flying car at the current moment, use the air state equation to solve to obtain the optimal total lift and the optimal torque in three directions from the current moment to the next moment, and based on the optimal total lift and the optimal torque in three directions from the current moment to the next moment, use the dynamic model of air flight to calculate the lift of the four rotors of the cycloid rotor aircraft from the current moment to the next moment, and send the lift of the four rotors to the cycloid rotor aircraft.

[0007] Furthermore, when the behavior of the flying car is level flight and turning;

[0008] Based on the state parameters of the flying car at the previous moment, the optimal total lift and the optimal torque in three directions from the current moment to the next moment are calculated using the air state equation, including:

[0009] When the flying car is flying flat and turning, the flying car's air state equation is:

[0010]

[0011] Among them, A, B and C are matrices; x k is the current time tk The flying car state parameters: x k =[p k,x ;p k,y ;p k,z ;v k,x ;v k,y ;v k,z ;w k,x ;w k,y ;w k,z ;q k,w ;q k,x ;q k,y ;q k,z ] T Among them, (p k,x ;p k,y ;p k,z ) is the current time t k The three components of the flying car's position, (v k,x ;v k,y ;v k,z ) is the current time t k The three components of the flying car's velocity, w k,x 、w k,y and w k,z are the current time t k The rolling angular velocity, pitch angular velocity and yaw angular velocity of the flying car; [q k,w ;q k,x ;q k,y ;q k,z ] T is the current time t k The quad of the flying car;

[0012] x k+1 is the predicted next time t k+1 The flying car state parameters;

[0013] u k→k+1 is the current time t k Until the next time t k+1 Control input:

[0014] u k→k+1 =[Thrust;M x ;M y ;M z ] T

[0015] Among them, Thrust is the total lift from the current moment to the next moment, M x , M y and M z They are the torques in three directions of the flying car from the current moment to the next moment;

[0016] y k+1 For the next moment t k+1 The output:

[0017] y k+1 =[p k+1,x ;p k+1,y ;p k+1,z ;yaw k+1 ] T

[0018] Among them, (p k+1,x ;p k+1,y ;p k+1,z ) is the next moment t k+1 The three components of the flying car's position, yaw k+1 For the next moment t k+1 The yaw angle of the flying car;

[0019]

[0020] Among them, p is the position vector of the flying car, is the first-order differential of p, v is the velocity vector of the flying car, is the first-order differential of v, w is the angular velocity component of the flying car, is the first-order differential of w, q is the quaternion of the flying car, is the first-order differential of q; is the differential of the flying car state parameters;

[0021] The calculation equations are as follows:

[0022]

[0023] Where c is the lift vector: c = [0; 0; Thrust] T , g is the gravity vector: g = [0; 0; 9.8] T , M is the moment vector: M = [M x ;M y ;M z ] T , J is the moment of inertia vector: J = [J xx ; J yy ; J zz ] T , J xx , J yy and J zz is the moment of inertia of the flying car in three directions; T represents transposition;

[0024] Define the loss function minJ as:

[0025] minJ=(y k+1 -y ref ) T ·Q·(y k+1 -y ref )+u k→k+1 T ·R·u k→k+1

[0026] Among them, y ref For the next moment t k+1 The expected output is:

[0027] y ref =[p ref ,x;p ref ,y;p ref ,z;yaw ref ] T

[0028] (p ref,x ;p ref,y ;p ref,z ) is the next moment t k+1 The desired position of the flying car in three directions, yaw ref For the next moment t k+1 The desired yaw angle of the flying car, Q and R are both weight matrices;

[0029] use The calculation equations and loss function are solved to get u k→k+1 The optimal vector of , that is, the optimal total lift from the current moment to the next moment and the optimal torque in three directions.

[0030] Further, when the behavior of the flying car is ascending or descending;

[0031] When the flying car is flying flat and turning, the flying car's air state equation is:

[0032]

[0033] Among them, A, B and C are matrices; x k is the current time t k The flying car state parameters: x k =[p k,x ;p k,y ;p k,z ;v k,x ;v k,y ;v k,z ;w k,x ;w k,y ;w k,z ;q k,w ;q k,x ;q k,y;q k,z ] T Among them, (p k,x ;p k,y ;p k,z ) is the current time t k The three components of the flying car's position, (v k,x ;v k,y ;v k,z ) is the current time t k The three components of the flying car's velocity, w k,x 、w k,y and w k,z are the current time t k The rolling angular velocity, pitch angular velocity and yaw angular velocity of the flying car; [q k,w ;q k,x ;q k,y ;q k,z ] T is the current time t k The quad of the flying car;

[0034] x k+1 is the predicted next time t k+1 The flying car state parameters;

[0035] u k→k+1 is the current time t k Until the next time t k+1 Control input:

[0036] u k→k+1 =[Thrust;M x ;M y ;M z ] T

[0037] Among them, Thrust is the total lift from the current moment to the next moment, M x , M y and M z They are the torques in three directions of the flying car from the current moment to the next moment;

[0038] y k+1 For the next moment t k+1 The output:

[0039] y k+1 =[p k+1,x ;p k+1,y ;p k+1,z ;yaw k+1 ] T

[0040] Among them, (p k+1,x ;pk+1,y ;p k+1,z ) is the next moment t k+1 The three components of the flying car's position, yaw k+1 For the next moment t k+1 The yaw angle of the flying car;

[0041]

[0042] Among them, p is the position vector of the flying car, is the first-order differential of p, v is the velocity vector of the flying car, is the first-order differential of v, w is the angular velocity component of the flying car, is the first-order differential of w, q is the quaternion of the flying car, is the first-order differential of q; is the differential of the flying car state parameters;

[0043] The calculation equations are as follows:

[0044]

[0045] Where c is the lift vector: c = [0; 0; Thrust] T , g is the gravity vector: g = [0; 0; 9.8] T , M is the moment vector: M = [M x ;M y ;M z ] T , J is the moment of inertia vector: J = [J xx ; J yy ; J zz ] T , J xx , J yy and J zz is the moment of inertia of the flying car in three directions; T represents transposition;

[0046] Define the loss function minJ as:

[0047] minJ=(y k+1 -y ref ) T ·Q·(y k+1 -y ref )+u k→k+1 T ·R·u k→k+1

[0048] Among them, y ref For the next moment t k+1 The expected output is:

[0049] y ref =[p ref,x ;p ref,y ;p ref,z ;yaw ref ] T

[0050] (p ref ,x;p ref,y ;p ref,z ) is the next moment t k+1 The desired position of the flying car in three directions, yaw ref For the next moment t k+1 The desired yaw angle of the flying car, Q and R are both weight matrices;

[0051] use The calculation equations and loss function are solved to get u k→k+1 The optimal vector of , that is, the optimal total lift from the current moment to the next moment and the optimal torque in three directions.

[0052] Furthermore, the dynamic model of the aerial flight is:

[0053]

[0054] Among them, F1, F2, F3 and F4 represent the lift of the four rotors, M1, M2, M3 and M4 represent the torque of the four rotors, l1, l2, l3, l4 represent the distance from the center of mass of the four rotors to the center of mass of the flying car, θ is the steering gear deflection angle, m is the mass of the flying car, is the optimal total lift from the current moment to the next moment, and It is the optimal torque in three directions from the current moment to the next moment.

[0055] Furthermore, the control chip further includes: a ground mode control module, and the mode switching module is further used to: in response to a mode switching instruction, use a state machine to switch the flying car to a ground mode, and start the ground mode control module;

[0056] The ground mode control module is used to determine whether the behavior of the flying car is moving or stationary according to the relative positions of the starting point and the target point, and to calculate the output of the position loop and the output of the attitude loop at the next moment by using the first PID controller and the second PID controller based on the motion state parameters at the current moment, thereby obtaining the second-order differentials of the speed and steering angle at the next moment; based on the second-order differentials of the speed and steering angle at the next moment, the velocities of the four rotors of the cycloid rotor aircraft at the next moment are calculated by using the dynamic model of ground motion, and the velocities of the four rotors at the next moment are sent to the cycloid rotor aircraft.

[0057] Further, based on the state parameters at the current moment, the output of the position loop and the output of the attitude loop at the next moment are calculated by using the first PID controller and the second PID controller, thereby obtaining the second-order differential of the speed and the steering angle at the next moment; including:

[0058] The differential equation of the first PID controller is:

[0059]

[0060] Among them, K 1p , K 1i and K 1d Respectively represent the proportional coefficient, integral coefficient and differential coefficient of the first PID controller; e x 、e y and e z are the three components of the flying car’s position deviation:

[0061] [e x , e y , e z ] T =[p x -p x_ref , p y -p y_ref , p z -p z_ref ] T

[0062] [p x ;p y ;p z ] T are the three components of the flying car’s position at the current moment;

[0063] [p x_ref , p y_ref , p z_ref ] T are the three components of the target position of the flying car;

[0064] [δ x , δ y , δ z ] T is the output of the position loop; δ x is the first-order differential of the position in the x direction; δ y is the first-order differential of the position in the y direction; δ z is the first-order differential of the position in the z direction;

[0065] The differential equation of the second PID controller is:

[0066]

[0067] Among them, K 2p , K 2i and K 2d Respectively represent the proportional coefficient, integral coefficient and differential coefficient of the second PID controller; The steering angle deviation of the flying car is:

[0068] Yaw is the steering angle of the flying car at the current moment, yaw ref The target steering angle of the flying car;

[0069] is the output of the attitude loop at the next moment; is the first-order differential of the steering angle of the flying car;

[0070] According to the output of the position loop at the next moment, calculate the speed v of the left wheel l and the speed v of the right wheel r , get the speed at the next moment

[0071] According to the output of the attitude loop at the next moment, the second-order differential of the steering angle at the next moment is obtained.

[0072] Furthermore, the dynamic model of the ground motion is:

[0073]

[0074] Among them, v1, v2, v3, v4 represent the speeds of the four rotors, R is the rotor radius, l l and l r are the left wheel radius and the right wheel radius.

[0075] Furthermore, the control chip further includes: a surface mode control module, and the mode switching module is further used to: in response to a mode switching instruction, use a state machine to switch the flying car to a surface mode, and start the surface mode control module;

[0076] The water surface modal control module is used to determine whether the behavior of the flying car is moving or stationary according to the relative positions of the starting point and the target point, and to calculate the output of the position loop and the output of the attitude loop at the next moment based on the state parameters at the current moment by using the third PID controller and the fourth PID controller, thereby obtaining the optimal total lift and the optimal torque in the Z direction from the current moment to the next moment; based on the optimal total lift and the optimal torque in the Z direction from the current moment to the next moment, the dynamic model of water surface motion is used to calculate the lift of the four rotors of the cycloid rotor aircraft from the current moment to the next moment; and the lift of the four rotors is sent to the cycloid rotor aircraft.

[0077] Further, based on the state parameters at the current moment, the third PID controller and the fourth PID controller are used to calculate the position loop and the attitude loop at the next moment, thereby obtaining the optimal total lift and the optimal torque in the Z direction from the current moment to the next moment; including:

[0078] The differential equation of the third PID controller is:

[0079]

[0080] Among them, K 3p , K 3i and K 3d They represent the proportional coefficient, integral coefficient and differential coefficient of the third PID controller respectively; e x 、e y and e z are the three components of the flying car’s position deviation:

[0081] [e x , e y , e z ] T =[p x -p x_ref , p y -p y_ref , p z -p z_ref ] T

[0082] [p x ;p y ;p z ] T are the three components of the flying car’s position at the current moment;

[0083] [p x_ref , p y_ref , p z_ref ] T are the three components of the target position of the flying car;

[0084] [δ x , δ y , δ z ] T is the output of the position loop at the next moment; [δ x , δ y , δ z ] T is the output of the position loop; δ x is the first-order differential of the position in the x direction; δ y is the first-order differential of the position in the y direction; δ z is the first-order differential of the position in the z direction;

[0085] The differential equation of the fourth PID controller is:

[0086]

[0087] Among them, K 4p , K 4i and K 4d They represent the proportional coefficient, integral coefficient and differential coefficient of the fourth PID controller respectively; e Φ , e Θ and The rolling angle deviation, pitch angle deviation and steering angle deviation of the flying car are:

[0088]

[0089] roll is the rolling angle of the flying car at the current moment, ref is the target rolling angle of the flying car; pitch is the pitch angle of the flying car at the current moment, ref is the target pitch angle of the flying car; yaw is the steering angle of the flying car at the current moment, yaw ref is the target steering angle of the flying car;

[0090] is the output of the attitude loop at the next moment; δ Φ is the first-order differential of the rolling angle; δ Θ is the first-order differential of the pitch angle; is the first-order differential of the deflection angle;

[0091] According to the output of the position loop, the optimal total lift from the current moment to the next moment is obtained According to the output of the attitude loop, the optimal torque in the Z direction from the current moment to the next moment is obtained.

[0092] Furthermore, the dynamic model of the water surface motion is:

[0093]

[0094] Among them, F1, F2, F3 and F4 represent the lift of the four rotors, M1, M2, M3 and M4 represent the torque of the four rotors, l1, l2, l3, l4 represent the distance from the center of mass of the four rotors to the center of mass of the flying car, and θ represents the deflection angle of the servo.

[0095] The present application can achieve level flight turning behavior by changing the yaw angle of the flying car, and there will be no drop in height when reaching the desired position. BRIEF DESCRIPTION OF THE DRAWINGS

[0096] In order to more clearly illustrate the specific implementation methods of the present application or the technical solutions in the prior art, the drawings required for use in the specific implementation methods or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some implementation methods of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.

[0097] Figure 1 This is a functional structure diagram of an agile-configured intelligent flying car according to an embodiment of the present application;

[0098] Figure 2 It is a schematic diagram of a cycloidal rotor aircraft according to an embodiment of the present application. DETAILED DESCRIPTION

[0099] In order to make the purpose, technical solution and advantages of the embodiments of the present application clearer, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, rather than all the embodiments. The components of the embodiments of the present application described and shown in the drawings here can be arranged and designed in various different configurations.

[0100] Therefore, the following detailed description of the embodiments of the present application provided in the accompanying drawings is not intended to limit the scope of the present application for which protection is sought, but merely represents selected embodiments of the present application. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in the field without creative work are within the scope of protection of the present application.

[0101] First, the design concept of the embodiments of the present application is briefly introduced.

[0102] When a flying car is flying in the air, it is impossible to directly change the yaw angle. Usually, the yaw angle of the flying car is changed by changing the roll angle and pitch angle. This method may cause the flying car to drop in height when reaching the desired position, and it is impossible to achieve level flight and turning behavior.

[0103] To solve the above problems, the present application can solve the problem of lack of freedom of traditional UAVs by setting a variable pitch servo in the cycloidal rotor aircraft and then setting a corresponding control program in the control chip. During the flight in the air, the yaw angle (yaw) of the flying car can be changed more conveniently, that is, there will be no drop in height when reaching the expected position, and level flight turning behavior can be achieved. The expected position and expected attitude can be analyzed autonomously, and whether the yaw angle needs to be changed can be determined based on the expected value.

[0104] If the yaw angle does not need to be changed, the servo angles at the rear two rotors are set to 0°. The platform is similar to a traditional UAV platform, and the controlled degrees of freedom are x, y, z, roll and pitch. The actual position and attitude are adjusted only by changing the roll angle (roll) and pitch angle (pitch).

[0105] If the yaw angle needs to be changed, the servo angle will be set to 10° and -10° respectively according to the positive and negative of the expected yaw angle. Since the goal of the multi-modal simulation platform is to change the yaw angle, the multi-modal simulation platform will suppress the change of the roll angle and pitch angle at this time to prevent the occurrence of drop height and the impact on the yaw angle solution. At this time, the control degrees of freedom are x, y and yaw. When the multi-modal simulation platform reaches the expected position and expected attitude, the servo angle will be restored to 0° to achieve a dynamic stability effect.

[0106] After introducing the application scenarios and design concepts of the embodiments of the present application, the technical solutions provided by the embodiments of the present application are described below.

[0107] like Figure 1 As shown, the present application provides an agile configuration intelligent flying car, comprising: a cycloidal rotor aircraft and a control chip; a servo is provided in the cycloidal rotor aircraft; used to achieve level flight turning behavior in the air by changing the yaw angle of the flying car; a mode switching module and an air mode control module are provided in the control chip;

[0108] The mode switching module is used to respond to the mode switching instruction, use the state machine to switch the flying car mode to the air mode, and start the air mode control module;

[0109] The air mode control module is used to determine whether the behavior of the flying car is ascending, descending or level flight turning according to the starting point and target point of the preset flight path, and based on the state parameters of the flying car at the current moment, use the air state equation to solve to obtain the optimal total lift and the optimal torque in three directions from the current moment to the next moment, and based on the optimal total lift and the optimal torque in three directions from the current moment to the next moment, use the dynamic model of air flight to calculate the lift of the four rotors of the cycloid rotor aircraft from the current moment to the next moment, and send the lift of the four rotors to the cycloid rotor aircraft.

[0110] There are four rotors in the cycloid rotor aircraft: MOTOR1, MOTOR2, MOTOR3 and MOTOR4, each of which is connected to an electronic speed controller ESC, corresponding to: ESC1, ESC2, ESC3 and ESC4. The specific structure of the cycloid rotor aircraft is shown in the figure below. Figure 2 shown.

[0111] Among them, the mode switching instruction can come from an external controller or be generated autonomously based on environmental perception.

[0112] Exemplarily, the aerial mode is that the flying car is in the air, and in this mode, actions such as ascending, descending, hovering, and level flight turning can be achieved.

[0113] When the altitude value of the starting point of the flight path is less than the altitude value of the target point, the flying car will ascend. When the altitude value of the starting point of the flight path is greater than the altitude value of the target point, the flying car will descend. The control strategies for ascending and descending include:

[0114] 1. According to the desired behavior or position, the flying car sets the steering angle to 0 to suppress the influence of yaw on the attitude of the flying car, and prepares to adjust the speed of each rotor to achieve the desired behavior or position.

[0115] 2. Provide real-time feedback of the current position, and calculate the optimal lift and torque based on the set desired position, loss function, and upper and lower limits of the state quantity.

[0116] 3. Based on the calculated lift and torque, the required rotation speed of each rotor is inversely solved according to the dynamic model and transmitted to the flying car.

[0117] 4. The flying car adjusts its displacement and attitude according to the speed required at the current moment to achieve the desired behavior or position, and finally the flying car becomes hovering.

[0118] When the altitude value of the starting point of the flight path is equal to the altitude value of the target point, and the starting point and the target point are not the same point, the flying car behaves as a level flight turn. The control strategy for level flight turns includes:

[0119] 1. According to the desired behavior or position, the flying car suppresses the influence of roll and pitch on the flying car in the controller, sets the servo angle to 10° or -10° to change the attitude of the flying car through yaw, and prepares to adjust the speed of each rotor to achieve the desired behavior or position.

[0120] 2. Provide real-time feedback of the current position, and calculate the optimal lift and torque based on the set desired position, loss function, and upper and lower limits of the state quantity.

[0121] 3. Based on the calculated lift and torque, the required rotation speed of each rotor is inversely solved according to the dynamic model and transmitted to the flying car.

[0122] 4. The flying car adjusts its displacement and attitude according to the speed required at the current moment to achieve the desired behavior or position, and finally the flying car becomes hovering.

[0123] When the starting point and the target point are the same point, the flying car behaves as hovering. The hovering control strategy includes:

[0124] The sum of the lift generated by the rotational speeds of the flying car's rotors is equal to the flying car's own gravity, and each attitude angle is 0.

[0125] In this embodiment, when the behavior of the flying car is level flight and turning;

[0126] Based on the state parameters of the flying car at the previous moment, the optimal lift and the optimal torque in three directions from the current moment to the next moment are calculated using the air state equation, including:

[0127] When the flying car is flying flat and turning, the flying car's air state equation is:

[0128]

[0129] Among them, A, B and C are matrices; x k is the current time t k The flying car state parameters: x k =[p k,x ;p k,y ;p k,z ;v k,x ;v k,y ;v k,z ;w k,x ;w k,y ;w k,z ;q k,w ;q k,x ;q k,y ;q k,z ] T Among them, (p k,x ;p k,y ;p k,z ) is the current time t k The three components of the flying car's position, (v k,x ;v k,y ;v k,z ) is the current time t k The three components of the flying car's velocity, w k,x 、w k,y and w k,z are the current time t k The rolling angular velocity, pitch angular velocity and yaw angular velocity of the flying car; [q k,w ;q k,x ;q k,y ;q k,z ] T is the current time t k The quad of the flying car;

[0130] x k+1 is the predicted next time t k+1 The flying car state parameters;

[0131] u k→k+1 is the current time t k Until the next time t k+1 System input:

[0132] u k→k+1 =[Thrust;M x ;M y ;M z ] T

[0133] Among them, Thrust is the total lift from the current moment to the next moment, M x , M y and M z They are the torques in three directions of the flying car from the current moment to the next moment;

[0134] y k+1 For the next moment t k+1 The output:

[0135] y k+1 =[p k+1,x ;p k+1,y ;p k+1,z ;yaw k+1 ] T

[0136] Among them, (p k+1,x ;p k+1,y ;p k+1,z ) is the next moment t k+1 The three components of the flying car's position, yaw k+1 For the next moment t k+1 The yaw angle of the flying car;

[0137]

[0138] Among them, p is the position vector of the flying car, is the first-order differential of p, v is the velocity vector of the flying car, is the first-order differential of v, w is the angular velocity component of the flying car, is the first-order differential of w, q is the quaternion of the flying car, is the first-order differential of q; is the differential of the flying car state parameters;

[0139] The calculation equations are as follows:

[0140]

[0141] Where c is the lift vector: c = [0; 0; Thrust] T , g is the gravity vector: g = [0; 0; 9.8] T , M is the moment vector: M = [M x ;M y ;M z ] T , J is the moment of inertia vector: J = [J xx ; J yy ; J zz ] T , J xx , J yy and J zz is the moment of inertia of the flying car in three directions; T represents transposition;

[0142] Define the loss function minJ as:

[0143] minJ=(y k+1 -y ref ) T ·Q·(y k+1 -y ref )+u k→k+1 T ·R·u k→k+1

[0144] Among them, y ref For the next moment t k+1 The expected output is:

[0145] y ref =[p ref,x ;p ref,y ;p ref,z ;yaw ref ] T

[0146] (p ref,x ;p ref,y ;p ref,z ) is the next moment t k+1 The desired position of the flying car in three directions, yaw ref For the next moment t k+1 The desired yaw angle of the flying car, Q and R are both weight matrices;

[0147] use The calculation equations and loss function are solved to get u k→k+1 The optimal vector of , that is, the optimal total lift from the current moment to the next moment and the optimal torque in three directions.

[0148] The specific solution method is:

[0149] According to the state equation and loss function, the following inequality can be obtained

[0150]

[0151] Since the unknown quantities are all related to the system input u, they can be simplified to the following inequality:

[0152]

[0153] A(u) and f(u) are functions of u;

[0154] The solution method is the Lagrange multiplier method, which is mainly as follows:

[0155] Define the following function L(u,λ):

[0156] L(u,λ)=f(u) T ·Q·f(u)+u T ·R·u+λ T (A(u)-b)

[0157] λ is the parameter vector; let the derivatives of L(u,λ) with respect to u and λ be 0, and we get the linear equation system:

[0158]

[0159] The optimal solution of u can be obtained through the above equation.

[0160] In this embodiment, when the behavior of the flying car is ascending or descending, the state equation of the flying car in the air is the same as that of the level flight and turning, except that The calculation equations are as follows:

[0161]

[0162] In this embodiment, the dynamic model of the aerial flight is:

[0163]

[0164] Among them, F1, F2, F3 and F4 represent the lift of the four rotors, M1, M2, M3 and M4 represent the torque of the four rotors, l1, l2, l3, l4 represent the distance from the center of mass of the four rotors to the center of mass of the flying car, θ is the steering gear deflection angle (preset, 10° or -10°), m is the mass of the flying car, is the optimal total lift from the current moment to the next moment, and It is the optimal torque in three directions from the current moment to the next moment.

[0165] Preferably, the control chip further includes: a ground mode control module, and the mode switching module is further used to: in response to a mode switching instruction, use a state machine to switch the flying car to a ground mode, and start the ground mode control module;

[0166] The ground mode control module is used to determine whether the behavior of the flying car is moving or stationary according to the relative positions of the starting point and the target point, and to calculate the output of the position loop and the output of the attitude loop at the next moment by using the first PID controller and the second PID controller based on the motion state parameters at the current moment, thereby obtaining the second-order differentials of the speed and steering angle at the next moment; based on the second-order differentials of the speed and steering angle at the next moment, the velocities of the four rotors of the cycloid rotor aircraft at the next moment are calculated by using the dynamic model of ground motion, and the velocities of the four rotors at the next moment are sent to the cycloid rotor aircraft.

[0167] The ground mode is when the flying car is on the ground, and in this mode, actions such as going straight, turning, and staying still can be achieved.

[0168] The control strategies for motion and immobility include:

[0169] 1. The flying car is prepared to adjust the speed of each rotor to achieve the desired behavior or position according to the desired behavior or position.

[0170] 2. Provide real-time feedback of the current position, set the displacement loop and attitude loop to calculate the required linear speed of each rotor according to the desired position.

[0171] 3. The calculated linear velocity is used to inversely solve the required rotational speed of each rotor according to the dynamic model and transmit it to the flying car.

[0172] 4. The flying car adjusts its displacement and posture according to the speed required at the current moment to achieve the desired behavior or position, and finally the flying car becomes stationary.

[0173] Specifically, based on the state parameters at the current moment, the output of the position loop and the output of the attitude loop at the next moment are calculated by using the first PID controller and the second PID controller, thereby obtaining the second-order differential of the speed and steering angle at the next moment; including:

[0174] The differential equation of the first PID controller is:

[0175]

[0176] Among them, K 1p , K 1i and K 1d Respectively represent the proportional coefficient, integral coefficient and differential coefficient of the first PID controller; e x 、ey and e z are the three components of the flying car’s position deviation:

[0177] [e x , e y , e z ] T =[p x -p x_ref , p y -p y_ref , p z -p z_ref ] T

[0178] [p x ;p y ;p z ] T are the three components of the flying car’s position at the current moment;

[0179] [p x_ref , p y_ref , p z_ref ] T are the three components of the target position of the flying car;

[0180] [δ x , δ y , δ z ] T is the output of the position loop; δ x is the first-order differential of the position in the x direction; δ y is the first-order differential of the position in the y direction; δ z is the first-order differential of the position in the z direction;

[0181] The differential equation of the second PID controller is:

[0182]

[0183] Among them, K 2p , K 2i and K 2d Respectively represent the proportional coefficient, integral coefficient and differential coefficient of the second PID controller; The steering angle deviation of the flying car is:

[0184] Yaw is the steering angle of the flying car at the current moment, yaw ref The target steering angle of the flying car;

[0185] is the output of the attitude loop at the next moment; is the first-order differential of the steering angle of the flying car;

[0186] According to the output of the position loop at the next moment, calculate the speed v of the left wheel l and the speed v of the right wheel r , get the speed at the next moment

[0187] According to the output of the attitude loop at the next moment, the second-order differential of the steering angle at the next moment is obtained.

[0188] Exemplarily, the dynamic model of the ground motion is:

[0189]

[0190] Among them, v1, v2, v3, v4 represent the speeds of the four rotors, R is the rotor radius, l l and l r are the left wheel radius and the right wheel radius.

[0191] Preferably, the control chip further includes: a surface mode control module, and the mode switching module is further used to: in response to a mode switching instruction, use a state machine to switch the flying car to the surface mode, and start the surface mode control module;

[0192] The water surface modal control module is used to determine whether the behavior of the flying car is moving or stationary according to the relative positions of the starting point and the target point, and to calculate the output of the position loop and the output of the attitude loop at the next moment based on the state parameters at the current moment by using the third PID controller and the fourth PID controller, thereby obtaining the optimal total lift and the optimal torque in the Z direction from the current moment to the next moment; based on the optimal total lift and the optimal torque in the Z direction from the current moment to the next moment, the dynamic model of water surface motion is used to calculate the lift of the four rotors of the cycloid rotor aircraft from the current moment to the next moment; and the lift of the four rotors is sent to the cycloid rotor aircraft.

[0193] The water surface mode is that the flying car is on the water surface, and in this mode, behaviors such as straight-moving, turning, and stationary can be achieved.

[0194] The control strategies for motion and immobility include:

[0195] 1. The flying car sets the speed of the two front rotors to 0 according to the desired behavior or position, and prepares to adjust the speed of the two rear rotors to achieve the desired behavior or position.

[0196] 2. Real-time feedback of the current position, setting the displacement loop and attitude loop to solve the required thrust and torque according to the expected position.

[0197] 3. Based on the calculated lift and torque, the required rotation speed of the last two rotors is inversely solved according to the dynamic model and transmitted to the flying car.

[0198] 4. The flying car adjusts its displacement and attitude according to the speed required by the two rotors at the current moment to achieve the desired behavior or position, and finally the flying car becomes stationary.

[0199] In this embodiment, based on the state parameters at the current moment, the third PID controller and the fourth PID controller are used to calculate the position loop and the attitude loop at the next moment, thereby obtaining the total lift and the torque in the Z direction from the current moment to the next moment; including:

[0200] The differential equation of the third PID controller is:

[0201]

[0202] Among them, K 3p , K 3i and K 3d They represent the proportional coefficient, integral coefficient and differential coefficient of the third PID controller respectively; e x 、e y and e z are the three components of the flying car’s position deviation:

[0203] [e x , e y , e z ] T =[p x -p x_ref , p y -p y_ref , p z -p z_ref ] T

[0204] [p x ;p y ;p z ] T are the three components of the flying car’s position at the current moment;

[0205] [p x_ref , p y_ref , p z_ref ] T are the three components of the target position of the flying car;

[0206] [δ x , δ y , δ z ] T is the output of the position loop at the next moment; [δ x , δ y , δ z ] T is the output of the position loop; δ xis the first-order differential of the position in the x direction; δ y is the first-order differential of the position in the y direction; δ z is the first-order differential of the position in the z direction;

[0207] The differential equation of the fourth PID controller is:

[0208]

[0209] Among them, K 4p , K 4i and K 4d They represent the proportional coefficient, integral coefficient and differential coefficient of the fourth PID controller respectively; e Φ , e Θ and The rolling angle deviation, pitch angle deviation and steering angle deviation of the flying car are:

[0210]

[0211] roll is the rolling angle of the flying car at the current moment, ref is the target rolling angle of the flying car; pitch is the pitch angle of the flying car at the current moment, and pitchref is the target pitch angle of the flying car; yaw is the steering angle of the flying car at the current moment, and yaw ref is the target steering angle of the flying car;

[0212] is the output of the attitude loop at the next moment; δ Φ is the first-order differential of the rolling angle; δ Θ is the first-order differential of the pitch angle; is the first-order differential of the deflection angle;

[0213] According to the output of the position loop, the optimal total lift from the current moment to the next moment is obtained According to the output of the attitude loop, the optimal torque in the Z direction from the current moment to the next moment is obtained.

[0214] In this embodiment, the dynamic model of the water surface motion is:

[0215]

[0216] Among them, F1, F2, F3 and F4 represent the lift of the four rotors respectively, M1, M2, M3 and M4 represent the torque of the four rotors respectively, l1, l2, l3, l4 represent the distance from the center of mass of the four rotors to the center of mass of the flying car respectively, and θ represents the deflection angle of the servo.

[0217] It should be noted that, although several units or subunits of the device are mentioned in the above detailed description, this division is merely exemplary and not mandatory. In fact, according to the embodiments of the present application, the features and functions of two or more units described above can be embodied in one unit. Conversely, the features and functions of one unit described above can be further divided into multiple units to be embodied.

[0218] In addition, although the operations of the method of the present application are described in a specific order in the drawings, this does not require or imply that the operations must be performed in this specific order, or that all the operations shown must be performed to achieve the desired results. Additionally or alternatively, some steps may be omitted, multiple steps may be combined into one step, and / or one step may be decomposed into multiple steps.

[0219] Finally, it should be noted that the above embodiments are only used to illustrate the technical solution of the present application and are not intended to limit it. Although the present application is described in detail with reference to the embodiments, a person skilled in the art should understand that any modification or equivalent replacement of the technical solution of the present application does not depart from the spirit and scope of the technical solution of the present application and should be included in the scope of the claims of the present application.

Claims

1. An agile intelligent flying car, characterized in that: include: A cycloid rotor aircraft and a control chip; a steering gear is arranged in the cycloid rotor aircraft; Used to achieve level flight turning behavior in the air by changing the yaw angle of the flying car; the control chip is provided with a mode switching module and an air mode control module; The mode switching module is used to respond to the mode switching instruction, use the state machine to switch the flying car mode to the air mode, and start the air mode control module; The air mode control module is used to determine whether the behavior of the flying car is ascending, descending or level flight turning according to the starting point and target point of the preset flight path, and based on the state parameters of the flying car at the current moment, use the air state equation to solve to obtain the optimal total lift and the optimal torque in three directions from the current moment to the next moment, and based on the optimal total lift and the optimal torque in three directions from the current moment to the next moment, use the dynamic model of air flight to calculate the lift of the four rotors of the cycloid rotor aircraft from the current moment to the next moment, and send the lift of the four rotors to the cycloid rotor aircraft.

2. The agile intelligent flying car according to claim 1, characterized in that: When the flying car's behavior is level flight and turning; Based on the state parameters of the flying car at the previous moment, the optimal total lift and the optimal torque in three directions from the current moment to the next moment are calculated using the air state equation, including: When the flying car is flying flat and turning, the flying car's air state equation is: Among them, A, B and C are matrices; x k is the current time t k Flying car status parameters: x k =[p k,x ;p k,y ;p k,z ;v k,x ;v k,y ;v k,z ;w k,x ;w k,y ;w k,z ;q k,w ;q k,x ;q k,y ;q k,z ] T Among them, (p k,x ;p k,y ;p k,z ) is the current time t k The three components of the flying car's position, (v k,x ;v k,y ;v k,z ) is the current time t k The three components of the flying car's velocity, w k,x 、w k,y and w k,z are the current time t k The rolling angular velocity, pitch angular velocity and yaw angular velocity of the flying car; [q k,w ;q k,x ;q k,y ;q k,z ] T is the current time t k The quad of the flying car; x k+1 is the predicted next time t k+1 The flying car state parameters; u k→k+1 is the current time t k Until the next time t k+1 Control input: u k→k+1 =[Thrust;M x ;M y ;M z ] T Among them, Thrust is the total lift from the current moment to the next moment, M x , M y and M z They are the torques in three directions of the flying car from the current moment to the next moment; y k+1 For the next moment t k+1 The output: y k+1 =[p k+1,x ;p k+1,y ;p k+1,z ;yaw k+1 ] T Among them, (p k+1,x ;p k+1,y ;p k+1,z ) is the next moment t k+1 The three components of the flying car's position, yaw k+1 For the next moment t kk+1 The yaw angle of the flying car; Among them, p is the position vector of the flying car, is the first-order differential of p, v is the velocity vector of the flying car, is the first-order differential of v, w is the angular velocity component of the flying car, is the first-order differential of w, q is the quaternion of the flying car, is the first-order differential of q; is the differential of the flying car state parameters; The calculation equations are as follows: Where c is the lift vector: c = [0; 0; Thrust] T , g is the gravity vector: g = [0; 0; 9.8] T , M is the moment vector: M = [M x ;M y ;M z ] T , J is the moment of inertia vector: J = [J xx ; J yy ; J zz ] T , J xx , J yy and J zz is the moment of inertia of the flying car in three directions; T represents transposition; Define the loss function minJ as: minJ=(and k+1 -and ref ) T ·Q·(and k+1 -and ref )+u k→k+1 T ·R·u k→k+1 Among them, y ref For the next moment t k+1 The expected output is: y ref =[p ref,x ;p ref,y ;p ref,z ;yaw ref ] T (p ref,x; p ref,y ;p ref,z ) is the next moment t k+1 The desired position of the flying car in three directions, yaw ref For the next moment t k+1 The desired yaw angle of the flying car, Q and R are both weight matrices; use The calculation equations and loss function are solved to get u k→k+1 The optimal vector of , that is, the optimal total lift from the current moment to the next moment and the optimal torque in three directions.

3. The agile intelligent flying car according to claim 1, characterized in that: When the flying car's behavior is ascending or descending; When the flying car is flying flat and turning, the flying car's air state equation is: Among them, A, B and C are matrices; x k is the current time t k Flying car status parameters: x k =[p k,x ;p k,y ;p k,z ;v k,x ;v k,y ;v k,z ;w k,x ;w k,y ;w k,z ;q k,w ;q k,x ;q k,y ;q k,z ] T Among them, (p k,x ;p k,y ;p k,z ) is the current time t k The three components of the flying car's position, (v k,x ;v k,y ;v k,z ) is the current time t k The three components of the flying car's velocity, w k,x 、w k,y and w k,z are the current time t k The rolling angular velocity, pitch angular velocity and yaw angular velocity of the flying car; [q k,w ;q k,x ;q k,y ;q k,z ] T is the current time t k The quad of the flying car; x k+1 is the predicted next time t k+1 The flying car state parameters; u k→k+1 is the current time t k Until the next time t k+1 Control input: u k→k+1 =[Thrust;M x ;M y ;M z ] T Among them, Thrust is the total lift from the current moment to the next moment, M x , M y and M z They are the torques in three directions of the flying car from the current moment to the next moment; y k+1 For the next moment t k+1 The output: y k+1 =[p k+1,x ;p k+1,y ;p k+1,z ;yaw k+1 ] T Among them, (p k+1,x ;p k+1,y ;p k+1,z ) is the next moment t k+1 The three components of the flying car's position, yaw k+1 For the next moment t k+1 The yaw angle of the flying car; Among them, p is the position vector of the flying car, is the first-order differential of p, v is the velocity vector of the flying car, is the first-order differential of v, w is the angular velocity component of the flying car, is the first-order differential of w, q is the quaternion of the flying car, is the first-order differential of q; is the differential of the flying car state parameters; The calculation equations are as follows: Where c is the lift vector: c = [0; 0; Thrust] T , g is the gravity vector: g = [0; 0; 9.8] T , M is the moment vector: M = [M x ;M y ;M z ] T , J is the moment of inertia vector: J = [J xx ; J yy ; J zz ] T , J xx , J yy and J zz is the moment of inertia of the flying car in three directions; T represents transposition; Define the loss function minJ as: minJ=(and k+1 -and ref ) T ·Q·(and k+1 -and ref )+u k→k+1 T ·R·u k→k+1 Among them, y ref For the next moment t k+1 The expected output is: y ref =[p ref,x ;p ref,y ;p ref,z ;yaw ref ] T (p ref,x ;p ref,y ;p ref,z ) is the next moment t k+1 The desired position of the flying car in three directions, yaw ref For the next moment t k+1 The desired yaw angle of the flying car, Q and R are both weight matrices; use The calculation equations and loss function are solved to get u k→k+1 The optimal vector of , that is, the optimal total lift from the current moment to the next moment and the optimal torque in three directions.

4. The agile intelligent flying car according to claim 2 or 3, characterized in that: The dynamic model of the aerial flight is: Among them, F1, F2, F3 and F4 represent the lift of the four rotors, M1, M2, M3 and M4 represent the torque of the four rotors, l1, l2, l3, l4 represent the distance from the center of mass of the four rotors to the center of mass of the flying car, θ is the steering gear deflection angle, m is the mass of the flying car, is the optimal total lift from the current moment to the next moment, and It is the optimal torque in three directions from the current moment to the next moment.

5. The agile intelligent flying car according to claim 1, characterized in that: The control chip further includes: a ground mode control module, and the mode switching module is further used to: in response to a mode switching instruction, use a state machine to switch the flying car to a ground mode, and start the ground mode control module; The ground mode control module is used to determine whether the behavior of the flying car is moving or stationary according to the relative positions of the starting point and the target point, and to calculate the output of the position loop and the output of the attitude loop at the next moment by using the first PID controller and the second PID controller based on the motion state parameters at the current moment, thereby obtaining the second-order differentials of the speed and steering angle at the next moment; based on the second-order differentials of the speed and steering angle at the next moment, the velocities of the four rotors of the cycloid rotor aircraft at the next moment are calculated by using the dynamic model of ground motion, and the velocities of the four rotors at the next moment are sent to the cycloid rotor aircraft.

6. The agile intelligent flying car according to claim 5, characterized in that: Based on the state parameters at the current moment, the output of the position loop and the output of the attitude loop at the next moment are calculated by using the first PID controller and the second PID controller, thereby obtaining the second-order differential of the speed and steering angle at the next moment; including: The differential equation of the first PID controller is: Among them, K 1p , K 1i and K 1d Respectively represent the proportional coefficient, integral coefficient and differential coefficient of the first PID controller; e x 、e y and e z are the three components of the flying car's position deviation: [e x ,e y ,e z ] T =[p x -p x_ref ,p y -p y_ref ,p z -p z_ref ] T [p x ;p y ;p z ] T are the three components of the flying car’s position at the current moment; [p x_ref , p y_ref , p z_ref ] T are the three components of the target position of the flying car; [δ x , δ y , δ z ] T is the output of the position loop; δ x is the first-order differential of the position in the x direction; δ y is the first-order differential of the position in the y direction; δ z is the first-order differential of the position in the z direction; The differential equation of the second PID controller is: Among them, K 2p , K 2i and K 2d Respectively represent the proportional coefficient, integral coefficient and differential coefficient of the second PID controller; The steering angle deviation of the flying car is: Yaw is the steering angle of the flying car at the current moment, yaw ref The target steering angle of the flying car; is the output of the attitude loop at the next moment; is the first-order differential of the steering angle of the flying car; According to the output of the position loop at the next moment, calculate the speed v of the left wheel l and the speed v of the right wheel r , get the speed at the next moment According to the output of the attitude loop at the next moment, the second-order differential of the steering angle at the next moment is obtained.

7. The agile intelligent flying car according to claim 6, characterized in that: The dynamic model of the ground motion is: Among them, v1, v2, v3, v4 represent the speeds of the four rotors, R is the rotor radius, l l and l r are the left wheel radius and the right wheel radius.

8. The agile intelligent flying car according to claim 1, characterized in that: The control chip further includes: a water surface mode control module, and the mode switching module is further used to: in response to a mode switching instruction, use a state machine to switch the flying car to a water surface mode, and start the water surface mode control module; The water surface modal control module is used to determine whether the behavior of the flying car is moving or stationary according to the relative positions of the starting point and the target point, and to calculate the output of the position loop and the output of the attitude loop at the next moment based on the state parameters at the current moment by using the third PID controller and the fourth PID controller, thereby obtaining the optimal total lift and the optimal torque in the Z direction from the current moment to the next moment; based on the optimal total lift and the optimal torque in the Z direction from the current moment to the next moment, the dynamic model of water surface motion is used to calculate the lift of the four rotors of the cycloid rotor aircraft from the current moment to the next moment; and the lift of the four rotors is sent to the cycloid rotor aircraft.

9. The agile intelligent flying car according to claim 8, characterized in that: Based on the state parameters at the current moment, the position loop and the attitude loop at the next moment are calculated by using the third PID controller and the fourth PID controller, thereby obtaining the optimal total lift and the optimal torque in the Z direction from the current moment to the next moment; including: The differential equation of the third PID controller is: Among them, K 3p , K 3i and K 3d They represent the proportional coefficient, integral coefficient and differential coefficient of the third PID controller respectively; e x 、e y and e z are the three components of the flying car's position deviation: [e x ,e y ,e z ] T =[p x -p x_ref ,p y -p y_ref ,p z -p z_ref ] T [p x ;p y ;p z ] T are the three components of the flying car’s position at the current moment; [p x_ref , p y_ref , p z_ref ] T are the three components of the target position of the flying car; [δ x , δ y , δ z ] T is the output of the position loop at the next moment; [δ x , δ y , δ z ] T is the output of the position loop; δ x is the first-order differential of the position in the x direction; δ y is the first-order differential of the position in the y direction; δ z is the first-order differential of the position in the z direction; The differential equation of the fourth PID controller is: Among them, K 4p , K 4i and K 4d They represent the proportional coefficient, integral coefficient and differential coefficient of the fourth PID controller respectively; e Φ , e Θ and The rolling angle deviation, pitch angle deviation and steering angle deviation of the flying car are: roll is the rolling angle of the flying car at the current moment, ref is the target rolling angle of the flying car; pitch is the pitch angle of the flying car at the current moment, ref is the target pitch angle of the flying car; yaw is the steering angle of the flying car at the current moment, yaw ref is the target steering angle of the flying car; is the output of the attitude loop at the next moment; δ Φ is the first-order differential of the rolling angle; δ Θ is the first-order differential of the pitch angle; is the first-order differential of the deflection angle; According to the output of the position loop, the optimal total lift from the current moment to the next moment is obtained According to the output of the attitude loop, the optimal torque in the Z direction from the current moment to the next moment is obtained.

10. The agile intelligent flying car according to claim 9, characterized in that: The dynamic model of the water surface motion is: Among them, F1, F2, F3 and F4 represent the lift of the four rotors, M1, M2, M3 and M4 represent the torque of the four rotors, l1, l2, l3, l4 represent the distance from the center of mass of the four rotors to the center of mass of the flying car, and θ represents the deflection angle of the servo.