Position closed-loop control method, apparatus, system and readable storage medium
By establishing the dynamic equations of the vehicle steering execution system and designing the steering feedback control rate, combined with a feedforward compensation strategy, the problem of steering lag in the steer-by-wire system was solved, improving steering accuracy and the safety of intelligent driving.
Patent Information
- Application Number
- CN202410330821.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-03-21
- Publication Date
- 2026-11-10
- Estimated Expiration
- 2044-03-21
AI Technical Summary
Existing angle tracking control algorithms are insufficient to meet the performance requirements of steer-by-wire systems, exhibiting significant lag and failing to effectively reduce trajectory deviation and steering lag during advanced driver assistance and autonomous driving processes.
By establishing the dynamic equations of the vehicle steering execution system, designing the steering feedback control rate in conjunction with the optimization strategy, and designing the feedforward compensation strategy in conjunction with the steering angle command of the upper controller or sensor information, the driving force of the target rack is calculated to improve the speed and consistency of steering angle tracking.
It improves the vehicle's control performance during steering initiation, direction changing, and small-amplitude slow steering, thereby enhancing the steering precision of the steer-by-wire system and the safety of intelligent driving.
Smart Images

Figure CN117985103B_ABST
Abstract
Description
Technical Field
[0001] This disclosure relates to the field of control technology, and in particular to a position closed-loop control method, apparatus, system and readable storage medium. Background Technology
[0002] With the development of advanced driver assistance systems (ADAS), autonomous driving technologies, and drive-by-wire chassis technologies, passenger vehicle steering systems need to evolve in two directions: intelligence and drive-by-wire. In electric power steering systems, the steering controller receives and tracks the angle / speed commands issued by the ADAS or autonomous driving controllers to achieve functions such as tracking and obstacle avoidance. In drive-by-wire steering systems, in addition to meeting the requirements of ADAS and autonomous driving for the steering system, the steering execution controller also needs to track steering commands from the driver.
[0003] On the one hand, improving the performance of position closed-loop control can reduce trajectory deviations in advanced driver assistance and autonomous driving functions during the tracking process, as well as improve the vehicle's passability and stability in intelligent control; on the other hand, improving the performance of position closed-loop control in steer-by-wire systems can reduce steering lag, thereby improving the steering accuracy of steer-by-wire vehicles.
[0004] Existing angle tracking control algorithms suffer from difficulties in defining performance requirements and control frameworks. On the one hand, the performance requirements of existing angle tracking control algorithms still refer to the standards of automatic parking functions, which are difficult to meet the performance requirements of steer-by-wire systems. On the other hand, mature mass-produced position closed-loop control strategies still use the angle-speed-current cascade control framework, resulting in significant lag in angle tracking control response. Summary of the Invention
[0005] This disclosure provides a position closed-loop control method, apparatus, system, and readable storage medium to solve the above-mentioned technical problems.
[0006] According to a first aspect of this disclosure, a position closed-loop control method is provided, the method comprising:
[0007] Obtain the target displacement, actual displacement, and target speed of the rack of the vehicle tire;
[0008] The initial driving force of the target rack is calculated based on the target displacement, the actual displacement, the target speed, and the control rate parameters of the steering actuation system.
[0009] The compensation driving force of the target rack is obtained based on the target moving speed;
[0010] The resultant force of the initial driving force and the compensated driving force is obtained as the target driving force of the target rack.
[0011] Optionally, the initial driving force of the target rack is calculated based on the target displacement, the actual displacement, the target speed, and the control rate parameters of the steering actuation system, including:
[0012] The difference between the target displacement and the actual displacement is obtained to obtain the displacement deviation;
[0013] The difference between the target speed and the actual speed corresponding to the actual displacement is obtained to obtain the speed deviation;
[0014] The first driving force is the product of the displacement deviation and the first parameter in the control rate parameters.
[0015] The product of the integral value of the displacement deviation and the second parameter in the control rate parameters is used as the second driving force;
[0016] The third driving force is the product of the speed deviation and the first parameter in the control rate parameters.
[0017] The sum of the first driving force, the second driving force, and the third driving force is obtained as the initial driving force.
[0018] Optionally, the control rate parameter is obtained through the following steps:
[0019] Obtain the state-space equations of the steering execution system;
[0020] Obtain the control equations for the controlled input of the steering actuation system;
[0021] The constraint model of the steering execution system is constructed based on the state-space equation, the control equation, the control input weights, and the tracking performance weights.
[0022] The constraint model is solved based on the given control input weights and tracking performance weights to obtain the control rate parameters.
[0023] Optionally, the state-space equations of the steering execution system are obtained, including:
[0024] Obtain the dynamic equations of the steering execution system;
[0025] Obtain the integral state equation of the steering execution system;
[0026] The state-space equation of the steering execution system is obtained based on the dynamic equation and the integral state equation.
[0027] Optionally, the constraint model includes the control law of the system designed based on a linear quadratic regulator constructed using optimal control theory, or the control law of the system designed using robust control theory.
[0028] Optionally, obtaining the compensating driving force of the target rack based on the target moving speed includes:
[0029] The target speed is corrected using a phase correction strategy to obtain the corrected speed.
[0030] The corrective speed is processed using a dynamic friction model to obtain the compensating driving force of the target rack.
[0031] Optionally, the target displacement may be derived from an intelligent driving controller or a road sense simulation controller; the intelligent driving controller is used to generate the target displacement in the vehicle's intelligent driving mode; the road sense simulation controller is used to generate the target displacement in the manual driving mode.
[0032] According to a second aspect of this disclosure, a position closed-loop control device is provided, the device comprising:
[0033] The displacement and velocity acquisition module is used to acquire the target displacement, actual displacement, and target velocity of the rack of the vehicle tire;
[0034] An initial driving force acquisition module is used to calculate the initial driving force of the target rack based on the target displacement, the actual displacement, the target speed, and the control rate parameters of the steering execution system.
[0035] A compensation driving force acquisition module is used to acquire the compensation driving force of the target rack based on the target moving speed;
[0036] The target driving force acquisition module is used to acquire the resultant force of the initial driving force and the compensation driving force, which is used as the target driving force of the target rack.
[0037] Optionally, the initial driving force acquisition module includes:
[0038] The displacement deviation acquisition submodule is used to obtain the difference between the target displacement and the actual displacement to obtain the displacement deviation;
[0039] The speed deviation acquisition submodule is used to obtain the difference between the target speed and the actual speed corresponding to the actual displacement, and thus obtain the speed deviation.
[0040] The first driving force acquisition submodule is used to obtain the first driving force based on the product of the displacement deviation and the first parameter in the control rate parameter.
[0041] The second driving force acquisition submodule is used to obtain the second driving force based on the product of the integral value of the displacement deviation and the second parameter in the control rate parameter.
[0042] The third driving force acquisition submodule is used to obtain the third driving force based on the product of the speed deviation and the first parameter in the control rate parameter.
[0043] The initial driving force acquisition submodule is used to acquire the sum of the first driving force, the second driving force and the third driving force as the initial driving force.
[0044] Optionally, the device further includes a control rate parameter acquisition module, the control rate parameter acquisition module comprising:
[0045] The state equation acquisition submodule is used to acquire the state space equations of the steering execution system;
[0046] The control equation acquisition submodule is used to acquire the control equations of the controlled input of the steering execution system.
[0047] The constraint model acquisition submodule is used to construct the constraint model of the steering execution system based on the state space equation, the control equation, the control input weights, and the tracking performance weights.
[0048] The control rate parameter acquisition submodule is used to solve the constraint model based on the given control input weights and tracking performance weights to obtain the control rate parameters.
[0049] Optionally, the state equation acquisition submodule includes:
[0050] The dynamic equation acquisition unit is used to acquire the dynamic equations of the steering execution system.
[0051] The integral state equation acquisition unit is used to acquire the integral state equation of the steering execution system.
[0052] The state equation acquisition unit is used to acquire the state space equation of the steering execution system based on the dynamic equation and the integral state equation.
[0053] Optionally, the constraint model includes the control law of the system designed based on a linear quadratic regulator constructed using optimal control theory, or the control law of the system designed using robust control theory.
[0054] Optionally, obtaining the compensating driving force of the target rack based on the target moving speed includes:
[0055] The target speed is corrected using a phase correction strategy to obtain the corrected speed.
[0056] The corrective speed is processed using a dynamic friction model to obtain the compensating driving force of the target rack.
[0057] Optionally, the target displacement may be derived from an intelligent driving controller or a road sense simulation controller; the intelligent driving controller is used to generate the target displacement in the vehicle's intelligent driving mode; the road sense simulation controller is used to generate the target displacement in the manual driving mode.
[0058] According to a third aspect of this disclosure, a position closed-loop control system is provided, including a processor, a memory, and a sensor;
[0059] The sensor is used to detect the actual displacement of the rack of the vehicle tire and send it to the processor;
[0060] The memory is used to store computer programs that can be executed by the processor;
[0061] The processor is configured to execute a computer program in the memory to implement the method as described in any of the first aspects.
[0062] According to a fourth aspect of this disclosure, a non-transitory computer-readable storage medium is provided, which, when an executable computer program in the storage medium is executed by a processor, enables the implementation of the method as described in any of the first aspects.
[0063] The technical solutions provided by the embodiments of this disclosure may include the following beneficial effects:
[0064] The position closed-loop control method provided in this embodiment can acquire the target displacement, actual displacement, and target speed of the rack of the vehicle tire; then, it calculates the initial driving force of the target rack based on the target displacement, actual displacement, target speed, and control rate parameters of the steering actuation system; subsequently, it acquires the compensating driving force of the target rack based on the target speed; finally, it acquires the resultant force of the initial driving force and the compensating driving force as the target driving force of the target rack. Thus, this embodiment, by providing compensating driving force, i.e., feedforward compensation, can improve the vehicle's control performance during steering initiation, direction changing, and small-amplitude slow steering, and is applicable to electric power steering systems and steer-by-wire systems.
[0065] It should be understood that the above general description and the following detailed description are exemplary and explanatory only, and are not intended to limit this disclosure. Attached Figure Description
[0066] Figure 1 This is a schematic diagram of an electric power steering system according to an embodiment of the present disclosure.
[0067] Figure 2 This is an example diagram of an online steering system according to an embodiment of the present disclosure.
[0068] Figure 3 This is a flowchart of a position closed-loop control method according to an embodiment of the present disclosure.
[0069] Figure 4 This is a flowchart illustrating an embodiment of the present disclosure for obtaining the initial driving force based on the target displacement and the actual displacement.
[0070] Figure 5 This is a block diagram of a position closed-loop control system according to an embodiment of the present disclosure.
[0071] Figure 6 This is a simulation diagram of a step response condition according to an embodiment of the present disclosure.
[0072] Figure 7 This is a simulation diagram of a sinusoidal response under an embodiment of the present disclosure.
[0073] Figure 8 This is a block diagram of a position closed-loop control device according to an embodiment of the present disclosure. Detailed Implementation
[0074] Exemplary embodiments will now be described in detail, examples of which are illustrated in the accompanying drawings. When the following description relates to the drawings, unless otherwise indicated, the same numerals in different drawings denote the same or similar elements. The embodiments described in the following exemplary embodiments do not represent all embodiments consistent with this disclosure. Rather, they are merely examples of apparatuses consistent with some aspects of this disclosure as detailed in the appended claims.
[0075] This disclosure provides a position closed-loop control method, apparatus, system, and readable storage medium. The inventive concept of the position closed-loop control method is as follows: (1) By establishing the dynamic equations of the vehicle steering execution system, combining optimization strategies (such as using optimal control theory or robust control theory) to design a steering feedback control law, and then combining this with a feedforward compensation strategy designed based on the steering angle command from the upper controller or information from internal steering sensors, the final output target driving force drives the rack rotation, thereby improving the speed and consistency of steering angle tracking.
[0076] The position closed-loop control method provided in this disclosure can be applied to a position closed-loop control system, which may include an electric steering system or a steer-by-wire system. The aim is to improve the steering accuracy of the steer-by-wire system by improving the performance of the position closed-loop control, so as to avoid dangers such as S-shaped "dragon-like" movements and loss of steering control during intelligent driving, and improve the safety of intelligent driving.
[0077] See Figure 1A position closed-loop control system includes an intelligent driving controller 1, a communication bus 2, a torque angle sensor 3, an electric power steering controller 4, and a drive motor 5. The intelligent driving controller 1 can send the target displacement of the tire rack to the electric power steering controller 4 via the communication bus 2. The torque angle sensor 3 can collect the actual displacement of the tire rack and send it to the electric power steering controller 4. The electric power steering controller 4 can then execute a position closed-loop control method according to an embodiment of this disclosure based on the target displacement and the actual displacement, and calculate the equivalent target driving force on the target rack when the drive motor drives the tire.
[0078] See Figure 2 A position closed-loop control system includes an intelligent driving controller 1, a communication bus 2, a torque angle sensor 3, an electric power steering controller 4, a drive motor 5, a column angle torque sensor 6, a road feel simulation controller 7, and a communication bus 8. Figure 2 In the example where both communication bus 2 and communication bus 8 are implemented using CAN bus, other buses can be selected according to the specific scenario, and the corresponding solutions fall within the protection scope of this disclosure.
[0079] In this system, the intelligent driving controller 1 sends the target displacement of the rack to the electric power steering controller 4 in intelligent driving scenarios, or the road feel simulation controller 7 sends the target displacement of the rack to the electric power steering controller 4 in manual driving scenarios. The torque angle sensor 3 can collect the actual displacement of the tire rack and send it to the electric power steering controller 4. Then, the electric power steering controller 4 can execute a position closed-loop control method according to the target displacement and the actual displacement, and calculate the equivalent target driving force on the target rack when the drive motor drives the tire.
[0080] Based on the aforementioned position closed-loop control system, this disclosure provides a position closed-loop control method, see [link to relevant documentation]. Figure 3 This includes steps 31 to 34.
[0081] In step 31, the target displacement, actual displacement, and target speed of the rack of the vehicle tire are obtained.
[0082] In this embodiment, the electric power steering controller 4 can obtain the target displacement, which can come from the intelligent driving controller 1 or the road feel simulation controller 7, as well as the actual displacement of the rack sent by the torque angle sensor 3.
[0083] In this embodiment, the electric power steering controller 4 can calculate the target speed based on the target displacement. In one example, the electric power steering controller 4 can calculate the target speed using Kalman filtering. The first-order differential equation of Kalman filtering is shown in equation (1).
[0084]
[0085] In equation (1), ε is the assumed Gaussian white noise, and x d For the target displacement, For target movement speed, Accelerate towards the target.
[0086] In step 32, the initial driving force of the target rack is calculated based on the target displacement, the actual displacement, the target speed, and the control rate parameters of the steering actuation system.
[0087] In this embodiment, the electric power steering controller 4 can calculate the initial driving force of the target rack based on the target displacement, the actual displacement, the target speed, and the control rate parameters of the steering actuation system. (See also...) Figure 4 This includes steps 41 to 46.
[0088] In step 41, the electric power steering controller 4 can obtain the difference between the target displacement and the actual displacement to obtain the displacement deviation. In one example, the target displacement minus the actual displacement equals the displacement deviation. It is understood that in this example, after calculating the displacement deviation, amplitude limiting and gradient limiting processing are also performed to ensure that the displacement deviation is within a preset displacement range.
[0089] In step 42, the electric power steering controller 4 can obtain the difference between the target speed and the actual speed corresponding to the actual displacement, thus obtaining the speed deviation. The electric power steering controller 4 can estimate the actual rotational speed of the rack based on the actual displacement. In one example, the target speed minus the actual speed equals the speed deviation. It is understood that in this example, after calculating the speed deviation, amplitude limiting and gradient limiting processing are performed to ensure that the speed deviation remains within a preset speed range.
[0090] In step 43, the electric power steering controller 4 can use the product of the displacement deviation and the first parameter (Kp) in the control rate parameters as the first driving force.
[0091] In step 44, the electric power steering controller 4 can use the product of the integral value of the displacement deviation and the second parameter (KI) in the control rate parameters as the second driving force.
[0092] In step 45, the electric power steering controller 4 can use the product of the speed deviation and the first parameter (Kd) in the control rate parameters as the third driving force.
[0093] In step 46, the electric power steering controller 4 can obtain the sum of the first driving force, the second driving force, and the third driving force as the initial driving force.
[0094] In this embodiment, the control rate parameter is pre-acquired and stored in the position closed-loop control system, which is obtained through the following steps:
[0095] (1) Obtain the state-space equation of the steering execution system.
[0096] First, the dynamic equations of the steering execution system are obtained, which are used to derive the state-space equations of the system, as shown in equation (2).
[0097]
[0098] In equation (2), F m The power provided by the drive motor of the steering actuator is equivalent to the thrust on the rack, where m is the mass of the steering actuator equivalent to the rack, and x is the thrust. r For the displacement of the steering rack, B r F is the damping coefficient of the steering actuation system equivalent to that on the rack. f For the internal friction force in the steering system equivalent to that on the rack, F d The tire steering resistance torque is equivalent to the resistance on the rack.
[0099] Then, the integral state equation of the steering execution system is obtained to resist external disturbances and reduce steady-state error, as shown in equation (3).
[0100]
[0101] In equation (3), x d For the target displacement, x rI Let x be the integral value over the actual rotation angle. dI This is the integral value over the target turning angle.
[0102] Furthermore, the state-space equation of the steering execution system is obtained based on the dynamic equation and the integral state equation.
[0103]
[0104] In equation (4), For the first derivative of the integral value of the actual rotation angle, This is the first derivative of the integral value of the target turning angle; The first derivative of the steering rack displacement is the displacement speed. x is the second derivative of the steering rack displacement, i.e., the locating acceleration; d For the target displacement, For target movement speed, Accelerate towards the target.
[0105] Referring to equation (4), the state-space equation of the steering execution system shows that the system states are the integral deviation between the rack displacement and the target displacement, the deviation between the rack displacement and the target displacement, and the deviation between the rack speed and the target speed. The system input is the equivalent rack thrust F. m The system disturbance includes the internal friction F equivalent to the rack. f and steering resistance F d and the perturbation generated by the target instruction
[0106] (2) Obtain the control equation of the controlled input of the steering execution system.
[0107] Considering that the input equation of a position closed-loop control system in this embodiment is as shown in equation (5).
[0108]
[0109] In equation (5), u represents the target driving force, and K P K I and K d F represents the first parameter (proportional parameter), the second parameter (integral parameter), and the third parameter (derivative parameter) of the control rate, respectively. ff This refers to the frictional force that is compensated for by feedforward (i.e., the aforementioned compensating driving force).
[0110] Combining equations (4) and (5), the state-space equation of the steering execution system can be simplified to equation (6).
[0111]
[0112] In equation (6), A is B is u = F m d1 is d2 is
[0113] (3) Construct the constraint model of the steering execution system based on the state space equation, the control equation, the control input weight and the tracking performance weight.
[0114] In one example, optimal control theory, such as a linear quadratic regulator, can be used to design the control law of the system, and the cost function of the system is shown in equation (7).
[0115]
[0116] In equation (7), Q and R are the weight matrices in the cost function, which are used to define the tracking performance of the system and constrain the control input of the system, respectively.
[0117] It should be noted that when the steering execution system prioritizes tracking performance, the value of the weight matrix Q should be greater than the value of the weight matrix R. Conversely, when the steering execution system prioritizes system stability, the value of the weight matrix R should be greater than the value of the weight matrix Q. The given values of the weight matrices Q and R can be evaluated based on tracking performance and stability. It is understandable that the given values of the weight matrices Q and R represent known quantities in subsequent calculations.
[0118] In another example, robust control theory can be used to design the system's control law. In this example, robust control theory can be implemented using H... ∞ Alternatively, the H2 paradigm is used, where the target displacement and target velocity are considered as external inputs, the rack thrust is considered as the controlled input, and z1, z2 and z3 are used for the system's tracking performance, limiting the controlled input and suppressing fluctuations in the output, respectively. The weight functions W1, W2 and W3 are defined according to the frequency domain characteristics of z1, z2 and z3, respectively. The system equation is shown in equation (8).
[0119]
[0120] In equation (8), G is the transfer function of the steering system from the controlled input to the output.
[0121] (4) Solve the constraint model based on the given control input weights and tracking performance weights to obtain the control rate parameters.
[0122] In one example, taking the cost function determined by optimal control theory, when the control input weights, i.e., the weight matrix Q and the weight matrix R, are given values, the control rate parameter K can be selected when the cost function J reaches its minimum value. P K I and K d Alternatively, the control rate parameter K can be selected when the cost function J is less than or equal to a preset cost threshold. P K I and K d .
[0123] In another example, taking the design of system equations using robust control theory as an example, the control rate parameter K can be calculated given the weighting function. P K I and K d .
[0124] In step 33, the compensation driving force of the target rack is obtained based on the target moving speed.
[0125] In this embodiment, the electric power steering controller 4 can obtain the compensating driving force of the target rack based on the target speed. First, it uses a phase correction strategy to correct the target speed to obtain the corrected speed. Then, it uses a dynamic friction model to process the corrected speed to obtain the compensating driving force of the target rack.
[0126] In one example, the equation for the phase correction strategy is shown in equation (9).
[0127]
[0128] In equation (9), F1 is the frequency at which the correction begins, F2 is the frequency at which the phase correction ends, and s is the Laplace operator.
[0129] In one example, the dynamic friction model can take the form of LuGre, as shown in Equations (10), (11) and (12).
[0130]
[0131]
[0132]
[0133] In equations (10) to (12), It is the Stribeck equation, α0, α1 and v s Here, σ0 represents the characteristic parameters of the Stribeck equation, z represents the state in the LuGre equation, σ0 and σ1 are the corresponding stiffness and damping coefficients, α2 is the viscous damping coefficient, and F0 is the characteristic parameter of the Stribeck equation. ff Friction force for feedforward compensation.
[0134] In step 34, the resultant force of the initial driving force and the compensated driving force is obtained as the target driving force of the target rack.
[0135] In this embodiment, the electric power steering controller 4 can input the target driving force into the drive motor to drive the vehicle tires to rotate and drive the rack to rotate, thereby achieving the effect of tracking the target displacement.
[0136] Thus, this embodiment improves the vehicle's control performance during steering initiation, steering change, and small-amplitude slow steering by providing compensating driving force, i.e., feedforward compensation, and is applicable to electric power steering systems and steer-by-wire systems.
[0137] Based on the aforementioned position closed-loop control method, this embodiment can provide... Figure 1 or Figure 2 The position closed-loop control system shown provides a control block diagram. See also... Figure 5The position closed-loop control system includes a Kalman filter unit 11, a displacement deviation calculation unit 12, a speed deviation calculation unit 13, a proportional unit 14, an integral unit 15, a speed loop unit 16, a feedforward compensation unit 17, a controlled input unit 18, a drive motor equivalent unit 19, a sensor unit 20, an actual speed estimation unit 21, and a phase correction strategy unit 22. The working principle of this position closed-loop control system is as follows:
[0138] The target displacement is issued by the intelligent driving controller or road sense simulation controller. The intelligent driving controller is used to generate the target displacement in the vehicle's intelligent driving mode, and is suitable for... Figure 1 The scenario shown; the road feel simulation controller is used to generate target displacement in manual driving mode, and is suitable for... Figure 2 The scene shown.
[0139] The target speed is calculated by the Kalman filter unit 11 based on the target displacement; at the same time, the actual displacement is obtained by the sensor unit 20, and the actual speed is obtained by the actual displacement and the actual rotational speed estimation unit 21.
[0140] The controlled input of the controlled input unit 18 consists of four parts, including a proportional unit 14, an integral unit 15, a speed loop unit 16, and a feedforward compensation unit 17.
[0141] The input signals of the proportional unit 14 and the integral unit 15 are the displacement deviation between the target displacement and the actual displacement; the displacement deviation calculation unit 12 may include amplitude limiting processing and gradient limiting processing, so as to ensure that the calculated displacement deviation is within the preset displacement range.
[0142] The input signal of the speed loop unit 16 is the speed deviation between the target speed and the actual speed. The speed deviation calculation unit 13 may include amplitude limiting processing and gradient limiting processing, so as to ensure that the calculated speed deviation is within the preset speed range.
[0143] The feedforward compensation unit 17 adopts the LuGre dynamic friction model, and the input signal is the speed signal after passing through the phase correction unit 22.
[0144] The parameters in proportional unit 14, integral unit 15, and velocity loop unit 16 are the control rate parameter K. P K I and K d .
[0145] Combination Figure 5 The position closed-loop control system block diagram shown is applied to... Figure 1 and Figure 2 The control system was simulated, and the test conditions included step response 23 and sinusoidal response 24. The simulation results are as follows: Figure 6 and Figure 7 As shown.
[0146] See Figure 6 The left figure illustrates the fitting between the target angle and the actual angle under the step response 23 condition, as well as the current of the drive motor. It can be seen that under the step response 23 condition, the actual angle can quickly track the target angle. (See also...) Figure 7 The right figure illustrates the fitting between the target angle and the actual angle under the sinusoidal response 24 condition, as well as the current of the drive motor. It can be seen that under the sinusoidal response 24 condition, the actual angle can quickly track the target angle. In other words, when the actual angle can quickly track the target angle, and the relationship between angle and displacement remains unchanged, the actual displacement can quickly track the target angle. The position closed-loop control method based on optimized control and feedforward compensation proposed in this disclosure can effectively improve the system's bandwidth and response speed.
[0147] Based on the position closed-loop control method provided in this disclosure, this disclosure also provides a position closed-loop control device, see [link to relevant documentation]. Figure 8 The device includes:
[0148] The displacement and speed acquisition module 81 is used to acquire the target displacement, actual displacement, and target speed of the rack of the vehicle tire;
[0149] The initial driving force acquisition module 82 is used to calculate the initial driving force of the target rack based on the target displacement, the actual displacement, the target speed, and the control rate parameters of the steering execution system.
[0150] The compensation driving force acquisition module 83 is used to acquire the compensation driving force of the target rack based on the target moving speed;
[0151] The target driving force acquisition module 84 is used to acquire the resultant force of the initial driving force and the compensation driving force as the target driving force of the target rack.
[0152] Optionally, the initial driving force acquisition module includes:
[0153] The displacement deviation acquisition submodule is used to obtain the difference between the target displacement and the actual displacement to obtain the displacement deviation;
[0154] The speed deviation acquisition submodule is used to obtain the difference between the target speed and the actual speed corresponding to the actual displacement, and thus obtain the speed deviation.
[0155] The first driving force acquisition submodule is used to obtain the first driving force based on the product of the displacement deviation and the first parameter in the control rate parameter.
[0156] The second driving force acquisition submodule is used to obtain the second driving force based on the product of the integral value of the displacement deviation and the second parameter in the control rate parameter.
[0157] The third driving force acquisition submodule is used to obtain the third driving force based on the product of the speed deviation and the first parameter in the control rate parameter.
[0158] The initial driving force acquisition submodule is used to acquire the sum of the first driving force, the second driving force and the third driving force as the initial driving force.
[0159] Optionally, the device further includes a control rate parameter acquisition module, the control rate parameter acquisition module comprising:
[0160] The state equation acquisition submodule is used to acquire the state space equations of the steering execution system;
[0161] The control equation acquisition submodule is used to acquire the control equations of the controlled input of the steering execution system.
[0162] The constraint model acquisition submodule is used to construct the constraint model of the steering execution system based on the state space equation, the control equation, the control input weights, and the tracking performance weights.
[0163] The control rate parameter acquisition submodule is used to solve the constraint model based on the given control input weights and tracking performance weights to obtain the control rate parameters.
[0164] Optionally, the state equation acquisition submodule includes:
[0165] The dynamic equation acquisition unit is used to acquire the dynamic equations of the steering execution system.
[0166] The integral state equation acquisition unit is used to acquire the integral state equation of the steering execution system.
[0167] The state equation acquisition unit is used to acquire the state space equation of the steering execution system based on the dynamic equation and the integral state equation.
[0168] Optionally, the constraint model includes the control law of the system designed based on a linear quadratic regulator constructed using optimal control theory, or the control law of the system designed using robust control theory.
[0169] Optionally, obtaining the compensating driving force of the target rack based on the target moving speed includes:
[0170] The target speed is corrected using a phase correction strategy to obtain the corrected speed.
[0171] The corrective speed is processed using a dynamic friction model to obtain the compensating driving force of the target rack.
[0172] Optionally, the target displacement may include that from an intelligent driving controller or a road feel simulation controller.
[0173] It should be noted that the device embodiment provided in this embodiment corresponds to the method embodiment described above. For details, please refer to the content of each method embodiment described above, which will not be repeated here.
[0174] According to a third aspect of this disclosure, a position closed-loop control system is provided, including a processor, a memory, and a sensor;
[0175] The sensor is used to detect the actual displacement of the rack of the vehicle tire and send it to the processor;
[0176] The memory is used to store computer programs that can be executed by the processor;
[0177] The processor is used to execute the computer program in the memory to implement the method described above.
[0178] This disclosure also provides a non-transitory computer-readable storage medium that, when an executable computer program in the storage medium is executed by a processor, can implement the method described above.
[0179] Other embodiments of this disclosure will readily occur to those skilled in the art upon consideration of the specification and practice of the disclosure herein. This disclosure is intended to cover any variations, uses, or adaptations that follow the general principles of this disclosure and include common knowledge or customary techniques in the art not disclosed herein. The specification and examples are to be considered exemplary only, and the true scope and spirit of this disclosure are indicated by the following claims.
[0180] It should be understood that this disclosure is not limited to the precise structures described above and shown in the accompanying drawings, and various modifications and changes can be made without departing from its scope. The scope of this disclosure is limited only by the appended claims.
Claims
1. A position closed-loop control method, characterized in that, The method includes: Obtain the target displacement, actual displacement, and target speed of the rack of the vehicle tire; The initial driving force of the target rack is calculated based on the target displacement, the actual displacement, the target speed, and the control rate parameters of the steering actuation system. The compensation driving force of the target rack is obtained based on the target moving speed; The resultant force of the initial driving force and the compensated driving force is obtained as the target driving force of the target rack.
2. The method according to claim 1, characterized in that, The initial driving force of the target rack is calculated based on the target displacement, the actual displacement, the target speed, and the control rate parameters of the steering actuation system, including: The difference between the target displacement and the actual displacement is obtained to obtain the displacement deviation; The difference between the target speed and the actual speed corresponding to the actual displacement is obtained to obtain the speed deviation; The first driving force is the product of the displacement deviation and the first parameter in the control rate parameters. The product of the integral value of the displacement deviation and the second parameter in the control rate parameters is used as the second driving force; The third driving force is the product of the speed deviation and the first parameter in the control rate parameters. The sum of the first driving force, the second driving force, and the third driving force is obtained as the initial driving force.
3. The method according to claim 1 or 2, characterized in that, The control rate parameter is obtained through the following steps: Obtain the state-space equations of the steering execution system; Obtain the control equations for the controlled input of the steering actuation system; The constraint model of the steering execution system is constructed based on the state-space equation, the control equation, the control input weights, and the tracking performance weights. The constraint model is solved based on the given control input weights and tracking performance weights to obtain the control rate parameters.
4. The method according to claim 3, characterized in that, Obtain the state-space equations of the steering execution system, including: Obtain the dynamic equations of the steering execution system; Obtain the integral state equation of the steering execution system; The state-space equation of the steering execution system is obtained based on the dynamic equation and the integral state equation.
5. The method according to claim 3, characterized in that, The constraint model includes the control law of the system designed based on the linear quadratic regulator constructed based on optimal control theory, or the control law of the system designed using robust control theory.
6. The method according to claim 1, characterized in that, Obtaining the compensating driving force of the target rack based on the target moving speed includes: The target speed is corrected using a phase correction strategy to obtain the corrected speed. The corrective speed is processed using a dynamic friction model to obtain the compensating driving force of the target rack.
7. The method according to any one of claims 1-2 and 4-6, characterized in that, The target displacement includes the displacement from the intelligent driving controller or the road sense simulation controller; the intelligent driving controller is used to generate the target displacement in the intelligent driving mode of the vehicle; the road sense simulation controller is used to generate the target displacement in the manual driving mode.
8. A position closed-loop control device, characterized in that, The device includes: The displacement and velocity acquisition module is used to acquire the target displacement, actual displacement, and target velocity of the rack of the vehicle tire; An initial driving force acquisition module is used to calculate the initial driving force of the target rack based on the target displacement, the actual displacement, the target speed, and the control rate parameters of the steering execution system. A compensation driving force acquisition module is used to acquire the compensation driving force of the target rack based on the target moving speed; The target driving force acquisition module is used to acquire the resultant force of the initial driving force and the compensation driving force, which is used as the target driving force of the target rack.
9. A position closed-loop control system, characterized in that, Includes processors, memory, and sensors; The sensor is used to detect the actual displacement of the rack of the vehicle tire and send it to the processor; The memory is used to store computer programs that can be executed by the processor; The processor is configured to execute a computer program in the memory to implement the method as described in any one of claims 1 to 7.
10. A non-transitory computer-readable storage medium, characterized in that, When the executable computer program in the storage medium is executed by a processor, it can implement the method as described in any one of claims 1 to 7.
Citation Information
Patent Citations
Cascaded position control architecture for steering systems
CN110341785A
Road feeling simulation method and device, electronic equipment and storage medium
CN115503812A
