[go: up one dir, main page]

WO2024261947A1 - モータ制御装置 - Google Patents

モータ制御装置 Download PDF

Info

Publication number
WO2024261947A1
WO2024261947A1 PCT/JP2023/023082 JP2023023082W WO2024261947A1 WO 2024261947 A1 WO2024261947 A1 WO 2024261947A1 JP 2023023082 W JP2023023082 W JP 2023023082W WO 2024261947 A1 WO2024261947 A1 WO 2024261947A1
Authority
WO
WIPO (PCT)
Prior art keywords
command value
reaction force
steering command
manual steering
unit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
PCT/JP2023/023082
Other languages
English (en)
French (fr)
Inventor
祥馬 枝元
勉 田村
ロバート フックス
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
JTEKT Corp
Original Assignee
JTEKT Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by JTEKT Corp filed Critical JTEKT Corp
Priority to PCT/JP2023/023082 priority Critical patent/WO2024261947A1/ja
Publication of WO2024261947A1 publication Critical patent/WO2024261947A1/ja
Anticipated expiration legal-status Critical
Pending legal-status Critical Current

Links

Images

Classifications

    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P6/00Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
    • H02P6/08Arrangements for controlling the speed or torque of a single motor

Definitions

  • This disclosure relates to a control device for an electric motor for steering angle control.
  • Patent Document 1 discloses a motor control device that includes an assist torque command value setting unit that generates an assist torque command value using a torsion bar torque, a manual steering command value generation unit that generates a manual steering command value using the torsion bar torque and the assist torque command value, an integrated angle command value calculation unit that adds the manual steering command value to the automatic steering command value to calculate an integrated angle command value, and a switching unit that switches between a first control that controls the electric motor based only on the assist torque command value and a second control that controls the electric motor based on the integrated angle command value based on a switching signal.
  • the manual steering command value generating unit generates a manual steering command value using the equation of motion of the reference model of the steering device.
  • the equation of motion of the reference model of the steering device includes a moment of inertia, a virtual spring reaction force, and a virtual damper reaction force (a virtual damper reaction force corresponding to the manual steering command value).
  • the virtual damper reaction force corresponding to the manual steering command value contains an automatic steering component corresponding to the first-order differential value of the automatic steering command value.
  • the absolute value of the first-order differential value of the automatic steering command value becomes large, for example, when the yaw angle relative to the lane is large or the vehicle speed is high, so in such cases the absolute value of the automatic steering component of the virtual damper reaction force becomes large.
  • the automatic steering component included in the virtual damper reaction force is unrelated to the driver's behavior, so if the absolute value of the automatic steering component of the virtual damper reaction force becomes large, the driver may feel uncomfortable.
  • the objective of this disclosure is to provide a motor control device that can reduce the discomfort felt by the driver due to the automatic steering component contained in the virtual damper reaction force corresponding to the manual steering command value.
  • One embodiment of the present disclosure provides a motor control device for controlling the drive of an electric motor of a steering device, the motor control device including a manual steering command value calculation unit that calculates a manual steering command value using a torsion bar torque, an integrated angle command value calculation unit that calculates an integrated angle command value by adding the manual steering command value to an automatic steering command value for driving assistance, and a control unit that drives and controls the electric motor based on the integrated angle command value, and in a driving assistance mode, the manual steering command value calculation unit is configured to calculate the manual steering command value using an equation of motion of a reference model of the steering device, and the manual steering command value calculation unit calculates the manual steering command value using, as a virtual damper reaction force in the equation of motion, a virtual damper reaction force corresponding to a differential value of the manual steering command value plus a virtual damper reaction force corresponding to a differential value of the automatic steering command value.
  • This configuration can reduce the discomfort felt by the driver due to the automatic steering component contained in the virtual damper reaction force corresponding to the manual steering command value.
  • FIG. 1 is a schematic diagram showing a schematic configuration of an electric power steering system to which a motor control device according to an embodiment of the present disclosure is applied.
  • FIG. 2 is a block diagram for explaining the electrical configuration of the motor control ECU.
  • FIG. 3 is a graph showing an example of setting the assist torque command value T as relative to the torsion bar torque T tb .
  • FIG. 4 is a schematic diagram showing an example of a reference EPS model.
  • FIG. 5 is a block diagram showing the configuration of the manual steering command value calculation unit.
  • FIG. 6 is a block diagram showing the configuration of the angle control unit.
  • FIG. 7 is a schematic diagram showing an example of the configuration of a physical model of an electric power steering system.
  • FIG. 8 is a block diagram showing the configuration of the disturbance torque estimating unit.
  • FIG. 9 is a schematic diagram showing the configuration of the torque control unit.
  • FIG. 10 is a block diagram showing a first modified example of the motor control ECU.
  • FIG. 11 is a graph showing an example of setting the target virtual spring reaction force T tb,d (e l ) relative to the lateral deviation e l .
  • FIG. 12 is a block diagram showing the configuration of a manual steering command value calculation unit used in the first modified example of the motor control ECU.
  • FIG. 13 is a block diagram showing second and third modified examples of the motor control ECU.
  • FIG. 14 is a graph showing an example of setting of the LCA target virtual spring reaction force/weight setting unit with respect to the lateral deviation e l .
  • FIG. 15 is a block diagram showing the configuration of a manual steering command value calculation unit used in the second modified example of the motor control ECU.
  • FIG. 16 is a block diagram showing the configuration of a manual steering command value calculation unit used in the third modified example of the motor control ECU.
  • One embodiment of the present disclosure provides a motor control device for driving and controlling an electric motor for steering angle control of a steering device, the motor control device including a manual steering command value calculation unit that calculates a manual steering command value using a torsion bar torque, an integrated angle command value calculation unit that calculates an integrated angle command value by adding the manual steering command value to an automatic steering command value for driving assistance, and a control unit that drives and controls the electric motor based on the integrated angle command value, wherein in a driving assistance mode, the manual steering command value calculation unit is configured to calculate the manual steering command value by utilizing an equation of motion of a reference model of the steering device, and the manual steering command value calculation unit calculates the manual steering command value using, as a virtual damper reaction force in the equation of motion, a virtual damper reaction force obtained by adding a virtual damper reaction force corresponding to a differential value of the manual steering command value to a virtual damper reaction force corresponding to a differential value of the automatic steering command value.
  • This configuration can reduce the discomfort felt by the driver due to the automatic steering component contained in the virtual damper reaction force corresponding to the manual steering command value.
  • the manual steering command value calculation unit uses a target virtual spring reaction force according to the lateral position of the vehicle reference position relative to the driving lane as the virtual spring reaction force in the equation of motion.
  • the manual steering command value calculation unit calculates the manual steering command value using a virtual spring reaction force in which a virtual spring reaction force corresponding to the manual steering command value is added to a virtual spring reaction force corresponding to the automatic steering command value as a virtual spring reaction force in the equation of motion.
  • the manual steering command value calculation unit calculates the manual steering command value using, as the moment of inertia in the equation of motion, a moment of inertia obtained by adding a moment of inertia corresponding to the automatic steering command value to a moment of inertia corresponding to the manual steering command value.
  • FIG. 1 is a schematic diagram showing the general configuration of an electric power steering system to which a motor control device according to one embodiment of the present disclosure is applied.
  • the electric power steering system 1 includes a steering wheel (handle) 2 as a steering member for steering the vehicle, a steering mechanism 4 that steers the steered wheels 3 in conjunction with the rotation of the steering wheel 2, and a steering assist mechanism 5 that assists the driver in steering.
  • the steering wheel 2 and the steering mechanism 4 are mechanically connected via a steering shaft 6 and an intermediate shaft 7.
  • 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.
  • a torque sensor 12 is disposed near the torsion bar 10.
  • the torque sensor 12 detects a torsion bar torque (steering torque) Ttb applied to the steering wheel 2 based on the amount of relative rotational displacement between the input shaft 8 and the output shaft 9.
  • the torsion bar torque Ttb detected by the torque sensor 12 is detected as a positive value for torque for steering to the right and a negative value for torque for steering to the left, for example, and the magnitude of the torsion bar torque Ttb increases as the absolute value increases .
  • the steering mechanism 4 is composed 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.
  • 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 middle of the rack shaft 14 in the axial direction.
  • the pinion 16 and rack 17 convert the rotation of the pinion shaft 13 into axial movement of the rack shaft 14.
  • the steered wheels 3 can be steered by moving the rack shaft 14 in the axial direction.
  • 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.
  • the reduction ratio (gear ratio) of the reducer 19 is represented as N.
  • the reduction ratio N is defined as the ratio ( ⁇ wg / ⁇ WW ) of the worm gear angle ⁇ wg , which is the rotation angle of the worm gear 20, to the worm wheel angle ⁇ ww , which is the rotation angle of the worm wheel 21.
  • the worm gear 20 is rotated by the electric motor 18.
  • the worm wheel 21 is connected to the output shaft 9 so that they can rotate together.
  • the worm gear 20 When the worm gear 20 is driven to rotate by the electric motor 18, the worm wheel 21 is driven to rotate, 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. This causes the steered wheels 3 to be steered. In other words, by driving the worm gear 20 to rotate by the electric motor 18, steering assistance by the electric motor 18 and steering of the steered wheels 3 are 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.
  • the torque applied to the output shaft 9 includes the motor torque by the electric motor 18 and a disturbance torque Tlc other than the motor torque.
  • the disturbance torque Tlc other than the motor torque includes a torsion bar torque Ttb , a road reaction torque (road load torque) Trl , a friction torque Tf, etc.
  • the torsion bar torque Ttb is a torque applied to the output shaft 9 from the steering wheel 2 side due to a force applied to the steering wheel 2 by the driver, a force generated by steering inertia, or the like.
  • the road reaction torque Trl is a torque applied to the output shaft 9 from the steered wheels 3 via the rack shaft 14 due to the self-aligning torque generated in the tires, forces generated by the suspension and tire/wheel alignment, frictional forces of the rack and pinion mechanism, etc.
  • the vehicle is equipped with a CCD (Charge Coupled Device) camera 25 that photographs the road ahead in the vehicle's direction of travel, a GPS (Global Positioning System) 26 for detecting the vehicle's position, a radar 27 for detecting road shapes and obstacles, and a map information memory 28 that stores map information.
  • CCD Charge Coupled Device
  • GPS Global Positioning System
  • Map information memory 28 that stores map information.
  • the vehicle is also equipped with two mode switches 31, 32 for manually switching steering modes.
  • a manual steering mode in which steering is performed by manual driving
  • a cooperative steering mode in which steering based on both manual driving and automatic driving is possible.
  • the CCD camera 25, GPS 26, radar 27 and map information memory 28 are connected to a host ECU (Electronic Control Unit) 201 for driving assistance control and automatic driving control. Based on the information obtained by the CCD camera 25, GPS 26 and radar 27, as well as the map information, the host ECU 201 performs surrounding environment recognition, vehicle position estimation, route planning, etc., and determines control target values for steering and drive actuators.
  • ECU Electronic Control Unit
  • the host ECU 201 sets an automatic steering command value ⁇ ad for automatic steering.
  • the automatic steering control is, for example, control for driving the vehicle along a target trajectory.
  • the automatic steering command value ⁇ ad is a target value of the steering angle for automatically driving the vehicle along the target trajectory.
  • the automatic steering command value ⁇ ad is represented by the amount of rotation (rotation angle) from the neutral position of the output shaft 9, the amount of rotation from the neutral position in the right steering direction is represented as a positive value, and the amount of rotation from the neutral position in the left steering direction is represented as a negative value.
  • the automatic steering command value ⁇ ad is set based on, for example, the vehicle speed, the lateral deviation from the target driving line (lane center line), and the yaw deviation of the vehicle from the target driving line.
  • the process of setting such an automatic steering command value ⁇ ad is well known, so a detailed description thereof will be omitted here.
  • the automatic steering control may be, for example, lane keeping assist (LKA) control, which assists in steering so that the vehicle stays within the driving lane, or lane centering assist (LCA) control, which assists in steering so that the vehicle stays in the center of the driving lane, etc.
  • LKA lane keeping assist
  • LCDA lane centering assist
  • the host ECU 201 outputs a steering mode signal S mode indicating 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. Specifically, when the first mode switch 31 is turned on by the driver, the host ECU 201 outputs a steering mode signal S mode indicating that the steering mode is the manual steering mode . On the other hand, when the second mode switch 32 is turned on by the driver, the host ECU 201 outputs a steering mode signal S mode indicating that the steering mode is the cooperative steering mode.
  • the automatic steering command value ⁇ ad and the steering mode signal S mode are provided to the motor control ECU 202 via an in-vehicle network.
  • the torsion bar torque T tb detected by the torque sensor 12 and the output signal of the rotation angle sensor 23 are 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 host ECU 201.
  • FIG. 2 is a block diagram illustrating the electrical configuration of the motor control ECU 202.
  • the motor control ECU 202 includes a microcomputer 50, a drive circuit (inverter circuit) 41 controlled by the microcomputer 50 and supplying power to the electric motor 18, and a current detection circuit 42 for detecting the current flowing through the electric motor 18 (hereinafter referred to as "motor current I m ").
  • the microcomputer 50 is equipped with a CPU and memory (ROM, RAM, non-volatile memory, etc.), and functions as multiple function processing units by executing a predetermined program.
  • the multiple function processing units include an assist torque command value setting unit 51, a manual steering command value calculation unit 53, an integrated angle command value calculation unit 54, an angle control unit 55, a first switch 56, a second switch 57, an adder 58, and a torque control unit (current control unit) 59.
  • the assist torque command value setting unit 51 sets an assist torque command value T as which is a target value of the assist torque required for manual operation.
  • the assist torque command value setting unit 51 sets the assist torque command value T as based on the torsion bar torque T tb detected by the torque sensor 12.
  • FIG. 3 is a graph showing an example of setting the assist torque command value T as relative to the torsion bar torque T tb .
  • the assist torque command value T as is set to a positive value when a steering assist force for steering to the right is to be generated from the electric motor 18, and is set to a negative value when a steering assist force for steering to the left is to be generated from the electric motor 18.
  • the assist torque command value T as is positive for a positive value of the torsion bar torque T tb , and is negative for a negative value of the torsion bar torque T tb .
  • the assist torque command value T as is set so that its absolute value increases as the absolute value of the torsion bar torque T tb increases.
  • the assist torque command value setting unit 51 may calculate the assist torque command value T as by multiplying the torsion bar torque T tb by a preset constant.
  • the assist torque command value T as may be set in consideration of the vehicle speed.
  • the manual steering command value calculation unit 53 is provided for setting a steering angle (more precisely, a rotation angle ⁇ c of the output shaft 9) corresponding to the steering wheel operation as a manual steering command value ⁇ md when the driver operates the steering wheel 2 in the cooperative steering mode.
  • the manual steering command value calculation unit 53 generates the manual steering command value ⁇ md using the torsion bar torque T tb detected by the torque sensor 12, the assist torque command value T as set by the assist torque command value setting unit 51, and the target virtual spring reaction force T tb,d (e l ) set by the target virtual spring reaction force setting unit 52. Details of the manual steering command value calculation unit 53 will be described later.
  • the integrated angle command value calculation unit 54 adds the manual steering command value ⁇ md to the automatic steering command value ⁇ ad set by the host ECU 201 to calculate an integrated angle command value ⁇ cmd .
  • the angle control unit 55 calculates an integrated motor torque command value T com based on the integrated angle command value ⁇ cmd .
  • the angle control unit 55 will be described in detail later.
  • the first switch 56 and the second switch 57 are turned on and off in response to the input steering mode signal S mode . Specifically, when the steering mode signal S mode indicating that the steering mode is the manual steering mode is input, the first switch 56 is turned on and the second switch 57 is turned off.
  • the first switch 56 is turned off and the second switch 57 is turned on.
  • the motor torque command value T m,cmd which is the output of the adding unit 58 , is given to a torque control unit 59 .
  • the torque control unit 59 drives the drive circuit 41 so that the motor torque of the electric motor 18 approaches the motor torque command value Tm,cmd .
  • the torque control unit 59 will be described in detail later.
  • the manual steering command value calculation unit 53 will now be explained in detail.
  • the manual steering command value generating unit generates the manual steering command value ⁇ md by using the reference EPS model of Fig. 4.
  • the reference EPS model of Fig. 4 is an example of the "reference model of the steering device" of the present disclosure.
  • 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.
  • this model is only an example, and an inertia model including a configuration other than the above (for example, a rack bar, etc.) may be used.
  • Jmd is the inertia of the lower column (hereinafter referred to as "column inertia")
  • ⁇ col is the rotation angle of the lower column
  • Ttb is the torsion bar torque.
  • the lower column is supplied with a torsion bar torque Ttb , a torque N ⁇ Tm acting on the output shaft 9 from the electric motor 18, and a road reaction torque (virtual reaction force) Trl .
  • the road surface reaction torque T rl is expressed by the following equation (1) using the spring constant k md of the virtual spring and the viscous damping coefficient c md of the virtual damper.
  • k md and the viscous damping coefficient c md are obtained in advance by experiment, analysis, etc.
  • k md ⁇ col may be referred to as a virtual spring reaction force
  • c md (d ⁇ col /dt) may be referred to as a virtual damper reaction force.
  • J md ⁇ d 2 ⁇ col /dt 2 is the moment of inertia acting on the lower column.
  • the manual steering command value generating unit substitutes the torsion bar torque Ttb detected by the torque sensor 12 into Ttb , substitutes the assist torque command value Tas set by the assist torque command value setting unit 51 into Tm , and calculates the rotation angle ⁇ ccol of the lower column by solving the differential equation of equation (2). Then, the manual steering command value generating unit generates the obtained rotation angle ⁇ col of the lower column as the manual steering command value ⁇ md .
  • the method of setting the manual steering command value ⁇ md in this manner is referred to as a comparison method.
  • the equation of motion of formula (2) is equivalent to an equation of motion in which T m is replaced with T as and ⁇ col is replaced with ⁇ md .
  • the manual steering command value calculation unit 53 calculates the manual steering command value ⁇ md by utilizing the equation of motion (2) of the reference EPS model described above. Specifically, in this embodiment, the manual steering command value calculation unit 53 calculates the manual steering command value ⁇ md based on an equation of motion obtained by modifying the equation of motion (2) of the reference EPS model described above.
  • FIG. 5 is a block diagram showing the configuration of the manual steering command value calculation unit 53.
  • Jmd is the column inertia.
  • s is a differential operator.
  • ⁇ md is a manual steering command value, which corresponds to the rotation angle ⁇ col of the lower column in the comparison method.
  • cmd is the viscous damping coefficient of the virtual damper.
  • kmd is the spring constant of the virtual spring. The viscous damping coefficient cmd of the virtual damper and the spring constant kmd of the virtual spring are obtained in advance by experiment, analysis, etc.
  • the manual steering command value calculation unit 53 includes a reduction ratio multiplication unit 101, a second-order differentiation unit 102, an inertia multiplication unit 103, an addition/subtraction unit 104, an inertia division unit 105, a first integration unit 106, a second integration unit 107, a first-order differentiation unit 108, an addition unit 109, a virtual damper reaction force calculation unit 110, and a virtual spring reaction force calculation unit 111.
  • the reduction ratio multiplication unit 101 converts the assist torque command value T as for the rotary shaft of the electric motor 18 into an assist torque command value N ⁇ T as for the output shaft 9 by multiplying the assist torque command value T as by the reduction ratio N of the reducer 19 .
  • a second-order differentiation unit 102 differentiates the automatic steering command value ⁇ ad by the second order.
  • An inertia multiplication unit 103 multiplies the second-order differentiation value d 2 ⁇ ad /dt 2 of the automatic steering command value ⁇ ad by the column inertia J md to calculate the moment of inertia J md ⁇ d 2 ⁇ ad /dt 2 for the automatic steering command value ⁇ ad .
  • the addition and subtraction unit 104 receives as input the torsion bar torque Ttb , the assist torque command value N ⁇ Tas for the output shaft 9, the moment of inertia Jmd ⁇ d2 ⁇ ad / dt2 for the automatic steering command value ⁇ ad , the virtual damper reaction force cmd ( d ⁇ md /dt+ d ⁇ ad / dt ) provided by the virtual damper reaction force calculation unit 110, and the virtual spring reaction force kmd ⁇ ⁇ md provided by the virtual spring reaction force calculation unit 111.
  • the addition/subtraction unit 104 adds the assist torque command value N ⁇ T as for the output shaft 9 to the torsion bar torque T tb , and subtracts the moment of inertia J md ⁇ d2 ⁇ ad /dt 2 for the automatic steering command value ⁇ ad , the virtual damper reaction force c md (d ⁇ md /dt + d ⁇ ad /dt) and the virtual spring reaction force kmd ⁇ md from the addition result.
  • the inertia division unit 105 divides the moment of inertia Jmd ⁇ d2 ⁇ md / dt2 calculated by the addition/subtraction unit 104 by the column inertia Jmd to calculate a second-order differential value d2 ⁇ md / dt2 of the manual steering command value ⁇ md .
  • the first integration unit 106 calculates a first-order differential value d ⁇ md /dt of the manual steering command value ⁇ md by integrating a second-order differential value d 2 ⁇ md /dt 2 of the manual steering command value ⁇ md .
  • the second integral unit 107 calculates the manual steering command value ⁇ md by integrating the first-order differential value d ⁇ md /dt of the manual steering command value ⁇ md .
  • This manual steering command value ⁇ md is output from the manual steering command value calculation unit 53.
  • a first-order differentiation unit 108 differentiates the automatic steering command value ⁇ ad by one order.
  • the adder 109 adds the first-order differential value d ⁇ md /dt of the automatic steering command value ⁇ ad calculated by the first-order differentiation unit 108 to the first-order differential value d ⁇ md /dt of the manual steering command value ⁇ md calculated by the first integration unit 106 .
  • a virtual damper reaction force calculation unit 110 calculates a virtual damper reaction force c md (d ⁇ md /dt + d ⁇ ad /dt) by multiplying the addition result (d ⁇ md /dt + d ⁇ ad /dt) of the addition unit 109 by a viscous damping coefficient c md .
  • This virtual damper reaction force c md (d ⁇ md /dt + d ⁇ ad /dt) is fed back to the addition and subtraction unit 104.
  • the virtual spring reaction force calculation unit 111 calculates a virtual spring reaction force kmd ⁇ ⁇ md by multiplying the manual steering command value ⁇ md calculated by the second integration unit 107 by a spring constant kmd . This virtual spring reaction force kmd ⁇ ⁇ md is fed back to the addition/subtraction unit 104.
  • the manual steering command value calculation unit 53 calculates the manual steering command value ⁇ md based on the equation of motion of the following equation (3).
  • Jmd.d2 ⁇ md / dt2 + Jmd.d2 ⁇ ad / dt2 is the moment of inertia
  • cmd.d ⁇ md / dt + cmd.d2 ⁇ ad / dt2 is the virtual damper reaction force
  • kmd. ⁇ md is the virtual spring reaction force.
  • the manual steering command value calculation unit 53 calculates the manual steering command value ⁇ md using ( Jmd ⁇ d2 ⁇ md / dt2 + Jmd ⁇ d2 ⁇ ad /dt2) and (cmd ⁇ d ⁇ md / dt + cmd ⁇ d ⁇ ad /dt) as the moment of inertia Jmd ⁇ d2 ⁇ col /dt2 and the virtual damper reaction force cmd ⁇ d ⁇ col / dt in equation ( 2 ) , respectively.
  • FIG. 6 is a block diagram showing the configuration of the angle control unit 55.
  • the angle control unit 55 calculates an integrated motor torque command value T com based on the integrated angle command value ⁇ cmd .
  • the angle control unit 55 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 gear ratio dividing unit 67, a reduction gear ratio multiplying unit 68, a rotation angle calculating unit 69, and a second reduction gear ratio dividing unit 70.
  • LPF low pass filter
  • the reduction ratio multiplication unit 68 multiplies the motor torque command value Tm,cmd calculated by the addition unit 58 (see FIG. 2) by the reduction ratio N of the reducer 19, thereby converting the motor torque command value Tm,cmd into an output shaft torque command value N ⁇ Tm,cmd acting on the output shaft 9 (worm wheel 21).
  • the rotation angle calculation unit 69 calculates a rotor rotation angle ⁇ m of the electric motor 18 based on the output signal of the rotation angle sensor 23.
  • the second reduction ratio division unit 70 converts the rotor rotation angle ⁇ m into a rotation angle (actual steering angle) ⁇ c of the output shaft 9 by dividing the rotor rotation angle ⁇ m calculated by the rotation angle calculation unit 69 by the reduction ratio N.
  • the actual steering angle ⁇ c is represented by the amount of rotation (rotation angle) from the neutral position of the output shaft 9, where the amount of rotation from the neutral position in the right steering direction is represented as a positive value, and the amount of rotation from the neutral position in the left steering direction is represented as a negative value.
  • the low-pass filter 61 performs low-pass filtering on the integrated angle command value ⁇ cmd .
  • the integrated angle command value ⁇ cmdl after the low-pass filtering is provided to the feedback control unit 62 and the feedforward control unit 63.
  • the low-pass filter 61 may not be provided.
  • the feedback control unit 62 is provided to bring the steering angle estimated value ⁇ calculated by the disturbance torque estimation unit 64 closer to the integrated angle command value ⁇ cmdl after low-pass filter processing.
  • the feedback control unit 62 includes an angle deviation calculation unit 62A and a PD control unit 62B.
  • the PD control unit 62B performs a PD calculation (proportional differential calculation) on the angle deviation ⁇ calculated by the angle deviation calculation unit 62A to calculate a feedback control torque Tfb .
  • the feedback control torque Tfb is provided to a torque addition unit 65.
  • the feedforward control unit 63 is provided to improve the control response by compensating for a delay in response due to the inertia of the electric power steering system 1.
  • 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 the target angular acceleration d 2 ⁇ cmdl /dt 2 by second-order differentiation of the integrated angle command value ⁇ cmdl .
  • the inertia J is obtained, for example, from a physical model (see FIG. 7 ) of the electric power steering system 1, which will be described later.
  • the feedforward control torque T ff is provided to the torque addition unit 65 as an inertia compensation value.
  • the torque addition unit 65 calculates a basic torque command value ( Tfb + Tff ) by adding the feedforward control torque Tff to the feedback control torque Tfb .
  • the disturbance torque estimating unit 64 is provided to estimate a nonlinear torque (disturbance torque: torque other than motor torque) that occurs as a disturbance in the plant (the control target of the electric motor 18).
  • the disturbance torque estimating unit 64 estimates the disturbance torque (disturbance load) T lc , the steering angle ⁇ , and the steering angle differential value (angular velocity) d ⁇ c /dt based on the output shaft torque command value N ⁇ T m,cmd and the actual steering angle ⁇ c .
  • the estimated values of the disturbance torque T lc , the steering angle ⁇ c, and the steering angle differential value (angular velocity) d ⁇ c /dt are represented by ⁇ T lc , ⁇ c, and d ⁇ c /dt, respectively.
  • the details of the disturbance torque estimating unit 64 will be described later.
  • the disturbance torque estimated value ⁇ Tlc calculated by the disturbance torque estimating section 64 is provided as a disturbance torque compensation value to a disturbance torque compensating section 66.
  • the steering angle estimated value ⁇ ⁇ c calculated by the disturbance torque estimating section 64 is provided to an angle deviation calculating section 62A.
  • the integrated torque command value Tco is provided to a first reduction ratio division unit 67.
  • the first reduction ratio division unit 67 calculates an integrated motor torque command value Tcom (torque command value for the electric motor 18) by dividing the integrated torque command value Tco by the reduction ratio N.
  • This integrated motor torque command value Tcom is provided to a second switch 57 (see FIG. 2).
  • the disturbance torque estimation unit 64 will be described in detail.
  • the disturbance torque estimation unit 64 is composed of a disturbance observer that estimates the disturbance torque T lc , the steering angle ⁇ c and the angular velocity d ⁇ c /dt using, for example, a physical model 300 of the electric power steering system 1 shown in FIG.
  • This physical model 300 includes a plant (an example of a motor-driven object) 301 including an output shaft 9 and a worm wheel 21 fixed to the output shaft 9.
  • a torsion bar torque Ttb is applied to the plant 301 from the steering wheel 2 via the torsion bar 10, and a road reaction torque Trl is applied from the steered wheels 3 side.
  • an output shaft torque command value N ⁇ T m,cmd is applied to the plant 301 via the worm gear 20 , and a friction torque T f is applied due to friction between the worm wheel 21 and the worm gear 20 .
  • Tlc indicates a disturbance torque other than the motor torque applied to the plant 301.
  • the disturbance torque Tlc is shown as the sum of the torsion bar torque Ttb , the road surface reaction torque Trl, and the friction torque Tf , but in reality, the disturbance torque Tlc includes torques other than these.
  • x is a state variable vector
  • u1 is a known input vector
  • u2 is an unknown input vector
  • y is an output vector (measured value).
  • A is a system matrix
  • B1 is a first input matrix
  • B2 is a second input matrix
  • C is an output matrix
  • D is a direct feedthrough matrix.
  • the state equation is expanded to a system including the unknown input vector u2 as one of the states.
  • the state equation of the expanded system (expanded state equation) is expressed by the following equation (6).
  • x e is a state variable vector of the extended system, and is expressed by the following formula (7).
  • a e is the system matrix of the extended system
  • B e is the known input matrix of the extended system
  • C e is the output matrix of the extended system.
  • ⁇ xe represents an estimated value of xe .
  • L is the observer gain.
  • ⁇ y represents an estimated value of y.
  • ⁇ xe is expressed by the following equation (9).
  • ⁇ c is an estimate of ⁇ c and ⁇ T lc is an estimate of T lc .
  • the disturbance torque estimation unit 64 calculates the state variable vector ⁇ x e based on the above equation (8).
  • FIG. 8 is a block diagram showing the configuration of the disturbance torque estimation unit 64.
  • the disturbance torque estimation unit 64 includes an input vector input unit 81, an output matrix multiplication unit 82, a first adder unit 83, a gain multiplication unit 84, an input matrix multiplication unit 85, a system matrix multiplication unit 86, a second adder unit 87, an integrator unit 88, and a state variable vector output unit 89.
  • the output shaft torque command value N ⁇ T m,cmd calculated by the reduction ratio multiplication section 68 (see FIG. 6) is given to an input vector input section 81.
  • the input vector input section 81 outputs an input vector u1 .
  • the output of the integrator 88 becomes the state variable vector ⁇ x e (see equation (9) above).
  • an initial value is given as the state variable vector ⁇ x e .
  • the initial value of the state variable vector ⁇ x e is, for example, 0.
  • the system matrix multiplication unit 86 multiplies the state variable vector ⁇ xe by the system matrix A e .
  • the output matrix multiplication unit 82 multiplies the state variable vector ⁇ xe by the output matrix C e .
  • the gain multiplier 84 multiplies the output (y - ⁇ y) of the first adder 83 by the observer gain L (see equation (8) above).
  • the input matrix multiplication unit 85 multiplies the input vector u 1 output from the input vector input unit 81 by the input matrix B e .
  • the second adder 87 adds the output (B e ⁇ u 1 ) of the input matrix multiplication unit 85, the output (A e ⁇ ⁇ x e ) of the system matrix multiplication unit 86, and the output (L(y- ⁇ y)) of the gain multiplication unit 84 to calculate a differential value d ⁇ x e /dt of the state variable vector.
  • the integrator 88 integrates the output (d ⁇ x e /dt) of the second adder 87 to calculate the state variable vector ⁇ x e .
  • the state variable vector output unit 89 calculates a disturbance torque estimate value ⁇ T lc , a steering angle estimate value ⁇ c, and an angular velocity estimate value d ⁇ c /dt based on the state variable vector ⁇ x e .
  • a typical disturbance observer consists of an inverse model of the plant and a low-pass filter.
  • the equation of motion of the plant is expressed by equation (3) as described above. Therefore, the inverse model of the plant is expressed by the following equation (10).
  • the inputs to a typical disturbance observer are J ⁇ d2 ⁇ c / dt2 and N ⁇ Tm ,cmd , and since the second-order differential value of the actual steering angle ⁇ c is used, it is significantly affected by noise from the rotation angle sensor 23.
  • the extended state observer of the above-mentioned embodiment estimates the disturbance torque in an integral manner, so that it is possible to reduce the influence of noise due to differentiation.
  • a general disturbance observer consisting of an inverse model of the plant and a low-pass filter may be used as the disturbance torque estimation unit 64.
  • FIG. 9 is a schematic diagram showing the configuration of the torque control unit 59.
  • the torque control unit 59 (see FIG. 2) includes a motor current command value calculation unit 91, a current deviation calculation unit 92, a PI control unit 93, and a PWM (Pulse Width Modulation) control unit 94.
  • the motor current command value calculation unit 91 calculates the motor current command value I m,cmd by dividing the motor torque command value T m,cmd calculated by the adder 58 (see FIG. 2) by the torque constant Kt of the electric motor 18 .
  • the PI control unit 93 performs a PI calculation (proportional integral calculation) on the current deviation ⁇ I calculated by the current deviation calculation unit 92 to generate a drive command value for guiding the motor current I flowing through the electric motor 18 to the motor current command value I m,cmd .
  • the PWM control unit 94 generates a PWM control signal with a duty ratio corresponding to the drive command value, and supplies the PWM control signal to the drive circuit 41. As a result, power corresponding to the drive command value is supplied to the electric motor 18.
  • the manual steering mode refers to a steering mode in which the electric motor 18 is controlled based only on 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 on an integrated angle command value ⁇ cmd that takes into account both the automatic steering command value ⁇ ad and the manual steering command value ⁇ md .
  • the motor control ECU 202 can switch the steering mode between the manual steering mode and the cooperative steering mode by the driver operating the mode switches 31, 32.
  • the electric motor 18 is controlled based only on the assist torque command value Tas , so that the driver can receive the actual road surface reaction torque.
  • the manual steering command value calculation unit 53 calculates the manual steering command value ⁇ md using (Jmd ⁇ d2 ⁇ md / dt2 + Jmd ⁇ d2 ⁇ ad / dt2 ) and (cmd ⁇ d ⁇ md /dt+ cmd ⁇ d ⁇ ad / dt ) as the moment of inertia Jmd ⁇ d2 ⁇ col / dt2 and the virtual damper reaction force cmd ⁇ d ⁇ col / dt in equation ( 2 ), respectively .
  • the electric motor 18 is controlled so that the actual steering angle ⁇ c follows the integrated angle command value ⁇ cmd .
  • c md ⁇ d ⁇ md /dt includes an actual steering angle component c md ⁇ d ⁇ c /dt corresponding to the first-order differential of the actual steering angle ⁇ c and an automatic steering component -c md ⁇ d ⁇ ad /dt corresponding to the first-order differential of the automatic steering command value ⁇ ad .
  • J md ⁇ d 2 ⁇ md /dt 2 includes an actual steering angle component J md ⁇ d 2 ⁇ c /dt 2 corresponding to the second-order differential of the actual steering angle ⁇ c and an automatic steering component -J md ⁇ d 2 ⁇ ad /dt 2 corresponding to the second-order differential of the automatic steering command value ⁇ ad .
  • the equation of motion of the above formula (3) includes, as the virtual damper reaction force, a virtual damper reaction force c md ⁇ d ⁇ md /dt for the manual steering command value ⁇ md as well as a virtual damper reaction force c md ⁇ d ⁇ ad /dt for the automatic steering command value ⁇ ad .
  • the equation of motion of the above formula (3) includes, as the moment of inertia, a moment of inertia J md ⁇ d 2 ⁇ md /dt 2 for the automatic steering command value ⁇ ad as well as a moment of inertia J md ⁇ d 2 ⁇ md / dt 2 for the manual steering command value ⁇ md.
  • the automatic steering component -c md ⁇ d ⁇ ad /dt contained in c md ⁇ d ⁇ md /dt is compensated, and only the actual steering angle component c md ⁇ d ⁇ c /dt for the actual steering angle ⁇ c remains, and the automatic steering component -J md ⁇ d 2 ⁇ ad /dt 2 contained in J md ⁇ d 2 ⁇ md /dt 2 is compensated, and only J md ⁇ d 2 ⁇ c /dt 2 for the actual steering angle ⁇ c remains.
  • the basic torque command value ( Tfb + Tff ) is calculated based on the integrated angle command value ⁇ cmd and corrected by the disturbance torque estimated value ⁇ Tlc calculated by the disturbance torque estimator 64 , so that the effect of disturbance torque on the angle control performance can be suppressed. This makes it possible to realize high-precision angle control.
  • FIG. 10 is a block diagram showing a first modified example of the motor control ECU.
  • parts corresponding to those in FIG. 2 are denoted by the same reference numerals as in FIG. 2.
  • the host ECU 201 When the motor control ECU 202A of Fig. 10 is used as the motor control ECU, the host ECU 201 outputs the mode signal S mode , the automatic steering command value ⁇ ad , and the lateral deviation e1 with respect to the currently set target driving line, as shown by the dashed line in Fig. 1.
  • the lateral deviation e1 is the distance from the currently set target driving line (lane center line) to the reference position of the vehicle (hereinafter referred to as the "vehicle reference position").
  • the vehicle reference position is set at a predetermined position in the center of the vehicle width.
  • the motor control ECU 202A in FIG. 10 differs from the motor control ECU 202 in FIG. 2 in the following (1) and (2).
  • a target virtual spring reaction force setting unit 52 is added as a functional processing unit to the microcomputer 50 of the motor control ECU 202A.
  • the configuration of the manual steering command value calculation unit 53A is different from the configuration of the manual steering command value calculation unit 53 in FIG.
  • the target virtual spring reaction force setting unit 52 sets the target virtual spring reaction force T tb,d (e l ) based on the lateral deviation e l given by the host ECU 201 in the cooperative steering mode.
  • FIG. 11 is a graph showing an example of setting the target virtual spring reaction force T tb,d (e l ) relative to the lateral deviation e l .
  • the target virtual spring reaction force T tb,d (e l ) is set to increase as the lateral deviation e l increases from -T tb,d,s (where T tb,d,s > 0) to T tb,d,s .
  • the target virtual spring reaction force T tb,d (e l ) changes linearly, but may change nonlinearly.
  • the target virtual spring reaction force T tb,d (e l ) is set to be larger as the lateral deviation e l increases from T tb,d,s to T tb ,d,m (where T tb,d,m > T tb,d,s ), and the slope of the straight line is set to be larger compared to the range of the lateral deviation e l from -e l,s to e l,s .
  • the target virtual spring reaction force T tb,d (e l ) changes linearly, but may change nonlinearly.
  • the target virtual spring reaction force T tb,d (e l ) is set to T tb,d,m .
  • the target virtual spring reaction force T tb,d (e l ) is set to be smaller as the lateral deviation e l becomes smaller from -T tb, d,s to -T tb ,d,m (however, -T tb,d,m ⁇ -T tb,d,s ), and the slope of the straight line is set to be larger compared to the range of the lateral deviation e l from -e l,s to e l,s .
  • the target virtual spring reaction force T tb,d (e l ) changes linearly, but may change nonlinearly.
  • the target virtual spring reaction force T tb,d (e l ) is set to -T tb,d,m .
  • the range from -e l,s to e l,s in the graph of FIG. 11 may be set as the characteristic for LCA control, and the other range may be set as the characteristic for LKA control.
  • the target virtual spring reaction force T tb,d (e l ) set by the target virtual spring reaction force setting unit 52 is provided to the manual steering command value calculation unit 53A.
  • the torsion bar torque T tb , the automatic steering command value ⁇ ad and the target virtual spring reaction force T tb,d (e l ) are provided to the manual steering command value calculation unit 53A.
  • the assist torque command value T as is not provided to the manual steering command value calculation unit 53A.
  • the assist torque command value T as may be provided to the manual steering command value calculation unit 53A.
  • FIG. 12 is a block diagram showing the configuration of the manual steering command value calculation unit 53A.
  • parts corresponding to those in FIG. 5 are denoted by the same reference numerals as in FIG. 5.
  • the manual steering command value calculation unit 53A includes a second-order differentiation unit 102, an inertia multiplication unit 103, an addition/subtraction unit 104, an inertia division unit 105, a first integration unit 106, a second integration unit 107, a first-order differentiation unit 108, an addition unit 109, and a virtual damper reaction force calculation unit 110.
  • the manual steering command value calculation unit 53A does not include the reduction ratio multiplication unit 101 and the virtual spring reaction force calculation unit 111 of FIG. 5.
  • the addition and subtraction unit 104 receives as input the torsion bar torque Ttb , the target virtual spring reaction force Ttb,d (e l ) set by the target virtual spring reaction force setting unit 52, the moment of inertia Jmd ⁇ d2 ⁇ ad / dt2 with respect to the automatic steering command value ⁇ ad , and the virtual damper reaction force cmd ( d ⁇ md / dt + d ⁇ ad /dt) provided by the virtual damper reaction force calculation unit 110.
  • the adding and subtracting unit 104 subtracts the target virtual spring reaction force Ttb ,d (e l ), the moment of inertia Jmd ⁇ d2 ⁇ ad/dt2 for the automatic steering command value ⁇ ad, and the virtual damper reaction force cmd(d ⁇ md / dt + d ⁇ ad / dt ) from the torsion bar torque Ttb.
  • the inertia division unit 105 divides the moment of inertia Jmd ⁇ d2 ⁇ md / dt2 calculated by the addition/subtraction unit 104 by the column inertia Jmd to calculate a second-order differential value d2 ⁇ md / dt2 of the manual steering command value ⁇ md .
  • the first integration unit 106 calculates a first-order differential value d ⁇ md /dt of the manual steering command value ⁇ md by integrating a second-order differential value d 2 ⁇ md /dt 2 of the manual steering command value ⁇ md .
  • the second integral unit 107 calculates the manual steering command value ⁇ md by integrating the first-order differential value d ⁇ md /dt of the manual steering command value ⁇ md .
  • This manual steering command value ⁇ md is output from the manual steering command value calculation unit 53A.
  • a first-order differentiation unit 108 differentiates the automatic steering command value ⁇ ad by one order.
  • the adder 109 adds the first-order differential value d ⁇ md /dt of the automatic steering command value ⁇ ad calculated by the first-order differentiation unit 108 to the first-order differential value d ⁇ md /dt of the manual steering command value ⁇ md calculated by the first integration unit 106 .
  • a virtual damper reaction force calculation unit 110 calculates a virtual damper reaction force c md (d ⁇ md /dt + d ⁇ ad /dt) by multiplying the addition result (d ⁇ md /dt + d ⁇ ad /dt) of the addition unit 109 by a viscous damping coefficient c md .
  • This virtual damper reaction force c md (d ⁇ md /dt + d ⁇ ad /dt) is fed back to the addition and subtraction unit 104.
  • the manual steering command value calculation unit 53A calculates the manual steering command value ⁇ md based on the equation of motion of the following equation (14).
  • J md ⁇ d 2 ⁇ md /dt 2 + J md ⁇ d 2 ⁇ ad /dt 2 is the moment of inertia
  • c md ⁇ d ⁇ md /dt + c md ⁇ d ⁇ ad /dt is the virtual damper reaction force
  • T tb,d (e l ) is the target virtual spring reaction force.
  • the manual steering command value calculation unit 53A sets N ⁇ Tm in equation (2) to 0, and calculates the manual steering command value ⁇ md using ( Jmd ⁇ d2 ⁇ md / dt2 + Jmd ⁇ d2 ⁇ ad /dt2), (cmd ⁇ d ⁇ md /dt+cmd ⁇ d ⁇ ad / dt ) and Ttb ,d (e l ) as the moment of inertia Jmd ⁇ d2 ⁇ col/dt2, virtual damper reaction force cmd ⁇ d ⁇ col / dt and virtual spring reaction force kmd ⁇ col in equation ( 2 ), respectively.
  • the first variant provides the same effects as the previous embodiment.
  • the first variant also has the effect of making it easier for the driver to recognize the distance from the center of the lane or the distance to the lane when in cooperative steering mode. This point will be explained below.
  • the manual steering command value calculation unit 53 calculates the manual steering command value ⁇ md by using the target virtual spring reaction force Ttb,d (e l ) corresponding to the lateral deviation e l as the virtual spring reaction force kmd ⁇ ⁇ md in the equation of motion of the above-mentioned equation (2). This makes it possible to give the driver a steering reaction force corresponding to the lateral deviation e l in the cooperative steering mode. This makes it easier for the driver to recognize the distance from the center of the driving lane or the distance to the lane.
  • the steering mode is switched by mode switches 31 and 32, but the host ECU 201 may also switch the steering mode in response to the ON/OFF signal of the driving assistance function or the automatic driving function, obstacles, driver status, driver operations such as accelerator and brake, and the vehicle's running state.
  • the host ECU 201 generates a mode setting signal in response to the ON/OFF signal of the driving assistance function or the automatic driving function, obstacles, driver status, driver operations such as accelerator and brake, and the vehicle's running state, and provides it to the motor control ECU 202.
  • the host ECU 201 may automatically switch the steering mode as follows.
  • the host ECU 201 sets the steering mode to the manual steering mode. This causes the first switch 56 to be turned on and the second switch 57 to be turned off. In this case, since the second switch 57 is turned off, the target virtual spring reaction force T tb,d (e l ) within the range from -e l,s to e l,s in FIG. 11 is no longer reflected as the steering reaction force.
  • the host ECU 201 sets the steering mode to the cooperative steering mode. This causes the second switch 57 to be turned on and the first switch 56 to be turned off. In this case, since the second switch 57 is turned on, the target virtual spring reaction force T tb,d (e l ) outside the range from -e l,s to e l,s in FIG. 11 is reflected as the steering reaction force.
  • the manual steering command value calculation unit 53A calculates the manual steering command value ⁇ md using the target virtual spring reaction force T tb,d (e l ) corresponding to the lateral deviation e l as the virtual spring reaction force k ⁇ ⁇ md in the equation of motion of the above formula (2).
  • FIG. 13 is a block diagram showing a second modified example of the motor control ECU.
  • parts corresponding to those in FIG. 2 are denoted by the same reference numerals as in FIG. 2.
  • the host ECU 201 When the motor control ECU 202B of FIG. 13 is used as the motor control ECU, the host ECU 201 outputs a mode signal S mode , an automatic steering command value ⁇ ad and a lateral deviation e l in the same manner as when the motor control ECU 202A of FIG. 10 is used as the motor control ECU.
  • the motor control ECU 202B in FIG. 13 differs from the motor control ECU 202 in FIG. 2 in the following (1) and (2).
  • the microcomputer 20 of the motor control ECU 202B is additionally provided with an LCA target virtual spring reaction force setting unit 52A as a functional processing unit.
  • the configuration of the manual steering command value calculation unit 53B is different from the configuration of the manual steering command value calculation unit 53 in FIG.
  • the LCA target virtual spring reaction force setting unit 52A sets an LCA target virtual spring reaction force T tb, d _LCA (e l ) for lane centering assist based on the lateral deviation e l provided by the host ECU 201 in the cooperative steering mode.
  • FIG. 14 is a graph showing an example of setting the target virtual spring reaction force for LCA T tb, d _LCA (e l ) with respect to the lateral deviation e l .
  • the target virtual spring reaction force for LCA T tb,d_LCA (e l ) is set to 0 when the lateral deviation (e l ) is 0.
  • the lateral deviation (e l ) when the vehicle reference position is at the right lane boundary is set to e l,max
  • the lateral deviation (e l ) when the vehicle reference position is at the left lane boundary is set to -e l,max .
  • the target virtual spring reaction force for LCA T tb,d_LCA (e l ) is set to a predetermined maximum value T tb,d_LCA,max when the lateral deviation ( e l ) is e l ,max, and is set to -T tb,d_LCA,max when the lateral deviation (e l ) is -e l,max .
  • the target virtual spring reaction force for LCA T tb,d_LCA (e l ) is set to increase as the lateral deviation (e l ) increases from 0 to T tb,d_LCA,max .
  • the target virtual spring reaction force for LCA T tb,d_LCA (e l ) is set to decrease as the lateral deviation (e l ) decreases from 0 to -T tb,d_LCA,max .
  • the target virtual spring reaction force for LCA T tb,d_LCA (e l ) changes linearly, but it may change nonlinearly.
  • the target virtual spring reaction force for LCA T tb,d_LCA (e l ) set by the target virtual spring reaction force for LCA setting unit 52A is provided to a manual steering command value calculation unit 53B.
  • the torsion bar torque T tb , the automatic steering command value ⁇ ad and the target virtual spring reaction force for LCA T tb,d_LCA (e l ) are provided to the manual steering command value calculation unit 53B.
  • the assist torque command value T as is not provided to the manual steering command value calculation unit 53B.
  • the assist torque command value T as may be provided to the manual steering command value calculation unit 53B.
  • FIG. 15 is a block diagram showing the configuration of the manual steering command value calculation unit 53B.
  • parts corresponding to those in FIG. 5 are denoted by the same reference numerals as in FIG. 5.
  • the manual steering command value calculation unit 53B includes a second-order differentiation unit 102, an inertia multiplication unit 103, an addition/subtraction unit 104, an inertia division unit 105, a first integration unit 106, a second integration unit 107, a first-order differentiation unit 108, a first addition unit 109, a virtual damper reaction force calculation unit 110, a second addition unit 112, and a virtual spring reaction force calculation unit 111.
  • the manual steering command value calculation unit 53B does not include the reduction ratio multiplication unit 101 of FIG. 5.
  • the addition and subtraction unit 104 receives as input the torsion bar torque Ttb , the target virtual spring reaction force for LCA Ttb,d_LCA (e l ) set by the target virtual spring reaction force setting unit for LCA 52A, the moment of inertia Jmd ⁇ d2 ⁇ ad / dt2 with respect to the automatic steering command value ⁇ ad , the virtual damper reaction force cmd ⁇ ( d ⁇ md /dt+ d ⁇ ad /dt) provided by the virtual damper reaction force calculation unit 110, and the virtual spring reaction force kmd ⁇ ( ⁇ md + ⁇ ad ) provided by the virtual spring reaction force calculation unit 111.
  • the addition and subtraction unit 104 subtracts the target virtual spring reaction force for LCA Ttb,d_LCA (e l ), the moment of inertia Jmd ⁇ d2 ⁇ ad / dt2 with respect to the automatic steering command value ⁇ ad , the virtual damper reaction force cmd ⁇ ( d ⁇ md /dt+ d ⁇ ad /dt), and the virtual spring reaction force kmd ⁇ ( ⁇ md + ⁇ ad ) from the torsion bar torque Ttb.
  • the inertia division unit 105 divides the moment of inertia Jmd ⁇ d2 ⁇ md / dt2 calculated by the addition/subtraction unit 104 by the column inertia Jmd to calculate a second-order differential value d2 ⁇ md / dt2 of the manual steering command value ⁇ md .
  • the first integration unit 106 calculates a first-order differential value d ⁇ md /dt of the manual steering command value ⁇ md by integrating a second-order differential value d 2 ⁇ md /dt 2 of the manual steering command value ⁇ md .
  • the second integral unit 107 calculates the manual steering command value ⁇ md by integrating the first-order differential value d ⁇ md /dt of the manual steering command value ⁇ md .
  • This manual steering command value ⁇ md is output from the manual steering command value calculation unit 53B.
  • a first-order differentiation unit 108 differentiates the automatic steering command value ⁇ ad by one order.
  • the first adder 109 adds the first-order differential value d ⁇ md / dt of the automatic steering command value ⁇ ad calculated by the first-order differentiation unit 108 to the first-order differential value d ⁇ md /dt of the manual steering command value ⁇ md calculated by the first integration unit 106 .
  • the virtual damper reaction force calculation unit 110 calculates a virtual damper reaction force c md (d ⁇ md /dt + d ⁇ ad /dt) by multiplying the addition result (d ⁇ md /dt + d2 ⁇ ad / dt2 ) of the first addition unit 109 by the viscous damping coefficient c md .
  • This virtual damper reaction force c md (d ⁇ md /dt + d ⁇ ad /dt) is fed back to the addition and subtraction unit 104.
  • the second adder 112 adds the automatic steering command value ⁇ ad to the manual steering command value ⁇ md calculated by the second integrator 107 .
  • the virtual spring reaction force calculation unit 111 calculates a virtual spring reaction force kmd ( ⁇ md + ⁇ ad ) by multiplying the sum ( ⁇ md + ⁇ ad) of the second adder 112 by a spring constant kmd. This virtual spring reaction force kmd ( ⁇ md + ⁇ ad ) is fed back to the addition/subtraction unit 104.
  • the manual steering command value calculation unit 53B calculates the manual steering command value ⁇ md based on the equation of motion of the following equation (15).
  • Jmdd2 ⁇ md / dt2 + Jmdd2 ⁇ ad / dt2 is the moment of inertia.
  • cmdd ⁇ md /dt+cmdd2 ⁇ ad/dt2 is the virtual damper reaction force.
  • kmd ⁇ md + kmd ⁇ ad is the virtual spring reaction force.
  • Ttb,d_LCA (e l ) is the target virtual spring reaction force for LCA .
  • the manual steering command value calculation unit 53A sets N ⁇ Tm in equation (2) to 0, and calculates the manual steering command value ⁇ md using ( Jmd ⁇ d2 ⁇ md / dt2 + Jmd ⁇ d2 ⁇ ad / dt2 ), (cmd ⁇ d ⁇ md /dt+cmd ⁇ d ⁇ ad/dt) and ( kmd ⁇ ⁇ md + kmd ⁇ ⁇ ad + Ttb , d_LCA (e l )) as the moment of inertia Jmd ⁇ d2 ⁇ col / dt2 , virtual damper reaction force cmd ⁇ d ⁇ col / dt and virtual spring reaction force kmd ⁇ ⁇ col in equation ( 2 ), respectively.
  • the second variant provides the same effects as the previous embodiment.
  • the equation of motion includes, as the virtual spring reaction force, a virtual spring reaction force kmd.d ⁇ md /dt for an automatic steering command value ⁇ ad in addition to a virtual spring reaction force kmd.d ⁇ md / dt for a manual steering command value ⁇ md.
  • a virtual spring reaction force kmd.d ⁇ md /dt for an automatic steering command value ⁇ ad in addition to a virtual spring reaction force kmd.d ⁇ md / dt for a manual steering command value ⁇ md.
  • the second variant also has the effect of making it easier for the driver to recognize the distance from the center of the lane or the distance to the lane when in cooperative steering mode. This point will be explained below.
  • the manual steering command value calculation unit 53 calculates the manual steering command value ⁇ md by using (k md ⁇ ⁇ md +k md ⁇ ⁇ ad +T tb,d_LCA (e l )) instead of the virtual spring reaction force k ⁇ ⁇ md in the equation of motion of the above-mentioned formula (2).
  • T tb,d_LCA (e l ) is a target virtual spring reaction force for LCA corresponding to the lateral deviation e l . This makes it possible to provide the driver with a steering reaction force corresponding to the lateral deviation e l in the cooperative steering mode. This makes it easier for the driver to recognize the distance from the center of the driving lane or the distance to the lane.
  • a manual steering command value calculation unit 53C shown in FIG. 16 may be used instead of the manual steering command value calculation unit 53B in FIG. 13 and FIG. 15.
  • a manual steering command value calculation unit 53C shown in FIG. 16 may be used instead of the manual steering command value calculation unit 53B in FIG. 13 and FIG. 15 .
  • parts corresponding to the parts in FIG. 15 described above are denoted by the same reference numerals as in FIG. 15.
  • a motor control ECU in which the manual steering command value calculation unit 53C shown in FIG. 16 is used instead of the manual steering command value calculation unit 53B in FIG. 13 and FIG. 15 will be referred to as a motor control ECU 202C according to the third modified example (see FIG. 13).
  • the actual steering angle ⁇ c calculated by the second reduction ratio division unit 70 (see Figure 6) in the angle control unit 55 is input to the manual steering command value calculation unit 53C , as shown by the dashed line in Figure 13.
  • the manual steering command value calculation unit 53C includes a second-order differentiation unit 102, an inertia multiplication unit 103, an addition/subtraction unit 104, an inertia division unit 105, a first integration unit 106, a second integration unit 107, a first-order differentiation unit 108, a virtual damper reaction force calculation unit 110, and a virtual spring reaction force calculation unit 111.
  • the manual steering command value calculation unit 53C does not include the first addition unit 109 and the second addition unit 112 of FIG. 15.
  • the addition and subtraction unit 104 receives as input the torsion bar torque Ttb , the target virtual spring reaction force for LCA Ttb,d_LCA (e l ) set by the target virtual spring reaction force setting unit for LCA 52A, the moment of inertia Jmd ⁇ d2 ⁇ ad / dt2 with respect to the automatic steering command value ⁇ ad , the virtual damper reaction force cmd ⁇ d ⁇ c / dt provided by the virtual damper reaction force calculation unit 110, and the virtual spring reaction force kmd ⁇ ⁇ c provided by the virtual spring reaction force calculation unit 111.
  • the addition/subtraction unit 104 subtracts the target virtual spring reaction force for LCA T tb ,d_LCA (e l ), the moment of inertia J md ⁇ d2 ⁇ ad /dt 2 for the automatic steering command value ⁇ ad , the virtual damper reaction force c md ⁇ d ⁇ c /dt, and the virtual spring reaction force kmd ⁇ ⁇ c from the torsion bar torque T tb.
  • the inertia division unit 105 divides the moment of inertia Jmd ⁇ d2 ⁇ md / dt2 calculated by the addition/subtraction unit 104 by the column inertia Jmd to calculate a second-order differential value d2 ⁇ md / dt2 of the manual steering command value ⁇ md .
  • the first integration unit 106 calculates a first-order differential value d ⁇ md /dt of the manual steering command value ⁇ md by integrating a second-order differential value d 2 ⁇ md /dt 2 of the manual steering command value ⁇ md .
  • the second integral unit 107 calculates the manual steering command value ⁇ md by integrating the first-order differential value d ⁇ md /dt of the manual steering command value ⁇ md .
  • This manual steering command value ⁇ md is output from the manual steering command value calculation unit 53C.
  • a first-order differentiation unit 108 differentiates the actual steering angle ⁇ c by one order.
  • the virtual damper reaction force calculation unit 110 calculates a virtual damper reaction force c md ⁇ d ⁇ c / dt by multiplying a first-order differential value d ⁇ c / dt of the actual steering angle ⁇ c by a viscous damping coefficient c md .
  • This virtual damper reaction force c md ⁇ d ⁇ c / dt is fed back to the addition and subtraction unit 104.
  • the virtual spring reaction force calculation unit 111 calculates a virtual spring reaction force kmd ⁇ ⁇ c by multiplying the actual steering angle ⁇ c by a spring constant kmd . This virtual spring reaction force kmd ⁇ ⁇ c is fed back to the addition/subtraction unit 104.
  • the manual steering command value calculation unit 53B calculates the manual steering command value ⁇ md based on the equation of motion of the following equation (16).
  • J md ⁇ d 2 ⁇ md /dt 2 + J md ⁇ d 2 ⁇ ad /dt 2 is the moment of inertia.
  • c md ⁇ d ⁇ c /dt is the virtual damper reaction force.
  • k md ⁇ c is the virtual spring reaction force.
  • T tb,d_LCA (e l ) is the target virtual spring reaction force for LCA.
  • the manual steering command value calculation unit 53A sets N ⁇ Tm in equation (2) to 0, and calculates the manual steering command value ⁇ md using ( Jmd ⁇ d2 ⁇ md / dt2 + Jmd ⁇ d2 ⁇ ad /dt2), cmd ⁇ d ⁇ c /dt and kmd ⁇ ⁇ c + Ttb ,d_LCA ( e l ) as the moment of inertia Jmd ⁇ d2 ⁇ col / dt2 , virtual damper reaction force cmd ⁇ d ⁇ col /dt and virtual spring reaction force kmd ⁇ ⁇ col in equation ( 2 ), respectively .
  • a virtual damper reaction force c md ⁇ d ⁇ col / dt instead of the virtual damper reaction force c md ⁇ d ⁇ col / dt, a virtual damper reaction force c md ⁇ d ⁇ c / dt corresponding to the first derivative value d ⁇ c / dt of the actual steering angle ⁇ c is used, so the virtual damper reaction force does not include an automatic steering component.
  • a virtual spring reaction force kmd ⁇ ⁇ col a virtual spring reaction force kmd ⁇ ⁇ c corresponding to the actual steering angle ⁇ c is used, so the virtual spring reaction force does not include an automatic steering component.
  • the spring constant kmd in the above-described formulas (3), (15), and (16) is obtained in advance by experiment, analysis, etc.
  • the spring constant kmd in the above-described formulas (3), (15), and (16) may be calculated based on the following formula (17) using the disturbance torque estimated value ⁇ Tlc calculated by the disturbance torque estimation unit 64 (see FIG. 6) and the actual steering angle ⁇ c calculated by the second reduction ratio division unit 70.
  • the viscous damping coefficients cmd in the above-described expressions (3), (14), (15), and (16) are obtained in advance through experiments, analyses, and the like.
  • the viscous damping coefficient cmd in the above equations (3), (14), (15), and (16) may be calculated based on the following equation (18) using the disturbance torque estimation value ⁇ Tlc calculated by the disturbance torque estimation unit 64 and the actual steering angle ⁇ c calculated by the second reduction ratio division unit 70.
  • the angle control unit 55 (see FIG. 6) includes the feedforward control unit 63, but the feedforward control unit 63 may be omitted.
  • the feedback control torque Tfb calculated by the feedback control unit 62 becomes the basic target torque.
  • 1...electric power steering device 3...steered wheels, 4...steered mechanism, 18...electric motor, 51...assist torque command value setting unit, 52...target virtual spring reaction force setting unit, 52A...LCA target virtual spring reaction force setting unit, 53, 53A, 53B, 53C...manual steering command value calculation unit, 54...integrated angle command value calculation unit, 55...angle control unit, 56...subtraction unit, 56...first switch, 57...second switch, 58...addition unit, 59...torque control unit, 201...host ECU, 202, 202A, 202B, 202C...motor control ECU

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

モータ制御装置は、トーションバートルクを用いて手動操舵指令値を演算する手動操舵指令値演算部と、運転支援用の自動操舵指令値に手動操舵指令値を加算して、統合角度指令値を演算する統合角度指令値演算部と、統合角度指令値に基づいて、電動モータを駆動制御する制御部とを含み、運転支援モードにおいて、手動操舵指令値演算部は、操舵装置のリファレンスモデルの運動方程式を利用して手動操舵指令値を演算するように構成されており、手動操舵指令値演算部は、運動方程式における仮想ダンパ反力として、前記手動操舵指令値の微分値に応じた仮想ダンパ反力に、自動操舵指令値の微分値に応じた仮想ダンパ反力が付加された仮想ダンパ反力を用いて、手動操舵指令値を演算する。

Description

モータ制御装置
 本開示は、舵角制御用の電動モータの制御装置に関する。
 下記特許文献1には、トーションバートルクを用いてアシストトルク指令値を生成するアシストトルク指令値設定部と、トーションバートルクおよびアシストトルク指令値を用いて手動操舵指令値を生成する手動操舵指令値生成部と、自動操舵指令値に手動操舵指令値を加算して、統合角度指令値を演算する統合角度指令値演算部と、アシストトルク指令値のみに基づいて電動モータを制御する第1制御と、統合角度指令値に基づいて電動モータを制御する第2制御とを、切替信号に基づいて切り替える切替部とを備えたモータ制御装置が開示されている。
国際公開第2023/286169号
 特許文献1に記載の第2制御では、手動操舵指令値生成部は、操舵装置のリファレンスモデルの運動方程式を用いて手動操舵指令値を生成している。操舵装置のリファレンスモデルの運動方程式は、慣性モーメントと、仮想ばね反力と、仮想ダンパ反力(手動操舵指令値に応じた仮想ダンパ反力)とを含む。
 手動操舵指令値に応じた仮想ダンパ反力は、自動操舵指令値の1階微分値に応じた自動操舵成分を含んでいる。自動操舵指令値の1階微分値の絶対値は、例えば車線に対するヨー角が大きい場合や車速が大きい場合に大きくなるので、このような場合に仮想ダンパ反力の自動操舵成分の絶対値が大きくなる。仮想ダンパ反力に含まれている自動操舵成分は、ドライバの挙動と関係がないため、仮想ダンパ反力の自動操舵成分の絶対値が大きくなると、ドライバが違和感を抱くおそれがある。
 本開示の目的は、手動操舵指令値に応じた仮想ダンパ反力に含まれている自動操舵成分に起因するドライバの違和感を低減できるモータ制御装置を提供することである。
 本開示の一実施形態は、操舵装置の電動モータを駆動制御するためのモータ制御装置であって、トーションバートルクを用いて手動操舵指令値を演算する手動操舵指令値演算部と、運転支援用の自動操舵指令値に前記手動操舵指令値を加算して、統合角度指令値を演算する統合角度指令値演算部と、前記統合角度指令値に基づいて、前記電動モータを駆動制御する制御部とを含み、運転支援モードにおいて、前記手動操舵指令値演算部は、前記操舵装置のリファレンスモデルの運動方程式を利用して前記手動操舵指令値を演算するように構成されており、前記手動操舵指令値演算部は、前記運動方程式における仮想ダンパ反力として、前記手動操舵指令値の微分値に応じた仮想ダンパ反力に、前記自動操舵指令値の微分値に応じた仮想ダンパ反力が付加された仮想ダンパ反力を用いて、前記手動操舵指令値を演算する、モータ制御装置を提供する。
 この構成では、手動操舵指令値に応じた仮想ダンパ反力に含まれている自動操舵成分に起因するドライバの違和感を低減できる。
 本開示における上述の、またはさらに他の目的、特徴および効果は、添付図面を参照して次に述べる実施形態の説明により明らかにされる。
図1は、本開示の一実施形態に係るモータ制御装置が適用された電動パワーステアリングシステムの概略構成を示す模式図である。 図2は、モータ制御用ECUの電気的構成を説明するためのブロック図である。 図3は、トーションバートルクTtbに対するアシストトルク指令値Tasの設定例を示すグラフである。 図4は、リファレンスEPSモデルの一例を示す模式図である。 図5は、手動操舵指令値演算部の構成を示すブロック図である。 図6は、角度制御部の構成を示すブロック図である。 図7は、電動パワーステアリングシステムの物理モデルの構成例を示す模式図である。 図8は、外乱トルク推定部の構成を示すブロック図である。 図9は、トルク制御部の構成を示す模式図である。 図10は、モータ制御用ECUの第1変形例を示すブロック図である。 図11は、横偏差eに対する目標仮想ばね反力Ttb,d(e)の設定例を示すグラフである。 図12は、モータ制御用ECUの第1変形例で用いられる手動操舵指令値演算部の構成を示すブロック図である。 図13は、モータ制御用ECUの第2変形例および第3変形例を示すブロック図である。 図14は、横偏差eに対するLCA用目標仮想ばね反力/重み設定部の設定例を示すグラフである。 図15は、モータ制御用ECUの第2変形例で用いられる手動操舵指令値演算部の構成を示すブロック図である。 図16は、モータ制御用ECUの第3変形例で用いられる手動操舵指令値演算部の構成を示すブロック図である。
 [本開示の実施形態の説明]
 本開示の一実施形態は、操舵装置の舵角制御用の電動モータを駆動制御するためのモータ制御装置であって、トーションバートルクを用いて手動操舵指令値を演算する手動操舵指令値演算部と、運転支援用の自動操舵指令値に前記手動操舵指令値を加算して、統合角度指令値を演算する統合角度指令値演算部と、前記統合角度指令値に基づいて、前記電動モータを駆動制御する制御部とを含み、運転支援モードにおいて、前記手動操舵指令値演算部は、前記操舵装置のリファレンスモデルの運動方程式を利用して前記手動操舵指令値を演算するように構成されており、前記手動操舵指令値演算部は、前記運動方程式における仮想ダンパ反力として、前記手動操舵指令値の微分値に応じた仮想ダンパ反力に、前記自動操舵指令値の微分値に応じた仮想ダンパ反力が付加された仮想ダンパ反力を用いて、前記手動操舵指令値を演算する、モータ制御装置を提供する。
 この構成では、手動操舵指令値に応じた仮想ダンパ反力に含まれている自動操舵成分に起因するドライバの違和感を低減できる。
 本開示の一実施形態では、前記手動操舵指令値演算部は、前記手動操舵指令値を演算する際に、前記運動方程式における仮想ばね反力として、車両基準位置の走行車線に対する横位置に応じた目標仮想ばね反力を用いる。
 本開示の一実施形態では、前記手動操舵指令値演算部は、前記運動方程式における仮想ばね反力として、前記手動操舵指令値に応じた仮想ばね反力に、前記自動操舵指令値に応じた仮想ばね反力が付加された仮想ばね反力を用いて、前記手動操舵指令値を演算する。
 本開示の一実施形態では、前記手動操舵指令値演算部は、前記運動方程式における慣性モーメントとして、前記手動操舵指令値に応じた慣性モーメントに、前記自動操舵指令値に応じた慣性モーメントが付加された慣性モーメントを用いて、前記手動操舵指令値を演算する。
 [本開示の実施形態の詳細な説明]
 以下では、本開示の実施の形態を、添付図面を参照して詳細に説明する。
 図1は、本開示の一実施形態に係るモータ制御装置が適用された電動パワーステアリングシステムの概略構成を示す模式図である。
 電動パワーステアリングシステム1は、車両を操向するための操舵部材としてのステアリングホイール(ハンドル)2と、このステアリングホイール2の回転に連動して転舵輪3を転舵する転舵機構4と、運転者の操舵を補助するための操舵補助機構5とを備えている。ステアリングホイール2と転舵機構4とは、ステアリングシャフト6および中間軸7を介して機械的に連結されている。
 ステアリングシャフト6は、ステアリングホイール2に連結された入力軸8と、中間軸7に連結された出力軸9とを含む。入力軸8と出力軸9とは、トーションバー10を介して相対回転可能に連結されている。
 トーションバー10の近傍には、トルクセンサ12が配置されている。トルクセンサ12は、入力軸8および出力軸9の相対回転変位量に基づいて、ステアリングホイール2に与えられたトーションバートルク(操舵トルク)Ttbを検出する。この実施形態では、トルクセンサ12によって検出されるトーションバートルクTtbは、例えば、右方向への操舵のためのトルクが正の値として検出され、左方向への操舵のためのトルクが負の値として検出され、その絶対値が大きいほどトーションバートルクTtbの大きさが大きくなるものとする。
 転舵機構4は、ピニオン軸13と、転舵軸としてのラック軸14とを含むラックアンドピニオン機構からなる。ラック軸14の各端部には、タイロッド15およびナックルアーム(図示略)を介して転舵輪3が連結されている。ピニオン軸13は、中間軸7に連結されている。ピニオン軸13は、ステアリングホイール2の操舵に連動して回転するようになっている。ピニオン軸13の先端には、ピニオン16が連結されている。
 ラック軸14は、車両の左右方向に沿って直線状に延びている。ラック軸14の軸方向の中間部には、ピニオン16に噛み合うラック17が形成されている。このピニオン16およびラック17によって、ピニオン軸13の回転がラック軸14の軸方向移動に変換される。ラック軸14を軸方向に移動させることによって、転舵輪3を転舵することができる。
 ステアリングホイール2が操舵(回転)されると、この回転が、ステアリングシャフト6および中間軸7を介して、ピニオン軸13に伝達される。そして、ピニオン軸13の回転は、ピニオン16およびラック17によって、ラック軸14の軸方向移動に変換される。これにより、転舵輪3が転舵される。
 操舵補助機構5は、操舵補助力(アシストトルク)を発生するための電動モータ18と、電動モータ18の出力トルクを増幅して転舵機構4に伝達するための減速機19とを含む。減速機19は、ウォームギヤ20と、このウォームギヤ20と噛み合うウォームホイール21とを含むウォームギヤ機構からなる。減速機19は、伝達機構ハウジングとしてのギヤハウジング22内に収容されている。
 以下において、減速機19の減速比(ギヤ比)をNで表す。減速比Nは、ウォームホイール21の回転角であるウォームホイール角θwwに対するウォームギヤ20の回転角であるウォームギヤ角θwgの比(θwg/θww)として定義される。
 ウォームギヤ20は、電動モータ18によって回転駆動される。また、ウォームホイール21は、出力軸9に一体回転可能に連結されている。
 電動モータ18によってウォームギヤ20が回転駆動されると、ウォームホイール21が回転駆動され、ステアリングシャフト6にモータトルクが付与されるとともにステアリングシャフト6(出力軸9)が回転する。そして、ステアリングシャフト6の回転は、中間軸7を介してピニオン軸13に伝達される。ピニオン軸13の回転は、ラック軸14の軸方向移動に変換される。これにより、転舵輪3が転舵される。すなわち、電動モータ18によってウォームギヤ20を回転駆動することによって、電動モータ18による操舵補助や転舵輪3の転舵が可能となる。電動モータ18には、電動モータ18のロータの回転角を検出するための回転角センサ23が設けられている。
 出力軸9(電動モータ18の駆動対象の一例)に加えられるトルクとしては、電動モータ18によるモータトルクと、モータトルク以外の外乱トルクTlcとがある。モータトルク以外の外乱トルクTlcには、トーションバートルクTtb、路面反力トルク(路面負荷トルク)Trl、摩擦トルクT等が含まれる。
 トーションバートルクTtbは、運転者によってステアリングホイール2に加えられる力や、ステアリング慣性によって発生する力等によって、ステアリングホイール2側から出力軸9に加えられるトルクである。
 路面反力トルクTrlは、タイヤに発生するセルフアライニングトルク、サスペンションやタイヤホイールアライメントによって発生する力、ラックアンドピニオン機構の摩擦力等によって、転舵輪3側からラック軸14を介して出力軸9に加えられるトルクである。
 車両には、車両の進行方向前方の道路を撮影するCCD(Charge Coupled Device)カメラ25、自車位置を検出するためのGPS(Global Positioning System)26、道路形状や障害物を検出するためのレーダー27および地図情報を記憶した地図情報メモリ28が搭載されている。車両には、さらに、操舵モードを手動で切り替えるための2つのモードスイッチ31,32が搭載されている。
 操舵モードには、後述するように、手動運転によって操舵が行われる手動操舵モードと、手動運転および自動運転の両方に基づく操舵が可能な協調操舵モードとがある。
 CCDカメラ25、GPS26、レーダー27および地図情報メモリ28は、運転支援制御や自動運転制御を行うための上位ECU(ECU:Electronic Control Unit)201に接続されている。上位ECU201は、CCDカメラ25、GPS26およびレーダー27によって得られる情報および地図情報を元に、周辺環境認識、自車位置推定、経路計画等を行い、操舵や駆動アクチュエータの制御目標値の決定を行う。
 この実施形態では、上位ECU201は、自動操舵のための自動操舵指令値θadを設定する。この実施形態では、自動操舵制御は、例えば、目標軌道に沿って車両を走行させるための制御である。自動操舵指令値θadは、車両を目標軌道に沿って自動走行させるための操舵角の目標値である。
 この実施形態では、自動操舵指令値θadは、出力軸9の中立位置からの回転量(回転角)で表され、中立位置から右操舵方向への回転量が正の値として表され、中立位置から左操舵方向への回転量が負の値として表される。自動操舵指令値θadは、例えば、車速、目標走行ライン(車線中央ライン)に対する横偏差および目標走行ラインに対する車両のヨー偏差に基づいて、設定される。このような自動操舵指令値θadを設定する処理は、周知であるため、ここでは詳細な説明を省略する。
 なお、自動操舵制御(運転支援制御)は、例えば、車両が走行車線内を維持するように操舵を支援するレーン・キーピング・アシスト(LKA)制御、車両が走行車線の中央を走行するように操舵を支援するレーン・センタリング・アシスト(LCA)制御等であってもよい。
 また、上位ECU201は、第1モードスイッチ31および第2モードスイッチ32の操作に基づいて、操舵モード(運転モード)が、手動操舵モード(手動運転モード)であるか協調操舵モード(運転支援モード)であるかを示す操舵モード信号Smodeを出力する。具体的には、第1モードスイッチ31がドライバによってオンされたときに、上位ECU201は、操舵モードが手動操舵モードであることを示す操舵モード信号Smodeを出力する。一方、第2モードスイッチ32がドライバによってオンされたときに、上位ECU201は、操舵モードが協調操舵モードであることを示す操舵モード信号Smodeを出力する。
 自動操舵指令値θadおよび操舵モード信号Smodeは、車載ネットワークを介して、モータ制御用ECU202に与えられる。トルクセンサ12によって検出されるトーションバートルクTtb、回転角センサ23の出力信号は、モータ制御用ECU202に入力される。モータ制御用ECU202は、これらの入力信号および上位ECU201から与えられる情報に基づいて、電動モータ18を制御する。
 図2は、モータ制御用ECU202の電気的構成を説明するためのブロック図である。
 モータ制御用ECU202は、マイクロコンピュータ50と、マイクロコンピュータ50によって制御され、電動モータ18に電力を供給する駆動回路(インバータ回路)41と、電動モータ18に流れる電流(以下、「モータ電流I」という)を検出するための電流検出回路42とを備えている。
 マイクロコンピュータ50は、CPUおよびメモリ(ROM、RAM、不揮発性メモリなど)を備えており、所定のプログラムを実行することによって、複数の機能処理部として機能するようになっている。複数の機能処理部は、アシストトルク指令値設定部51と、手動操舵指令値演算部53と、統合角度指令値演算部54と、角度制御部55と、第1スイッチ56と、第2スイッチ57と、加算部58と、トルク制御部(電流制御部)59とを含む。
 アシストトルク指令値設定部51は、手動操作に必要なアシストトルクの目標値であるアシストトルク指令値Tasを設定する。アシストトルク指令値設定部51は、トルクセンサ12によって検出されるトーションバートルクTtbに基づいて、アシストトルク指令値Tasを設定する。
 図3は、トーションバートルクTtbに対するアシストトルク指令値Tasの設定例を示すグラフである。
 アシストトルク指令値Tasは、電動モータ18から右方向操舵のための操舵補助力を発生させるべきときには正の値とされ、電動モータ18から左方向操舵のための操舵補助力を発生させるべきときには負の値とされる。アシストトルク指令値Tasは、トーションバートルクTtbの正の値に対しては正をとり、トーションバートルクTtbの負の値に対しては負をとる。そして、アシストトルク指令値Tasは、トーションバートルクTtbの絶対値が大きくなるほど、その絶対値が大きくなるように設定される。
 なお、アシストトルク指令値設定部51は、トーションバートルクTtbに予め設定された定数を乗算することによって、アシストトルク指令値Tasを演算してもよい。また、アシストトルク指令値Tasは、車速をも考慮して設定されてもよい。
 手動操舵指令値演算部53は、協調操舵モード時において、運転者がステアリングホイール2を操作した場合に、当該ステアリングホイール操作に応じた操舵角(より正確には出力軸9の回転角θ)を手動操舵指令値θmdとして設定するために設けられている。手動操舵指令値演算部53は、トルクセンサ12によって検出されるトーションバートルクTtbと、アシストトルク指令値設定部51によって設定されるアシストトルク指令値Tasと、目標仮想ばね反力設定部52によって設定される目標仮想ばね反力Ttb,d(e)とを用いて手動操舵指令値θmdを生成する。手動操舵指令値演算部53の詳細については、後述する。
 統合角度指令値演算部54は、上位ECU201によって設定される自動操舵指令値θadに手動操舵指令値θmdを加算して、統合角度指令値θcmdを演算する。
 角度制御部55は、統合角度指令値θcmdに基づいて、統合モータトルク指令値Tcomを演算する。角度制御部55の詳細については、後述する。
 第1スイッチ56および第2スイッチ57は、入力される操舵モード信号Smodeに応じて、オンオフされる。具体的には、操舵モードが手動操舵モードであることを示す操舵モード信号Smodeが入力されている場合には、第1スイッチ56がオンにされ、第2スイッチ57がオフにされる。
 一方、操舵モードが協調操舵モードであることを示す操舵モード信号Smodeが入力されている場合には、第1スイッチ56がオフにされ、第2スイッチ57がオンにされる。
 第1スイッチ56がオン状態であり、第2スイッチ57がオフ状態である場合には、加算部58は、アシストトルク指令値Tasを、モータトルク指令値Tm,cmd(=Tas)として出力する。一方、第2スイッチ57がオン状態であり、第1スイッチ56がオフ状態である場合には、加算部58は、角度制御部55から出力される統合モータトルク指令値Tcomをモータトルク指令値Tm,cmd(=Tcom)として出力する。
 加算部58の出力であるモータトルク指令値Tm,cmdは、トルク制御部59に与えられる。
 トルク制御部59は、電動モータ18のモータトルクがモータトルク指令値Tm,cmdに近づくように駆動回路41を駆動する。トルク制御部59の詳細については、後述する。
 手動操舵指令値演算部53について、詳しく説明する。
 まず、特許文献1に記載された手動操舵指令値生成部による手動操舵指令値θmdの設定方法について説明する。
 手動操舵指令値生成部は、図4のリファレンスEPSモデルを用いて、手動操舵指令値θmdを生成する。図4のリファレンスEPSモデルは、本開示の「操舵装置のリファレンスモデル」の一例である。
 このリファレンスEPSモデルは、ロアコラムを含む単一慣性モデルである。ロアコラムは、出力軸9およびウォームホイール21に対応する。ただし、このモデルは一例であり、上記以外の構成(例えばラックバーなど)を含む慣性モデルであってもよい。図4において、Jmdは、ロアコラムの慣性(以下、「コラム慣性」という。)であり、θcolはロアコラムの回転角であり、Ttbは、トーションバートルクである。ロアコラムには、トーションバートルクTtb、電動モータ18から出力軸9に作用するトルクN・Tおよび路面反力トルク(仮想反力)Trlが与えられる。
 路面反力トルクTrlは、仮想ばねのばね定数kmdおよび仮想ダンパの粘性減衰係数cmd)を用いて、次式(1)で表される。
Figure JPOXMLDOC01-appb-M000001
 ばね定数kmdおよび粘性減衰係数cmdは、予め実験、解析等によって求められている。以下において、kmd・θcolを仮想ばね反力といい、cmd(dθcol/dt)を仮想ダンパ反力という場合がある。
 リファレンスEPSモデルの運動方程式は、次式(2)で表される。
Figure JPOXMLDOC01-appb-M000002
 式(2)において、Jmd・dθcol/dtは、ロアコラムに作用する慣性モーメントである。
 手動操舵指令値生成部は、Ttbにトルクセンサ12によって検出されるトーションバートルクTtbを代入し、Tにアシストトルク指令値設定部51によって設定されるアシストトルク指令値Tasを代入して、式(2)の微分方程式を解くことにより、ロアコラムの回転角θccolを演算する。そして、手動操舵指令値生成部は、得られたロアコラムの回転角θcolを手動操舵指令値θmdとして生成する。このようにして、手動操舵指令値θmdを設定する方法を比較方法ということにする。
 式(2)の運動方程式は、TをTasに置き換えるとともに、θcolをθmdに置き換えた運動方程式と等価である。
 比較方法では、仮想ダンパ反力cmd・dθcol/dt(=cmd・dθmd/dt)は、後述するように、自動操舵指令値θadの1階微分値dθad/dtに応じた自動操舵成分を含んでいる。仮想ダンパ反力cmd・dθcol/dt(=cmd・dθmd/dt)に含まれている自動操舵成分は、ドライバの挙動と関係がないため、ドライバが違和感を抱くおそれがある。
 同様に、ロアコラムに作用する慣性モーメントJmd・dθcol/dt(=Jmd・dθmd/dt)は、後述するように、自動操舵指令値θadの2階微分値dθad/dtに応じた自動操舵成分を含んでいる。慣性モーメントJmd・dθcol/dt(=Jmd・dθmd/dt)に含まれている自動操舵成分は、ドライバの挙動と関係がないため、ドライバが違和感を抱くおそれがある。
 本実施形態では、手動操舵指令値演算部53は、前述したリファレンスEPSモデルの運動方程式(2)を利用して手動操舵指令値θmdを演算する。具体的には、本実施形態では、手動操舵指令値演算部53は、前述したリファレンスEPSモデルの運動方程式(2)を変形した運動方程式に基づいて手動操舵指令値θmdを演算する。
 図5は、手動操舵指令値演算部53の構成を示すブロック図である。
 図5において、Jmdは、コラム慣性である。sは、微分演算子である。θmdは、手動操舵指令値であり、比較方法のロアコラムの回転角θcolに相当する。cmdは、仮想ダンパの粘性減衰係数である。kmdは、仮想ばねのばね定数である。仮想ダンパの粘性減衰係数cmdおよび仮想ばねのばね定数kmdは、予め実験、解析等によって求められている。
 手動操舵指令値演算部53は、減速比乗算部101と、2階微分部102と、慣性乗算部103と、加減算部104と、慣性除算部105と、第1積分部106と、第2積分部107と、1階微分部108と、加算部109と、仮想ダンパ反力演算部110と、仮想ばね反力演算部111とを含む。
 減速比乗算部101は、アシストトルク指令値Tasに減速機19の減速比Nを乗算することにより、電動モータ18の回転軸に対するアシストトルク指令値Tasを、出力軸9に対するアシストトルク指令値N・Tasに変換する。
 2階微分部102は、自動操舵指令値θadを2階微分する。慣性乗算部103は、自動操舵指令値θadの2階微分値dθad/dtにコラム慣性Jmdを乗算することにより、自動操舵指令値θadに対する慣性モーメントJmd・dθad/dtを演算する。
 加減算部104には、トーションバートルクTtbと、出力軸9に対するアシストトルク指令値N・Tasと、自動操舵指令値θadに対する慣性モーメントJmd・dθad/dtと、仮想ダンパ反力演算部110から与えられる仮想ダンパ反力cmd(dθmd/dt+dθad/dt)と、仮想ばね反力演算部111から与えられる仮想ばね反力kmd・θmdとが入力する。
 加減算部104は、トーションバートルクTtbに出力軸9に対するアシストトルク指令値N・Tasを加算し、その加算結果から自動操舵指令値θadに対する慣性モーメントJmd・dθad/dt、仮想ダンパ反力cmd(dθmd/dt+dθad/dt)および仮想ばね反力kmd・θmdを減算する。これにより、加減算部104は、前記式(2)の左辺のJmd・dθcol/dtに相当する慣性モーメントJmd・dθmd/dt(=Ttb+N・Tas―Jmd・dθad/dt―cmd(dθmd/dt+dθad/dt)-kmd・θmd)を演算する。
 慣性除算部105は、加減算部104によって演算された慣性モーメントJmd・dθmd/dtをコラム慣性Jmdで除算することにより、手動操舵指令値θmdの2階微分値dθmd/dtを演算する。
 第1積分部106は、手動操舵指令値θmdの2階微分値dθmd/dtを積分することにより、手動操舵指令値θmdの1階微分値dθmd/dtを演算する。
 第2積分部107は、手動操舵指令値θmdの1階微分値dθmd/dtを積分することにより、手動操舵指令値θmdを演算する。この手動操舵指令値θmdが、手動操舵指令値演算部53から出力される。
 1階微分部108は、自動操舵指令値θadを1階微分する。
 加算部109は、第1積分部106よって演算された手動操舵指令値θmdの1階微分値dθmd/dtに、1階微分部108によって演算された自動操舵指令値θadの1階微分値dθad/dtを加算する。
 仮想ダンパ反力演算部110は、加算部109の加算結果(dθmd/dt+dθad/dt)に粘性減衰係数cmdを乗算することにより、仮想ダンパ反力cmd(dθmd/dt+dθad/dt)を演算する。この仮想ダンパ反力cmd(dθmd/dt+dθad/dt)は、加減算部104にフィードバックされる。
 仮想ばね反力演算部111は、第2積分部107によって演算された手動操舵指令値θmdに、ばね定数kmdを乗算することにより、仮想ばね反力kmd・θmdを演算する。この仮想ばね反力kmd・θmdは、加減算部104にフィードバックされる。
 つまり、手動操舵指令値演算部53は、次式(3)の運動方程式に基づいて、手動操舵指令値θmdを演算する。
Figure JPOXMLDOC01-appb-M000003
 式(3)において、Jmd・dθmd/dt+Jmd・dθad/dtは、慣性モーメントである。cmd・dθmd/dt+cmd・dθad/dtは、仮想ダンパ反力である。kmd・θmdは、仮想ばね反力である。
 つまり、手動操舵指令値演算部53は、前記式(2)の慣性モーメントJmd・dθcol/dtおよび仮想ダンパ反力cmd・dθcol/dtとして、それぞれ、(Jmd・dθmd/dt+Jmd・dθad/dt)および(cmd・dθmd/dt+cmd・dθad/dt)を用いて、手動操舵指令値θmdを演算する。
 図6は、角度制御部55の構成を示すブロック図である。
 角度制御部55は、統合角度指令値θcmdに基づいて、統合モータトルク指令値Tcomを演算する。角度制御部55は、ローパスフィルタ(LPF)61と、フィードバック制御部62と、フィードフォワード制御部63と、外乱トルク推定部64と、トルク加算部65と、外乱トルク補償部66と、第1減速比除算部67と、減速比乗算部68と、回転角演算部69と、第2減速比除算部70とを含む。
 減速比乗算部68は、加算部58(図2参照)によって演算されるモータトルク指令値Tm,cmdに減速機19の減速比Nを乗算することにより、モータトルク指令値Tm,cmdを出力軸9(ウォームホイール21)に作用する出力軸トルク指令値N・Tm,cmdに変換する。
 回転角演算部69は、回転角センサ23の出力信号に基づいて、電動モータ18のロータ回転角θを演算する。第2減速比除算部70は、回転角演算部69によって演算されるロータ回転角θを減速比Nで除算することにより、ロータ回転角θを出力軸9の回転角(実操舵角)θに換算する。
 この実施形態では、実操舵角θは、出力軸9の中立位置からの回転量(回転角)で表され、中立位置から右操舵方向への回転量が正の値として表され、中立位置から左操舵方向への回転量が負の値として表される。
 ローパスフィルタ61は、統合角度指令値θcmdに対してローパスフィルタ処理を行う。ローパスフィルタ処理後の統合角度指令値θcmdlは、フィードバック制御部62およびフィードフォワード制御部63に与えられる。なお、ローパスフィルタ61を設けなくてもよい。
 フィードバック制御部62は、外乱トルク推定部64によって演算される操舵角推定値^θを、ローパスフィルタ処理後の統合角度指令値θcmdlに近づけるために設けられている。フィードバック制御部62は、角度偏差演算部62AとPD制御部62Bとを含む。角度偏差演算部62Aは、統合角度指令値θcmdlと操舵角推定値^θとの偏差Δθ(=θcmdl-^θ)を演算する。なお、角度偏差演算部62Aは、統合角度指令値θcmdlと、第2減速比除算部70によって演算される実操舵角θとの偏差(θcmdl-θ)を、角度偏差Δθとして演算するようにしてもよい。
 PD制御部62Bは、角度偏差演算部62Aによって演算される角度偏差Δθに対してPD演算(比例微分演算)を行うことにより、フィードバック制御トルクTfbを演算する。フィードバック制御トルクTfbは、トルク加算部65に与えられる。
 フィードフォワード制御部63は、電動パワーステアリングシステム1の慣性による応答性の遅れを補償して、制御の応答性を向上させるために設けられている。フィードフォワード制御部63は、角加速度演算部63Aと慣性乗算部63Bとを含む。角加速度演算部63Aは、統合角度指令値θcmdlを2階微分することにより、目標角加速度dθcmdl/dtを演算する。
 慣性乗算部63Bは、角加速度演算部63Aによって演算された目標角加速度dθcmdl/dtに、電動パワーステアリングシステム1の慣性Jを乗算することにより、フィードフォワード制御トルクTff(=J・dθcmdl/dt)を演算する。慣性Jは、例えば、後述する電動パワーステアリングシステム1の物理モデル(図7参照)から求められる。フィードフォワード制御トルクTffは、慣性補償値として、トルク加算部65に与えられる。
 トルク加算部65は、フィードバック制御トルクTfbにフィードフォワード制御トルクTffを加算することにより、基本トルク指令値(Tfb+Tff)を演算する。
 外乱トルク推定部64は、プラント(電動モータ18の制御対象)に外乱として発生する非線形なトルク(外乱トルク:モータトルク以外のトルク)を推定するために設けられている。外乱トルク推定部64は、出力軸トルク指令値N・Tm,cmdと、実操舵角θとに基づいて、外乱トルク(外乱負荷)Tlc、操舵角θおよび操舵角微分値(角速度)dθ/dtを推定する。外乱トルクTlc、操舵角θおよび操舵角微分値(角速度)dθ/dtの推定値を、それぞれ^Tlc、^θおよびd^θ/dtで表す。外乱トルク推定部64の詳細については、後述する。
 外乱トルク推定部64によって演算された外乱トルク推定値^Tlcは、外乱トルク補償値として外乱トルク補償部66に与えられる。外乱トルク推定部64によって演算された操舵角推定値^θは、角度偏差演算部62Aに与えられる。
 外乱トルク補償部66は、基本トルク指令値(Tfb+Tff)から外乱トルク推定値^Tlcを減算することにより、統合トルク指令値Tco(=Tfb+Tff-^Tlc)を演算する。これにより、外乱トルクが補償された統合トルク指令値Tco(出力軸9に対するトルク指令値)が得られる。
 統合トルク指令値Tcoは、第1減速比除算部67に与えられる。第1減速比除算部67は、統合トルク指令値Tcoを減速比Nで除算することにより、統合モータトルク指令値Tcom(電動モータ18に対するトルク指令値)を演算する。この統合モータトルク指令値Tcomが、第2スイッチ57(図2参照)に与えられる。
 外乱トルク推定部64について詳しく説明する。外乱トルク推定部64は、例えば、図7に示す電動パワーステアリングシステム1の物理モデル300を使用して、外乱トルクTlc、操舵角θおよび角速度dθ/dtを推定する外乱オブザーバから構成されている。
 この物理モデル300は、出力軸9および出力軸9に固定されたウォームホイール21を含むプラント(モータ駆動対象の一例)301を含む。プラント301には、ステアリングホイール2からトーションバー10を介してトーションバートルクTtbが与えられるとともに、転舵輪3側から路面反力トルクTrlが与えられる。
 さらに、プラント301には、ウォームギヤ20を介して出力軸トルク指令値N・Tm,cmdが与えられるとともに、ウォームホイール21とウォームギヤ20との間の摩擦によって摩擦トルクTが与えられる。
 プラント301の慣性をJとすると、物理モデル300の慣性についての運動方程式は、次式(4)で表される。
Figure JPOXMLDOC01-appb-M000004
 dθ/dtは、プラント301の角加速度である。Nは、減速機19の減速比である。Tlcは、プラント301に与えられるモータトルク以外の外乱トルクを示している。この実施形態では、外乱トルクTlcは、トーションバートルクTtbと路面反力トルクTrlと摩擦トルクTとの和として示されているが、実際には、外乱トルクTlcはこれら以外のトルクを含んでいる。
 図7の物理モデル300に対する状態方程式は、次式(5)で表わされる。
Figure JPOXMLDOC01-appb-M000005
 前記式(5)において、xは、状態変数ベクトル、uは、既知入力ベクトル、uは、未知入力ベクトル、yは、出力ベクトル(測定値)である。また、前記式(5)において、Aは、システム行列、Bは、第1入力行列、Bは、第2入力行列、Cは、出力行列、Dは、直達行列である。
 前記状態方程式を、未知入力ベクトルuを状態の1つとして含めた系に拡張する。拡張系の状態方程式(拡張状態方程式)は、次式(6)で表される。
Figure JPOXMLDOC01-appb-M000006
 前記式(6)において、xは、拡張系の状態変数ベクトルであり、次式(7)で表される。
Figure JPOXMLDOC01-appb-M000007
 前記式(6)において、Aは、拡張系のシステム行列、Bは、拡張系の既知入力行列、Cは、拡張系の出力行列である。
 前記式(6)の拡張状態方程式から、次式(8)の方程式で表される外乱オブザーバ(拡張状態オブザーバ)が構築される。
Figure JPOXMLDOC01-appb-M000008
 式(8)において、^xはxの推定値を表している。また、Lはオブザーバゲインである。また、^yはyの推定値を表している。^xは、次式(9)で表される。
Figure JPOXMLDOC01-appb-M000009
 式(9)において、^θはθの推定値であり、^TlcはTlcの推定値である。
 外乱トルク推定部64は、前記式(8)の方程式に基づいて状態変数ベクトル^xを演算する。
 図8は、外乱トルク推定部64の構成を示すブロック図である。
 外乱トルク推定部64は、入力ベクトル入力部81と、出力行列乗算部82と、第1加算部83と、ゲイン乗算部84と、入力行列乗算部85と、システム行列乗算部86と、第2加算部87と、積分部88と、状態変数ベクトル出力部89とを含む。
 減速比乗算部68(図6参照)によって演算される出力軸トルク指令値N・Tm,cmdは、入力ベクトル入力部81に与えられる。入力ベクトル入力部81は、入力ベクトルuを出力する。
 積分部88の出力が状態変数ベクトル^x(前記式(9)参照)となる。演算開始時には、状態変数ベクトル^xとして初期値が与えられる。状態変数ベクトル^xの初期値は、たとえば0である。
 システム行列乗算部86は、状態変数ベクトル^xにシステム行列Aを乗算する。出力行列乗算部82は、状態変数ベクトル^xに出力行列Cを乗算する。
 第1加算部83は、第2減速比除算部70(図6参照)によって演算された実操舵角θである出力ベクトル(測定値)yから、出力行列乗算部82の出力(C・^x)を減算する。つまり、第1加算部83は、出力ベクトルyと出力ベクトル推定値^y(=C・^x)との差(y-^y)を演算する。ゲイン乗算部84は、第1加算部83の出力(y-^y)にオブザーバゲインL(前記式(8)参照)を乗算する。
 入力行列乗算部85は、入力ベクトル入力部81から出力される入力ベクトルuに入力行列Bを乗算する。第2加算部87は、入力行列乗算部85の出力(B・u)と、システム行列乗算部86の出力(A・^x)と、ゲイン乗算部84の出力(L(y-^y))とを加算することにより、状態変数ベクトルの微分値d^x/dtを演算する。積分部88は、第2加算部87の出力(d^x/dt)を積分することにより、状態変数ベクトル^xを演算する。状態変数ベクトル出力部89は、状態変数ベクトル^xに基づいて、外乱トルク推定値^Tlc、操舵角推定値^θおよび角速度推定値d^θ/dtを演算する。
 一般的な外乱オブザーバは、前述の拡張状態オブザーバとは異なり、プラントの逆モデルとローパスフィルタとから構成される。プラントの運動方程式は、前述のように式(3)で表される。したがって、プラントの逆モデルは、次式(10)となる。
Figure JPOXMLDOC01-appb-M000010
 一般的な外乱オブザーバへの入力は、J・dθ/dtおよびN・Tm,cmdであり、実操舵角θの2階微分値を用いるため、回転角センサ23のノイズの影響を大きく受ける。これに対して、前述の実施形態の拡張状態オブザーバでは、積分型で外乱トルクを推定するため、微分によるノイズ影響を低減できる。
 なお、外乱トルク推定部64として、プラントの逆モデルとローパスフィルタとから構成される一般的な外乱オブザーバを用いてもよい。
 図9は、トルク制御部59の構成を示す模式図である。
 トルク制御部59(図2参照)は、モータ電流指令値演算部91と、電流偏差演算部92と、PI制御部93と、PWM(Pulse Width Modulation)制御部94とを含む。
 モータ電流指令値演算部91は、加算部58(図2参照)によって演算されたモータトルク指令値Tm,cmdを電動モータ18のトルク定数Kで除算することにより、モータ電流指令値Im,cmdを演算する。
 電流偏差演算部92は、モータ電流指令値演算部91によって得られたモータ電流指令値Im,cmdと電流検出回路42によって検出されたモータ電流Iとの偏差ΔI(=Im,cmd-I)を演算する。
 PI制御部93は、電流偏差演算部92によって演算された電流偏差ΔIに対するPI演算(比例積分演算)を行うことにより、電動モータ18に流れるモータ電流Iをモータ電流指令値Im,cmdに導くための駆動指令値を生成する。PWM制御部94は、前記駆動指令値に対応するデューティ比のPWM制御信号を生成して、駆動回路41に供給する。これにより、駆動指令値に対応した電力が電動モータ18に供給されることになる。
 以下、図2を参照して、本実施形態の動作について説明する。
 この実施形態では、手動操舵モードとは、アシストトルク指令値Tasのみに基づいて電動モータ18が制御される操舵モードをいう。また、協調操舵モードとは、自動操舵指令値θadと手動操舵指令値θmdとの両方が加味された統合角度指令値θcmdに基づいて電動モータ18が制御される操舵モードをいう。
 操舵モードが手動操舵モードに設定されている場合には、第1スイッチ56がオンとなり、第2スイッチ57がオフとなる。操舵モードが協調操舵モードに設定されている場合には、第1スイッチ56がオフとなり、第2スイッチ57がオンとなる。つまり、このモータ制御用ECU202は、運転者によるモードスイッチ31,32の操作によって、手動操舵モードと協調操舵モードの間で操舵モードの切り替えを行うことが可能となる。
 前述の実施形態では、統合角度指令値θcmdに基づいて電動モータ18を制御できる協調操舵モードと、アシストトルク指令値Tasのみに基づいて電動モータ18を制御できる手動操舵モードとを切り替えることができるようになる。
 つまり、統合角度指令値θcmdに基づいて電動モータ18を制御できる電動パワーステアリングシステム1において、アシストトルク指令値Tasのみに基づいて電動モータ18を制御することが可能となる。
 前述の実施形態では、手動操舵モード時には、アシストトルク指令値Tasのみに基づいて電動モータ18が制御されるから、ドライバは、実際の路面反力トルクを受け取ることができるようになる。
 前述の実施形態では、協調操舵モード時には、手動操舵指令値演算部53は、前記式(2)の慣性モーメントJmd・dθcol/dtおよび仮想ダンパ反力cmd・dθcol/dtとして、それぞれ、(Jmd・dθmd/dt+Jmd・dθad/dt)および(cmd・dθmd/dt+cmd・dθad/dt)を用いて、手動操舵指令値θmdを演算している。
 これにより、協調操舵モード時において、前記式(2)の仮想ダンパ反力cmd・dθcol/dtに含まれている自動操舵成分および前記式(2)の慣性モーメントJmd・dθcol/dtに含まれている自動操舵成分に起因するドライバの違和感を低減できる。以下、この点について説明する。
 図2および図6を参照して、協調操舵モード時には、実舵角θが統合角度指令値θcmdに追従するように、電動モータ18が制御される。実舵角θが統合角度指令値θcmdに完全に追従していると仮定すると、θmd=θ-θadという関係が成り立つ。
 この場合、前記式(3)内の手動操舵指令値θmdに対する仮想ダンパ反力cmd・dθmd/dtは、次式(11)で表される。
Figure JPOXMLDOC01-appb-M000011
 また、前記式(3)内の手動操舵指令値θmdに対する慣性モーメントJmd・dθmd/dtは、次式(12)で表される。
Figure JPOXMLDOC01-appb-M000012
 つまり、cmd・dθmd/dtは、実舵角θの1階微分に応じた実舵角成分cmd・dθ/dtと、自動操舵指令値θadの1階微分に応じた自動操舵成分-cmd・dθad/dtとを含む。同様に、Jmd・dθmd/dtは、実舵角θの2階微分に応じた実舵角成分Jmd・dθ/dtと、自動操舵指令値θadの2階微分に応じた自動操舵成分-Jmd・dθad/dtとを含む。
 これらの実舵角成分cmd・dθ/dtおよびJmd・dθ/dtは、ドライバの挙動に対応するため、ドライバは違和感を抱かない。一方、これらの自動操舵成分-cmd・dθad/dtおよび-Jmd・dθad/dtはドライバの挙動と関係がないため、ドライバが違和感を抱くおそれがある。-dθad/dtの絶対値は、-dθad/dtの絶対値よりも大きいため、特に、仮想ダンパ反力の自動操舵成分-cmd・dθad/dθは、操舵感に悪影響を及ぼしやすい。
 この実施形態では、前記式(3)の運動方程式は、仮想ダンパ反力として、手動操舵指令値θmdに対する仮想ダンパ反力cmd・dθmd/dtに加えて自動操舵指令値θadに対する仮想ダンパ反力cmd・dθad/dtを含む。また、前記式(3)の運動方程式は、慣性モーメントとして、手動操舵指令値θmdに対する慣性モーメントJmd・dθmd/dtに加えて自動操舵指令値θadに対する慣性モーメントJmd・dθad/dtを含む。
 これにより、手動操舵指令値θmdに対する仮想ダンパ反力cmd・dθmd/dtに含まれる自動操舵成分-cmd・dθad/dtを低下させることができる。同様に、手動操舵指令値θmdに対する慣性モーメントJmd・dθmd/dtに含まれる自動操舵成分-Jmd・dθad/dtを低下させることができる。これにより、協調操舵モード時において、ドライバの違和感を低減できる。
 θmd=θ-θadという関係が成り立つと仮定した場合には、式(3)の運動方程式は、次式(13)に示すようになる。
Figure JPOXMLDOC01-appb-M000013
 この場合には、cmd・dθmd/dtに含まれる自動操舵成分-cmd・dθad/dtが補償され、実舵角θに対する実舵角成分cmd・dθ/dtのみが残る、また、Jmd・dθmd/dtに含まれる自動操舵成分-Jmd・dθad/dtが補償され、実舵角θに対するJmd・dθ/dtのみが残る。
 また、前述の実施形態では、統合角度指令値θcmdに基づいて基本トルク指令値(Tfb+Tff)が演算され、外乱トルク推定部64によって演算された外乱トルク推定値^Tlcによって基本トルク指令値(Tfb+Tff)が補正されているので、角度制御性能に対する外乱トルクの影響を抑制することができる。これにより、高精度の角度制御を実現することが可能となる。
 以下、モータ制御用ECU202の変形例について説明する。以下のモータ制御用ECU202の変形例においても、手動操舵モード時の動作は前述の実施形態と同様であるので、以下においては、協調操舵モード時の動作について説明する。
 図10は、モータ制御用ECUの第1変形例を示すブロック図である。図10において、図2の各部に対応する部分には、図2と同じ符号を付して示す。
 モータ制御用ECUとして図10のモータ制御用ECU202Aが用いられる場合、上位ECU201は、モード信号Smodeおよび自動操舵指令値θadの他、図1に破線で示すように、現在設定されている目標走行ラインに対する横偏差eを出力する。この実施形態では、横偏差eは、現在設定されている目標走行ライン(車線中央ライン)から車両の基準位置(以下、「車両基準位置」という。)までの距離である。車両基準位置は、車両の幅中央の所定位置に設定されている。
 この実施形態では、横偏差eは、車両基準位置が目標走行ライン上にある場合には0(e=0)となり、車両基準位置が進行方向に向かって目標走行ラインの右側にある場合には正の値(e>0)となり、車両基準位置が進行方向に向かって目標走行ラインの左側にある場合には負の値(e<0)となる。
 図10のモータ制御用ECU202Aでは、以下の(1),(2)において、図2のモータ制御用ECU202と異なっている。
(1)モータ制御用ECU202Aのマイクロコンピュータ50には、機能処理部として、目標仮想ばね反力設定部52が追加されている。
(2)手動操舵指令値演算部53Aの構成が、図2の手動操舵指令値演算部53の構成と異なる。
 目標仮想ばね反力設定部52は、協調操舵モード時において、上位ECU201から与えられる横偏差eに基づいて、目標仮想ばね反力Ttb,d(e)を設定する。
 図11は、横偏差eに対する目標仮想ばね反力Ttb,d(e)の設定例を示すグラフである。
 横偏差eが-el,s(ただし、el,s>0)からel,sまでの範囲では、目標仮想ばね反力Ttb,d(e)は、-Ttb,d,s(ただし、Ttb,d,s>0)からTtb,d,sまで、横偏差eが大きいほど大きくなるように設定されている。この例では、目標仮想ばね反力Ttb,d(e)は、線形的に変化しているが、非線形的に変化してもよい。
 横偏差el,sからel,m(ただし、el,m>el,s)までの範囲では、目標仮想ばね反力Ttb,d(e)は、Ttb,d,sからTtb,d,m(ただし、Ttb,d,m>Ttb,d,s)まで、横偏差eが大きいほど大きくなるように設定されており、横偏差eが-el,sからel,sまでの範囲と比較して、直線の傾きが大きくなるように設定されている。この例では、目標仮想ばね反力Ttb,d(e)は、線形的に変化しているが、非線形的に変化してもよい。横偏差eがel,mより大きい範囲では、目標仮想ばね反力Ttb,d(e)は、Ttb,d,mに設定されている。
 横偏差eが-el,sから-el,m(ただし、-el,m<-el,s)までの範囲では、目標仮想ばね反力Ttb,d(e)は、-Ttb,d,sから-Ttb,d,m(ただし、-Ttb,d,m<-Ttb,d,s)まで、横偏差eが小さいほど小さくなるように設定されており、横偏差eが-el,sからel,sまでの範囲と比較して、直線の傾きが大きくなるように設定されている。この例では、目標仮想ばね反力Ttb,d(e)は、線形的に変化しているが、非線形的に変化してもよい。横偏差eが-el,mより小さい範囲では、目標仮想ばね反力Ttb,d(e)は、-Ttb,d,mに設定されている。
 図11のグラフの-el,sからel,sまでの範囲はLCA制御用の特性として設定し、それ以外の範囲はLKA制御用の特性として設定してもよい。
 目標仮想ばね反力設定部52によって設定される目標仮想ばね反力Ttb,d(e)は、手動操舵指令値演算部53Aに与えられる。手動操舵指令値演算部53Aには、トーションバートルクTtb、自動操舵指令値θadおよび目標仮想ばね反力Ttb,d(e)が与えられる。第1変形例では、手動操舵指令値演算部53Aに、アシストトルク指令値Tasは与えられない。ただし、前述の実施形態と同様に、手動操舵指令値演算部53Aに、アシストトルク指令値Tasが与えられてもよい。
 図12は、手動操舵指令値演算部53Aの構成を示すブロック図である。図12において、前述の図5の各部に対応する部分には、図5と同じ符号を付して示す。
 手動操舵指令値演算部53Aは、2階微分部102と、慣性乗算部103と、加減算部104と、慣性除算部105と、第1積分部106と、第2積分部107と、1階微分部108と、加算部109と、仮想ダンパ反力演算部110とを含む。手動操舵指令値演算部53Aは、図5の減速比乗算部101および仮想ばね反力演算部111を備えていない。
 加減算部104には、トーションバートルクTtbと、目標仮想ばね反力設定部52によって設定される目標仮想ばね反力Ttb,d(e)と、自動操舵指令値θadに対する慣性モーメントJmd・dθad/dtと、仮想ダンパ反力演算部110から与えられる仮想ダンパ反力cmd(dθmd/dt+dθad/dt)とが入力する。
 加減算部104は、トーションバートルクTtbから、目標仮想ばね反力Ttb,d(e)と、自動操舵指令値θadに対する慣性モーメントJmd・dθad/dtと、仮想ダンパ反力cmd(dθmd/dt+dθad/dt)とを減算する。これにより、加減算部104は、前記式(2)の左辺のJmd・dθcol/dtに相当する慣性モーメントJmd・dθmd/dt(=Ttb-Jmd・dθad/dt-cmd(dθmd/dt+dθad/dt)-Ttb,d(e))を演算する。
 慣性除算部105は、加減算部104によって演算された慣性モーメントJmd・dθmd/dtをコラム慣性Jmdで除算することにより、手動操舵指令値θmdの2階微分値dθmd/dtを演算する。
 第1積分部106は、手動操舵指令値θmdの2階微分値dθmd/dtを積分することにより、手動操舵指令値θmdの1階微分値dθmd/dtを演算する。
 第2積分部107は、手動操舵指令値θmdの1階微分値dθmd/dtを積分することにより、手動操舵指令値θmdを演算する。この手動操舵指令値θmdが、手動操舵指令値演算部53Aから出力される。
 1階微分部108は、自動操舵指令値θadを1階微分する。
 加算部109は、第1積分部106よって演算された手動操舵指令値θmdの1階微分値dθmd/dtに、1階微分部108によって演算された自動操舵指令値θadの1階微分値dθad/dtを加算する。
 仮想ダンパ反力演算部110は、加算部109の加算結果(dθmd/dt+dθad/dt)に粘性減衰係数cmdを乗算することにより、仮想ダンパ反力cmd(dθmd/dt+dθad/dt)を演算する。この仮想ダンパ反力cmd(dθmd/dt+dθad/dt)は、加減算部104にフィードバックされる。
 つまり、手動操舵指令値演算部53Aは、次式(14)の運動方程式に基づいて、手動操舵指令値θmdを演算する。
Figure JPOXMLDOC01-appb-M000014
 式(14)において、Jmd・dθmd/dt+Jmd・dθad/dtは、慣性モーメントである。cmd・dθmd/dt+cmd・dθad/dtは、仮想ダンパ反力である。Ttb,d(e)は、目標仮想ばね反力である。
 つまり、手動操舵指令値演算部53Aは、前記式(2)のN・Tを0とし、前記式(2)の慣性モーメントJmd・dθcol/dt、仮想ダンパ反力cmd・dθcol/dtおよび仮想ばね反力kmd・θcolとして、それぞれ、(Jmd・dθmd/dt+Jmd・dθad/dt)、(cmd・dθmd/dt+cmd・dθad/dt)およびTtb,d(e)を用いて、手動操舵指令値θmdを演算する。
 第1変形例では、前記実施形態と同様の効果を奏する。
 第1変形例では、さらに、協調操舵モード時において、走行車線の中央からの距離または車線までの距離を、ドライバが認識しやすくなるという効果を奏する。以下、この点について説明する。
 前述の比較方法では、仮想ばね反力として、仮想ばねのばね定数kmdにロアコラムJmdの回転角θcol(手動操舵指令値θmd)を乗算した値が用いられている。このため、ばね定数として車両基準位置の横位置に応じた値を用いたとしても、仮想ばね反力として車両基準位置の横位置に応じたトルクを設定することはできない。このため、比較方法では、協調制御モード時には、仮想ばね反力kmd・θcol(=kmd・θmd)は、成り行き任せの反力となる。
 第1変形例では、協調操舵モード時には、手動操舵指令値演算部53は、前記式(2)の運動方程式における仮想ばね反力kmd・θmdとして、横偏差eに応じた目標仮想ばね反力Ttb,d(e)を用いて、手動操舵指令値θmdを演算している。これにより、協調操舵モード時において、横偏差eに対応した操舵反力をドライバに与えることができる。これにより、ドライバは、走行車線の中央からの距離または車線までの距離を認識しやすくなる。
 操舵モードの切り替えは、モードスイッチ31,32によって行われているが、上位ECU201が、運転支援機能または自動運転機能のON/OFF信号、障害物、ドライバ状態、アクセル・ブレーキなどのドライバ操作および車両の走行状態に応じて操舵モードの切り替えるようにしてもよい。この場合には、上位ECU201が、運転支援機能または自動運転機能のON/OFF信号、障害物、ドライバ状態、アクセル・ブレーキなどのドライバ操作および車両の走行状態に応じてモード設定信号を生成して、モータ制御用ECU202に与える。
 例えば、車両を車線内に維持させるためのレーン・キーピング・アシスト制御が行われる場合には、次のようにして、上位ECU201は、操舵モードを自動的に切り替えるようにしてもよい。
 図11を参照して、横偏差eが、-el,sからel,sまでの範囲内にあるときには、上位ECU201は、操舵モードを手動操舵モードに設定する。これにより、第1スイッチ56がオンとなり、第2スイッチ57がオフとなる。この場合には、第2スイッチ57がオフとなるので、図11の-el,sからel,sまでの範囲内の目標仮想ばね反力Ttb,d(e)は、操舵反力として反映されなくなる。
 一方、横偏差eが、-el,sからel,sまでの範囲外にあるときには、上位ECU201は、操舵モードを協調操舵モードに設定する。これにより、第2スイッチ57がオンとなり、第1スイッチ56がオフとなる。この場合には、第2スイッチ57がオンとなるので、図11の-el,sからel,sまでの範囲外の目標仮想ばね反力Ttb,d(e)は、操舵反力として反映される。
 このように操舵モードが自動的に切り替えられる場合には、横偏差eが、-el,sからel,sまでの範囲外にあるという条件下において、手動操舵指令値演算部53Aは、前記式(2)の運動方程式における仮想ばね反力k・θmdとして、横偏差eに応じた目標仮想ばね反力Ttb,d(e)を用いて、手動操舵指令値θmdを演算する。
 図13は、モータ制御用ECUの第2変形例を示すブロック図である。図13において、前述の図2の各部に対応する部分には、図2と同じ符号を付して示す。
 モータ制御用ECUとして図13のモータ制御用ECU202Bが用いられる場合には、モータ制御用ECUとして図10のモータ制御用ECU202Aが用いられる場合と同様に、上位ECU201は、モード信号Smode、自動操舵指令値θadおよび横偏差eを出力する。
 図13のモータ制御用ECU202Bでは、以下の(1),(2)において、図2のモータ制御用ECU202と異なっている。
(1)モータ制御用ECU202Bのマイクロコンピュータ20には、機能処理部としてLCA用目標仮想ばね反力設定部52Aが追加されている。
(2)手動操舵指令値演算部53Bの構成が、図2の手動操舵指令値演算部53の構成と異なる。
 LCA用目標仮想ばね反力設定部52Aは、協調操舵モード時において、上位ECU201から与えられる横偏差eに基づいて、レーン・センタリング・アシスト用のLCA用目標仮想ばね反力Ttb,_LCA(e)を設定する。
 図14は、横偏差eに対するLCA用目標仮想ばね反力Ttb,_LCA(e)の設定例を示すグラフである。
 LCA用目標仮想ばね反力Ttb,d_LCA(e)は、横偏差(e)が0のときには、0に設定される。車両基準位置が右側車線境界にあるときの横偏差(e)をel,maxとし、車両基準位置が左側車線境界にあるときの横偏差(e)を-el,maxとする。LCA用目標仮想ばね反力Ttb,d_LCA(e)は、横偏差(e)がel,maxのときには、所定の最大値Ttb,d_LCA,maxに設定され、横偏差(e)が-el,maxのときには、-Ttb,d_LCA,maxに設定される。
 横偏差(e)が0からel,maxまでの範囲においては、LCA用目標仮想ばね反力Ttb,d_LCA(e)は、0からTtb,d_LCA,maxまで、横偏差(e)が大きくなるほど大きくなるように設定される。横偏差eが0から-el,maxまでの範囲においては、LCA用目標仮想ばね反力Ttb,d_LCA(e)は、0から-Ttb,d_LCA,maxまで、横偏差(e)が小さくなるほど小さくなるように設定される。この例では、LCA用目標仮想ばね反力Ttb,d_LCA(e)は、線形的に変化しているが、非線形的に変化してもよい。
 LCA用目標仮想ばね反力設定部52Aによって設定されるLCA用目標仮想ばね反力Ttb,d_LCA(e)は、手動操舵指令値演算部53Bに与えられる。手動操舵指令値演算部53Bには、トーションバートルクTtb、自動操舵指令値θadおよびLCA用目標仮想ばね反力Ttb,d_LCA(e)が与えられる。第2変形例では、手動操舵指令値演算部53Bに、アシストトルク指令値Tasは与えられない。ただし、前述の実施形態と同様に、手動操舵指令値演算部53Bに、アシストトルク指令値Tasが与えられてもよい。
 図15は、手動操舵指令値演算部53Bの構成を示すブロック図である。図15において、前述の図5の各部に対応する部分には、図5と同じ符号を付して示す。
 手動操舵指令値演算部53Bは、2階微分部102と、慣性乗算部103と、加減算部104と、慣性除算部105と、第1積分部106と、第2積分部107と、1階微分部108と、第1加算部109と、仮想ダンパ反力演算部110と、第2加算部112と、仮想ばね反力演算部111とを含む。手動操舵指令値演算部53Bは、図5の減速比乗算部101を備えていない。
 加減算部104には、トーションバートルクTtbと、LCA用目標仮想ばね反力設定部52Aによって設定されるLCA用目標仮想ばね反力Ttb,d_LCA(e)と、自動操舵指令値θadに対する慣性モーメントJmd・dθad/dtと、仮想ダンパ反力演算部110から与えられる仮想ダンパ反力cmd・(dθmd/dt+dθad/dt)と、仮想ばね反力演算部111から与えられる仮想ばね反力kmd・(θmd+θad)とが入力する。
 加減算部104は、トーションバートルクTtbから、LCA用目標仮想ばね反力Ttb,d_LCA(e)と、自動操舵指令値θadに対する慣性モーメントJmd・dθad/dtと、仮想ダンパ反力cmd・(dθmd/dt+dθad/dt)と、仮想ばね反力kmd・(θmd+θad)とを減算する。これにより、加減算部104は、前記式(2)の左辺のJmd・dθcol/dtに相当する慣性モーメントJmd・dθmd/dt(=Ttb-Jmd・dθad/dt-cmd・(dθmd/dt+dθad/dt)-kmd・(θmd+θad)-Ttb,d_LCA(e))を演算する。
 慣性除算部105は、加減算部104によって演算された慣性モーメントJmd・dθmd/dtをコラム慣性Jmdで除算することにより、手動操舵指令値θmdの2階微分値dθmd/dtを演算する。
 第1積分部106は、手動操舵指令値θmdの2階微分値dθmd/dtを積分することにより、手動操舵指令値θmdの1階微分値dθmd/dtを演算する。
 第2積分部107は、手動操舵指令値θmdの1階微分値dθmd/dtを積分することにより、手動操舵指令値θmdを演算する。この手動操舵指令値θmdが、手動操舵指令値演算部53Bから出力される。
 1階微分部108は、自動操舵指令値θadを1階微分する。
 第1加算部109は、第1積分部106よって演算された手動操舵指令値θmdの1階微分値dθmd/dtに、1階微分部108によって演算された自動操舵指令値θadの1階微分値dθad/dtを加算する。
 仮想ダンパ反力演算部110は、第1加算部109の加算結果(dθmd/dt+dθad/dt)に粘性減衰係数cmdを乗算することにより、仮想ダンパ反力cmd(dθmd/dt+dθad/dt)を演算する。この仮想ダンパ反力cmd(dθmd/dt+dθad/dt)は、加減算部104にフィードバックされる。
 第2加算部112は、第2積分部107よって演算された手動操舵指令値θmdに、自動操舵指令値θadを加算する。
 仮想ばね反力演算部111は、第2加算部112の加算結果(θmd+θad)にばね定数kmdを乗算することにより、仮想ばね反力kmd(θmd+θad)を演算する。この仮想ばね反力kmd(θmd+θad)は、加減算部104にフィードバックされる。
 つまり、手動操舵指令値演算部53Bは、次式(15)の運動方程式に基づいて、手動操舵指令値θmdを演算する。
Figure JPOXMLDOC01-appb-M000015
 式(15)において、Jmd・dθmd/dt+Jmd・dθad/dtは、慣性モーメントである。cmd・dθmd/dt+cmd・dθad/dtは、仮想ダンパ反力である。kmd・θmd+kmd・θadは、仮想ばね反力である。Ttb,d_LCA(e)は、LCA用目標仮想ばね反力である。
 つまり、手動操舵指令値演算部53Aは、前記式(2)のN・Tを0とし、前記式(2)の慣性モーメントJmd・dθcol/dt、仮想ダンパ反力cmd・dθcol/dtおよび仮想ばね反力kmd・θcolとして、それぞれ、(Jmd・dθmd/dt+Jmd・dθad/dt)、(cmd・dθmd/dt+cmd・dθad/dt)および(kmd・θmd+kmd・θad+Ttb,d_LCA(e))を用いて、手動操舵指令値θmdを演算する。
 第2変形例では、前記実施形態と同様の効果を奏する。
 第2変形例では、運動方程式(式(15))は、仮想ばね反力として、手動操舵指令値θmdに対する仮想ばね反力kmd・dθmd/dtに加えて自動操舵指令値θadに対する仮想ばね反力kmd・dθad/dtを含む。これにより、手動操舵指令値θmdに対する仮想ばね反力kmd・dθmd/dtに含まれる自動操舵成分を低下させることができるので、ドライバの違和感をより低減できる。
 第2変形例では、さらに、協調操舵モード時において、走行車線の中央からの距離または車線までの距離を、ドライバが認識しやすくなるという効果を奏する。以下、この点について説明する。
 前述したように、前述の比較方法では、協調制御モード時には、仮想ばね反力k・θcol(=k・θmd)は、成り行き任せの反力となる。
 第2変形例では、協調操舵モード時には、手動操舵指令値演算部53は、前記式(2)の運動方程式における仮想ばね反力k・θmdの代わりに、(kmd・θmd+kmd・θad+Ttb,d_LCA(e))を用いて、手動操舵指令値θmdを演算している。Ttb,d_LCA(e)は、横偏差eに応じたLCA用目標仮想ばね反力である。これにより、協調操舵モード時において、横偏差eに対応した操舵反力をドライバに与えることができる。これにより、ドライバは、走行車線の中央からの距離または車線までの距離を認識しやすくなる。
 図13および図15の手動操舵指令値演算部53Bの代わりに、図16に示す手動操舵指令値演算部53Cを用いてもよい。図16において、前述の図15の各部に対応する部分には、図15と同じ符号を付して示す。
 図13および図15の手動操舵指令値演算部53Bの代わりに、図16に示す手動操舵指令値演算部53Cが用いられたモータ制御用ECUを、第3変形例に係るモータ制御用ECU202C(図13参照)ということにする。
 第3変形例に係るモータ制御用ECU202Cにおいては、手動操舵指令値演算部53Cには、Ttb、Ttb,d_LCA(e)およびθadに加えて、図13に破線で示すように、角度制御部55内の第2減速比除算部70(図6参照)によって演算される実操舵角θが入力される。
 図16を参照して、手動操舵指令値演算部53Cは、2階微分部102と、慣性乗算部103と、加減算部104と、慣性除算部105と、第1積分部106と、第2積分部107と、1階微分部108と、仮想ダンパ反力演算部110と、仮想ばね反力演算部111とを含む。手動操舵指令値演算部53Cは、図15の第1加算部109および第2加算部112を備えていない。
 加減算部104には、トーションバートルクTtbと、LCA用目標仮想ばね反力設定部52Aによって設定されるLCA用目標仮想ばね反力Ttb,d_LCA(e)と、自動操舵指令値θadに対する慣性モーメントJmd・dθad/dtと、仮想ダンパ反力演算部110から与えられる仮想ダンパ反力cmd・dθ/dtと、仮想ばね反力演算部111から与えられる仮想ばね反力kmd・θとが入力する。
 加減算部104は、トーションバートルクTtbから、LCA用目標仮想ばね反力Ttb,d_LCA(e)と、自動操舵指令値θadに対する慣性モーメントJmd・dθad/dtと、仮想ダンパ反力cmd・dθ/dtと、仮想ばね反力kmd・θとを減算する。これにより、加減算部104は、前記式(2)の左辺のJmd・dθcol/dtに相当する慣性モーメントJmd・dθmd/dt(=Ttb-Jmd・dθad/dt-cmd・dθ/dt-kmd・θ-Ttb,d_LCA(e))を演算する。
 慣性除算部105は、加減算部104によって演算された慣性モーメントJmd・dθmd/dtをコラム慣性Jmdで除算することにより、手動操舵指令値θmdの2階微分値dθmd/dtを演算する。
 第1積分部106は、手動操舵指令値θmdの2階微分値dθmd/dtを積分することにより、手動操舵指令値θmdの1階微分値dθmd/dtを演算する。
 第2積分部107は、手動操舵指令値θmdの1階微分値dθmd/dtを積分することにより、手動操舵指令値θmdを演算する。この手動操舵指令値θmdが、手動操舵指令値演算部53Cから出力される。
 1階微分部108は、実操舵角θを1階微分する。
 仮想ダンパ反力演算部110は、実操舵角θの1階微分値dθ/dtに粘性減衰係数cmdを乗算することにより、仮想ダンパ反力cmd・dθ/dtを演算する。この仮想ダンパ反力cmd・dθ/dtは、加減算部104にフィードバックされる。
 仮想ばね反力演算部111は、実操舵角θにばね定数kmdを乗算することにより、仮想ばね反力kmd・θを演算する。この仮想ばね反力kmd・θは、加減算部104にフィードバックされる。
 つまり、手動操舵指令値演算部53Bは、次式(16)の運動方程式に基づいて、手動操舵指令値θmdを演算する。
Figure JPOXMLDOC01-appb-M000016
 式(16)において、Jmd・dθmd/dt+Jmd・dθad/dtは、慣性モーメントである。cmd・dθ/dtは、仮想ダンパ反力である。kmd・θは、仮想ばね反力である。Ttb,d_LCA(e)は、LCA用目標仮想ばね反力である。
 つまり、手動操舵指令値演算部53Aは、前記式(2)のN・Tを0とし、前記式(2)の慣性モーメントJmd・dθcol/dt、仮想ダンパ反力cmd・dθcol/dtおよび仮想ばね反力kmd・θcolとして、それぞれ、(Jmd・dθmd/dt+Jmd・dθad/dt)、cmd・dθ/dtおよびkmd・θ+Ttb,d_LCA(e)を用いて、手動操舵指令値θmdを演算する。
 第3変形例では、前記式(2)の慣性モーメントJmd・dθcol/dtの代わりに(Jmd・dθmd/dt+Jmd・dθad/dt)が用いられているので、手動操舵指令値θmdに応じた慣性モーメントJmd・dθmd/dtに含まれる自動操舵成分Jmd・dθad/dtを低減することができる。
 また、第3変形例では、仮想ダンパ反力cmd・dθcol/dtの代わりに、実舵角θの1階微分値dθ/dtに応じた仮想ダンパ反力cmd・dθ/dtが用いられているので、仮想ダンパ反力に自動操舵成分は含まれない。また、仮想ばね反力kmd・θcolの代わりに、実舵角θに応じた仮想ばね反力kmd・θが用いられているので、仮想ばね反力に自動操舵成分は含まれない。これにより、第3変形例では、協調操舵モード時に、ドライバの違和感を低減することができる。
 以上、本開示の実施形態および変形例について説明したが、本開示はさらに他の形態で実施することもできる。
 前述の実施形態では、前記式(3),(15),(16)におけるばね定数kmdは、予め実験、解析等によって求められている。しかし、前記式(3),(15),(16)におけるばね定数kmdは、外乱トルク推定部64(図6参照)によって演算される外乱トルク推定値^Tlcと、第2減速比除算部70によって演算される実操舵角θとを用いて、次式(17)に基づいて、演算されてもよい。
Figure JPOXMLDOC01-appb-M000017
 また、前述の実施形態では、前記式(3),(14),(15),(16)における粘性減衰係数cmdは、予め実験、解析等によって求められている。
 しかし、前記式(3),(14),(15),(16)における粘性減衰係数cmdは、外乱トルク推定部64によって演算される外乱トルク推定値^Tlcと、第2減速比除算部70によって演算される実操舵角θとを用いて、次式(18)に基づいて、演算されてもよい。
Figure JPOXMLDOC01-appb-M000018
 また、前述の実施形態では、角度制御部55(図6参照)は、フィードフォワード制御部63を備えているが、フィードフォワード制御部63を省略してもよい。この場合には、フィードバック制御部62によって演算されるフィードバック制御トルクTfbが基本目標トルクとなる。
 また、前述の実施形態では、本開示をコラムタイプEPSのモータ制御に適用した場合の例を示したが、本開示は、コラムタイプ以外のEPSのモータ制御にも適用することができる。また、本開示は、ステアバイワイヤシステムの転舵角制御用の電動モータの制御にも適用することができる。
 本開示の実施形態について詳細に説明してきたが、これらは本開示の技術的内容を明らかにするために用いられた具体例に過ぎず、本開示はこれらの具体例に限定して解釈されるべきではなく、本開示の範囲は添付の請求の範囲によってのみ限定される。
 1…電動パワーステアリング装置、3…転舵輪、4…転舵機構、18…電動モータ、51…アシストトルク指令値設定部、52…目標仮想ばね反力設定部、52A…LCA用目標仮想ばね反力設定部、53,53A,53B,53C…手動操舵指令値演算部、54…統合角度指令値演算部、55…角度制御部、56…減算部、56…第1スイッチ、57…第2スイッチ、58…加算部、59…トルク制御部、201…上位ECU、202,202A,202B,202C…モータ制御用ECU

Claims (4)

  1.  操舵装置の電動モータを駆動制御するためのモータ制御装置であって、
     トーションバートルクを用いて手動操舵指令値を演算する手動操舵指令値演算部と、
     運転支援用の自動操舵指令値に前記手動操舵指令値を加算して、統合角度指令値を演算する統合角度指令値演算部と、
     前記統合角度指令値に基づいて、前記電動モータを駆動制御する制御部とを含み、
     運転支援モードにおいて、前記手動操舵指令値演算部は、前記操舵装置のリファレンスモデルの運動方程式を利用して前記手動操舵指令値を演算するように構成されており、
     前記手動操舵指令値演算部は、前記運動方程式における仮想ダンパ反力として、前記手動操舵指令値の微分値に応じた仮想ダンパ反力に、前記自動操舵指令値の微分値に応じた仮想ダンパ反力が付加された仮想ダンパ反力を用いて、前記手動操舵指令値を演算する、モータ制御装置。
  2.  前記手動操舵指令値演算部は、前記手動操舵指令値を演算する際に、前記運動方程式における仮想ばね反力として、車両基準位置の走行車線に対する横位置に応じた目標仮想ばね反力を用いる、請求項1に記載のモータ制御装置。
  3.  前記手動操舵指令値演算部は、前記運動方程式における仮想ばね反力として、前記手動操舵指令値に応じた仮想ばね反力に、前記自動操舵指令値に応じた仮想ばね反力が付加された仮想ばね反力を用いて、前記手動操舵指令値を演算する、請求項1にモータ制御装置。
  4.  前記手動操舵指令値演算部は、前記運動方程式における慣性モーメントとして、前記手動操舵指令値に応じた慣性モーメントに、前記自動操舵指令値に応じた慣性モーメントが付加された慣性モーメントを用いて、前記手動操舵指令値を演算する、請求項1~3のいずれか一項に記載のモータ制御装置。
PCT/JP2023/023082 2023-06-22 2023-06-22 モータ制御装置 Pending WO2024261947A1 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/JP2023/023082 WO2024261947A1 (ja) 2023-06-22 2023-06-22 モータ制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2023/023082 WO2024261947A1 (ja) 2023-06-22 2023-06-22 モータ制御装置

Publications (1)

Publication Number Publication Date
WO2024261947A1 true WO2024261947A1 (ja) 2024-12-26

Family

ID=93935189

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2023/023082 Pending WO2024261947A1 (ja) 2023-06-22 2023-06-22 モータ制御装置

Country Status (1)

Country Link
WO (1) WO2024261947A1 (ja)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016162902A1 (ja) * 2015-04-09 2016-10-13 日産自動車株式会社 車線維持支援装置
WO2023286169A1 (ja) 2021-07-13 2023-01-19 株式会社ジェイテクト モータ制御装置
WO2023079765A1 (ja) * 2021-11-08 2023-05-11 株式会社ジェイテクト モータ制御装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016162902A1 (ja) * 2015-04-09 2016-10-13 日産自動車株式会社 車線維持支援装置
WO2023286169A1 (ja) 2021-07-13 2023-01-19 株式会社ジェイテクト モータ制御装置
WO2023079765A1 (ja) * 2021-11-08 2023-05-11 株式会社ジェイテクト モータ制御装置

Similar Documents

Publication Publication Date Title
EP3608203B1 (en) Motor control apparatus
JP7194326B2 (ja) モータ制御装置
CN110406589B (zh) 马达控制装置
JP7129004B2 (ja) モータ制御装置
JP7256958B2 (ja) 電動パワーステアリング装置
JP7129003B2 (ja) モータ制御装置
WO2023286592A1 (ja) モータ制御装置
JP7769862B2 (ja) モータ制御装置
JP7695632B2 (ja) モータ制御装置
JP7769889B2 (ja) モータ制御装置
US11745792B2 (en) Steering device
EP4620779A1 (en) Motor control device
WO2023079765A1 (ja) モータ制御装置
JP7681245B2 (ja) 操舵装置
JP7737610B2 (ja) モータ制御装置
WO2024261947A1 (ja) モータ制御装置
WO2024261946A1 (ja) モータ制御装置
WO2024257466A1 (ja) モータ制御装置
JP7755798B2 (ja) モータ制御装置
JP7769888B2 (ja) モータ制御装置
WO2024224627A1 (ja) モータ制御装置
CN121399847A (en) Motor control device
WO2024252630A1 (ja) モータ制御装置
WO2025233992A1 (ja) モータ制御装置
JP2025140644A (ja) モータ制御装置

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 23941828

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2025527335

Country of ref document: JP

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 2025527335

Country of ref document: JP