Straight movement and steering balance control method for unmanned motorcycle without self-balancing auxiliary device

By establishing a motorcycle dynamics model and designing a linear extended state observer and an active disturbance rejection controller, the balance control problem of unmanned motorcycles under steering conditions was solved, and stable driving and rapid response of unmanned motorcycles under different conditions were achieved.

CN118963103APending Publication Date: 2024-11-15ZHENGZHOU UNIV
View PDF 3 Cites 0 Cited by

Patent Information

Application Number
CN202411032714.0
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-30
Publication Date
2024-11-15

AI Technical Summary

Technical Problem

Existing unmanned motorcycle control methods cannot track the handlebar steering angle, especially in terms of balance control during steering, and cannot effectively observe external disturbances.

Method used

A dynamic model based on motorcycle steering conditions is adopted, and a model-aided linear extended state observer and an improved model-aided linear active disturbance rejection controller are designed. Motion data is acquired through sensors, unknown disturbances are estimated and compensated in real time, handlebar steering angle error feedback is added, and control commands are generated.

Benefits of technology

It enables unmanned motorcycles to maintain stability during straight-line driving and turning, improves the tracking speed of handlebar angle and body tilt angle, and can quickly respond to changes in driving conditions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118963103A_ABST
    Figure CN118963103A_ABST
Patent Text Reader

Abstract

The invention relates to a straight movement and steering balance control method for an unmanned motorcycle without a self-balancing auxiliary device, which comprises the following steps of: establishing a kinetic model of the unmanned motorcycle on the basis of moment balance under a steering working condition of the motorcycle, and designing a linear expansion state observer MLESO based on model assistance, so that unmodeled dynamics and external disturbance can be observed; acquiring motion data in the running process of the motorcycle; an improved model auxiliary linear active disturbance rejection controller (MLADRC) based on handlebar steering angle error feedback is designed, corresponding control commands are generated according to different driving conditions, and a motorcycle handlebar can be controlled to rotate to an expected angle at an expected angular speed. Therefore, the unmanned motorcycle can still keep a stable state in the straight running or even steering process, the handlebar can respond quickly when the motorcycle enters another steady-state working condition from one steady-state working condition by adding handlebar steering angle error feedback, and the tracking speed of the handlebar angle and the inclination angle of the motorcycle body is increased.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a straight-moving and turning balance control method for an unmanned motorcycle without a self-balancing auxiliary device. Background Art

[0002] An unmanned motorcycle is an intelligent motorcycle that mainly uses a computer system to replace people in decision-making planning and behavior judgment, so as to achieve more reasonable and safer driving operations. Most of the existing related technologies are unmanned bicycles. The name of the invention is an unmanned bicycle control method and system (application number: 202111034490.3), which discloses an unmanned bicycle control method, but the method can only achieve stable driving of the unmanned bicycle under straight-line conditions, and the desired tilt angle is zero. When the vehicle turns, it is impossible to track the desired tilt angle while tracking the desired handlebar steering angle. The name of the invention is a switching PID control method, system and simulation method based on an unmanned bicycle (application number: 202111463391.7), which discloses an unmanned bicycle control method based on switching PID, which realizes the tracking of the desired tilt angle through the switching of PID, and realizes the balance control of the unmanned bicycle in the straight-line state, but cannot realize the tracking of the handlebar steering angle, and it is difficult to achieve balance control when the unmanned bicycle turns, and the PID controller cannot observe external disturbances. The name of the invention is A robust control method for the lateral balance of an unmanned bicycle (application number: 202211553966.9), which discloses a robust control method for the lateral balance of an unmanned bicycle to achieve balance control of the bicycle in a straight-line driving state. However, this method regards the steering angle and steering angular velocity of the handlebar as interference, observes and compensates through an observer, and ultimately ensures that the bicycle can achieve balance in a straight-line driving state. In real life, the steering angle and steering angular velocity of the handlebar are important control quantities for controlling motorcycles and bicycles. When regarded as disturbances, balance control cannot be achieved under vehicle steering conditions. Summary of the invention

[0003] In order to solve the existing problems, the present invention provides a method for controlling the straight-moving and turning balance of an unmanned motorcycle without a self-balancing auxiliary device.

[0004] The present invention adopts the following technical solutions:

[0005] A method for controlling the straight-moving and turning balance of an unmanned motorcycle without a self-balancing auxiliary device, comprising:

[0006] Step 1: Based on the torque balance under the steering condition of the motorcycle, a dynamic model of the unmanned motorcycle is established to obtain the relationship between the handlebar angle, vehicle speed and body inclination angle of the unmanned motorcycle;

[0007] Step 2: Based on the unmanned motorcycle dynamics model, a model-assisted linear extended state observer (MLESO) is designed to estimate and compensate for unknown disturbances during the driving process of the unmanned motorcycle in real time;

[0008] Step 3: Obtain the motion data of the motorcycle during driving through the sensor;

[0009] Step 4: Design an improved model-assisted linear active disturbance rejection controller (MLADRC) based on handlebar steering angle error feedback to generate corresponding control commands for different driving conditions.

[0010] Furthermore, in step 1, the expression of the unmanned motorcycle dynamics model is as follows:

[0011]

[0012] Among them, I x is the moment of inertia of the unmanned motorcycle body around the x-axis, M is the total mass of the unmanned motorcycle, h is the vertical distance between the center of mass of the unmanned motorcycle and the ground, θ is the inclination angle of the unmanned motorcycle body, g is the gravitational acceleration, l r v is the distance between the rear wheel contact point and the intersection of the center of mass and the ground, x is the speed of the unmanned motorcycle, L is the wheelbase of the unmanned motorcycle, δ f is the handlebar steering angle, is the steering angular velocity of the handlebar, I f is the moment of inertia of the front wheel, I r is the rear wheel moment of inertia, R f is the front wheel radius, R r is the rear wheel radius, is the yaw angular velocity generated when the unmanned motorcycle turns.

[0013] Furthermore, the unmanned motorcycle dynamics model in step 1 is simplified as follows:

[0014]

[0015] By making a small angle approximation on the above formula, the final form of the unmanned motorcycle dynamics model is obtained as follows:

[0016]

[0017] Furthermore, in step 2, the unmanned motorcycle dynamics model is written as a state space equation as follows:

[0018]

[0019] in, To control the state of the system, is the input of the control system, f' is the actual total disturbance, and f contains the actual total disturbance and the known model information, which is called the expansion of the disturbance.

[0020]

[0021] The model-assisted linear extended state observer MLESO is constructed as follows:

[0022]

[0023] Where L = [l1 l2 l3] T is the observer gain matrix, which is parameterized to place the poles of the observer characteristic equation in the same position -ω o Above, as follows:

[0024] λ(s)=|sI-(A-LC)|=(s+ω o ) 3

[0025] Among them, ω o is the observer bandwidth, I is the unit matrix;

[0026] Let the left and right sides of the equation be equal, and according to the method of undetermined coefficients, we get:

[0027]

[0028] Furthermore, in step 3, the motion data of the motorcycle during driving obtained by the sensor includes vehicle speed, handlebar angle, handlebar angle velocity and vehicle body inclination angle.

[0029] Furthermore, in step 4, the acquisition process of the improved model-assisted linear active disturbance rejection controller MLADRC includes:

[0030] The linear error feedback control rate is as follows:

[0031] u0=k p (θ ref -z1)-k d z2

[0032] The MLADRC control rates are as follows:

[0033]

[0034] Among them, k p and k d is the controller gain parameter, θ ref is the expected value of the motorcycle body inclination angle, z1 is the estimated value of the motorcycle body inclination angle, z2 is the expected value of the motorcycle body inclination angular velocity, z3 is the estimated value of the unknown disturbance, including unmodeled dynamics and external disturbances, b0 is the control gain, δfref is the expected value of the handlebar steering angle, and K is the handlebar steering error feedback gain coefficient.

[0035] The beneficial effects of the present invention include: the control scheme of the present invention can realize controlling the handlebars of a motorcycle to turn to a desired angle at a desired angular velocity, thereby realizing that an unmanned motorcycle without a self-balancing auxiliary device can remain in a stable state during straight driving or even turning, and the designed model-assisted linear extended state observer can observe unmodeled dynamics and external disturbances. At the same time, by adding handlebar steering angle error feedback in the scheme, the handlebars can respond quickly when the motorcycle enters another steady-state working condition from one steady-state working condition, thereby improving the tracking speed of the handlebar angle and the body inclination angle. BRIEF DESCRIPTION OF THE DRAWINGS

[0036] In order to more clearly illustrate the technical solution of the embodiment of the present invention, the following briefly introduces the drawings required for use in the embodiment:

[0037] Figure 1 It is a schematic diagram of the overall flow of a method for controlling the straight-moving and turning balance of an unmanned motorcycle without a self-balancing auxiliary device provided by the present invention;

[0038] Figure 2 This is the overall control block diagram of the unmanned motorcycle;

[0039] Figure 3 It is a schematic diagram of the motion of an unmanned motorcycle;

[0040] Figure 4 This is a simulation diagram of an unmanned motorcycle in motion. DETAILED DESCRIPTION

[0041] In the following description, specific details such as specific system structures, technologies, etc. are provided for the purpose of illustration rather than limitation, so as to provide a thorough understanding of the embodiments of the present application. However, it should be clear to those skilled in the art that the present application may also be implemented in other embodiments without these specific details. In other cases, detailed descriptions of well-known systems, devices, circuits, and methods are omitted to prevent unnecessary details from obstructing the description of the present application.

[0042] It should be understood that when used in the present specification and the appended claims, the term "comprising" indicates the presence of described features, wholes, steps, operations, elements and / or components, but does not exclude the presence or addition of one or more other features, wholes, steps, operations, elements, components and / or combinations thereof.

[0043] It should also be understood that the term “and / or” used in the specification and appended claims refers to any and all possible combinations of one or more of the associated listed items, and includes these combinations.

[0044] As used in the specification and appended claims of this application, the term "if" can be interpreted as "when" or "uponce" or "in response to determining" or "in response to detecting", depending on the context. Similarly, the phrase "if it is determined" or "if [described condition or event] is detected" can be interpreted as meaning "uponce it is determined" or "in response to determining" or "uponce [described condition or event] is detected" or "in response to detecting [described condition or event]", depending on the context.

[0045] In addition, in the description of the present application specification and the appended claims, the terms "first", "second", "third", etc. are only used to distinguish the descriptions and cannot be understood as indicating or implying relative importance.

[0046] References to "one embodiment" or "some embodiments" etc. described in the specification of this application mean that one or more embodiments of the present application include specific features, structures or characteristics described in conjunction with the embodiment. Therefore, the statements "in one embodiment", "in some embodiments", "in some other embodiments", "in some other embodiments", etc. that appear in different places in this specification do not necessarily refer to the same embodiment, but mean "one or more but not all embodiments", unless otherwise specifically emphasized in other ways. The terms "including", "comprising", "having" and their variations all mean "including but not limited to", unless otherwise specifically emphasized in other ways.

[0047] In order to illustrate the technical solution described in this application, a specific implementation method is provided below.

[0048] like Figure 1 As shown, this embodiment provides a method for controlling the straight-moving and turning balance of an unmanned motorcycle without a self-balancing auxiliary device. Figure 2 This is the overall control block diagram of the unmanned motorcycle. Figure 3 It is a schematic diagram of the movement of an unmanned motorcycle.

[0049] The straight driving and turning balance control method of an unmanned motorcycle without a self-balancing auxiliary device comprises the following steps:

[0050] Step 1: Based on the torque balance under the steering condition of the motorcycle, the unmanned motorcycle dynamics model is established to obtain the relationship between the handlebar angle, vehicle speed and body inclination angle of the unmanned motorcycle:

[0051] The expression of the unmanned motorcycle dynamics model is as follows:

[0052]

[0053] Among them, I xis the moment of inertia of the unmanned motorcycle body around the x-axis, M is the total mass of the unmanned motorcycle, h is the vertical distance between the center of mass of the unmanned motorcycle and the ground, θ is the inclination angle of the unmanned motorcycle body, g is the gravitational acceleration, l r v is the distance between the rear wheel contact point and the intersection of the center of mass and the ground, x is the speed of the unmanned motorcycle, L is the wheelbase of the unmanned motorcycle, δ f is the handlebar steering angle, is the steering angular velocity of the handlebar, I f is the moment of inertia of the front wheel, I r is the rear wheel moment of inertia, R f is the front wheel radius, R r is the rear wheel radius, is the yaw angular velocity generated when the unmanned motorcycle turns.

[0054] In order to simplify the controller design, the gyroscopic effect of the wheels at normal driving speed has little influence. Therefore, the gyroscopic effect of the wheels is not considered, and the unmanned motorcycle is regarded as a mass point. The dynamic model of the unmanned motorcycle is simplified as follows:

[0055]

[0056] By making a small angle approximation on the above formula, the final form of the unmanned motorcycle dynamics model is obtained as follows:

[0057]

[0058] Step 2: Based on the unmanned motorcycle dynamics model, a model-assisted linear extended state observer (MLESO) is designed to estimate and compensate for unknown disturbances during the driving process of the unmanned motorcycle in real time:

[0059] The unmanned motorcycle dynamics model is written as a state space equation as follows:

[0060]

[0061] in, To control the state of the system, is the input of the control system, f' is the actual total disturbance, f contains the actual total disturbance and the known model information, which is called the expansion of the disturbance, and the matrix

[0062] The model-assisted linear extended state observer MLESO is constructed as follows:

[0063]

[0064] Where L = [l1 l2 l3] Tis the observer gain matrix, which is parameterized to place the poles of the observer characteristic equation in the same position -ω o Above, as follows:

[0065] λ(s)=|sI-(A-LC)|=(s+ω o ) 3

[0066] Among them, ω o is the observer bandwidth and I is the identity matrix.

[0067] Let the left and right sides of the equation be equal, and according to the method of undetermined coefficients, we get:

[0068]

[0069] Step 3: Obtain the motion data of the motorcycle during driving through the sensor.

[0070] In this embodiment, the motion data of the motorcycle during driving obtained by the sensor includes vehicle speed, handlebar angle, handlebar angle velocity and vehicle body inclination angle.

[0071] Step 4: Design an improved model-assisted linear active disturbance rejection controller (MLADRC) based on handlebar steering angle error feedback to generate corresponding control commands for different driving conditions.

[0072] An improved model-assisted linear active disturbance rejection controller (MLADRC) based on handlebar steering angle error feedback is designed. According to different driving conditions, corresponding control commands are generated to achieve the handlebars turning to the desired angle at the desired angular velocity at the same time, so that the unmanned motorcycle without balance assistance device can run stably under different conditions.

[0073] The acquisition process of the improved model-assisted linear active disturbance rejection controller MLADRC includes:

[0074] The linear error feedback control rate is as follows:

[0075] u0=k p (θ ref -z1)-k d z2

[0076] The MLADRC control rates are as follows:

[0077]

[0078] Among them, k p and k d is the controller gain parameter, θ refis the expected value of the motorcycle body inclination angle, z1 is the estimated value of the motorcycle body inclination angle, z2 is the expected value of the motorcycle body inclination angular velocity, z3 is the estimated value of the unknown disturbance, including unmodeled dynamics and external disturbances, b0 is the control gain, δ fref is the expected value of the handlebar steering angle, and K is the handlebar steering error feedback gain coefficient.

[0079] Figure 4 This is a simulation diagram of the unmanned motorcycle movement. The unmanned motorcycle simulation time is 20s, the simulation step is 0.001, and the simulated driving conditions are: the unmanned motorcycle drives in a straight line. After driving for 5s, the motorcycle turns left. After driving for 10 seconds, the motorcycle turns right and continues to drive in a straight line. After 15 seconds, the motorcycle turns left. Figure 4 The handlebar steering angle, body tilt angle, and observer observations of unmodeled dynamics and external disturbances during the driving of the unmanned motorcycle are shown respectively.

[0080] The control scheme provided in this embodiment can control the handlebars of a motorcycle to turn to a desired angle at a desired angular velocity, so that an unmanned motorcycle without a self-balancing auxiliary device can remain in a stable state during straight driving or even turning. In addition, the designed model-assisted linear extended state observer can observe unmodeled dynamics and external disturbances. At the same time, by adding handlebar steering angle error feedback in the scheme, the handlebars can respond quickly when the motorcycle enters another steady-state condition from one steady-state condition, thereby improving the tracking speed of the handlebar angle and the body inclination angle.

[0081] The embodiments described above are only used to illustrate the technical solutions of the present application, rather than to limit them. Although the present application has been described in detail with reference to the aforementioned embodiments, a person skilled in the art should understand that the technical solutions described in the aforementioned embodiments may still be modified, or some of the technical features may be replaced by equivalents. Such modifications or replacements do not deviate the essence of the corresponding technical solutions from the scope of the technical solutions of the embodiments of the present application, and should all be included in the protection scope of the present application.

Claims

1. A method for controlling the straight-moving and turning balance of an unmanned motorcycle without a self-balancing auxiliary device, characterized in that: include: Step 1: Based on the torque balance under the steering condition of the motorcycle, a dynamic model of the unmanned motorcycle is established to obtain the relationship between the handlebar angle, vehicle speed and body inclination angle of the unmanned motorcycle; Step 2: Based on the unmanned motorcycle dynamics model, a model-assisted linear extended state observer (MLESO) is designed to estimate and compensate for unknown disturbances during the driving process of the unmanned motorcycle in real time; Step 3: Obtain the motion data of the motorcycle during driving through the sensor; Step 4: Design an improved model-assisted linear active disturbance rejection controller (MLADRC) based on handlebar steering angle error feedback to generate corresponding control commands for different driving conditions.

2. The method for controlling the straight-moving and turning balance of an unmanned motorcycle without a self-balancing auxiliary device according to claim 1, characterized in that: In step 1, the expression of the unmanned motorcycle dynamics model is as follows: Among them, I x is the moment of inertia of the unmanned motorcycle body around the x-axis, M is the total mass of the unmanned motorcycle, h is the vertical distance between the center of mass of the unmanned motorcycle and the ground, θ is the inclination angle of the unmanned motorcycle body, g is the gravitational acceleration, l r v is the distance between the rear wheel contact point and the intersection of the center of mass and the ground, x is the speed of the unmanned motorcycle, L is the wheelbase of the unmanned motorcycle, δ f is the handlebar steering angle, is the handlebar steering angular velocity, I f is the moment of inertia of the front wheel, I r is the rear wheel moment of inertia, R f is the front wheel radius, R r is the rear wheel radius, is the yaw angular velocity generated when the unmanned motorcycle turns.

3. The method for controlling the straight-moving and turning balance of an unmanned motorcycle without a self-balancing auxiliary device according to claim 2, characterized in that: The unmanned motorcycle dynamics model in step 1 is simplified as follows: By making a small angle approximation on the above formula, the final form of the unmanned motorcycle dynamics model is obtained as follows:

4. The method for controlling the straight-moving and turning balance of an unmanned motorcycle without a self-balancing auxiliary device according to claim 2, characterized in that: In step 2, the unmanned motorcycle dynamics model is written as a state space equation as follows: in, To control the state of the system, is the input of the control system, f' is the actual total disturbance, f contains the actual total disturbance and the known model information, which is called the expansion of the disturbance, and the matrix C = [1 0 0]; The model-assisted linear extended state observer MLESO is constructed as follows: Where L = [l1 l2 l3] T is the observer gain matrix, which is parameterized to place the poles of the observer characteristic equation in the same position -ω o Above, as follows: λ(s)=|sI-(A-LC)|=(s+ω o ) 3 Among them, ω o is the observer bandwidth, I is the unit matrix; Let the left and right sides of the equation be equal, and according to the method of undetermined coefficients, we get:

5. The method for controlling the straight-moving and turning balance of an unmanned motorcycle without a self-balancing auxiliary device according to claim 1, characterized in that: In step 3, the motion data of the motorcycle during driving obtained by the sensor include vehicle speed, handlebar angle, handlebar angle velocity and vehicle body inclination angle.

6. The method for controlling the straight-moving and turning balance of an unmanned motorcycle without a self-balancing auxiliary device according to claim 4, characterized in that: In step 4, the acquisition process of the improved model-assisted linear active disturbance rejection controller MLADRC includes: The linear error feedback control rate is as follows: u0=k p (i ref -z1)-k d z2 The MLADRC control rates are as follows: Among them, k p and k d is the controller gain parameter, θ ref is the expected value of the motorcycle body inclination angle, z1 is the estimated value of the motorcycle body inclination angle, z2 is the expected value of the motorcycle body inclination angular velocity, z3 is the estimated value of the unknown disturbance, including unmodeled dynamics and external disturbances, b0 is the control gain, δ fref is the expected value of the handlebar steering angle, and K is the handlebar steering error feedback gain coefficient.

Citation Information

Patent Citations

  • Unmanned bicycle control method and system

    CN113771837A

  • PID switching control method based on unmanned bicycle, system and simulation method

    CN114019806A

  • Robust control method for lateral balance of unmanned bicycle

    CN115793462A