Steering control system
The steering control system addresses communication overload by integrating manual and automatic steering command calculations within a central control device, improving system efficiency and reducing bus load.
Patent Information
- Application Number
- PCT/JP2024/015448
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2024-04-18
- Publication Date
- 2025-10-23
AI Technical Summary
The existing steering control systems experience increased communication bus load when calculating manual steering command values using information from multiple detection devices, which can lead to inefficiencies and potential overload.
A steering control system that includes a central control device to calculate manual and automatic steering command values, integrating these into an overall command value to reduce the communication load between the central control device and the motor control device, utilizing a manual steering command value calculation unit and an automatic steering command value calculation unit within the central control device.
This configuration effectively reduces the communication bus load by integrating steering command values centrally, enhancing system efficiency and reducing the burden on communication channels.
Smart Images

Figure JP2024015448_23102025_PF_FP_ABST
Abstract
Description
Steering Control System
[0001] The present disclosure relates to a steering control system for controlling an electric motor of a steering device.
[0002] Japanese Patent Application Laid-Open No. 2003-144222 discloses a motor control ECU (motor control device) that includes a manual steering command value generating unit, an integrated angle command value calculating unit, and a control unit.
[0003] The manual steering command value generation unit generates a manual steering command value based on a detection signal provided from the torque sensor to the motor control ECU. The integrated angle command value calculation unit calculates an integrated angle command value by adding the manual steering command value to an automatic steering command value provided from a higher-level ECU (overall control device). The control unit controls the electric motor of the steering device based on the integrated angle command value. The electric motor of the steering device is an electric motor for applying driving force to a steering mechanism that steers the steered wheels.
[0004] A plurality of detecting devices are connected to the host ECU. When it is necessary to calculate a manual steering command value using information obtained from a detection signal of at least one of the detecting devices connected to the host ECU, the information needs to be transmitted from the host ECU to the motor control ECU, which increases the load on the communication bus between the host ECU and the motor control ECU.
[0005] Japanese Patent Application Laid-Open No. 2019-194059
[0006] The object of the present disclosure is to provide a steering control system that can suppress an increase in the communication bus load between the overall control device and the motor control device when calculating a manual steering command value using information obtained from the detection signal of at least one of multiple detection devices connected to the overall control device.
[0007] One embodiment of the present disclosure provides a steering control system comprising: a motor control device for drive control of an electric motor of a steering device, the motor control device being connected to a steering torque detection unit that detects steering torque applied to a steering member; a plurality of control devices that control each of a plurality of in-vehicle systems, the plurality of control devices including the motor control device being an overall control device that overall controls the plurality of control devices; and a plurality of detection devices connected to the overall control device; the overall control device including: a manual steering command value calculation unit that calculates a manual steering command value based on the steering torque applied from the motor control device and information obtained from a detection signal of at least one of the plurality of detection devices; and an automatic steering command value calculation unit that calculates an automatic steering command value for driving assistance; and the motor control device controls the electric motor based on an integrated angle command value calculated from the manual steering command value and the automatic steering command value.
[0008] In this configuration, when a manual steering command value is calculated using information obtained from the detection signal of at least one of the multiple detection devices connected to the overall control device, the communication bus load between the overall control device and the motor control device can be prevented from becoming too high.
[0009] The above and other objects, features, and advantages of the present disclosure will become apparent from the following description of the embodiments with reference to the accompanying drawings.
[0010] Fig. 1 is a schematic diagram showing an electric power steering device and a steering control system that controls an electric motor in the electric power steering device. Fig. 2 is a block diagram for explaining the electrical configuration of an overall control ECU. Fig. 3 is a diagram showing a lateral deviation e L Target virtual spring reaction force T tb,d (e L ) is a graph showing an example of setting. FIG. 4 is a schematic diagram showing an example of a reference EPS model. FIG. 5 is a block diagram showing the configuration of a manual steering command value calculation unit. FIG. 6 is a block diagram for explaining the electrical configuration of a motor control ECU. FIG. 7 is a graph showing an example of setting a torsion bar torque T tb Assist torque command value T as8 is a graph showing an example of setting of the angle control unit.
[0011] [Description of an embodiment of the present disclosure] One embodiment of the present disclosure is a steering control system including: a motor control device for drive control of an electric motor of a steering device, the motor control device being connected to a steering torque detection unit that detects steering torque applied to a steering member; a plurality of control devices that control each of a plurality of in-vehicle systems, the central control device centralizing control of the plurality of control devices including the motor control device; and a plurality of detection devices connected to the central control device; the central control device including: a manual steering command value calculation unit that calculates a manual steering command value based on the steering torque applied from the motor control device and information obtained from a detection signal of at least one of the plurality of detection devices; and an automatic steering command value calculation unit that calculates an automatic steering command value for driving assistance; and the motor control device controls the electric motor based on an integrated angle command value calculated from the manual steering command value and the automatic steering command value.
[0012] In this configuration, when a manual steering command value is calculated using information obtained from the detection signal of at least one of the multiple detection devices connected to the overall control device, the communication bus load between the overall control device and the motor control device can be prevented from becoming too high.
[0013] In one embodiment of the present disclosure, the integrated control device includes an integrated angle command value calculation unit that calculates the integrated angle command value by adding the manual steering command value to the automatic steering command value.
[0014] In one embodiment of the present disclosure, the manual steering command value generation unit is configured to calculate the manual steering command value by using an equation of motion of a reference model of the steering device.
[0015] DETAILED DESCRIPTION OF EMBODIMENTS OF THE PRESENT DISCLOSURE Hereinafter, embodiments of the present disclosure will be described in detail with reference to the accompanying drawings.
[0016] FIG. 1 is a schematic diagram showing an electric power steering device 1 and a steering control system that controls an electric motor in the electric power steering device 1.
[0017] The electric power steering device 1 includes a steering wheel (handle) 2 as a steering member for steering the vehicle, a steering mechanism 4 that steers steered wheels 3 in conjunction with the rotation of the steering wheel 2, a steering assist mechanism 5 that assists the driver in steering, and a motor control ECU 202. The steering wheel 2 and the steering mechanism 4 are mechanically connected via a steering shaft 6 and an intermediate shaft 7.
[0018] The steering shaft 6 includes an input shaft 8 connected to the steering wheel 2 and an output shaft 9 connected to the intermediate shaft 7. The input shaft 8 and the output shaft 9 are connected via a torsion bar 10 so as to be capable of relative rotation.
[0019] A torque sensor 12 is disposed near the torsion bar 10. The torque sensor 12 detects the torsion bar torque (steering torque) T applied to the steering wheel 2 based on the amount of relative rotational displacement between the input shaft 8 and the output shaft 9. tb In this embodiment, the torsion bar torque T tb For example, the torque for steering left is detected as a positive value, and the torque for steering right is detected as a negative value. The larger the absolute value of the torque, the greater the torsion bar torque T tb The torque sensor 12 is an example of a "steering torque detection unit" in the present disclosure.
[0020] The steering mechanism 4 is made up of a rack-and-pinion mechanism including a pinion shaft 13 and a rack shaft 14 as a steering shaft. The steered wheels 3 are connected to each end of the rack shaft 14 via tie rods 15 and knuckle arms (not shown). The pinion shaft 13 is connected to the intermediate shaft 7. The pinion shaft 13 rotates in conjunction with the steering of the steering wheel 2. A pinion 16 is connected to the tip of the pinion shaft 13.
[0021] The rack shaft 14 extends linearly in the left-right direction of the vehicle. A rack 17 that meshes with the pinion 16 is formed in the axial middle of the rack shaft 14. The pinion 16 and the rack 17 convert the rotation of the pinion shaft 13 into axial movement of the rack shaft 14. By moving the rack shaft 14 in the axial direction, the steered wheels 3 can be steered.
[0022] When the steering wheel 2 is steered (rotated), this rotation is transmitted to the pinion shaft 13 via the steering shaft 6 and the intermediate shaft 7. The rotation of the pinion shaft 13 is then converted into axial movement of the rack shaft 14 by the pinion 16 and the rack 17. As a result, the steered wheels 3 are steered.
[0023] The steering assist mechanism 5 includes an electric motor 18 for generating a steering assist force (assist torque), and a reducer 19 for amplifying the output torque of the electric motor 18 and transmitting it to the steering mechanism 4. The reducer 19 is made up of a worm gear mechanism including a worm gear 20 and a worm wheel 21 that meshes with the worm gear 20. The reducer 19 is housed in a gear housing 22 that serves as a transmission mechanism housing.
[0024] In the following description, the reduction ratio (gear ratio) of the reducer 19 is represented by N. The reduction ratio N is expressed as a function of the worm wheel angle θ, which is the rotation angle of the worm wheel 21. ww The worm gear angle θ is the rotation angle of the worm gear 20 relative to the wg The ratio (θ wg / θ ww ) is defined as
[0025] The worm gear 20 is rotationally driven by the electric motor 18. The worm wheel 21 is coupled to the output shaft 9 so as to be rotatable integrally therewith. The electric motor 18 is an example of the "electric motor of the steering device" in this disclosure.
[0026] When the worm gear 20 is rotationally driven by the electric motor 18, the worm wheel 21 is rotationally driven, and motor torque is applied to the steering shaft 6, causing the steering shaft 6 (output shaft 9) to rotate. The rotation of the steering shaft 6 is then transmitted to the pinion shaft 13 via the intermediate shaft 7. The rotation of the pinion shaft 13 is converted into axial movement of the rack shaft 14, thereby turning the steered wheels 3. In other words, by rotating the worm gear 20 with the electric motor 18, steering assistance by the electric motor 18 and steering of the steered wheels 3 become possible. The electric motor 18 is provided with a rotation angle sensor 23 for detecting the rotation angle of the rotor of the electric motor 18.
[0027] The torque applied to the output shaft 9 (an example of a drive target of the electric motor 18) includes a motor torque by the electric motor 18 and a disturbance torque T lc Disturbance torque other than the motor torque T lc Torsion bar torque T tb , road reaction torque (road load torque) T rl , friction torque T f etc. are included.
[0028] Torsion bar torque T tb is the torque applied to the output shaft 9 from the steering wheel 2 side by the force applied to the steering wheel 2 by the driver, the force generated by steering inertia, etc.
[0029] Road reaction torque T rl is the torque applied to the output shaft 9 from the steered wheels 3 side via the rack shaft 14 due to the self-aligning torque generated in the tire, the force generated by the suspension and tire-wheel alignment, the frictional force of the rack-and-pinion mechanism, etc.
[0030] The electric motor 18 is controlled by a motor control ECU 202. The motor control ECU 202 is an example of a "motor control device" in the present disclosure.
[0031] The vehicle is equipped with a CCD (Charge Coupled Device) camera 25 that captures images of the road ahead in the direction of travel of the vehicle, a GPS (Global Positioning System) 26 for detecting the vehicle's position, a radar 27 for detecting road shapes and obstacles, a vehicle speed sensor 28 for detecting the vehicle speed, and a map information memory 29 that stores map information. The vehicle is also equipped with two mode switches 31 and 32 for manually switching the steering mode.
[0032] As will be described later, the steering modes include a manual steering mode in which steering is performed by manual driving, and a cooperative steering mode in which steering based on both manual driving and automatic driving is possible.
[0033] The CCD camera 25, the GPS 26, the radar 27, the vehicle speed sensor 28, the map information memory 29, and the mode switches 31 and 32 are connected to the overall control ECU 201. tb is provided to the overall control ECU 201 via the motor control ECU 202. The overall control ECU 201 is an example of an “overall control device” in the present disclosure. A steering control system for controlling the electric motor 18 includes the motor control ECU 202 and the overall control ECU 201.
[0034] The overall control ECU 201 is an ECU for overall control of a plurality of control devices that control a plurality of on-board systems. The plurality of control devices that control the plurality of on-board systems includes a motor control ECU 202. The plurality of control devices that control the plurality of on-board systems may also include a brake control ECU, an engine control ECU, etc. In addition to the detection devices 25 to 28, such as the CCD camera 25, the GPS 26, the radar 27, and the vehicle speed sensor 28, one or more detection devices of different types may also be connected to the overall control ECU 201.
[0035] Fig. 2 is a block diagram showing a part of the configuration of the overall control ECU 201. In Fig. 2, only the configuration of the overall control ECU 201 related to the control of the motor control ECU 202 is shown.
[0036] The overall control ECU 201 is composed of a microcomputer. The microcomputer has a CPU and memory (ROM, RAM, non-volatile memory, etc.), and functions as a plurality of functional processing units by executing a predetermined program. The plurality of functional processing units includes a steering mode signal generation unit 101, a lateral deviation / automatic steering command value calculation unit 102, a target virtual spring reaction force setting unit 103, a manual steering command value calculation unit 104, and an integrated angle command value calculation unit 105.
[0037] The steering mode signal generation unit 101 generates a steering mode signal S , which indicates whether the steering mode (driving mode) is a manual steering mode (manual driving mode) or a cooperative steering mode (driving assistance mode), based on the operation of the first mode switch 31 and the second mode switch 32. mode Generate.
[0038] Specifically, when the first mode switch 31 is turned on by the driver, the overall control ECU 201 outputs a steering mode signal S mode On the other hand, when the second mode switch 32 is turned on by the driver, the overall control ECU 201 generates a steering mode signal S mode Generate.
[0039] The lateral deviation / automatic steering command value calculation unit 102 recognizes the surrounding environment, estimates the vehicle's position, plans a route, etc. based on information obtained from the CCD camera 25, GPS 26, radar 27, and vehicle speed sensor 28, as well as map information, and determines the control target values for the steering and drive actuators.
[0040] Then, the lateral deviation / automatic steering command value calculation unit 102 calculates the lateral deviation e L and calculates the automatic steering command value θ for automatic steering (driving assistance control). ad Calculate the following.
[0041] In this embodiment, the lateral deviation e Lis the distance from the currently set target driving line (lane center line) to the vehicle's reference position (hereinafter referred to as the "vehicle reference position"). The vehicle reference position is set at a predetermined position in the center of the vehicle's width.
[0042] In this embodiment, the lateral deviation e L is 0 (e L = 0), and when the vehicle reference position is on the left side of the target driving line in the direction of travel, it becomes a positive value (e L >0), and when the vehicle reference position is on the right side of the target driving line in the direction of travel, it becomes a negative value (e L <0).
[0043] The automatic steering control is, for example, a control for driving the vehicle along a target driving line. ad is a target value of the steering angle for automatically driving the vehicle along the target driving line. The automatic steering control may be, for example, lane keeping assist (LKA) control that assists steering so that the vehicle stays within the driving lane, lane centering assist (LCA) control that assists steering so that the vehicle drives in the center of the driving lane, or the like.
[0044] In this embodiment, the automatic steering command value θ ad is expressed as the amount of rotation (rotation angle) of the output shaft 9 from the neutral position, and the amount of rotation from the neutral position in the left steering direction is expressed as a positive value, and the amount of rotation from the neutral position in the right steering direction is expressed as a negative value. ad is, for example, the vehicle speed, the lateral deviation e from the target driving line (lane center line), L and the yaw deviation of the vehicle relative to the target driving line. ad The process of setting the value is well known, so a detailed description will be omitted here.
[0045] The lateral deviation e calculated by the lateral deviation / automatic steering command value calculation unit 102 L is given to the target virtual spring reaction force setting unit 103. The automatic steering command value θ calculated by the lateral deviation / automatic steering command value calculation unit 102 adis given to the integrated angle command value calculation unit 105.
[0046] The target virtual spring reaction force setting unit 103 calculates the lateral deviation e L Based on this, the target virtual spring reaction force T tb,d (e L ) to set the
[0047] FIG. 3 shows the lateral deviation e L Target virtual spring reaction force T tb,d (e L ) is a graph showing an example of setting.
[0048] Lateral deviation e L Ga-e L,s (However, e L,s >0) to e L,s In the range up to tb,d (e L ) is -T tb,d,s (However, T tb,d,s >0) to T tb,d,s Until, lateral deviation e L In this example, the target virtual spring reaction force T tb,d (e L ) varies linearly, but may vary nonlinearly. In this example, e L,s is set to a predetermined value that is greater than zero and less than half the width of the driving lane.
[0049] Lateral deviation e L Gae L,s From e L,m (However, e L,m >e L,s ) in the range up to the target virtual spring reaction force T tb,d (e L ) is T tb,d,s From T tb,d,m (However, T tb,d,m >T tb,d,s ) until the lateral deviation e L The larger the lateral deviation e is, the larger the L Gae L,s From e L,m In the range up to lateral deviation e L Ga-e L,s From e L,s Compared with the range up to the target virtual spring reaction force Ttb,d (e L In this example, the slope of the line representing the target virtual spring reaction force T tb,d (e L ) changes linearly, but may change nonlinearly. L Gae L,m In the larger range, the target virtual spring reaction force T tb,d (e L ) is T tb,d,m is set to.
[0050] Lateral deviation e L Ga-e L,s From -e L,m (However, -e L,m <-e L,s ) in the range up to the target virtual spring reaction force T tb,d (e L ) is -T tb,d,s From -T tb,d,m (However, -T tb,d,m <-T tb,d,s ) until the lateral deviation e L The smaller the lateral deviation e, the smaller the L Ga-e L,s From -e L,m In the range up to lateral deviation e L Ga-e L,s From e L,s Compared with the range up to the target virtual spring reaction force T tb,d (e L In this example, the slope of the line representing the target virtual spring reaction force T tb,d (e L ) changes linearly, but may change nonlinearly. L Ga-e L,m In a smaller range, the target virtual spring reaction force T tb,d (e L ) is -T tb,d,m is set to.
[0051] The target virtual spring reaction force T set by the target virtual spring reaction force setting unit 103 tb,d (e L ) is given to the manual steering command value calculation unit 104.
[0052] The manual steering command value calculation unit 104 basically calculates the steering angle (more precisely, the rotation angle θ of the output shaft 9) corresponding to the steering wheel operation when the driver operates the steering wheel 2 in the cooperative steering mode. c ) is the manual steering command value θ md It is provided to set as.
[0053] The manual steering command value calculation unit 104 calculates the torsion bar torque T tb and a manual steering command value θ based on information obtained from a detection signal of at least one of the plurality of detection devices connected to the overall control ECU 201. md In this embodiment, the manual steering command value calculation unit 104 calculates the torsion bar torque T tb and the target virtual spring reaction force T set by the target virtual spring reaction force setting unit 103. tb,d (e L ) and the manual steering command value θ md Generate.
[0054] The manual steering command value calculation unit 104 will be described in detail below.
[0055] First, the manual steering command value θ generated by the manual steering command value generating unit described in Patent Document 1 md This section explains how to set this up.
[0056] The manual steering command value generating unit described in Patent Document 1 is provided in a motor control ECU. The manual steering command value generating unit calculates a manual steering command value θ using the reference EPS model shown in FIG. md The reference EPS model in FIG. 4 is an example of the "reference model of the steering device" of the present disclosure.
[0057] This reference EPS model is a single inertia model including a lower column. The lower column corresponds to the output shaft 9 and the worm wheel 21. However, this model is only an example, and an inertia model including a configuration other than the above (for example, a rack shaft 14) may also be used. In FIG. 4, J mdis the inertia of the lower column (hereinafter referred to as "column inertia"), and θ col is the rotation angle of the lower column, and T tb is the torsion bar torque. tb , torque N·T acting on the output shaft 9 from the electric motor 18 m and road reaction torque (virtual reaction force) T rl is given.
[0058] Road reaction torque T rl is the spring constant k of the virtual spring md and the viscous damping coefficient c of the virtual damper md Using the above, it is expressed by the following equation (1).
[0059]
[0060] Spring constant k md and the viscous damping coefficient c md is previously determined by, for example, experiments, analysis, etc. md ・θ col is called the virtual spring reaction force, and c md (dθ col / dt) is sometimes called a virtual damper reaction force.
[0061] The equation of motion of the reference EPS model is expressed by the following equation (2).
[0062]
[0063] In formula (2), J md ・d 2 θ col / dt 2 is the inertia torque acting on the lower column.
[0064] The manual steering command value generating unit is T tb The torsion bar torque T detected by the torque sensor 12 tb Substituting, T m The assist torque command value T is set by the assist torque command value setting unit 51 (see FIG. 6) in the motor control ECU 202. as By substituting the above and solving the differential equation (2), the rotation angle θ of the lower column is obtained. colThen, the manual steering command value generating unit calculates the obtained rotation angle θ of the lower column. col The manual steering command value θ md In this way, the manual steering command value θ md The method of setting is called the comparison method.
[0065] The equation of motion in equation (2) is T m T as and θ col θ md is equivalent to the equation of motion in which
[0066] In the comparative method, the spring constant k of the virtual spring is used as the virtual spring reaction force. md Low Column J md Rotation angle θ col (Manual steering command value θ md ) is used. Therefore, the spring constant k md Even if a value corresponding to the lateral position of the vehicle reference position is used as the virtual spring reaction force, it is not possible to set a torque corresponding to the lateral position of the vehicle reference position as the virtual spring reaction force. md ・θ col (= k md ・θ md ) is a reaction force that is left to chance.
[0067] In this embodiment, unlike the comparison method, the manual steering command value calculation unit 104 is provided in the overall control ECU 201. Also, the manual steering command value calculation unit 104 calculates the manual steering command value θ based on a motion equation different from that used in the comparison method. md Calculate the following.
[0068] The manual steering command value calculation unit 104 calculates the manual steering command value θ using the equation of motion (2) of the reference EPS model described above. md Specifically, in this embodiment, the manual steering command value calculation unit 104 calculates the manual steering command value θ based on the equation of motion obtained by modifying the equation of motion (2) of the reference EPS model described above. md Calculate the following.
[0069] FIG. 5 is a block diagram showing the configuration of the manual steering command value calculation unit 104.
[0070] In FIG. md is the column inertia. s is the differential operator and 1 / s corresponds to the integrator. θ md is the manual steering command value, and the rotation angle θ of the lower column in the comparison method col Equivalent to: md is the viscous damping coefficient of the virtual damper, which is obtained in advance by experiment, analysis, etc.
[0071] The manual steering command value calculation unit 104 includes an addition / subtraction unit 111 , an inertia division unit 112 , a first integration unit 113 , a second integration unit 114 , and a virtual damper reaction force calculation unit 115 .
[0072] The addition / subtraction unit 111 receives the torsion bar torque T tb and the target virtual spring reaction force T tb,d (e L ) and the virtual damper reaction force c given by the virtual damper reaction force calculation unit 115 md ・dθ md / dt is input.
[0073] The addition / subtraction unit 111 calculates the torsion bar torque T tb From the above, the target virtual spring reaction force T tb,d (e L ) and virtual damper reaction force c md ・dθ md As a result, the adder / subtractor 111 subtracts J on the left side of the equation (2). md ・d 2 θ col / dt 2 The inertial torque J corresponds to md ・d 2 θ md / dt 2 (=T tb -c md ・dθ md / dt-T tb,d (e L )) is calculated.
[0074] The inertia division unit 112 calculates the inertia torque J calculated by the addition / subtraction unit 111. md ・d 2 θ md / dt 2 The column inertia J mdBy dividing by , the manual steering command value θ md The second derivative d 2 θ md / dt 2 Calculate the following.
[0075] The first integration unit 113 calculates the manual steering command value θ md The second derivative d 2 θ md / dt 2 By integrating the manual steering command value θ md The first derivative dθ md / dt is calculated.
[0076] The second integration unit 114 calculates the manual steering command value θ md The first derivative dθ md By integrating / dt, the manual steering command value θ md This manual steering command value θ md is output from the manual steering command value calculation unit 104.
[0077] The virtual damper reaction force calculation unit 115 calculates the manual steering command value θ md The first derivative dθ md / dt with viscous damping coefficient c md By multiplying by md ・dθ md / dt is calculated. This virtual damper reaction force c md ・dθ md / dt is fed back to the addition / subtraction unit 111 .
[0078] That is, the manual steering command value calculation unit 104 calculates the manual steering command value θ based on the equation of motion shown in the following equation (3). md Calculate the following.
[0079]
[0080] In formula (3), J md ・d 2 θ md / dt 2 is the inertia torque. md ・dθ md / dt is the virtual damper reaction force. tb,d (e L) is the target virtual spring reaction force.
[0081] In this embodiment, the manual steering command value calculation unit 104 calculates the N·T m (=N.T. as ) is set to 0, and the virtual spring reaction force k θ in the equation of motion of the above equation (2) is md As a result, the lateral deviation e L Target virtual spring reaction force T according to tb,d (e L ) to obtain the manual steering command value θ md Calculate the following.
[0082] The overall control ECU 201 may also be provided with an assist torque command value setting unit similar to an assist torque command value setting unit 51 (see FIG. 6) described later. as By multiplying this by the reduction ratio N, we get N・T as Calculate the obtained N.T. as In this case, the addition / subtraction unit 111 calculates the torsion bar torque T tb N.T. as From the sum of these values, the virtual damper reaction force c md ・dθ md / dt and target virtual spring reaction force T tb,d (e L In this case, the manual steering command value calculation unit 104 subtracts N·T from the right side of the equation (3). as Based on the equation of motion to which is added, the manual steering command value θ md The following calculation is performed.
[0083] The manual steering command value θ calculated by the manual steering command value calculation unit 104 md is given to the integrated angle command value calculation unit 105 (see FIG. 2).
[0084] The integrated angle command value calculation unit 105 calculates the automatic steering command value θ ad Manual steering command value θ md By adding cmd Calculate the following.
[0085] The integrated angle command value θ calculated by the integrated angle command value calculation unit 105 cmd and the steering mode signal S generated by the steering mode signal generating unit 101. mode is given to the motor control ECU 202 via the in-vehicle network. tb The output signal of the rotation angle sensor 23 is input to the motor control ECU 202. The motor control ECU 202 controls the electric motor 18 based on these input signals and information provided by the overall control ECU 201.
[0086] FIG. 6 is a block diagram for explaining the electrical configuration of the motor control ECU 202.
[0087] The motor control ECU 202 includes a microcomputer 50, a drive circuit (inverter circuit) 41 controlled by the microcomputer 50 to supply power to the electric motor 18, and a current (hereinafter, "motor current I m and a current detection circuit 42 for detecting the current.
[0088] The microcomputer 50 includes a CPU and memory (ROM, RAM, non-volatile memory, etc.), and executes a predetermined program to function as a plurality of functional processing sections, including an assist torque command value setting section 51, an angle control section 52, a first switch 53, a second switch 54, an adder 55, and a torque control section (current control section) 56.
[0089] The assist torque command value setting unit 51 sets the assist torque command value T as The assist torque command value setting unit 51 sets the torsion bar torque T tb Based on this, the assist torque command value T as Set.
[0090] FIG. 7 shows the torsion bar torque T tb Assist torque command value T as10 is a graph showing an example of setting the
[0091] Assist torque command value T as is set to a positive value when the electric motor 18 is to generate a steering assist force for steering to the left, and is set to a negative value when the electric motor 18 is to generate a steering assist force for steering to the right. as is the torsion bar torque T tb The torsion bar torque T tb The assist torque command value T as is the torsion bar torque T tb The larger the absolute value of , the larger the absolute value is set.
[0092] The assist torque command value setting unit 51 calculates the torsion bar torque T tb is multiplied by a preset constant to obtain the assist torque command value T as The assist torque command value T as may be set taking into consideration the vehicle speed.
[0093] The angle control unit 52 receives an integrated angle command value θ cmd Based on this, the integrated motor torque command value T com The angle control unit 52 will be described in detail later.
[0094] The first switch 53 and the second switch 54 are connected to the steering mode signal S mode Specifically, the steering mode signal S indicates that the steering mode is the manual steering mode. mode is input, the first switch 53 is turned on and the second switch 54 is turned off.
[0095] On the other hand, the steering mode signal S mode is input, the first switch 53 is turned off and the second switch 54 is turned on.
[0096] When the first switch 53 is in the ON state and the second switch 54 is in the OFF state, the adder 55 calculates the assist torque command value T as , the motor torque command value T m,cmd (=T as On the other hand, when the second switch 54 is in the ON state and the first switch 53 is in the OFF state, the adder 55 outputs the integrated motor torque command value T com is the motor torque command value T m,cmd (=T com ) is output.
[0097] The motor torque command value T m,cmd is given to the torque control section 56.
[0098] The torque control unit 56 controls the motor torque of the electric motor 18 to be equal to the motor torque command value T m,cmd The drive circuit 41 is driven so that the torque control unit 56 approaches the motor torque command value T m,cmd The torque control unit 56 calculates a current command value by dividing the motor current I detected by the current detection circuit 42. m Feedback control is performed so that the current command value approaches the reference value.
[0099] FIG. 8 is a block diagram showing the configuration of the angle control unit 52.
[0100] The angle control unit 52 calculates an integrated angle command value θ cmd Based on this, the integrated motor torque command value T com The angle control unit 52 includes a low-pass filter (LPF) 61, a feedback control unit 62, a feedforward control unit 63, a disturbance torque estimating unit 64, a torque adding unit 65, a disturbance torque compensating unit 66, a first reduction ratio dividing unit 67, a reduction ratio multiplying unit 68, a rotation angle calculating unit 69, and a second reduction ratio dividing unit 70.
[0101] The reduction ratio multiplication unit 68 multiplies the motor torque command value T m,cmd is multiplied by the reduction ratio N of the reducer 19 to obtain the motor torque command value T m,cmd is the output shaft torque command value N·T acting on the output shaft 9 (worm wheel 21). m,cmd Convert to.
[0102] The rotation angle calculation unit 69 calculates the rotor rotation angle θ of the electric motor 18 based on the output signal of the rotation angle sensor 23. m The second reduction ratio division unit 70 calculates the rotor rotation angle θ calculated by the rotation angle calculation unit 69. m By dividing by the reduction ratio N, the rotor rotation angle θ m The rotation angle (actual steering angle) θ of the output shaft 9 c Convert to.
[0103] In this embodiment, the actual steering angle θ c is expressed as the amount of rotation (rotation angle) of the output shaft 9 from the neutral position, and the amount of rotation from the neutral position in the left steering direction is expressed as a positive value, and the amount of rotation from the neutral position in the right steering direction is expressed as a negative value.
[0104] The low-pass filter 61 calculates the integrated angle command value θ cmd The integrated angle command value θ after low-pass filtering is cmdl is given to the feedback control section 62 and the feedforward control section 63. The low-pass filter 61 does not have to be provided.
[0105] The feedback control unit 62 converts the steering angle estimated value ^θ calculated by the disturbance torque estimating unit 64 into an integrated angle command value θ after low-pass filtering. cmdl The feedback control unit 62 includes an angle deviation calculation unit 62A and a PD control unit 62B. The angle deviation calculation unit 62A calculates an integrated angle command value θ cmdl and the estimated steering angle ^θ c Deviation Δθ (= θ cmdl -^θ c ) is calculated. The angle deviation calculation unit 62A calculates the integrated angle command value θ cmdl and the actual steering angle θ calculated by the second reduction ratio division unit 70.c deviation from (θ cmdl -θ c ) may be calculated as the angle deviation Δθ.
[0106] The PD control unit 62B performs a PD calculation (proportional differential calculation) on the angle deviation Δθ calculated by the angle deviation calculation unit 62A, thereby obtaining a feedback control torque T fb The feedback control torque T fb is given to the torque adder 65.
[0107] The feedforward control unit 63 is provided to compensate for a delay in response due to the inertia of the electric power steering device 1, thereby improving the response of the control. The feedforward control unit 63 includes an angular acceleration calculation unit 63A and an inertia multiplication unit 63B. The angular acceleration calculation unit 63A calculates an integrated angle command value θ cmdl By differentiating twice, the target angular acceleration d 2 θ cmdl / dt 2 Calculate the following.
[0108] The inertia multiplication unit 63B multiplies the target angular acceleration d calculated by the angular acceleration calculation unit 63A by 2 θ cmdl / dt 2 is multiplied by the inertia J of the electric power steering device 1 to obtain the feedforward control torque T ff (=J.d 2 θ cmdl / dt 2 The inertia J is calculated from, for example, a physical model (not shown) of the electric power steering device 1. The feedforward control torque T ff is given to the torque adder 65 as an inertia compensation value.
[0109] The torque adder 65 calculates the feedback control torque T fb The feedforward control torque T ff By adding fb +T ff ) is calculated.
[0110] The disturbance torque estimating section 64 is provided to estimate a nonlinear torque (disturbance torque: torque other than motor torque) that occurs as a disturbance in the plant (the object driven by the electric motor 18). The disturbance torque estimating section 64 estimates the output shaft torque command value N·T m,cmd and the actual steering angle θ c Based on this, the disturbance torque (disturbance load) T lc , steering angle θ and steering angle differential value (angular velocity) dθ c / dt is estimated. lc and steering angle θ c The estimated values of ^T lc and ^θ c It is expressed as:
[0111] As the disturbance torque estimating unit 64, for example, the disturbance torque estimating unit (64) shown in Figures 6 and 8 of Japanese Patent Application Laid-Open No. 2019-194059 (Patent Document 1) can be used. However, in Figures 6 and 8 of Japanese Patent Application Laid-Open No. 2019-194059, the actual steering angle is θ c It is indicated by θ instead of θ.
[0112] The disturbance torque estimated value ^T calculated by the disturbance torque estimator 64 lc is given to the disturbance torque compensator 66 as a disturbance torque compensation value. The steering angle estimated value ^θ calculated by the disturbance torque estimator 64 c is given to the angle deviation calculation unit 62A.
[0113] The disturbance torque compensator 66 calculates the basic torque command value (T fb +T ff ) to the estimated disturbance torque value ^T lc By subtracting co (=T fb +T ff -^T lc ) is calculated. As a result, the integrated torque command value T co (torque command value for the output shaft 9) is obtained.
[0114] Integrated torque command value T co is given to the first reduction ratio division unit 67. The first reduction ratio division unit 67 calculates the integrated torque command value T cois divided by the reduction ratio N to obtain the integrated motor torque command value T com (torque command value for the electric motor 18). This integrated motor torque command value T com is applied to the second switch 54 (see FIG. 6).
[0115] The operation of this embodiment will be described below with reference to FIGS.
[0116] In this embodiment, the manual steering mode is when the assist torque command value T as The cooperative steering mode refers to a steering mode in which the electric motor 18 is controlled based only on the automatic steering command value θ ad and manual steering command value θ md The integrated angle command value θ cmd This refers to a steering mode in which the electric motor 18 is controlled based on the steering angle.
[0117] When the steering mode is set to the manual steering mode, the first switch 53 is turned on and the second switch 54 is turned off. When the steering mode is set to the cooperative steering mode, the first switch 53 is turned off and the second switch 54 is turned on. In other words, in this embodiment, the driver can switch the steering mode between the manual steering mode and the cooperative steering mode by operating the mode switches 31 and 32.
[0118] Although the steering mode is switched by the mode switches 31 and 32, the overall control ECU 201 may switch the steering mode in accordance with an ON / OFF signal of the driving assistance function or the automatic driving function, obstacles, the driver's state, driver operations such as accelerator and brake, and the running state of the vehicle. In this case, the overall control ECU 201 may generate a mode setting signal in accordance with an ON / OFF signal of the driving assistance function or the automatic driving function, obstacles, the driver's state, driver operations such as accelerator and brake, and the running state of the vehicle, and provide the signal to the motor control ECU 202.
[0119] In this embodiment, the integrated angle command value θ cmd and a cooperative steering mode in which the electric motor 18 can be controlled based on the assist torque command value Tas This allows switching between a manual steering mode in which the electric motor 18 can be controlled based only on the steering angle.
[0120] That is, the integrated angle command value θ cmd In the electric power steering device 1 that can control the electric motor 18 based on the assist torque command value T as Therefore, the electric motor 18 can be controlled based only on the above.
[0121] In this embodiment, in the manual steering mode, the assist torque command value T as Since the electric motor 18 is controlled based only on the road surface reaction torque, the driver can receive the actual road surface reaction torque.
[0122] In this embodiment, in the cooperative steering mode, the manual steering command value calculation unit 104 calculates the virtual spring reaction force k·θ in the equation of motion of the above-mentioned formula (2). md As a result, the lateral deviation e L Target virtual spring reaction force T according to tb,d (e L ) to obtain the manual steering command value θ md As a result, in the cooperative steering mode, the lateral deviation e L This allows the driver to easily recognize the distance from the center of the lane or the distance to the lane.
[0123] In this embodiment, the integrated angle command value θ cmd Based on the basic torque command value (T fb +T ff ) is calculated, and the disturbance torque estimated value ^T calculated by the disturbance torque estimating unit 64 lc The basic torque command value (T fb +T ff ) is corrected, the effect of disturbance torque on angle control performance can be suppressed, thereby realizing highly accurate angle control.
[0124] In this embodiment, the manual steering command value calculation unit 104 is provided not in the motor control ECU 202 but in the overall control ECU 201. As a result, the manual steering command value θ is calculated using information obtained from a detection signal of at least one of the multiple detection devices connected to the overall control ECU 201. md When calculating the above, it is possible to prevent the load on the communication bus between the overall control ECU 201 and the motor control ECU 202 from increasing.
[0125] This point will be described in detail below. In this embodiment, the lateral deviation e is calculated based on the detection signals of the detection devices such as the CCD camera 25, the GPS 26, the radar 27, and the vehicle speed sensor 28. L (or target virtual spring reaction force T tb,d (e L The manual steering command value calculation unit 104 calculates the lateral deviation e L (or target virtual spring reaction force T tb,d (e L ) and the torsion bar torque T given by the motor control ECU 202 tb Based on this, the manual steering command value θ md is calculated.
[0126] The manual steering command value calculation unit 104 calculates the manual steering command value θ md In order to calculate the torsion bar torque T tb However, in a vehicle equipped with an automatic driving function or a driving assistance function, the torsion bar torque T tb Therefore, in the past, the motor control ECU 202 transmitted the torsion bar torque T tb Therefore, even if the manual steering command value calculation unit 104 is provided in the overall control ECU 201, the torsion bar torque T tb The transmission of the above does not increase the load on the communication bus between the two ECUs.
[0127] When the manual steering command value calculation unit 104 is provided in the motor control ECU 202, the lateral deviation e calculated based on the detection signals of the detection devices 25 to 28 is L (or target virtual spring reaction force T tb,d (e L )) needs to be transmitted from the overall control ECU 201 to the motor control ECU 202. In contrast, when the manual steering command value calculation unit 104 is provided in the overall control ECU 201 as in this embodiment, the lateral deviation e L (or target virtual spring reaction force T tb,d (e L ) does not need to be transmitted from the overall control ECU 201 to the motor control ECU 202. This makes it possible to prevent the load on the communication bus between the overall control ECU 201 and the motor control ECU 202 from becoming too high.
[0128] Since the manual steering command value calculation unit 104 is provided in the overall control ECU 201, the following effect can be further obtained: Information to be used for calculation by the manual steering command value calculation unit 104 (for example, lateral deviation e L Or the target virtual spring reaction force T tb,d (e L When the algorithm for calculating the steering command value (i.e., the steering command value calculation unit 104) is changed, the algorithm of the manual steering command value calculation unit 104 may need to be changed accordingly.
[0129] In such a case, if the manual steering command value calculation unit 104 is provided in the motor control ECU 202 as in the conventional example, it is necessary to change the programs of both the overall control ECU 201 and the motor control ECU 202. In contrast, in this embodiment, the manual steering command value calculation unit 104 is provided in the overall control ECU 201, so in such a case, it is sufficient to change the program of only the overall control ECU 201.
[0130] Although the embodiments of the present disclosure have been described above, the present disclosure can also be embodied in other forms.
[0131] In the above-described embodiment, the manual steering command value calculation unit 104 calculates the manual steering command value θ based on the equation of motion shown in the above-described equation (3). mdHowever, the overall control ECU 201 may also be provided with an assist torque command value setting unit similar to the assist torque command value setting unit 51 in FIG. 6, thereby causing the manual steering command value calculation unit 104 to perform the following operation.
[0132] That is, the manual steering command value calculation unit 104 basically calculates the manual steering command value θ based on the equation of motion shown in the above equation (2). md Specifically, the manual steering command value calculation unit 104 calculates T tb The torsion bar torque T detected by the torque sensor 12 tb and T in the above formula (2) m The assist torque command value T is set by the assist torque command value setting unit provided in the overall control ECU 201. as By substituting the above and solving the differential equation (2), the rotation angle θ of the lower column is obtained. col Then, the manual steering command value calculation unit 104 calculates the obtained rotation angle θ of the lower column. col The manual steering command value θ md Set as.
[0133] However, the manual steering command value calculation unit 104 calculates the spring constant k md and the viscous damping coefficient c of the virtual damper md At least one of the lateral deviation e L For example, the spring constant k of the virtual spring is changed according to md and the viscous damping coefficient c of the virtual damper md , lateral deviation e L The larger the absolute value of is, the larger the value is set.
[0134] The overall control ECU 201 also calculates the curvature ρ of the lane on which the vehicle is traveling based on the detection devices 25 to 28 and the map information memory 29, and calculates the manual steering command value θ md In this case, the overall control ECU 201 may also be provided with an assist torque command value setting unit similar to the assist torque command value setting unit 51 in FIG. 6. The manual steering command value calculation unit 104 basically calculates the manual steering command value θ based on the equation of motion shown in the above formula (2).md However, the manual steering command value calculation unit 104 calculates the manual steering command value θ in consideration of the curvature ρ so that the vehicle can follow the target driving line more easily on a curved road than on a straight road. md Calculate the following.
[0135] Furthermore, in addition to the detection devices 25 to 28, side obstacle sensors for detecting obstacles present on the sides of the vehicle may be connected to the overall control ECU 201. The overall control ECU 201 detects side obstacles present on the sides of the vehicle based on the output signals of the side obstacle sensors, and calculates the position coordinates of the detected side obstacles. Then, the overall control ECU 201 calculates the manual steering command value θ md The side obstacle sensor may be an ultrasonic sensor, a CCD camera 25, or a radar 27.
[0136] In this case, the overall control ECU 201 may also be provided with an assist torque command value setting unit similar to the assist torque command value setting unit 51 in Fig. 6. The manual steering command value calculation unit 104 basically calculates the manual steering command value θ based on the equation of motion shown in the above formula (2). md However, the manual steering command value calculation unit 104 calculates the manual steering command value θ based on the position coordinates of the detected side obstacle so as to generate a steering reaction force for suppressing steering in a direction in which the side of the vehicle will collide with the side obstacle. md Calculate the following.
[0137] The driving assistance control may be parking assistance control that assists parking. In this case, an ultrasonic sensor may be connected to the overall control ECU 201 in addition to the detection devices 25 to 28, and the overall control ECU 201 may be made to perform the following operation. In the following, the target virtual spring reaction force T set by the target virtual spring reaction force setting unit 103 in FIG. 2 is tb,d (e L ) is the first target virtual spring reaction force T tb,d (e L ) Let's call it that.
[0138] That is, during parking assistance, the overall control ECU 201 generates a distance from the vehicle to the obstacle, a direction of travel signal indicating whether the vehicle is moving forward or backward, and an obstacle position signal indicating whether the obstacle is on the left or right side of a straight line that includes the vehicle width center line as part of it when viewed from behind the vehicle's direction of travel to the front.
[0139] The overall control ECU 201 then calculates a second target virtual spring reaction force T based on the distance from the vehicle to the obstacle, the traveling direction signal, and the obstacle position signal. tb,d Specifically, the overall control ECU 201 sets the second target virtual spring reaction force T tb,d The absolute value of the second target virtual spring reaction force T tb,d The second target virtual spring reaction force T tb,d Set.
[0140] Then, the manual steering command value calculation unit 104 calculates the manual steering command value θ based on the equation of motion shown in the above equation (3). md However, the first target virtual spring reaction force T tb,d (e L ) is the second target virtual spring reaction force T tb,d can be replaced by
[0141] In the above-described embodiment, the integrated angle command value calculation unit 105 is provided in the overall control ECU 201, but the integrated angle command value calculation unit 105 may be provided in the motor control ECU 202. In this case, the automatic steering command value θ ad and manual steering command value θ md and are sent separately from the overall control ECU 201 to the motor control ECU 202.
[0142] In the above-described embodiment, the angle control unit 52 (see FIG. 8) includes the feedforward control unit 63, but the feedforward control unit 63 may be omitted. In this case, the feedback control torque T calculated by the feedback control unit 62 is fb is the basic target torque.
[0143] In addition, although the above-described embodiment shows an example in which the present disclosure is applied to motor control of a column-type EPS, the present disclosure can also be applied to motor control of EPS other than column-type EPS. Furthermore, the present disclosure can also be applied to control of an electric motor for steering angle control in a steer-by-wire system.
[0144] Although the embodiments of the present disclosure have been described in detail, these are merely specific examples used to clarify the technical content of the present disclosure, and the present disclosure should not be construed as being limited to these specific examples, and the scope of the present disclosure is limited only by the appended claims.
[0145] 1...electric power steering device, 25...CCD camera, 26...GPS, 27...radar, 28...vehicle speed sensor, 51...assist torque command value setting unit, 52...angle control unit, 53...first switch, 54...second switch, 55...addition unit, 56...torque control unit, 101...steering mode signal generation unit, 102...lateral deviation / automatic steering command value calculation unit, 103...target virtual spring reaction force setting unit, 104...manual steering command value calculation unit, 105...integrated angle command value calculation unit, 201...host ECU for overall control, 202...motor control ECU
Claims
1. A steering control system comprising: a motor control device for driving and controlling an electric motor of a steering device, the motor control device being connected to a steering torque detection unit that detects steering torque applied to a steering member; a plurality of control devices that control each of a plurality of in-vehicle systems, the overall control device overall controlling the plurality of control devices including the motor control device; and a plurality of detection devices connected to the overall control device, wherein the overall control device comprises: a manual steering command value calculation unit that calculates a manual steering command value based on the steering torque applied from the motor control device and information obtained from a detection signal of at least one of the plurality of detection devices; and an automatic steering command value calculation unit that calculates an automatic steering command value for driving assistance, and the motor control device controls the electric motor based on an integrated angle command value calculated from the manual steering command value and the automatic steering command value.
2. A steering control system as described in claim 1, wherein the integrated control device includes an integrated angle command value calculation unit that calculates the integrated angle command value by adding the manual steering command value to the automatic steering command value.
Citation Information
Patent Citations
Automatic steering device
JP2013095198A
Motor control device
JP2020049962A
Motor control device
WO2024106377A1