This application is based upon and claims priority to Chinese Patent Application No. 202110083068.0, filed on Jan. 21, 2021, the entire contents of which are incorporated herein by reference.
The present invention relates to the field of vehicle technology, and in particular, to a takeoff and landing control method and control apparatus of a multimodal air-ground amphibious vehicle, and a computer storage medium.
A multimodal air-ground amphibious vehicle (flying automobile) is transport means that combines advantages of an aircraft and an automobile. Nowadays, with an increasingly serious traffic congestion problem, a multimodal air-ground amphibious vehicle that can both fly in the air and travel on the ground brings a new travel mode for human beings while solving the traffic congestion problem.
However, it is difficult to precisely control the motion state of the multimodal air-ground amphibious vehicle due to complex forces during takeoff and landing of the multimodal air-ground amphibious vehicle.
An object of the present invention is providing a takeoff and landing control method and control apparatus of a multimodal air-ground amphibious vehicle, and a computer storage medium, to precisely control the motion state of the multimodal air-ground amphibious vehicle during takeoff and landing.
To achieve the above object, the present invention provides a takeoff and landing control method of a multimodal air-ground amphibious vehicle. The multimodal air-ground amphibious vehicle includes an aircraft and a vehicle that are rigidly connected, the takeoff and landing control method of the multimodal air-ground amphibious vehicle including:
receiving dynamic parameters of the multimodal air-ground amphibious vehicle;
processing the dynamic parameters by a coupled dynamic model of the multimodal air-ground amphibious vehicle to obtain dynamic control parameters of the multimodal air-ground amphibious vehicle, wherein the coupled dynamic model of the multimodal air-ground amphibious vehicle includes a motion equation of the multimodal air-ground amphibious vehicle in a touchdown state; and the motion equation of the multimodal air-ground amphibious vehicle in a touchdown state is determined by a two-degree-of-freedom suspension dynamic equation and a six-degree-of-freedom motion equation of the multimodal air-ground amphibious vehicle in the touchdown state; and
controlling takeoff and landing of the multimodal air-ground amphibious vehicle according to the dynamic control parameters of the multimodal air-ground amphibious vehicle.
Compared with the prior art, the takeoff and landing control method of a multimodal air-ground amphibious vehicle provided in the present invention, by using the motion equation of the multimodal air-ground amphibious vehicle in the touchdown state determined by the two-degree-of-freedom suspension dynamic equation and the six-degree-of-freedom motion equation of the multimodal air-ground amphibious vehicle in the touchdown state, not only can accurately describe the motion state on six degrees of freedom during takeoff and landing of the multimodal air-ground amphibious vehicle, but also can accurately describe the motion state on two degrees of freedom (vertical direction) of the suspension during takeoff and landing of the multimodal air-ground amphibious vehicle. In this case, the motion states in the vertical direction of the tires and vehicle body connected to the suspension can be determined from the motion state in the vertical direction of the suspension, so that the motion state on the six degrees of freedom of the multimodal air-ground amphibious vehicle and the motion states in the vertical direction of the tires, the suspension and the vehicle body can be controlled during takeoff and landing by using the coupled dynamic model of the multimodal air-ground amphibious vehicle containing the motion equation of the multimodal air-ground amphibious vehicle in the touchdown state, to achieve the purpose of precisely controlling the motion state of the multimodal air-ground amphibious vehicle during takeoff and landing to avoid accidents.
The present invention also provides a takeoff and landing control apparatus of a multimodal air-ground amphibious vehicle. The takeoff and landing control apparatus of a multimodal air-ground amphibious vehicle includes a processor and a communication interface coupled to the processor, wherein processor is configured to run a computer program or instructions to execute the above-mentioned takeoff and landing control method of a multimodal air-ground amphibious vehicle.
Compared with the prior art, the takeoff and landing control apparatus of a multimodal air-ground amphibious vehicle provided in the present invention has the same beneficial effects as the takeoff and landing control method of a multimodal air-ground amphibious vehicle described in the above technical solution, which will not be repeated here.
The present invention also provides a computer storage medium. The computer storage medium stores instructions which, when being run, implement the above-mentioned takeoff and landing control method of a multimodal air-ground amphibious vehicle.
Compared with the prior art, the computer storage medium provided in the present invention has the same beneficial effects as the takeoff and landing control method of a multimodal air-ground amphibious vehicle described in the above technical solution, which will not be repeated here.
The drawings described here are used to provide further understanding of the present invention and form a part of the present invention. The illustrative embodiments of the present invention and description thereof are used for explaining rather than unduly limiting the present invention. In the drawings:
In
To make the technical problems to be solved, technical solutions, and beneficial effects of the present invention clearer and more apparent, the present invention will be further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used for explaining the present invention, rather than limiting the present invention.
It is to be noted that when an element is described as being “fixed to” or “arranged on” another element, it may be directly on another element or indirectly on another element. When an element is described as being “connected” to another element, it may be directly connected to another element or indirectly connected to another element.
In addition, the terms “first”, “second” and the like are used only for descriptive purposes and cannot be construed as indicating or implying relative importance or implicitly indicating the numbers of indicated technical features. Thus, a feature qualified by the term “first”, “second” or the like may explicitly or implicitly include one or more such features. In description of the present invention, the term “plurality” means two or more, unless otherwise expressly and specifically defined. The term “a number of” means one or more, unless otherwise expressly and specifically defined.
In description of the present invention, it needs to be understood that orientation or location relations denoted by the terms “upper”, “lower”, “front”, “back”, “left”, “right”, etc. are orientation or location relations based on illustration in the drawings, are only intended to facilitate describing the present invention and simplify description, instead of indicating or implying the denoted devices or elements necessarily have specific orientations and are constructed and operated in specific orientations, and thus they cannot be construed as limiting the present invention.
In description of the present invention, it is to be noted that, unless otherwise clearly specified and defined, the terms “install”, “be connected with”, “be connected”, etc., should be understood in a broad sense. For example, the term “be connected” may indicate “be fixedly connected”, “be detachably connected”, “be integratedly connected”, “be mechanically connected”, “be electrically connected”, “be directly connected”, “be indirectly connected through an intermediate medium”, or “internal communication between two elements or interactive relationship between two elements”. For those of ordinary skill in the art, the specific meanings of the above terms in the present invention may be understood according to specific circumstances.
An embodiment of the present invention provides a takeoff and landing control method of a multimodal air-ground amphibious vehicle. The multimodal air-ground amphibious vehicle may also be referred to as a flying automobile. For the sake of brevity, the following description will be made with a flying automobile. The flying automobile includes an aircraft and a vehicle that are rigidly connected. For example, the aircraft is arranged on the top of the vehicle by means of a connecting rod.
The above-mentioned aircraft mainly provides a flight driving force for the flying automobile, so that the flying automobile can fly in the air. It should be understood that the aircraft may be a rotorcraft with six rotors, four rotors or other number of rotors, and may also be any other aircraft with a flight function.
The above-mentioned vehicle mainly provides a driving force for the flying automobile to travel on the ground, so that the flying automobile can travel on the ground. It should be understood that the vehicle may be a four-wheeled automobile, a six-wheeled automobile, a two-wheeled motorcycle, or the like, as long as it has the ability to travel on the ground, and the specific structure of the vehicle is not specifically limited in embodiments of the present invention. The above-mentioned vehicle may be unmanned transport means, or manned transport means. The transport means may be an automobile, or any other vehicle, or a device in any other vehicle form, such as a car, a truck, a motorcycle or a bus.
The above-mentioned takeoff and landing control method of a flying automobile may be used for motion state control of the flying automobile in a takeoff/landing state, or for motion state control of the flying automobile in a flying state, or for motion state control of the flying automobile in a touchdown state.
When the flying automobile is in the flying state or touchdown state, the flying automobile is in a typical single traveling mode, and the motion state of the flying automobile is determined by the aircraft or the vehicle. When the flying automobile is in the flying state, the aircraft provides a driving force for the flying automobile, and the motion state of the flying automobile is determined by dynamic parameters of the aircraft. In this case, adjusting the dynamic parameters of the aircraft can achieve motion state control of the entire flying automobile. When the flying automobile is in the touchdown state, the vehicle provides a driving force for the flying automobile, and the motion state of the flying automobile is determined by dynamic parameters of the vehicle. In this case, adjusting the dynamic parameters of the vehicle can achieve motion state control of the entire flying automobile.
When the flying automobile takes off or lands, the aircraft and the vehicle of the flying automobile work simultaneously to jointly provide a driving force for the flying automobile, and the aircraft and the vehicle interact with each other to produce a complex coupling effect in the flying automobile. In this case, it is difficult to precisely control the motion state of the flying automobile by the aircraft or the vehicle alone.
To solve the above problem, the takeoff and landing control method of a flying automobile provided in the embodiment of the present invention may be executed by a terminal device or by a chip applied to a terminal device. As shown in
Step 110: receiving, by a terminal device, dynamic parameters of the flying automobile. The above-mentioned dynamic parameters include attitude parameters of tires of the flying automobile and flight dynamic parameters.
The attitude parameters of each tire include an angular velocity and a steering angle. The steering angle of each tire is an angle of rotation of each tire around a z-axis. The angular velocity of each tire is an angular velocity of rotation of each tire around the center of the tire. The flight dynamic parameters include dynamic parameters of vertical motion, dynamic parameters of roll motion, dynamic parameters of pitch motion, and dynamic parameters of yaw motion of the aircraft.
Step 120: processing, by the terminal device, the dynamic parameters by using a coupled dynamic model of the flying automobile to obtain dynamic control parameters of the flying automobile.
The coupled dynamic model of the flying automobile includes a motion equation of the flying automobile in the touchdown state and a motion equation of the flying automobile in the flying state. The motion equation of the flying automobile in the touchdown state is determined by a two-degree-of-freedom suspension dynamic equation and a six-degree-of-freedom motion equation of the flying automobile in the touchdown state.
The above-mentioned dynamic control parameters include motion parameters of six degrees of freedom of the flying automobile, a vertical displacement of each tire of the flying automobile, and a vertical displacement of a vehicle body corresponding to each tire of the flying automobile.
The above-mentioned six degrees of freedom are motion along an x-axis direction, along a y-axis direction, and along a z-axis direction, roll motion around the x-axis, pitch motion around the y-axis, and vertical motion around the z-axis.
The motion parameters of the six degrees of freedom of the flying automobile include a velocity of the flying automobile in the x-axis direction, a velocity of the flying automobile in the y-axis direction, a velocity of the flying automobile in the z-axis direction, a roll angle of the flying automobile around the x-axis, a pitch angle of the flying automobile around the y-axis, and a yaw angle of the flying automobile around the z-axis.
As shown in
The complexity of motion state control of the flying automobile in the touchdown state is mainly reflected in the influence by various forces during motion, such as ground contact force, friction force and disturbance force. These unpredictable forces bring challenges to the control work of the flying automobile.
In formula I, M is a mass of the flying automobile, is a sprung mass, g is a gravitational acceleration, Ix is a rotational inertia around the x-axis of the flying automobile with respect to a center of mass, Ix is a rotational inertia around the z-axis of the flying automobile with respect to the center of mass, VX is a velocity of the flying automobile in the x-axis direction, VY is a velocity of the flying automobile in the y-axis direction, ϕ is a roll angle of the flying automobile around the x-axis, Ψ is a yaw angle of the flying automobile around the z-axis, δi is a tire steering angle, Fdi is a tire longitudinal force of the flying automobile, FLi is a tire lateral force of the flying automobile, Fa is air resistance of the flying automobile during travel in the touchdown state, Kx is the equivalent stiffness of the flying automobile around the x-axis, Bx is the equivalent damping of the flying automobile around the x-axis, hs is a height from a center of gravity of the sprung mass to a center of gravity of the vehicle, Lx is a distance of a tire from the center of the flying automobile in the x-axis direction, Ly is a distance of the tire from the center of the flying automobile in the y-axis direction distance, i is a tire number, MW is a tire mass, and Ma is an air resistance moment of the flying automobile traveling in the touchdown state.
The air resistance Fa in the above-mentioned motion equation of the flying automobile in the touchdown state satisfies:
Fa=½CDρDADV2 formula II.
In formula II, ρa is an air density parameter, generally of 1.2258N·s2·m−4; AD is a windward area of the vehicle; CD represents an air resistance coefficient; and V is a velocity in a motion direction.
In description of the suspension of the flying automobile by using the equivalent stiffness Kx of the flying automobile around the x-axis and the equivalent damping Bx of the flying automobile around the x-axis, although the influence of the suspension on the attitude can be expressed simply and effectively, the displacements of each tire and the suspension cannot be known when the flying automobile is moving on the ground, and the motion states of each tire and the suspension during takeoff and landing of the flying automobile cannot be described.
The tire longitudinal force Fdi of the flying automobile in the above-mentioned motion equation of the flying automobile in the touchdown state satisfies:
In formula III, αi is a tire cornering angle, kdi is a tire longitudinal slip stiffness coefficient, FNi is a vertical load pressure of each tire, ζi is a tire longitudinal slip rate, and i is the tire number.
In view of the fact that an acting force between the tire and the ground is mainly generated by elastic deformation and local slip of the tire, thus in analysis of the tire longitudinal force, it is described by using the tire longitudinal slip rate ζi to facilitate its mathematical expression. The physical meaning of the tire longitudinal slip rate ζi is a ratio between a sliding velocity and an actual velocity during motion of the tire. The tire longitudinal slip rate ζi satisfies:
In formula IV, Rwi is a tire radius, ωwi is a tire angular velocity, vwi is a tire cornering velocity, and i is the tire number.
The above-mentioned tire cornering velocity vwi satisfies:
v
wi=(Vl−ωwi·Lx) cos δi+(Vr+{dot over (Ψ)}·Ly)sin δi formula V.
In formula V, Vi is a longitudinal velocity of the vehicle, Vr is a lateral velocity of the vehicle, Lx is the distance of a tire from the center of the flying automobile in the x-axis direction, Ly is the distance of a tire from the center of the flying automobile in the y-axis direction, ωwi is the tire angular velocity, Ψ is the yaw angle of the flying automobile around the z-axis, δi is the tire steering angle, and i is the tire number.
The above-mentioned longitudinal velocity Vi of the vehicle and lateral velocity Vr of the vehicle satisfy:
V
l
=V
X cos(Ψ)+VY sin(Ψ)
V
r
=−X sin(Ψ)+VY cos(Ψ) formula VI.
In formula VI, VX is the velocity of the flying automobile in the x-axis direction, VY is the velocity of the flying automobile in the y-axis direction, and Ψ is the yaw angle of the flying automobile around the z-axis.
When the flying automobile is in the touchdown state, and a traveling direction changes during traveling on the ground, the motion direction of a tire deviates from the direction of its rotation plane, which is a cornering phenomenon of the tire. In this case, the tire correspondingly slides laterally, thereby generating a corresponding frictional force with the ground, that is, the tire lateral force FLi. The included angle αi between an actual motion velocity of the tire and its rotation plane is the tire cornering angle. As the tire cornering angle can be calculated from a motion velocity of the flying automobile, the tire lateral force FLi in the above-mentioned motion equation of the flying automobile in the touchdown state satisfies:
In formula VII, kLi is a tire lateral slip stiffness coefficient, αi is the tire cornering angle, FNi is the tire vertical load, and i is the tire number.
The tire vertical load FNi in the tire longitudinal force Fdi and tire lateral force FLi described above can be expressed as:
F
Ni=Mg/4−Fiz formula VIII.
In formula VIII, Fiz is a compensating force to the suspension, M is the mass of the flying automobile, g is the gravitational acceleration, and i is the tire number.
As the flying automobile often has a large angular attitude change during motion, Fiz is used to describe the compensating force to the suspension due to a large attitude change, and the above-mentioned compensating force Fiz to the suspension can be expressed as:
F
iz
=[L
x sin(θ)kz2+cz{dot over (θ)}]+[Ly sin(ϕ)kz2+cz{dot over (ϕ)}] formula IX.
In formula IX, Lx and Ly are the distances of a tire from the center of the flying automobile in the x-axis direction and in the y-axis direction, respectively, Kz2 is a suspension shock absorber stiffness, cz a suspension shock absorber damping coefficient, θ is the pitch angle of the flying automobile around the y-axis, and φ is the roll angle of the flying automobile around the x-axis.
In view of the fact that the tire vertical load force FNi is related to coordinates of each tire, the coordinates of each tire can be expressed as:
X-axis: (Xt+sin(θ)hs)±Lx cos(θ)
Y-axis: (Yt+sin(θ)hs)±Ly cos(ϕ)
Z-axis: (Zt−cos(θ)cos(ϕ)hs)±Lz sin(θ)±Ly sin(ϕ)−Zi1 formula X.
In formula X, Xt, Yt and Zt are x-axis, y-axis and z-axis coordinates of the flying automobile in a geodesic coordinate system at time t, Lx is the distance of a tire from the center of the flying automobile in the x-axis direction, Ly is the distance of the tires from the center of the flying automobile in the y-axis direction, Zi1 is the vertical displacement of each tire, k is the height from the center of gravity of the sprung mass to the center of gravity of the vehicle, ϕ is the roll angle of the flying automobile around the x-axis, and θ is the pitch angle of the flying automobile around the y-axis.
As the coordinate origin of the flying automobile is at the center of gravity of the flying automobile, the tire is in the touchdown state when the Z-axis coordinate of each tire satisfies (Zt−cos(θ)cos(ϕ)hs)±Lx sin(θ)±sin(ϕ)−Zi1=hcg. In this case, the tire vertical load force FNi can be expressed as:
In formula XI, hcg is a height from the center of gravity of the flying automobile to the tire center, Fiz is the compensating force to the suspension, M is the mass of the flying automobile, g is the gravitational acceleration, ϕ is the roll angle of the flying automobile around the x-axis, θ is the pitch angle of the flying automobile around the y-axis, Kt is the number of tires that touch the ground at the time t, and u1 is a dynamic input of vertical motion of the flying automobile in the flying state.
In view of this, in the embodiment of the present invention, the motion equation of the flying automobile in the touchdown state is corrected by the two-degree-of-freedom suspension dynamic equation, and an attitude motion equation of the flying automobile around the y-axis is additionally established to obtain the six-degree-of-freedom motion equation of the flying automobile in the touchdown state.
M
w
{umlaut over (z)}
i1
=−c
z(żi1−żi2)−kz2(Zi1−Zi2)−kz1Zi1+q
M
s
{umlaut over (z)}
i2
=−c
z(żi2−żi1)−kz2(Zi2−Zi1)−FNi formula XII.
In formula XII, FNi is the vertical load of each tire, Mw is the tire mass, Ms is the sprung mass, Kz1 is a tire stiffness, Kz2 is the suspension shock absorber stiffness, cz is the suspension shock absorber damping coefficient, Zi2 is the vertical displacement of the vehicle body corresponding to each tire, Zi1 is the vertical displacement of each tire, q is an external excitation to the vehicle, and i is the tire number.
The above-mentioned six-degree-of-freedom motion equation of the flying automobile in the touchdown state satisfies:
In formula XIII, M is the mass of the flying automobile, Ms is the sprung mass, Ix is the rotational inertia around the x-axis of the flying automobile with respect to the center of mass, Iy is the rotational inertia around the y-axis of the flying automobile with respect to the center of mass, Iz is the rotational inertia around the z-axis of the flying automobile with respect to the center of mass, ϕ is the roll angle of the flying automobile around the x-axis, θ is the pitch angle of the flying automobile around the y-axis, Ψ is the yaw angle of the flying automobile around the z-axis, VX is the velocity of the flying automobile in the x-axis direction, VY is the velocity of the flying automobile in the y-axis direction, Fdi is the tire longitudinal force of the flying automobile, FLi is the tire lateral force of the flying automobile, δi is the tire steering angle, Fa is the air resistance of the flying automobile traveling in the touchdown state, g is the gravitational acceleration, hs is the height from the center of gravity of the sprung mass to the center of gravity of the vehicle, Lx is the distance of a tire from the center of the flying automobile in the x-axis direction, Ly is the distance of the tire from the center of the flying automobile in the y-axis direction distance, Zi2 is the vertical displacement of the vehicle body corresponding to each tire, Zi1 is the vertical displacement of each tire, Ma is the air resistance moment of the flying automobile traveling in the touchdown state, and i is the tire number.
The motion equation of the flying automobile in the touchdown state determined by the two-degree-of-freedom suspension dynamic equation and the six-degree-of-freedom motion equation of the flying automobile in the touchdown state described above satisfies:
In formula XIV, M is the mass of the flying automobile, MS is the sprung mass, MW is the tire mass, Ix is the rotational inertia around the x-axis of the flying automobile with respect to the center of mass, Iy is the rotational inertia around the y-axis of the flying automobile with respect to the center of mass, Iz is the rotational inertia around the z-axis of the flying automobile with respect to the center of mass, ϕ is the roll angle of the flying automobile around the x-axis, θ is the pitch angle of the flying automobile around the y-axis, Ψ is the yaw angle of the flying automobile around the z-axis, VX is the velocity of the flying automobile in the x-axis direction, VY is the velocity of the flying automobile in the y-axis direction, Fdi is the tire longitudinal force of the flying automobile, FLi is the tire lateral force of the flying automobile, δi is the tire steering angle, Fa is the air resistance of the flying automobile traveling in the touchdown state, g is the gravitational acceleration, hs is the height from the center of gravity of the sprung mass to the center of gravity of the vehicle, Lx is the distance of a tire from the center of the flying automobile in the x-axis direction, Ly is the distance of the tire from the center of the flying automobile in the y-axis direction distance, Zi2 is the vertical displacement of the vehicle body corresponding to each tire, Zi1 is the vertical displacement of each tire, Ma is the air resistance moment of the flying automobile traveling in the touchdown state, Kz1 is the tire stiffness, Kz2 is the suspension shock absorber stiffness, cz is the suspension shock absorber damping coefficient, q is the external excitation to the vehicle, Zi2 is the vertical displacement of the vehicle body corresponding to each tire, Zi1 is the vertical displacement of each tire, FNi is the vertical load pressure of the tire, and i is the tire number.
To enable the above-mentioned coupled dynamic model of the flying automobile to be used for both motion state control of the flying automobile in the touchdown state and motion state control of the flying automobile in the flying state, a motion equation of the flying automobile in the flying state can be added to the coupled dynamic model of the flying automobile. In this case, in addition to the motion equation of the flying automobile in the touchdown state, the coupled dynamic model of the flying automobile also includes the motion equation of the flying automobile in the flying state. The motion equation of the flying automobile in the flying state satisfies:
m{dot over (V)}
X
=−K
1
V
X−(cos Ψ sin θ cos ϕ+sin Ψsin ϕ)·u1
m{dot over (V)}
Y
=−K
2
V
Y−(sin Ψ sin θ cos ϕ−cos Ψsin ϕ)·u1
m{dot over (V)}
Z
=−K
3
V
Z−mg+cos ϕ cos θ·u1
I
x
{umlaut over (ϕ)}=−K
4
l{dot over (ϕ)}+l·u
2
I
y
{umlaut over (θ)}=−K
5
l{dot over (θ)}+l·u
3
I
z
{umlaut over (Ψ)}=−K
6{dot over (Ψ)}+c·u4 formula XV.
In formula XV, m is a mass of the aircraft, g is the gravitational acceleration, VX is the velocity of the flying automobile in the x-axis direction, VY is the velocity of the flying automobile in the y-axis direction, VZ is the velocity of the flying automobile in the z-axis direction, Ix is the rotational inertia around the x-axis of the flying automobile with respect to the center of mass, Iy is the rotational inertia around the y-axis of the flying automobile with respect to the center of mass, Iz is the rotational inertia around the z-axis of the flying automobile with respect to the center of mass, ϕ is the roll angle of the flying automobile around the x-axis, θ is the pitch angle of the flying automobile around the y-axis, Ψ is the yaw angle of the flying automobile around the z-axis, Ki(i=1 . . . 6) is an aerodynamic damping parameter, l is a distance from the center of the aircraft to a propeller axis, c is a conversion constant between a force and a moment. u1 is the dynamic input of vertical motion of the flying automobile in the flying state, u2 is a dynamic input of roll motion of the flying automobile in the flying state, u3 is a dynamic input of pitch motion of the flying automobile in the flying state, and u4 is a dynamic input of yaw motion of the flying automobile in the flying state.
In the flying state, the flying automobile is driven by the aircraft, so dynamic parameters of the above-mentioned motion equation of the flying automobile in the flying state are ui, u2, u3, and u4. In this case, u1 is a dynamic input of vertical motion of the aircraft, u2 is a dynamic input of roll motion of the aircraft, u3 is a dynamic input of pitch motion of the aircraft, and u4 is a dynamic input of yaw motion of the aircraft.
Exemplarily, as shown in
Vertical motion: By changing a throttle command signal to cause the rotational speeds of the six rotors to increase or decrease at the same time, upward or downward longitudinal motion of the aircraft relative to the geodesic coordinate system can be achieved, and especially when a lift provided by the six rotors is equal to the gravity of the aircraft, the aircraft is in a hovering flying state, which is denoted as u(1).
Roll motion: when a roll command signal is generated, the rotational speeds of the rotors 1, 3 and 5 increase (or decrease), while the rotational speeds of the rotors 2, 4 and 6 decrease (or increase). As aerodynamic moments on both sides of the aircraft body cannot be offset, a rolling moment relative to a body axis is generated, causing roll motion of the aircraft along the x-axis direction of the body, which is denoted as u(2).
Pitch motion: when a pitch command signal is generated, the rotational speeds of the rotors 1 and 2 increase (or decrease), while the rotational speeds of the rotors 4 and 5 decrease (or increase) and the rotational speeds of the rotors 3 and 6 remain unchanged, thereby generating a pitch moment relative to the body axis and causing pitch motion of the aircraft. When the pitch motion is generated, it also causes horizontal motion of the aircraft in a horizontal plane along the y-axis direction of the body, which is denoted as u(3).
Yaw motion: when a reaction torque generated by the three rotors rotating clockwise and a reaction torque generated by the three rotors rotating counter-clockwise cannot be offset, a yaw moment is generated to cause yaw motion of the aircraft. When there is a yaw command signal, the rotational speeds of the rotors 1, 3 and 5 (counter-clockwise blades) increase (or decrease), while the rotational speeds of the rotors 2, 4 and 6 (clockwise blades) decrease (or increase), the magnitudes of the reaction torques generated by the counter-clockwise blades and the clockwise blades are different, thereby generating a yaw moment around the z-axis of the body and causing yaw motion of the aircraft, which is denoted as u(4).
u1, u2, u3, and u4 in the above-mentioned motion equation of the flying automobile in the flying state satisfy:
In formula XVI, cα=3.5×10−5 is a conversion coefficient between a rotational speed and a thrust, α=30° is half of a mounting angle of each arm, Ωi(i=1 . . . 6) is the rotational speed of each rotor, and i is a rotor number.
The coupled dynamic model of the flying automobile can be determined by using the motion equation of the flying automobile in the flying state and the motion equation of the flying automobile in the touchdown state described above.
In formula XVII, M is the mass of the flying automobile, MS is the sprung mass, MW is the tire mass, Mla is the air resistance moment of the flying automobile traveling in the touchdown state, Ix is the rotational inertia around the x-axis of the flying automobile with respect to the center of mass, Iy is the rotational inertia around the y-axis of the flying automobile with respect to the center of mass, Iz is the rotational inertia around the z-axis of the flying automobile with respect to the center of mass, K1, K2, K3, K4, K5, and K6 are aerodynamic damping parameters of the flying automobile in six degrees of freedom, respectively, l is the distance from the center of the aircraft to the propeller axis, c is the conversion constant between a force and a moment, VX the velocity of the flying automobile in the x-axis direction, VY the velocity of the flying automobile in the y-axis direction, VZ the velocity of the flying automobile in the z-axis direction, ϕ is the roll angle of the flying automobile around the x-axis, θ is the pitch angle of the flying automobile around the y-axis, Ψ is the yaw angle of the flying automobile around the z-axis, δi is the tire steering angle, Fdi is the tire longitudinal force of the flying automobile, FLi is the tire lateral force of the flying automobile, FNi is the tire vertical load, FN is the sum of tire vertical loads, Fa is the air resistance of the flying automobile traveling in the touchdown state, g is the gravitational acceleration, Kz1 is the tire stiffness, Kz2 is the suspension shock absorber stiffness, cz is the suspension shock absorber damping coefficient, Zi2 is the vertical displacement of the body corresponding to each tire, Zi1 is the vertical displacement of each tire, q is the external excitation to the vehicle, hs is the height from the center of gravity of the sprung mass to the center of gravity of the vehicle, Lx is the distance of a tire from the center of the flying automobile in the x-axis direction, Ly is the distance of the tire from the center of the flying automobile in the y-axis direction distance, u1 is the dynamic input of vertical motion of the flying automobile in the flying state, u2 is the dynamic input of roll motion of the flying automobile in the flying state, u3 is the dynamic input of pitch motion of the flying automobile in the flying state, and u4 is the dynamic input of yaw motion of the flying automobile in the flying state, and i is the tire number.
As shown in
In the process that the coupled dynamic model of the flying automobile processes the dynamic parameters and outputs the dynamic control parameters of the flying automobile, the dynamic parameters are input variables to the coupled dynamic model of the flying automobile, the dynamic control parameters of the flying automobile are output variables of the coupled dynamic model of the flying automobile, and the tire longitudinal force Fdi of the flying automobile, the tire lateral force FLi of the flying automobile, and the tire vertical load FNi are all intermediate variables.
Step 130: controlling, by the terminal device, takeoff and landing of the flying automobile according to the dynamic control parameters of the flying automobile.
In the takeoff and landing control method of a flying automobile provided in the embodiment of the present invention, the motion equation of the flying automobile in the touchdown state determined by the two-degree-of-freedom suspension dynamic equation and the six-degree-of-freedom motion equation of the flying automobile in the touchdown state not only can accurately describe the motion state on six degrees of freedom during takeoff and landing of the flying automobile, but also can accurately describe the motion state on two degrees of freedom (vertical direction) of the suspension during takeoff and landing of the flying automobile. In this case, the motion states in the vertical direction of the tires and vehicle body connected to the suspension can be determined from the motion state in the vertical direction of the suspension, so that the motion state on the six degrees of freedom of the flying automobile and the motion states in the vertical direction of the tires, the suspension and the vehicle body can be controlled during takeoff and landing by using the coupled dynamic model of the flying automobile containing the motion equation of the flying automobile in the touchdown state, to achieve the purpose of precisely controlling the motion state of the flying automobile during takeoff and landing to avoid accidents.
In practical applications, the motion state of the flying automobile during takeoff and landing can be controlled according to the relationship between the dynamic parameters of the flying automobile and the dynamic control parameters of the flying automobile.
For example, the angular velocity of a tire and the steering angle of the tire are adjusted according to the vertical displacement of the tire output from the coupled dynamic model of the flying automobile to obtain an ideal vertical displacement of the tire.
As another example, the tire angular velocity and the flight dynamic parameters u1, u2, u3, and u4, etc. are adjusted according to the velocity VX of the flying automobile in the x-axis direction output by the coupled dynamic model of the flying automobile to obtain an ideal velocity VXof the flying automobile in the x-axis direction.
To verify the reliability of the above-mentioned coupled dynamic model of the flying automobile, a coupled dynamic model of a flying automobile composed of a six-rotor aircraft and a four-wheeled automobile is established in a Simulink module of MATLAB software by using an Intel 15-7400 processor, and an embodiment simulation experiment is performed by calculation using an ode-45 algorithm. Since the coupling of the parts of the flying automobile is obvious during landing, considering practical use of the flying automobile, the following four embodiments are carried out: an experiment of only traveling on the ground, an experiment of only flying in the air, an experiment of two-wheel touchdown after takeoff and an experiment of single-wheel touchdown after takeoff. The four embodiments are used to verify the reliability of the coupled dynamic model of the flying automobile of the embodiments of the present invention. Parameters used in the following embodiments are shown in Table 1.
(1) Embodiment of Only Traveling on the Ground
The simulation embodiment is used to verify the reliability of the coupled dynamic model of the flying automobile at the time of traveling on the ground. In this simulation embodiment, the rotor-type flying automobile accelerates gradually from a stationary state on the ground and performs steering. A simulation result of this embodiment is shown in
According to
(2) Embodiment of Only Flying in the Air
The simulation embodiment is used to verify the reliability of the coupled dynamic model of the flying automobile at the time of flying in the air. In this simulation embodiment, the rotor-type flying automobile accelerates gradually from a hovering state in the air and performs steering. A simulation result of this embodiment is shown in
According to
(3) Embodiment of Two-Wheel Touchdown After Takeoff
The simulation embodiment is used to verify the reliability of the coupled dynamic model of the flying automobile at the time of takeoff and landing. In this simulation embodiment, the rotor-type flying automobile accelerates gradually from a stationary state on the ground, and then takes off by a lift provided gradually by the rotor part, and during landing, it undergoes changes in an undulation angle θ due to attitude adjustment, and finally touches the ground with two wheels. A simulation result of this embodiment is shown in
As can be seen from the above description, in this embodiment, when the vehicle lands, it undergoes changes in the undulation angle θ due to attitude adjustment, and the front and rear tires of the vehicle do not touch the ground at the same time due to the presence of the angle θ, and as the angle θ is positive during landing, a pair of rear wheels touch the ground before a pair of front wheels, and then after touchdown, the suspension corresponding to the front and rear wheels is subjected to impacts successively, and after all the four wheels touch the ground, the angle θ gradually returns to 0 in continuous vibrations of the suspension.
According to
(4) Embodiment of Single-Wheel Touchdown After Takeoff
The simulation embodiment is used to verify the reliability of the coupled dynamic model of the flying automobile at the time of takeoff and landing. In this simulation embodiment, the rotor-type flying automobile accelerates gradually from a stationary state on the ground, and then takes off by a lift provided gradually by the rotor part, and during landing, it undergoes changes in an undulation angle θ due to attitude adjustment, and finally touches the ground. Due to crosswind of 5 m/s during landing, the rotor-type flying automobile has a relatively large lateral velocity, and if it lands at this velocity, the vehicle is liable to roll over laterally. Therefore, the rotor-type flying automobile needs to adjust a roll angle θ to offset a lateral velocity change caused by the crosswind, but adjusting the angle ϕ will cause the rotor-type flying automobile to touch the ground with a single wheel during landing. A simulation result of this embodiment is shown in
As can be seen from the above description, in this embodiment, when the vehicle lands, it undergoes changes in the undulation angle θ due to attitude adjustment, and the front and rear tires of the vehicle do not touch the ground at the same time due to the presence of the angle θ , and it undergoes changes in the roll angle ϕ due to the large crosswind during landing. The left and right tires of the vehicle do not touch the ground at the same time due to the presence of the angle ϕ. Furthermore, as the angle θ and the angle ϕ are both positive during landing, none of the four wheels touches the ground at the same time, and it can be seen from
According to
An embodiment of the present invention also provides a takeoff and landing control apparatus of a flying automobile. The takeoff and landing control apparatus of a flying automobile includes a processor and a communication interface coupled to the processor, wherein processor is configured to run a computer program or instructions to execute the above-mentioned takeoff and landing control method of a flying automobile.
Compared with the prior art, the takeoff and landing control apparatus of a flying automobile provided in the embodiment of the present invention has the same beneficial effects as the takeoff and landing control method of a flying automobile described in the above technical solution, which will not be repeated here.
An embodiment of the present invention also provides a computer storage medium. The computer storage medium stores instructions which, when being run, implement the above-mentioned takeoff and landing control method of a flying automobile.
Compared with the prior art, the computer storage medium provided in the embodiment of the present invention has the same beneficial effects as the takeoff and landing control method of a flying automobile described in the above technical solution, which will not be repeated here.
In the description of the above implementations, specific features, structures, materials or characteristics may be combined in a suitable manner in any one or more embodiments or examples.
Described above are only specific implementations of the present invention, but the protection scope of the present invention is not limited thereto, and all changes or substitutions that are readily conceivable to those skilled in the art within the technical scope disclosed by the present invention should be encompassed within the protection scope of the present invention. Thus, the protection scope of the present invention should be defined by the claims.
Number | Date | Country | Kind |
---|---|---|---|
202110083068.0 | Jan 2021 | CN | national |