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

モータ制御装置 Download PDF

Info

Publication number
WO2023079765A1
WO2023079765A1 PCT/JP2021/041059 JP2021041059W WO2023079765A1 WO 2023079765 A1 WO2023079765 A1 WO 2023079765A1 JP 2021041059 W JP2021041059 W JP 2021041059W WO 2023079765 A1 WO2023079765 A1 WO 2023079765A1
Authority
WO
WIPO (PCT)
Prior art keywords
command value
torque
steering
vehicle
lateral position
Prior art date
Application number
PCT/JP2021/041059
Other languages
English (en)
French (fr)
Inventor
祥馬 枝元
勉 田村
ロバート フックス
ミツコ ヨシダ
Original Assignee
株式会社ジェイテクト
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 株式会社ジェイテクト filed Critical 株式会社ジェイテクト
Priority to PCT/JP2021/041059 priority Critical patent/WO2023079765A1/ja
Priority to PCT/JP2022/020124 priority patent/WO2023079776A1/ja
Priority to JP2023557616A priority patent/JPWO2023079776A1/ja
Priority to CN202280074453.1A priority patent/CN118284551A/zh
Publication of WO2023079765A1 publication Critical patent/WO2023079765A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D15/00Steering not otherwise provided for
    • B62D15/02Steering position indicators ; Steering position determination; Steering aids
    • B62D15/025Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/008Control of feed-back to the steering input member, e.g. simulating road feel in steer-by-wire applications
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D5/00Power-assisted or power-driven steering
    • B62D5/04Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
    • B62D5/0457Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such
    • B62D5/046Controlling the motor
    • B62D5/0463Controlling the motor calculating assisting torque from the motor based on driver input
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/002Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits computing target steering angles for front or rear wheels

Definitions

  • the present invention relates to a motor control device that drives and controls an electric motor for steering angle control.
  • Patent Document 1 discloses the following vehicle steering system. That is, the steering assist current is calculated in the driving assistance mode. Also, the degree of risk is calculated, and the steering reaction force gain is calculated based on the degree of risk. Further, the steering reaction force control current is calculated by multiplying the deviation between the target steering angle for steering assistance and the steering angle by the steering reaction force gain, and the steering assist correction gain is calculated based on the steering reaction force gain. . Then, by adding the value obtained by multiplying the steering assist current by the steering assist correction gain and the steering reaction force control current, the actuator drive current is calculated, and the actuator (electric motor) is driven and controlled based on the actuator drive current. . Thereby, a reaction force corresponding to the risk is generated and the risk state is transmitted to the driver.
  • An object of an embodiment of the present invention is to provide a motor control device that can apply a steering reaction force to the driver in a novel manner during the driving assistance mode.
  • One embodiment of the present invention is a motor control device for driving and controlling an electric motor for steering angle control, comprising: an assist torque command value generation unit that generates an assist torque command value using a steering torque; A manual steering command value generation unit that generates a manual steering command value using the torque and the assist torque command value, and a combined angle command value is calculated by adding the manual steering command value to the automatic steering command value for driving support.
  • a first control mode for controlling the electric motor based on the assist torque command value or the manual steering command value in the driving support mode; and the integrated angle command value based on the integrated angle command value.
  • a second control mode for controlling an electric motor and a switching unit for switching according to a lateral position of a vehicle with respect to a lane are provided.
  • 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 invention is applied.
  • FIG. 2 is a block diagram showing the electrical configuration of the motor control ECU.
  • FIG. 3 is a graph showing a setting example of the assist torque command value T asst with respect to the torsion bar torque Ttb .
  • FIG. 4 is a schematic diagram showing an example of a reference EPS model used in the manual steering command value generator.
  • FIG. 5 is a graph showing a setting example of the virtual load spring component k vl with respect to the vehicle lateral position P lat .
  • FIG. 6 is a graph showing a setting example of the virtual load viscous damping coefficient cvl with respect to the vehicle lateral position P lat .
  • FIG. 7 is a block diagram showing the configuration of the angle control section.
  • FIG. 8 is a schematic diagram showing a configuration example of a physical model of the electric power steering system.
  • FIG. 9 is a block diagram showing the configuration of the disturbance torque estimator.
  • FIG. 10 is a schematic diagram showing the configuration of the torque control section.
  • FIG. 11 is a flow chart showing the procedure of weight setting processing performed by the weight setting unit in the driving assistance mode.
  • FIG. 12 is a graph showing an example of the relationship between the vehicle lateral position P lat and the absolute value
  • FIG. 13 is a schematic diagram for explaining the steering reaction force generated based on the road load torque Trl in the driving support mode.
  • One embodiment of the present invention is a motor control device for driving and controlling an electric motor for steering angle control, comprising: an assist torque command value generation unit that generates an assist torque command value using a steering torque; A manual steering command value generation unit that generates a manual steering command value using the torque and the assist torque command value, and a combined angle command value is calculated by adding the manual steering command value to the automatic steering command value for driving support.
  • a second control mode for controlling an electric motor and a switching unit for switching according to a lateral position of a vehicle with respect to a lane are provided.
  • An embodiment of the present invention includes an electric motor for steering angle control and a control device for driving and controlling the electric motor, and the control device uses steering torque to generate an assist torque command value.
  • a torque command value generator a manual steering command value generator that generates a manual steering command value using the steering torque and the assist torque command value; an integrated angle command value calculation unit for calculating an integrated angle command value; a first control mode for controlling the electric motor based on the assist torque command value or the manual steering command value in a driving assistance mode; a second control mode for controlling the electric motor based on the integrated angle command value; and a switching unit for switching according to the lateral position of the vehicle with respect to the lane.
  • the first lateral position is the lateral position at which the first control mode is switched to the second control mode
  • the lateral position is the lateral position at which the second control mode is switched to the first control mode.
  • the second lateral position is set to a different position.
  • the manual steering command value is configured to be calculated in consideration of the virtual road load torque.
  • the virtual road load torque is set according to the lateral position of the vehicle with respect to the lane.
  • the virtual road load torque is set based on information on the outside of the lane in which the vehicle is traveling.
  • FIG. 1 is a schematic diagram showing a schematic configuration of an electric power steering system to which a steering device according to one embodiment of the present invention is applied.
  • An electric power steering system 1 includes a steering wheel (handle) 2 as a steering member for steering a vehicle, a steering mechanism 4 for steering wheels 3 in conjunction with the rotation of the steering wheel 2, and a driver. and a steering assist mechanism 5 for assisting the steering of the vehicle.
  • the steering wheel 2 and 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 relatively rotatable.
  • a torque sensor 12 is arranged near the torsion bar 10 .
  • Torque sensor 12 detects torsion bar torque Ttb applied to steering wheel 2 based on relative rotational displacement amounts of input shaft 8 and output shaft 9 .
  • the torsion bar torque Ttb detected by the torque sensor 12 is such that the torque for leftward steering is detected as a positive value and the torque for rightward steering is detected as a negative value. It is assumed that the torsion bar torque Ttb increases as the absolute value increases.
  • the torsion bar torque Ttb is an example of the "steering torque" of the present invention.
  • the steering mechanism 4 consists 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 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 along the lateral direction of the vehicle.
  • a rack 17 that meshes with the pinion 16 is formed in the axially intermediate portion of the rack shaft 14 .
  • the pinion 16 and rack 17 convert the rotation of the pinion shaft 13 into axial movement of the rack shaft 14 .
  • the steerable wheels 3 can be steered.
  • the steering assist mechanism 5 includes an electric motor 18 for generating a steering assist force (assist torque) and a speed reducer 19 for amplifying the output torque of the electric motor 18 and transmitting it to the steering mechanism 4 .
  • the speed reducer 19 comprises a worm gear mechanism including a worm gear 20 and a worm wheel 21 meshing with the worm gear 20 .
  • the speed reducer 19 is accommodated in a gear housing 22 as a transmission mechanism housing.
  • the reduction ratio (gear ratio) of the speed reducer 19 may be represented by N.
  • the reduction ratio N is defined as the ratio ( ⁇ wg / ⁇ ww ) of the worm gear angle ⁇ wg that is the rotation angle of the worm gear 20 to the worm wheel angle ⁇ ww that is the rotation angle of the worm wheel 21 .
  • the worm gear 20 is rotationally driven by the electric motor 18 . Also, the worm wheel 21 is connected to the output shaft 9 so as to be rotatable together.
  • the worm gear 20 When the worm gear 20 is rotationally driven by the electric motor 18, the worm wheel 21 is rotationally driven, motor torque is applied to the steering shaft 6, and the steering shaft 6 (output shaft 9) rotates. Rotation of the steering shaft 6 is transmitted to the pinion shaft 13 via the intermediate shaft 7 . Rotation of the pinion shaft 13 is converted into axial movement of the rack shaft 14 . As a result, the steerable wheels 3 are steered. That is, by rotationally driving the worm gear 20 with the electric motor 18, the steering assistance with the electric motor 18 and the steering of the steerable wheels 3 become possible.
  • the electric motor 18 is provided with a rotation angle sensor 23 for detecting the rotation angle of the rotor of the electric motor 18 .
  • the torque applied to the output shaft 9 includes motor torque by the electric motor 18 and disturbance torque Tlc other than the motor torque.
  • the disturbance torque T lc other than the motor torque includes torsion bar torque T tb , road load torque (road surface reaction torque) T rl , friction torque T f and the like.
  • the torsion bar torque Ttb is torque applied to the output shaft 9 from the steering wheel 2 side due to force applied to the steering wheel 2 by the driver, force generated by steering inertia, or the like.
  • the road load torque Trl is generated by the self-aligning torque generated in the tire, the force generated by the suspension and tire wheel alignment, the frictional force of the rack and pinion mechanism, and the like. is the torque applied to
  • the vehicle has a CCD (Charge Coupled Device) camera 25 that captures the road in front of the vehicle, a GPS (Global Positioning System) 26 that detects the position of the vehicle, and a radar that detects road shapes and obstacles. 27 and a map information memory 28 storing map information.
  • CCD Charge Coupled Device
  • GPS Global Positioning System
  • the CCD camera 25, GPS 26, radar 27, map information memory 28, and vehicle speed sensor 29 are connected to a host ECU (Electronic Control Unit) 201 for driving support control. Based on the information and map information obtained by the CCD camera 25, the GPS 26, the radar 27 and the vehicle speed sensor 29, the host ECU 201 recognizes the surrounding environment, estimates the position of the vehicle, plans routes, etc., and determines control target values for steering and drive actuators. make a decision.
  • ECU Electronic Control Unit
  • the host ECU 201 sets an automatic steering command value ⁇ adac for driving assistance in the driving assistance mode.
  • the driving assistance is Lane Keep Assist (LKA) to avoid the vehicle leaving the lane.
  • the automatic steering command value ⁇ AD ,cmd is a target steering angle value for causing the vehicle to travel along the target travel line.
  • the automatic steering command value ⁇ AD,cmd is set based on, for example, the vehicle speed, the lateral deviation from the target travel line, and the yaw deviation of the vehicle from the target travel line. Since the processing for setting the automatic steering command value ⁇ AD ,cmd is well known, detailed description thereof will be omitted here.
  • the host ECU 201 also outputs a mode signal S mode indicating whether the driving mode is the normal mode or the driving assistance mode, a left/right discrimination signal S LR indicating whether the vehicle reference position is on the left or right side of the center of the lane, and Output the vehicle lateral position P lat .
  • the vehicle reference position is a predetermined reference position at the width center of the vehicle.
  • the vehicle lateral position P lat is the distance from the boundary of the lane in which the vehicle is currently traveling (hereinafter referred to as "lane boundary") to the vehicle reference position. Specifically, when the vehicle reference position is on the left side of the center, the vehicle lateral position P lat is the distance from the left lane boundary to the vehicle reference position. When the vehicle reference position is on the right side of the lane center, the vehicle lateral position P lat is the distance from the right lane boundary to the vehicle reference position.
  • the mode signal S mode , the left/right discrimination signal S LR , the vehicle lateral position P lat and the automatic steering command value ⁇ AD,cmd are given to the motor control ECU 202 via the vehicle-mounted 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 given from the host ECU 201 .
  • FIG. 2 is a block diagram showing the electrical configuration of the motor control ECU 202. As shown in FIG.
  • the motor control ECU 202 includes a microcomputer 40, a drive circuit (inverter circuit) 31 that is controlled by the microcomputer 40 and supplies power to the electric motor 18, and a current flowing through the electric motor 18 (hereinafter referred to as "motor current Im ”) . ) and a current detection circuit 32 for detecting the current.
  • the microcomputer 40 has a CPU and memory (ROM, RAM, non-volatile memory, etc.), and functions as a plurality of functional processing units by executing predetermined programs.
  • the plurality of function processing units include an assist torque command value setting unit 41, a manual steering command value generation unit 42, an integrated angle command value calculation unit 43, an angle control unit 44, a first weight multiplication unit 45, It includes a second weight multiplier 46 , an adder 47 , a torque controller (current controller) 48 , and a weight setter 49 .
  • the first weight multiplication section 45, the second weight multiplication section 46, the addition section 47 and the weight setting section 49 are examples of the "switching section" in the present invention.
  • the assist torque command value setting unit 41 sets an assist torque command value T asst , which is a target value of assist torque required for manual operation.
  • the assist torque command value setting unit 41 sets the assist torque command value T asst based on the torsion bar torque Ttb detected by the torque sensor 12 .
  • a setting example of the assist torque command value T asst for the torsion bar torque Ttb is shown in FIG.
  • the assist torque command value T asst is a positive value when the electric motor 18 should generate a steering assist force for left steering, and when the electric motor 18 should generate a steering assist force for right steering. Negative value.
  • the assist torque command value T asst takes a positive value for a positive value of the torsion bar torque Ttb , and takes a negative value for a negative value of the torsion bar torque Ttb .
  • the assist torque command value T asst is set such that its absolute value increases as the absolute value of the torsion bar torque Ttb increases.
  • the assist torque command value setting unit 41 may acquire the vehicle speed from the host ECU 201 and set the assist torque command value T asst based on the vehicle speed and the torsion bar torque Ttb .
  • the assist torque command value T asst is set according to the torsion bar torque Ttb as described above, and is set such that the greater the vehicle speed V, the smaller the absolute value of the assist torque command value T asst . be done.
  • the assist torque command value setting unit 41 may calculate the assist torque command value T asst by multiplying the torsion bar torque Ttb by a preset constant.
  • the manual steering command value generator 42 When the driver operates the steering wheel 2, the manual steering command value generator 42 generates a steering angle (more precisely, the rotation angle ⁇ of the output shaft 9) corresponding to the steering wheel operation as a manual steering command value ⁇ MD , It is provided to set as cmd .
  • the manual steering command value generator 42 uses the torsion bar torque T tb detected by the torque sensor 12 and the assist torque command value T asst set by the assist torque command value setting unit 41 to generate the manual steering command values ⁇ MD, Generate cmd . Details of the manual steering command value generator 42 will be described later.
  • Integrated angle command value calculation unit 43 adds manual steering command value ⁇ MD, cmd to automatic steering command value ⁇ AD, cmd set by host ECU 201 to calculate integrated angle command value ⁇ int, cmd .
  • the angle control unit 44 calculates integrated motor torque command values T mint, cmd corresponding to the integrated angle command values ⁇ int, cmd. Details of the angle control unit 44 will be described later.
  • the first weight multiplier 45 multiplies the assist torque command value T asst set by the assist torque command value setting unit 41 by the first weight W1.
  • a second weight multiplier 46 multiplies the integrated motor torque command value Tmint ,cmd by a second weight W2.
  • the first weight W1 and the first weight W2 are set by the weight setting section 49 . Details of the weight setting unit 49 will be described later.
  • the addition unit 47 calculates the assist torque command value W1 ⁇ T asst after the first weight multiplication (after the first weighting process) and the integrated motor torque command value W2 ⁇ Tmint after the second weight multiplication (after the second weighting process). , cmd , the motor torque command value Tm , cmd for the electric motor 18 is calculated.
  • the torque control unit 48 drives the drive circuit 31 so that the motor torque of the electric motor 18 approaches the motor torque command value Tm , cmd .
  • the manual steering command value generator 42 sets the manual steering command value ⁇ MD,cmd using the reference EPS model.
  • FIG. 4 is a schematic diagram showing an example of the reference EPS model used in the manual steering command value generator 42.
  • FIG. 4 is a schematic diagram showing an example of the reference EPS model used in the manual steering command value generator 42.
  • This reference EPS model is a single inertia model that includes a lower column.
  • a lower column corresponds to the output shaft 9 and the worm wheel 21 .
  • J ref is the inertia of the lower column
  • T tb is the torsion bar torque.
  • a torsion bar torque T tb , an assist torque command value T asst and a road load torque T rl are applied to the lower column.
  • the rotation angle of the lower column is the manual steering command value ⁇ MD , cmd
  • the road load torque (virtual road load torque) Trl is the virtual load spring stiffness coefficient kvl
  • the virtual load viscous damping coefficient cvl is the manual steering command value ⁇ It is represented by the following formula (1) using MD and cmd .
  • T rl ⁇ k vl ⁇ MD, cmd ⁇ c vl (d ⁇ MD, cmd /dt) (1)
  • k vl k vl (P lat )
  • c vl c vl (P lat )
  • the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl are set corresponding to the vehicle lateral position P lat .
  • FIG. 5 is a graph showing a setting example of the virtual load spring stiffness coefficient k vl with respect to the vehicle lateral position P lat .
  • the suffix L of the symbol in FIG. 5 indicates that the symbol is applied when the vehicle reference position is on the left side of the lane center, and R indicates that the symbol is applied when the vehicle reference position is on the right side of the lane center. applies. The same applies to FIG. 6, which will be described later.
  • the virtual load spring stiffness coefficient kvl is set to a predetermined value kvl,start is set to PL_start is set to about 60 cm, for example.
  • PR_start is set to about 70 cm, for example.
  • the virtual load spring stiffness coefficient kvl is set according to a characteristic that gradually increases from kvl,start to kvl,L_max as the vehicle reference position becomes smaller (as the vehicle reference position approaches the left lane boundary).
  • PL_small is set to about 40 cm, for example.
  • the virtual load spring stiffness coefficient kvl is calculated as follows: is set according to a characteristic that gradually increases from kvl,start to kvl,R_max as the vehicle reference position becomes smaller (as the vehicle reference position approaches the right lane boundary). PR_small is set to about 50 cm, for example.
  • the virtual load spring stiffness coefficient k vl is set to k vl,L_max . If the vehicle lateral position P lat is less than P R_small relative to the right lane boundary, the virtual load spring stiffness coefficient k vl is set to k vl,R_max . The reason why the virtual load spring stiffness coefficient kvl is limited in this way is to prevent the virtual road load torque Trl from becoming too large and the driver unable to intervene in steering.
  • FIG. 6 is a graph showing a setting example of the virtual load viscous damping coefficient c vl with respect to the vehicle lateral position P lat .
  • the virtual load viscous damping coefficient c vl is set to a predetermined value c vl,start is set to
  • the virtual load viscous damping coefficient cvl is set according to a characteristic that gradually increases from cvl,start to cvl,L_max as the vehicle reference position becomes smaller (as the vehicle reference position approaches the left lane boundary).
  • the virtual load viscous damping coefficient cvl is (the vehicle reference position approaches the right lane boundary), the setting is made according to a characteristic that gradually increases from cvl,start to cvl,R_max .
  • the hypothetical load viscous damping coefficient c vl is set to c vl,L_max . If the vehicle lateral position P lat is less than P R_small for the right lane boundary, the hypothetical load viscous damping coefficient c vl is set to c vl,R_max .
  • the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl may be set so that the characteristics of the virtual road load torque Trl change according to the information on the outside of the current lane.
  • the characteristics of the virtual road load torque Trl may change depending on whether there is an adjacent lane to the lane, when there is no adjacent lane to the lane, or when there is a protective fence such as a guardrail for the lane.
  • a virtual load spring stiffness coefficient kvl and a virtual load viscous damping coefficient cvl may be set.
  • the information on the outside of the lane is given from the host ECU 201 to the motor control ECU 202 .
  • FIG. 7 is a block diagram showing the configuration of the angle control section 44. As shown in FIG.
  • the angle control unit 44 calculates an integrated motor torque command value T mint , cmd based on the integrated angle command value ⁇ int, cmd.
  • the angle control unit 44 includes a low-pass filter (LPF) 51, a feedback control unit 52, a feedforward control unit 53, a disturbance torque estimation unit 54, a torque addition unit 55, a disturbance torque compensation unit 56, and a first deceleration It includes a ratio division section 57 , a reduction ratio multiplication section 58 , a rotation angle calculation section 59 and a second reduction ratio division section 60 .
  • LPF low-pass filter
  • the reduction ratio multiplication unit 58 multiplies the motor torque command value Tm,cmd calculated by the addition unit 47 (see FIG. 2) by the reduction ratio N of the speed reducer 19 to obtain the motor torque command value Tm ,cmd . Convert to an output shaft torque command value N ⁇ Tm , cmd acting on the output shaft 9 (worm wheel 21).
  • a rotation angle calculator 59 calculates a rotor rotation angle ⁇ m of the electric motor 18 based on the output signal of the rotation angle sensor 23 .
  • a second reduction ratio dividing unit 60 divides the rotor rotation angle ⁇ m calculated by the rotation angle calculation unit 59 by the reduction ratio N, thereby dividing the rotor rotation angle ⁇ m into the rotation angle (actual steering angle) of the output shaft 9. Convert to ⁇ .
  • a low-pass filter 51 performs low-pass filter processing on the integrated angle command value ⁇ int,cmd .
  • the integrated angle command value ⁇ intL,cmd after low-pass filtering is given to the feedback control section 52 and the feedforward control section 53 .
  • the feedback control unit 52 is provided to bring the estimated steering angle value ⁇ calculated by the disturbance torque estimating unit 54 closer to the integrated angle command value ⁇ intL,cmd after the low-pass filtering.
  • the feedback controller 52 includes an angular deviation calculator 52A and a PD controller 52B.
  • the angle deviation calculation unit 52A calculates the deviation ( ⁇ intL, cmd - ⁇ ) between the integrated angle command value ⁇ intL, cmd and the actual steering angle ⁇ calculated by the second reduction ratio division unit 60 as the angle deviation ⁇ You may make it calculate as.
  • the PD control section 52B calculates the feedback control torque Tfb by performing PD calculation (proportional differential calculation) on the angular deviation ⁇ calculated by the angular deviation calculating section 52A.
  • the feedback control torque T fb is applied to the torque addition section 55 .
  • the feedforward control unit 53 is provided to compensate for delay in response due to inertia of the electric power steering system 1 and improve control response.
  • Feedforward controller 53 includes an angular acceleration calculator 53A and an inertia multiplier 53B.
  • the angular acceleration calculator 53A calculates a target angular acceleration d 2 ⁇ intL, cmd /dt 2 by second-order differentiating the integrated angle command value ⁇ intL,cmd.
  • the inertia J is obtained, for example, from a physical model (see FIG. 8) of the electric power steering system 1, which will be described later.
  • the feedforward control torque Tff is given to the torque adder 55 as an inertia compensation value.
  • the torque adder 55 calculates a basic torque command value (T fb +T ff ) by adding the feedforward control torque T ff to the feedback control torque T fb .
  • the disturbance torque estimator 54 is provided for estimating nonlinear torque (disturbance torque: torque other than motor torque) generated as a disturbance in the plant (controlled object of the electric motor 18). Based on the output shaft torque command value N ⁇ T m,cmd and the actual steering angle ⁇ , the disturbance torque estimator 54 calculates the disturbance torque (disturbance load) T lc , the steering angle ⁇ , and the steering angle differential value (angular velocity) d ⁇ . /dt. Estimated values of disturbance torque T lc , steering angle ⁇ , and steering angle differential value (angular velocity) d ⁇ /dt are represented by ⁇ T lc , ⁇ , and d ⁇ /dt, respectively. Details of the disturbance torque estimator 54 will be described later.
  • the disturbance torque estimation value ⁇ Tlc calculated by the disturbance torque estimator 54 is given to the disturbance torque compensator 56 as a disturbance torque compensation value.
  • the steering angle estimated value ⁇ calculated by the disturbance torque estimator 54 is provided to the angle deviation calculator 52A.
  • the integrated steering torque command value T sint,cmd is given to the first reduction gear ratio dividing section 57 .
  • the first reduction ratio dividing unit 57 divides the integrated steering torque command value T sint,cmd by the reduction ratio N to calculate the integrated motor torque command value Tmint ,cmd .
  • This integrated motor torque command value Tmint ,cmd is given to the second weight multiplier 46 (see FIG. 2).
  • the disturbance torque estimator 54 will be described in detail.
  • the disturbance torque estimator 54 is composed of a disturbance observer that estimates the disturbance torque T lc , the steering angle ⁇ , and the angular velocity d ⁇ /dt using, for example, the physical model 101 of the electric power steering system 1 shown in FIG. .
  • This physical model 101 includes a plant (an example of a motor driven object) 102 including an output shaft 9 and a worm wheel 21 fixed to the output shaft 9 .
  • a torsion bar torque Ttb is applied from the steering wheel 2 through the torsion bar 10
  • a road load torque Trl is applied from the steered wheels 3 side.
  • the plant 102 is given an output shaft torque command value N ⁇ Tm ,cmd via the worm gear 20 and is given a friction torque Tf by friction between the worm wheel 21 and the worm gear 20 .
  • Tlc indicates disturbance torque other than the motor torque applied to the plant 102 .
  • the disturbance torque Tlc is shown as the sum of the torsion bar torque Ttb , the road load torque Trl , and the friction torque Tf . contains.
  • the state equation for the physical model 101 in FIG. 8 is expressed by the following formula (4).
  • 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 the system matrix
  • B1 is the first input matrix
  • B2 is the second input matrix
  • C is the output matrix
  • D is the direct reach matrix.
  • x e is a state variable vector of the extended system and is expressed by the following equation (6).
  • a e is a system matrix of the extended system
  • B e is a known input matrix of the extended system
  • Ce is an output matrix of the extended system.
  • a disturbance observer (extended state observer) represented by the following equation (7) is constructed from the extended state equation of equation (5) above.
  • ⁇ x e represents the estimated value of x e .
  • L is an observer gain.
  • ⁇ y represents the estimated value of y.
  • ⁇ x e is represented by the following equation (8).
  • is the estimated value of ⁇
  • ⁇ Tlc is the estimated value of Tlc .
  • the disturbance torque estimator 54 calculates the state variable vector ⁇ xe based on the equation (7).
  • FIG. 9 is a block diagram showing the configuration of the disturbance torque estimator 54. As shown in FIG.
  • the disturbance torque estimation unit 54 includes an input vector input unit 71, an output matrix multiplication unit 72, a first addition unit 73, a gain multiplication unit 74, an input matrix multiplication unit 75, a system matrix multiplication unit 76, a second It includes an addition section 77 , an integration section 78 and a state variable vector output section 79 .
  • the output shaft torque command value N ⁇ Tm ,cmd calculated by the reduction ratio multiplication section 58 (see FIG. 7) is given to the input vector input section 71 .
  • the input vector input unit 71 outputs an input vector u1 .
  • the output of the integrator 78 is the state variable vector ⁇ x e (see equation (8) above).
  • an initial value is given as the state variable vector ⁇ xe .
  • the initial value of the state variable vector ⁇ x e is 0, for example.
  • a system matrix multiplier 76 multiplies the state variable vector ⁇ x e by the system matrix A e .
  • the output matrix multiplier 72 multiplies the state variable vector ⁇ x e by the output matrix C e .
  • the gain multiplier 74 multiplies the output (y ⁇ y) of the first adder 73 by the observer gain L (see the above equation (7)).
  • the input matrix multiplication unit 75 multiplies the input vector u1 output from the input vector input unit 71 by the input matrix Be .
  • the second adder 77 outputs the output (Be ⁇ u 1 ) of the input matrix multiplier 75, the output (A e ⁇ x e ) of the system matrix multiplier 76, and the output of the gain multiplier 74 (L(y ⁇ ⁇ y)) is added to calculate the differential value d ⁇ x e /dt of the state variable vector.
  • the integrator 78 calculates the state variable vector ⁇ x e by integrating the output (d ⁇ x e /dt) of the second adder 77 .
  • a state variable vector output unit 79 calculates an estimated disturbance torque value ⁇ T lc , an estimated steering angle value ⁇ , and an estimated angular velocity value d ⁇ /dt based on the state variable vector ⁇ xe.
  • a general 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 becomes the following equation (9).
  • Inputs to a general disturbance observer are J ⁇ d 2 ⁇ /dt 2 and N ⁇ T m, cmd . receive greatly.
  • the disturbance torque is estimated in an integral manner, the noise effect due to differentiation can be reduced.
  • the disturbance torque estimator 64 a general disturbance observer composed of an inverse model of the plant and a low-pass filter may be used.
  • FIG. 10 is a schematic diagram showing the configuration of the torque control section 48. As shown in FIG.
  • the torque control unit 48 (see FIG. 2) includes a motor current command value calculation unit 81, a current deviation calculation unit 82, a PI control unit 83, and a PWM (Pulse Width Modulation) control unit 84.
  • the motor current command value calculation unit 81 divides the motor torque command value Tm , cmd calculated by the addition unit 47 (see FIG. 2) by the torque constant Kt of the electric motor 18 to obtain the motor current command value Im , cmd .
  • the PI control unit 83 performs a PI calculation (proportional integral calculation) on the current deviation ⁇ I calculated by the current deviation calculation unit 82 to convert the motor current Im flowing through the electric motor 18 to the motor current command value Im, cmd. Generate a drive command value for guidance.
  • the PWM control section 84 generates a PWM control signal having a duty ratio corresponding to the drive command value, and supplies it to the drive circuit 31 . As a result, electric power corresponding to the drive command value is supplied to the electric motor 18 .
  • FIG. 11 is a flowchart showing the weight setting process performed by the weight setting unit 49 in the driving support mode.
  • the weight setting unit 49 sets the first weight W1 to 1 and sets the second weight W2 to 0 (step S1).
  • the control mode of the electric motor 18 becomes the first control mode in which the electric motor 18 is driven and controlled only by the assist torque command value Tasst .
  • the host ECU 201 sets the automatic steering command value ⁇ AD,cmd , the automatic steering command value ⁇ AD,cmd , the mode signal Smode , the left/right discrimination signal SLR , and the vehicle lateral position.
  • Plat is given to the motor control ECU 202 .
  • the weight setting unit 49 determines whether or not the vehicle reference position is on the left side of the center of the lane based on the left/right determination signal SLR (step S2).
  • step S3 If the vehicle reference position is on the left side of the center of the lane (step S2: YES), the weight setting unit 49 determines whether the vehicle lateral position P lat is smaller than P L_start (see FIGS. 5 and 6). (step S3).
  • step S3 NO
  • the weight setting unit 49 returns to step S2.
  • step S3 If it is determined in step S3 that P lat ⁇ PL_start (step S3: YES), the weight setting unit 49 sets the first weight W1 to 0 and sets the second weight W2 to 1. (Step S4). At this time, it is preferable that the weight setting unit 49 gradually decrease the first weight W1 from 1 to 0 and gradually increase the second weight W2 from 0 to 1.
  • the time for gradually decreasing the first weight W1 from 1 to 0 (the time for gradually increasing the second weight W2 from 0 to 1) may be, for example, about 0.1 seconds.
  • the control mode of the electric motor 18 becomes the second control mode in which the electric motor 18 is driven and controlled by the integrated motor torque command values Tmint, cmd .
  • the assist torque command value W1 ⁇ T asst after the first weight multiplication and the integrated motor after the second weight multiplication The electric motor 18 is controlled based on the sum of the torque command value w2 ⁇ Tmint ,cmd .
  • the electric motor 18 is controlled based on the integrated angle command value ⁇ int,cmd which is the sum of the manual steering command value ⁇ MD,cmd and the automatic steering command value ⁇ AD ,cmd .
  • the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value ⁇ MD,cmd is reflected.
  • the weight setting unit 49 determines whether or not the vehicle lateral position P lat is smaller than a predetermined P L_return (see FIG. 12) which is larger than P L_strt (step S5).
  • P L_return is set to 80 cm, for example.
  • PL_return is a threshold used to return the control mode to the first control mode when the vehicle reference position is to the left of the lane center and the control mode is the second control mode.
  • step S5 If P lat ⁇ PL_return (step S5: NO), the weight setting unit 49 returns to step S5.
  • step S5 If it is determined in step S5 that P lat >P L_return (step S5: YES), the weight setting unit 49 sets the first weight W1 to 1 and the second weight W2 to 0. (Step S6). At this time, it is preferable that the weight setting unit 49 gradually increases the first weight W1 from 0 to 1 and gradually decreases the second weight W2 from 1 to 0.
  • the time for gradually increasing the first weight W1 from 0 to 1 may be, for example, about 0.1 second.
  • the control mode of the electric motor 18 becomes the first control mode. While the first weight W1 is gradually increased (while the second weight W2 is gradually decreased), the assist torque command value W1 ⁇ T asst after the first weight multiplication and the integrated motor after the second weight multiplication The electric motor 18 is controlled based on the sum of the torque command value w2 ⁇ Tmint ,cmd .
  • the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value ⁇ MD,cmd is not reflected.
  • step S6 After the process of step S6 is performed, the weight setting unit 49 returns to step S2.
  • step S2 If it is determined in step S2 that the vehicle reference position is on the right side of the lane center (step S2: NO), the weight setting unit 49 sets the vehicle lateral position P lat to P R_start (see FIGS. 5 and 6). (step S7).
  • step S7 NO
  • the weight setting unit 49 returns to step S2.
  • step S7 If it is determined in step S7 that P lat ⁇ PR_start (step S7: YES), the weight setting unit 49 sets the first weight W1 to 0 and sets the second weight W2 to 1. (Step S8). At this time, it is preferable that the weight setting unit 49 gradually decrease the first weight W1 from 1 to 0 and gradually increase the second weight W2 from 0 to 1.
  • the control mode of the electric motor 18 becomes the second control mode.
  • the steering reaction force based on the virtual road load torque Trl is reflected.
  • the weight setting unit 49 determines whether or not the vehicle lateral position P lat is smaller than a predetermined PR_return (see FIG. 12) which is larger than PR_strt (step S9).
  • PR_return is set to 90 cm, for example.
  • PR_return is a threshold used to return the control mode to the first control mode when the vehicle reference position is to the right of the lane center and the control mode is the second control mode.
  • step S9 NO
  • the weight setting unit 49 returns to step S9.
  • step S9 If it is determined in step S9 that P lat >P R_return (step S9: YES), the weight setting unit 49 sets the first weight W1 to 1 and the second weight W2 to 0. (Step S10). At this time, it is preferable that the weight setting unit 49 gradually increases the first weight W1 from 0 to 1 and gradually decreases the second weight W2 from 1 to 0.
  • the control mode of the electric motor 18 becomes the first control mode.
  • the steering reaction force based on the virtual road load torque Trl is not reflected.
  • step S10 After the process of step S10 is performed, the weight setting unit 49 returns to step S2.
  • the weight setting unit 49 sets the first weight W1 to 1 and sets the second weight W2 to 0. Therefore, in the normal mode, the electric motor 18 is driven and controlled based only on the assist torque command value T asst .
  • FIG. 12 is a graph showing an example of the relationship between the vehicle lateral position P lat and the absolute value
  • FIG. 12 shows the relationship between the vehicle lateral position P lat and the absolute value
  • the characteristics of the virtual road load torque Trl vary depending on whether there is an adjacent lane to the lane, when there is no adjacent lane to the lane, or when there is a protective fence such as a guardrail for the lane.
  • An example is shown in which the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl are set differently.
  • the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl are set so as to increase in order of certain cases.
  • FIG. 13 is a schematic diagram for explaining the steering reaction force generated based on the virtual road load torque Trl in the driving assistance mode.
  • the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command values ⁇ MD, cmd is 0, but from time t1 to t2, the virtual road load torque T Since part of the steering reaction force based on rl is reflected, the steering reaction force gradually increases. Since the control mode changes to the second control mode from time t2, the steering reaction force based on the virtual road load torque Trl further increases.
  • the steering reaction force reaches the maximum reaction force value.
  • the driver feels the steering reaction force and stops applying steering to the right, the vehicle moves toward the center of the lane.
  • the steering reaction force based on the virtual road load torque Trl decreases.
  • the vehicle lateral position Plat reaches PR_start (time t5), the steering reaction force based on the virtual road load torque Trl becomes a constant value.
  • the steering reaction force can be designed by the manual steering command value generator 42 independently of steering angle control for assist control and driving assistance.
  • the driver can feel the reaction force corresponding to the lateral position of the vehicle as steering torque, so the effect of lane departure prevention is improved.
  • the first vehicle lateral position for switching the first weight W1 from 1 to 0 (the second weight W1 from 0 to 1) and the first weight W1 from 0 to 1 (the second weight W1 is set to a position different from the second vehicle lateral position for switching from 1 to 0).
  • the second vehicle lateral position is set closer to the center of the lane than the first vehicle lateral position.
  • the control mode can be switched from the second control mode to the first control mode when a large steering reaction force is acting. , the vehicle behavior may become unstable.
  • the driver can intuitively recognize the degree of danger through the steering wheel according to the environment outside the current driving lane (existence of adjacent lanes, existence of guardrails, etc.).
  • the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl are set so as to vary according to the vehicle lateral position P lat . It may be set to change according to the angle (heading angle), the time differential value of the vehicle lateral position Plat , the differential value of the heading angle, and the like.
  • a preset fixed value may be used for the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl .
  • the vehicle lateral position P lat was the distance from the boundary of the lane in which the vehicle is currently traveling (lane boundary) to the vehicle reference position. may be the distance from the center of the current lane to the vehicle reference position.
  • the assist torque command value T asst is multiplied by the first weight W1, and the assist torque command value W1 ⁇ T asst after being multiplied by the first weight is provided to the adder 47 .
  • the manual torque command value corresponding to the manual steering command value ⁇ MD ,cmd is multiplied by the first weight W1, and the manual torque command value after multiplication with the first weight is given to the adding section 47. good too.
  • the angle control section 44 (see FIG. 5) includes the feedforward control section 53, but the feedforward control section 53 may be omitted.
  • the feedback control torque Tfb calculated by the feedback control section 52 becomes the basic target torque.
  • driving assistance control (LKA) according to this embodiment can be used together when lane centering assist (LCA) control is being performed to drive the vehicle along the center of the lane.
  • the present invention can also be applied to EPSs other than column-type EPS.
  • the invention can also be applied to a steer-by-wire system.

Landscapes

  • Engineering & Computer Science (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

モータ制御装置は、操舵トルクを用いてアシストトルク指令値を生成するアシストトルク指令値生成部と、操舵トルクおよびアシストトルク指令値を用いて手動操舵指令値を生成する手動操舵指令値生成部と、運転支援用の自動操舵指令値に手動操舵指令値を加算して、統合角度指令値を演算する統合角度指令値演算部と、運転支援モード時において、アシストトルク指令値または前記手動操舵指令値に基づいて電動モータを制御する第1制御モードと、統合角度指令値に基づいて前記電動モータを制御する第2制御モードとを、車線に対する車両の横位置に応じて切り替える切替部とを含む。

Description

モータ制御装置
 この発明は、舵角制御用の電動モータを駆動制御するモータ制御装置に関する。
 下記特許文献1には、次のような車両操舵装置が開示されている。つまり、運転支援モード時において、操舵アシスト電流を演算する。また、リスク度合いを算出し、リスク度合いに基づいて操舵反力ゲインを算出する。また、操舵支援のための目標操舵角と操舵角との偏差に操舵反力ゲインを乗算することにより操舵反力制御電流を算出するとともに、操舵反力ゲインに基づいて操舵アシスト補正ゲインを算出する。そして、操舵アシスト電流に操舵アシスト補正ゲインを乗算した値と、操舵反力制御電流とを加算することにより、アクチュエータ駆動電流を算出し、アクチュエータ駆動電流に基づいてアクチュエータ(電動モータ)を駆動制御する。これにより、リスクに応じた反力を発生させて、ドライバにリスク状態を伝達する。
特開2010-30505号公報
 この発明の一実施形態の目的は、運転支援モード時において、新規な方法で操舵反力をドライバに与えることができるモータ制御装置を提供することである。
 本発明の一実施形態は、舵角制御用の電動モータを駆動制御するためのモータ制御装置であって、操舵トルクを用いてアシストトルク指令値を生成するアシストトルク指令値生成部と、前記操舵トルクおよび前記アシストトルク指令値を用いて手動操舵指令値を生成する手動操舵指令値生成部と、運転支援用の自動操舵指令値に前記手動操舵指令値を加算して、統合角度指令値を演算する統合角度指令値演算部と、運転支援モード時において、前記アシストトルク指令値または前記手動操舵指令値に基づいて前記電動モータを制御する第1制御モードと、前記統合角度指令値に基づいて前記電動モータを制御する第2制御モードとを、車線に対する車両の横位置に応じて切り替える切替部とを含む、モータ制御装置を提供する。
 本発明における上述の、またはさらに他の目的、特徴および効果は、添付図面を参照して次に述べる実施形態の説明により明らかにされる。
図1は、本発明の一実施形態に係るモータ制御装置が適用された電動パワーステアリングシステムの概略構成を示す模式図である。 図2は、モータ制御用ECUの電気的構成を示すブロック図である。 図3は、トーションバートルクTtbに対するアシストトルク指令値Tasstの設定例を示すグラフである。 図4は、手動操舵指令値生成部で用いられるリファレンスEPSモデルの一例を示す模式図である。 図5は、車両横位置Platに対する仮想負荷ばね成分kvlの設定例を示すグラフである。 図6は車両横位置Platに対する仮想負荷粘性減衰係数cvlの設定例を示すグラフである。 図7は、角度制御部の構成を示すブロック図である。 図8は、電動パワーステアリングシステムの物理モデルの構成例を示す模式図である。 図9は、外乱トルク推定部の構成を示すブロック図である。 図10は、トルク制御部の構成を示す模式図である。 図11は、運転支援モード時に重み設定部によって行われる重み設定処理の手順を示すフローチャートである。 図12は、車両横位置Platと、数式(1)に基づいて演算される路面負荷トルクTrlの絶対値|Trl|との関係の一例を示すグラフである。 図13は、運転支援モード時において路面負荷トルクTrlに基づいて発生する操舵反力を説明するための模式図である。
 [本発明の実施形態の説明]
 本発明の一実施形態は、舵角制御用の電動モータを駆動制御するためのモータ制御装置であって、操舵トルクを用いてアシストトルク指令値を生成するアシストトルク指令値生成部と、前記操舵トルクおよび前記アシストトルク指令値を用いて手動操舵指令値を生成する手動操舵指令値生成部と、運転支援用の自動操舵指令値に前記手動操舵指令値を加算して、統合角度指令値を演算する統合角度指令値演算部と、運転支援モード時において、前記アシストトルク指令値または前記手動操舵指令値に基づいて前記電動モータを制御する第1制御モードと、前記統合角度指令値に基づいて前記電動モータを制御する第2制御モードとを、車線に対する車両の横位置に応じて切り替える切替部とを含む、モータ制御装置を提供する。
 本発明の一実施形態は、舵角制御用の電動モータと、前記電動モータを駆動制御するための制御装置とを備え、前記制御装置は、操舵トルクを用いてアシストトルク指令値を生成するアシストトルク指令値生成部と、前記操舵トルクおよび前記アシストトルク指令値を用いて手動操舵指令値を生成する手動操舵指令値生成部と、運転支援用の自動操舵指令値に前記手動操舵指令値を加算して、統合角度指令値を演算する統合角度指令値演算部と、運転支援モード時において、前記アシストトルク指令値または前記手動操舵指令値に基づいて前記電動モータを制御する第1制御モードと、前記統合角度指令値に基づいて前記電動モータを制御する第2制御モードとを、車線に対する車両の横位置に応じて切り替える切替部とを含む、操舵装置を提供する。
 本発明の一実施形態では、前記第1制御モードから前記第2制御モードに切り替わる前記横位置である第1横位置と、前記第2制御モードから前記第1制御モードに切り替わる前記横位置である第2横位置とが、異なる位置に設定されている。
 本発明の一実施形態では、前記手動操舵指令値は、仮想路面負荷トルクを考慮して、前記手動操舵指令値を演算するように構成されている。
 本発明の一実施形態では、前記仮想路面負荷トルクは、車線に対する車両の横位置に応じて設定される。
 本発明の一実施形態では、前記仮想路面負荷トルクは、車両が走行している車線の外側の情報に基づいて設定される。
 [本発明の実施形態の詳細な説明]
 以下では、この発明の実施の形態を、添付図面を参照して詳細に説明する。
 図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の大きさが大きくなるものとする。トーションバートルク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が搭載されている。
 CCDカメラ25、GPS26、レーダー27、地図情報メモリ28および車速センサ29は、運転支援制御を行うための上位ECU(ECU:Electronic Control Unit)201に接続されている。上位ECU201は、CCDカメラ25、GPS26、レーダー27および車速センサ29によって得られる情報および地図情報を元に、周辺環境認識、自車位置推定、経路計画等を行い、操舵や駆動アクチュエータの制御目標値の決定を行う。
 この実施形態では、運転モードとして、通常モードと運転支援モードとがある。上位ECU201は、運転支援モード時には、運転支援のための自動操舵指令値θadacを設定する。この実施形態では、運転支援は、車両が車線から逸脱するのを避けるためのレーンキープアシスト(LKA)である。自動操舵指令値θAD,cmdは、車両を目標走行ラインに沿って走行させるための操舵角の目標値である。
 自動操舵指令値θAD,cmdは、例えば、車速、目標走行ラインに対する横偏差および目標走行ラインに対する車両のヨー偏差に基づいて、設定される。このような自動操舵指令値θAD,cmdを設定する処理は、周知であるため、ここでは詳細な説明を省略する。
 また、上位ECU201は、運転モードが通常モードであるか運転支援モードであるかを示すモード信号Smode、車両基準位置が車線中央より左側にあるか右側にあるかを示す左右判別信号SLRおよび車両横位置Platを出力する。車両基準位置は、車両の幅中央の所定の基準位置である。
 車両横位置Platは、車両が現在走行している車線の境界(以下、「車線境界」という。)から、車両基準位置までの距離である。具体的には、車両基準位置が中央より左側にある場合には、車両横位置Platは、左側車線境界から車両基準位置までの距離である。車両基準位置が車線中央より右側にある場合には、車両横位置Platは、右側車線境界から車両基準位置までの距離である。
 モード信号Smode、左右判別信号SLR、車両横位置Platおよび自動操舵指令値θAD,cmdは、車載ネットワークを介して、モータ制御用ECU202に与えられる。トルクセンサ12によって検出されるトーションバートルクTtb、回転角センサ23の出力信号は、モータ制御用ECU202に入力される。モータ制御用ECU202は、これらの入力信号および上位ECU201から与えられる情報に基づいて、電動モータ18を制御する。
 図2は、モータ制御用ECU202の電気的構成を示すブロック図である。
 以下、主として、運転モードが運転支援モードである場合の動作について説明する。
 モータ制御用ECU202は、マイクロコンピュータ40と、マイクロコンピュータ40によって制御され、電動モータ18に電力を供給する駆動回路(インバータ回路)31と、電動モータ18に流れる電流(以下、「モータ電流Iという)を検出するための電流検出回路32とを備えている。
 マイクロコンピュータ40は、CPUおよびメモリ(ROM、RAM、不揮発性メモリなど)を備えており、所定のプログラムを実行することによって、複数の機能処理部として機能するようになっている。この複数の機能処理部には、アシストトルク指令値設定部41と、手動操舵指令値生成部42と、統合角度指令値演算部43と、角度制御部44と、第1重み乗算部45と、第2重み乗算部46と、加算部47と、トルク制御部(電流制御部)48と、重み設定部49とを含む。
 第1重み乗算部45、第2重み乗算部46、加算部47および重み設定部49は、本発明における「切替部」の一例である。
 アシストトルク指令値設定部41は、手動操作に必要なアシストトルクの目標値であるアシストトルク指令値Tasstを設定する。アシストトルク指令値設定部41は、トルクセンサ12によって検出されるトーションバートルクTtbに基づいて、アシストトルク指令値Tasstを設定する。トーションバートルクTtbに対するアシストトルク指令値Tasstの設定例は、図3に示されている。
 アシストトルク指令値Tasstは、電動モータ18から左方向操舵のための操舵補助力を発生させるべきときには正の値とされ、電動モータ18から右方向操舵のための操舵補助力を発生させるべきときには負の値とされる。アシストトルク指令値Tasstは、トーションバートルクTtbの正の値に対しては正をとり、トーションバートルクTtbの負の値に対しては負をとる。そして、アシストトルク指令値Tasstは、トーションバートルクTtbの絶対値が大きくなるほど、その絶対値が大きくなるように設定される。
 なお、アシストトルク指令値設定部41は、上位ECU201から車速を取得し、車速とトーションバートルクTtbとに基づいてアシストトルク指令値Tasstを設定してもよい。この場合には、アシストトルク指令値Tasstは、前述のようにトーションバートルクTtbに応じて設定されるとともに、車速Vが大きいほどアシストトルク指令値Tasstの絶対値が小さくなるように設定される。
 なお、アシストトルク指令値設定部41は、トーションバートルクTtbに予め設定された定数を乗算することによって、アシストトルク指令値Tasstを演算してもよい。
 手動操舵指令値生成部42は、ドライバがステアリングホイール2を操作した場合に、当該ステアリングホイール操作に応じた操舵角(より正確には出力軸9の回転角θ)を手動操舵指令値θMD,cmdとして設定するために設けられている。手動操舵指令値生成部42は、トルクセンサ12によって検出されるトーションバートルクTtb、アシストトルク指令値設定部41によって設定されるアシストトルク指令値Tasstとを用いて手動操舵指令値θMD,cmdを生成する。手動操舵指令値生成部42の詳細については、後述する。
 統合角度指令値演算部43は、上位ECU201によって設定される自動操舵指令値θAD,cmdに、手動操舵指令値θMD,cmdを加算して、統合角度指令値θint,cmdを演算する。
 角度制御部44は、統合角度指令値θint,cmdに基づいて、統合角度指令値θint,cmdに応じた統合モータトルク指令値Tmint,cmdを演算する。角度制御部44の詳細については、後述する。
 第1重み乗算部45は、アシストトルク指令値設定部41によって設定されるアシストトルク指令値Tasstに第1重みW1を乗算する。第2重み乗算部46は、統合モータトルク指令値Tmint,cmdに第2重みW2を乗算する。第1重みW1および第1重みW2は、重み設定部49によって設定される。重み設定部49の詳細については後述する。
 加算部47は、第1重み乗算後(第1重み付け処理後)のアシストトルク指令値W1・Tasstと、第2重み乗算後(第2重み付け処理後)の統合モータトルク指令値W2・Tmint,cmdとを加算することにより、電動モータ18に対するモータトルク指令値Tm,cmdを演算する。
 トルク制御部48は、電動モータ18のモータトルクがモータトルク指令値Tm,cmdに近づくように駆動回路31を駆動する。
 手動操舵指令値生成部42は、この実施形態では、リファレンスEPSモデルを用いて、手動操舵指令値θMD,cmdを設定する。
 図4は、手動操舵指令値生成部42で用いられるリファレンスEPSモデルの一例を示す模式図である。
 このリファレンスEPSモデルは、ロアコラムを含む単一慣性モデルである。ロアコラムは、出力軸9およびウォームホイール21に対応する。図4において、Jrefは、ロアコラムの慣性であり、Ttbは、トーションバートルクである。ロアコラムには、トーションバートルクTtb、アシストトルク指令値Tasstおよび路面負荷トルクTrlが与えられる。ロアコラムの回転角を手動操舵指令値θMD,cmdとすると、路面負荷トルク(仮想路面負荷トルク)Trlは、仮想負荷ばね剛性係数kvl、仮想負荷粘性減衰係数cvlおよび手動操舵指令値θMD,cmdを用いて、次式(1)で表される。
 Trl=-kvl・θMD,cmd-cvl(dθMD,cmd/dt)  …(1)
ただし、kvl=kvl(Plat), cvl=cvl(Plat
 前記式(1)で示されるように、仮想負荷ばね剛性係数kvlおよび仮想負荷粘性減衰係数cvlは、車両横位置Platに対応して設定されている。
 図5は、車両横位置Platに対する仮想負荷ばね剛性係数kvlの設定例を示すグラフである。図5における記号の添え字Lは、車両基準位置が車線中央よりも左側にある場合に当該記号が適用されることを示し、Rは車両基準位置が車線中央よりも右側にある場合に当該記号が適用されることを示す。後述する図6においても同じである。
 車両横位置Platが左側車線境界に対して所定のPL_start以上または右側車線境界に対して所定のPR_start以上である場合には、仮想負荷ばね剛性係数kvlは、所定値kvl,startに設定される。PL_startは、例えば60cm程度に設定される。PR_startは、例えば70cm程度に設定される。
 車両横位置Platが、左側車線境界に対してPL_startよりも小さい所定のPL_small以上かつPL_start未満である場合には、仮想負荷ばね剛性係数kvlは、車両横位置PlatがPL_startから小さくなるほど(車両基準位置が左側車線境界に近づくほど)、kvl,startからkvl,L_maxまで漸増する特性にしたがって設定される。PL_smallは、例えば40cm程度に設定される。
 車両横位置Platが、右側車線境界に対してPR_startよりも小さい所定のPR_small以上でPR_start未満である場合には、仮想負荷ばね剛性係数kvlは、車両横位置PlatがPR_startから小さくなるほど(車両基準位置が右側車線境界に近づくほど)、kvl,startからkvl,R_maxまで漸増する特性にしたがって設定される。PR_smallは、例えば50cm程度に設定される。
 車両横位置Platが左側車線境界に対してPL_small未満である場合には、仮想負荷ばね剛性係数kvlは、kvl,L_maxに設定される。車両横位置Platが右側車線境界に対してPR_small未満である場合には、仮想負荷ばね剛性係数kvlは、kvl,R_maxに設定される。このように、仮想負荷ばね剛性係数kvlに制限を設けているのは、仮想路面負荷トルクTrlが大きくなりすぎて、ドライバが操舵介入できなくなるのを防止するためである。
 図6は、車両横位置Platに対する仮想負荷粘性減衰係数cvlの設定例を示すグラフである。
 車両横位置Platが左側車線境界に対して所定のPL_start以上または右側車線境界に対して所定のPR_start以上である場合には、仮想負荷粘性減衰係数cvlは、所定値cvl,startに設定される。
 車両横位置Platが、左側車線境界に対してPL_startよりも小さい所定のPL_small以上かつPL_start未満である場合には、仮想負荷粘性減衰係数cvlは、車両横位置PlatがPL_startから小さくなるほど(車両基準位置が左側車線境界に近づくほど)、cvl,startからcvl,L_maxまで漸増する特性にしたがって設定される。
 車両横位置Platが、右側車線境界に対してPR_startよりも小さい所定のPR_small以上でPR_start未満である場合には、仮想負荷粘性減衰係数cvlは、車両横位置PlatがPR_startから小さくなるほど(車両基準位置が右側車線境界に近づくほど)、cvl,startからcvl,R_maxまで漸増する特性にしたがって設定される。
 車両横位置Platが左側車線境界に対してPL_small未満である場合には、仮想負荷粘性減衰係数cvlは、cvl,L_maxに設定される。車両横位置Platが右側車線境界に対してPR_small未満である場合には、仮想負荷粘性減衰係数cvlは、cvl,R_maxに設定される。
 リファレンスEPSモデルの運動方程式は、次式(2)で表される。
 Jref・dθMD,cmd/dt=Ttb+Tasst-kvl・θMD,cmd
               -cvl(dθMD,cmd/dt)  …(2)
 手動操舵指令値生成部42は、Ttbにトルクセンサ12によって検出されるトーションバートルクTtbを代入し、Tasstにアシストトルク指令値設定部41によって設定されるアシストトルク指令値Tasstを代入して、式(2)の微分方程式を解くことにより、手動操舵指令値θMD,cmdを演算する。
 なお、現在走行している車線の外側の情報に応じて仮想路面負荷トルクTrlの特性が変わるように、仮想負荷ばね剛性係数kvlおよび仮想負荷粘性減衰係数cvlを設定してもよい。例えば、車線に対して隣接レーンがある場合と、車線に対して隣接レーンがない場合と、車線に対してガードレール等の防護柵がある場合とによって、仮想路面負荷トルクTrlの特性が変わるように、仮想負荷ばね剛性係数kvlおよび仮想負荷粘性減衰係数cvlを設定してもよい。この場合、車線の外側の情報は、上位ECU201からモータ制御用ECU202に与えられる。
 図7は、角度制御部44の構成を示すブロック図である。
 角度制御部44は、統合角度指令値θint,cmdに基づいて、統合モータトルク指令値Tmint,cmdを演算する。角度制御部44は、ローパスフィルタ(LPF)51と、フィードバック制御部52と、フィードフォワード制御部53と、外乱トルク推定部54と、トルク加算部55と、外乱トルク補償部56と、第1減速比除算部57と、減速比乗算部58と、回転角演算部59と、第2減速比除算部60とを含む。
 減速比乗算部58は、加算部47(図2参照)によって演算されるモータトルク指令値Tm,cmdに減速機19の減速比Nを乗算することにより、モータトルク指令値Tm,cmdを出力軸9(ウォームホイール21)に作用する出力軸トルク指令値N・Tm,cmdに換算する。
 回転角演算部59は、回転角センサ23の出力信号に基づいて、電動モータ18のロータ回転角θを演算する。第2減速比除算部60は、回転角演算部59によって演算されるロータ回転角θを減速比Nで除算することにより、ロータ回転角θを出力軸9の回転角(実操舵角)θに換算する。
 ローパスフィルタ51は、統合角度指令値θint,cmdに対してローパスフィルタ処理を行う。ローパスフィルタ処理後の統合角度指令値θintL,cmdは、フィードバック制御部52およびフィードフォワード制御部53に与えられる。
 フィードバック制御部52は、外乱トルク推定部54によって演算される操舵角推定値^θを、ローパスフィルタ処理後の統合角度指令値θintL,cmdに近づけるために設けられている。フィードバック制御部52は、角度偏差演算部52AとPD制御部52Bとを含む。角度偏差演算部52Aは、統合角度指令値θintL,cmdと操舵角推定値^θとの偏差Δθ(=θintL,cmd-^θ)を演算する。なお、角度偏差演算部52Aは、統合角度指令値θintL,cmdと、第2減速比除算部60によって演算される実操舵角θとの偏差(θintL,cmd-θ)を、角度偏差Δθとして演算するようにしてもよい。
 PD制御部52Bは、角度偏差演算部52Aによって演算される角度偏差Δθに対してPD演算(比例微分演算)を行うことにより、フィードバック制御トルクTfbを演算する。フィードバック制御トルクTfbは、トルク加算部55に与えられる。
 フィードフォワード制御部53は、電動パワーステアリングシステム1の慣性による応答性の遅れを補償して、制御の応答性を向上させるために設けられている。フィードフォワード制御部53は、角加速度演算部53Aと慣性乗算部53Bとを含む。角加速度演算部53Aは、統合角度指令値θintL,cmdを2階微分することにより、目標角加速度dθintL,cmd/dtを演算する。
 慣性乗算部53Bは、角加速度演算部53Aによって演算された目標角加速度dθintL,cmd/dtに、電動パワーステアリングシステム1の慣性Jを乗算することにより、フィードフォワード制御トルクTff(=J・dθintL,cmd/dt)を演算する。慣性Jは、例えば、後述する電動パワーステアリングシステム1の物理モデル(図8参照)から求められる。フィードフォワード制御トルクTffは、慣性補償値として、トルク加算部55に与えられる。
 トルク加算部55は、フィードバック制御トルクTfbにフィードフォワード制御トルクTffを加算することにより、基本トルク指令値(Tfb+Tff)を演算する。
 外乱トルク推定部54は、プラント(電動モータ18の制御対象)に外乱として発生する非線形なトルク(外乱トルク:モータトルク以外のトルク)を推定するために設けられている。外乱トルク推定部54は、出力軸トルク指令値N・Tm,cmdと、実操舵角θとに基づいて、外乱トルク(外乱負荷)Tlc、操舵角θおよび操舵角微分値(角速度)dθ/dtを推定する。外乱トルクTlc、操舵角θおよび操舵角微分値(角速度)dθ/dtの推定値を、それぞれ^Tlc、^θおよびd^θ/dtで表す。外乱トルク推定部54の詳細については、後述する。
 外乱トルク推定部54によって演算された外乱トルク推定値^Tlcは、外乱トルク補償値として外乱トルク補償部56に与えられる。外乱トルク推定部54によって演算された操舵角推定値^θは、角度偏差演算部52Aに与えられる。
 外乱トルク補償部56は、基本トルク指令値(Tfb+Tff)から外乱トルク推定値^Tlcを減算することにより、統合操舵トルク指令値Tsint,cmd(=Tfb+Tff-^Tlc)を演算する。これにより、外乱トルクが補償された統合操舵トルク指令値Tsint,cmd(出力軸9に対するトルク指令値)が得られる。
 統合操舵トルク指令値Tsint,cmdは、第1減速比除算部57に与えられる。第1減速比除算部57は、統合操舵トルク指令値Tsint,cmdを減速比Nで除算することにより、統合モータトルク指令値Tmint,cmdを演算する。この統合モータトルク指令値Tmint,cmdが、第2重み乗算部46(図2参照)に与えられる。
 外乱トルク推定部54について詳しく説明する。外乱トルク推定部54は、例えば、図8に示す電動パワーステアリングシステム1の物理モデル101を使用して、外乱トルクTlc、操舵角θおよび角速度dθ/dtを推定する外乱オブザーバから構成されている。
 この物理モデル101は、出力軸9および出力軸9に固定されたウォームホイール21を含むプラント(モータ駆動対象の一例)102を含む。プラント102には、ステアリングホイール2からトーションバー10を介してトーションバートルクTtbが与えられるとともに、転舵輪3側から路面負荷トルクTrlが与えられる。
 さらに、プラント102には、ウォームギヤ20を介して出力軸トルク指令値N・Tm,cmdが与えられるとともに、ウォームホイール21とウォームギヤ20との間の摩擦によって摩擦トルクTが与えられる。
 プラント102の慣性をJとすると、物理モデル101の慣性についての運動方程式は、次式(3)で表される。
Figure JPOXMLDOC01-appb-M000001
 dθ/dtは、プラント102の角加速度である。Nは、減速機19の減速比である。Tlcは、プラント102に与えられるモータトルク以外の外乱トルクを示している。この実施形態では、外乱トルクTlcは、トーションバートルクTtbと路面負荷トルクTrlと摩擦トルクTとの和として示されているが、実際には、外乱トルクTlcはこれら以外のトルクを含んでいる。
 図8の物理モデル101に対する状態方程式は、次式(4)で表わされる。
Figure JPOXMLDOC01-appb-M000002
 前記式(4)において、xは、状態変数ベクトル、uは、既知入力ベクトル、uは、未知入力ベクトル、yは、出力ベクトル(測定値)である。また、前記式(4)において、Aは、システム行列、Bは、第1入力行列、Bは、第2入力行列、Cは、出力行列、Dは、直達行列である。
 前記状態方程式を、未知入力ベクトルuを状態の1つとして含めた系に拡張する。拡張系の状態方程式(拡張状態方程式)は、次式(5)で表される。
Figure JPOXMLDOC01-appb-M000003
 前記式(5)において、xは、拡張系の状態変数ベクトルであり、次式(6)で表される。
Figure JPOXMLDOC01-appb-M000004
 前記式(5)において、Aは、拡張系のシステム行列、Bは、拡張系の既知入力行列、Ceは、拡張系の出力行列である。
 前記式(5)の拡張状態方程式から、次式(7)の方程式で表される外乱オブザーバ(拡張状態オブザーバ)が構築される。
Figure JPOXMLDOC01-appb-M000005
 式(7)において、^xはxの推定値を表している。また、Lはオブザーバゲインである。また、^yはyの推定値を表している。^xは、次式(8)で表される。
Figure JPOXMLDOC01-appb-M000006
 式(8)において、^θはθの推定値であり、^TlcはTlcの推定値である。
 外乱トルク推定部54は、前記式(7)の方程式に基づいて状態変数ベクトル^xを演算する。
 図9は、外乱トルク推定部54の構成を示すブロック図である。
 外乱トルク推定部54は、入力ベクトル入力部71と、出力行列乗算部72と、第1加算部73と、ゲイン乗算部74と、入力行列乗算部75と、システム行列乗算部76と、第2加算部77と、積分部78と、状態変数ベクトル出力部79とを含む。
 減速比乗算部58(図7参照)によって演算される出力軸トルク指令値N・Tm,cmdは、入力ベクトル入力部71に与えられる。入力ベクトル入力部71は、入力ベクトルuを出力する。
 積分部78の出力が状態変数ベクトル^x(前記式(8)参照)となる。演算開始時には、状態変数ベクトル^xとして初期値が与えられる。状態変数ベクトル^xの初期値は、たとえば0である。
 システム行列乗算部76は、状態変数ベクトル^xにシステム行列Aを乗算する。出力行列乗算部72は、状態変数ベクトル^xに出力行列Cを乗算する。
 第1加算部73は、第2減速比除算部60(図7参照)によって演算された実操舵角θである出力ベクトル(測定値)yから、出力行列乗算部72の出力(C・^x)を減算する。つまり、第1加算部73は、出力ベクトルyと出力ベクトル推定値^y(=C・^x)との差(y-^y)を演算する。ゲイン乗算部74は、第1加算部73の出力(y-^y)にオブザーバゲインL(前記式(7)参照)を乗算する。
 入力行列乗算部75は、入力ベクトル入力部71から出力される入力ベクトルuに入力行列Bを乗算する。第2加算部77は、入力行列乗算部75の出力(Be・u)と、システム行列乗算部76の出力(A・^x)と、ゲイン乗算部74の出力(L(y-^y))とを加算することにより、状態変数ベクトルの微分値d^x/dtを演算する。積分部78は、第2加算部77の出力(d^x/dt)を積分することにより、状態変数ベクトル^xを演算する。状態変数ベクトル出力部79は、状態変数ベクトル^xに基づいて、外乱トルク推定値^Tlc、操舵角推定値^θおよび角速度推定値d^θ/dtを演算する。
 一般的な外乱オブザーバは、前述の拡張状態オブザーバとは異なり、プラントの逆モデルとローパスフィルタとから構成される。プラントの運動方程式は、前述のように式(3)で表される。したがって、プラントの逆モデルは、次式(9)となる。
Figure JPOXMLDOC01-appb-M000007
 一般的な外乱オブザーバへの入力は、J・dθ/dtおよびN・Tm,cmdであり、実操舵角θの2階微分値を用いるため、回転角センサ23のノイズの影響を大きく受ける。これに対して、前述の実施形態の拡張状態オブザーバでは、積分型で外乱トルクを推定するため、微分によるノイズ影響を低減できる。
 なお、外乱トルク推定部64として、プラントの逆モデルとローパスフィルタとから構成される一般的な外乱オブザーバを用いてもよい。
 図10は、トルク制御部48の構成を示す模式図である。
 トルク制御部48(図2参照)は、モータ電流指令値演算部81と、電流偏差演算部82と、PI制御部83と、PWM(Pulse Width Modulation)制御部84とを含む。
 モータ電流指令値演算部81は、加算部47(図2参照)によって演算されたモータトルク指令値Tm,cmdを電動モータ18のトルク定数Kで除算することにより、モータ電流指令値Im,cmdを演算する。
 電流偏差演算部82は、モータ電流指令値演算部81によって得られたモータ電流指令値Im,cmd電流検出回路32によって検出されたモータ電流Iとの偏差ΔI(=Im,cmd-I)を演算する。
 PI制御部83は、電流偏差演算部82によって演算された電流偏差ΔIに対するPI演算(比例積分演算)を行うことにより、電動モータ18に流れるモータ電流Iをモータ電流指令値Im,cmdに導くための駆動指令値を生成する。PWM制御部84は、前記駆動指令値に対応するデューティ比のPWM制御信号を生成して、駆動回路31に供給する。これにより、駆動指令値に対応した電力が電動モータ18に供給されることになる。
 図11は、運転支援モード時に重み設定部49によって行われる重み設定処理の手順を示すフローチャートである。
 運転モードが運転支援モードになると、重み設定部49は、第1重みW1を1に設定し、第2重みW2を0に設定する(ステップS1)。これにより、電動モータ18の制御モードは、アシストトルク指令値Tasstのみによって電動モータ18が駆動制御される第1制御モードとなる。
 なお、運転モードが運転支援モードになると、上位ECU201によって自動操舵指令値θAD,cmdが設定され、その自動操舵指令値θAD,cmd、モード信号Smode、左右判別信号SLRおよび車両横位置Platがモータ制御用ECU202に与えられる。
 次に、重み設定部49は、左右判別信号SLRに基づき、車両基準位置が車線中央の左側にあるか否かを判別する(ステップS2)。
 車両基準位置が車線中央の左側にある場合には(ステップS2:YES)、重み設定部49は、車両横位置PlatがPL_start(図5、図6参照)よりも小さいか否かを判別する(ステップS3)。
 Plat≧PL_startであれば(ステップS3:NO)、重み設定部49は、ステップS2に戻る。
 ステップS3において、Plat<PL_startであると判別された場合には(ステップS3:YES)、重み設定部49は、第1重みW1を0に設定し、第2重みW2を1に設定する(ステップS4)。この際、重み設定部49は、第1重みW1を1から0まで漸減させるとともに、第2重みW2を0から1まで漸増させることが好ましい。第1重みW1を1から0まで漸減させる時間(第2重みW2を0から1まで漸増させる時間)は、例えば0.1秒程度であってもよい。
 これにより、電動モータ18の制御モードは、統合モータトルク指令値Tmint,cmdによって電動モータ18が駆動制御される第2制御モードとなる。なお、第1重みW1が漸減されている間(第2重みW2が漸増されている間)は、第1重み乗算後のアシストトルク指令値W1・Tasstと、第2重み乗算後の統合モータトルク指令値w2・Tmint,cmdとの和に基づいて、電動モータ18が制御される。
 第2制御モード時においては、手動操舵指令値θMD,cmdと、自動操舵指令値θAD,cmdとの和である統合角度指令値θint,cmdに基づいて電動モータ18が制御されるので、手動操舵指令値θMD,cmdの演算に用いられる仮想路面負荷トルクTrlに基づく操舵反力が反映されるようになる。
 次に、重み設定部49は、車両横位置PlatがPL_strtよりも大きな所定のPL_return(図12参照)よりも小さいか否かを判別する(ステップS5)。PL_returnは、例えば80cmに設定される。PL_returnは、車両基準位置が車線中央よりも左側にあり、かつ制御モードが第2制御モードである場合に、制御モードを第1制御モードに戻すために使用される閾値である。
 Plat≦PL_returnであれば(ステップS5:NO)、重み設定部49は、ステップS5に戻る。
 ステップS5において、Plat>PL_returnであると判別された場合には(ステップS5:YES)、重み設定部49は、第1重みW1を1に設定し、第2重みW2を0に設定する(ステップS6)。この際、重み設定部49は、第1重みW1を0から1まで漸増させるとともに、第2重みW2を1から0まで漸減させることが好ましい。第1重みW1を0から1まで漸増させる時間(第2重みW2を1から0まで漸減させる時間)は、例えば0.1秒程度であってもよい。
 これにより、電動モータ18の制御モードは、第1制御モードとなる。なお、第1重みW1が漸増されている間(第2重みW2が漸減されている間)は、第1重み乗算後のアシストトルク指令値W1・Tasstと、第2重み乗算後の統合モータトルク指令値w2・Tmint,cmdとの和に基づいて、電動モータ18が制御される。
 第1制御モード時においては、手動操舵指令値θMD,cmdの演算に用いられる仮想路面負荷トルクTrlに基づく操舵反力は反映されない。
 ステップS6の処理が行われると、重み設定部49は、ステップS2に戻る。
 ステップS2において、車両基準位置が車線中央の右側にあると判別された場合には(ステップS2:NO)、重み設定部49は、車両横位置PlatがPR_start(図5、図6参照)よりも小さいか否かを判別する(ステップS7)。
 Plat≧PR_startであれば(ステップS7:NO)、重み設定部49は、ステップS2に戻る。
 ステップS7において、Plat<PR_startであると判別された場合には(ステップS7:YES)、重み設定部49は、第1重みW1を0に設定し、第2重みW2を1に設定する(ステップS8)。この際、重み設定部49は、第1重みW1を1から0まで漸減させるとともに、第2重みW2を0から1まで漸増させることが好ましい。
 これにより、電動モータ18の制御モードは、第2制御モードとなる。第2制御モード時においては、仮想路面負荷トルクTrlに基づく操舵反力が反映されるようになる。
 次に、重み設定部49は、車両横位置PlatがPR_strtよりも大きな所定のPR_return(図12参照)よりも小さいか否かを判別する(ステップS9)。PR_returnは、例えば90cmに設定される。PR_returnは、車両基準位置が車線中央よりも右側にあり、かつ制御モードが第2制御モードである場合に、制御モードを第1制御モードに戻すために使用される閾値である。
 Plat≦PR_returnであれば(ステップS9:NO)、重み設定部49は、ステップS9に戻る。
 ステップS9において、Plat>PR_returnであると判別された場合には(ステップS9:YES)、重み設定部49は、第1重みW1を1に設定し、第2重みW2を0に設定する(ステップS10)。この際、重み設定部49は、第1重みW1を0から1まで漸増させるとともに、第2重みW2を1から0まで漸減させることが好ましい。
 これにより、電動モータ18の制御モードは、第1制御モードとなる。第1制御モード時においては、仮想路面負荷トルクTrlに基づく操舵反力は反映されない。
 ステップS10の処理が行われると、重み設定部49は、ステップS2に戻る。
 なお、運転モードが通常モードである場合には、重み設定部49は、第1重みW1を1に設定し、第2重みW2を0に設定する。したがって、通常モード時には、アシストトルク指令値Tasstのみに基づいて、電動モータ18が駆動制御される。
 図12は、車両横位置Platと、式(1)に基づいて演算される仮想路面負荷トルクTrlの絶対値|Trl|との関係の一例を示すグラフである。図12は、式(1)におけるθMD,cmdおよびdθMD,cmd/dtが一定であると仮定した場合の車両横位置Platと仮想路面負荷トルクの絶対値|Trl|との関係を示している。
 図12では、車線に対して隣接レーンがある場合と、車線に対して隣接レーンがない場合と、車線に対してガードレール等の防護柵がある場合とによって、仮想路面負荷トルクTrlの特性が変わるように、仮想負荷ばね剛性係数kvlおよび仮想負荷粘性減衰係数cvlが設定されている場合の例を示している。
 車両横位置Platが左側車線境界に対してPL_start以上の場合または右側車線境界に対してPR_start以上の場合には、仮想負荷ばね合成係数kvlはkvl,startとなり、仮想負荷粘性減衰係数cvlはcvl,startとなるため、仮想路面負荷トルクの絶対値|Trl|は一定値となる。
 車両横位置Platが、左側車線境界に対してPL_small以上かつPL_start未満である場合には、仮想路面負荷トルクの絶対値|Trl|は、車両横位置PlatがPL_startから小さくなるほど(車両基準位置が左側車線境界に近づくほど)、大きくなる。
 車両横位置PlatがPL_small未満になると、仮想路面負荷トルクの絶対値|Trl|は、車両横位置PlatがPL_smallである場合の仮想路面負荷トルクの絶対値|Trl|に固定される。
 車両横位置Platが、右側車線境界に対してPR_small以上かつPR_start未満である場合には、仮想路面負荷トルクの絶対値|Trl|は、車両横位置PlatがPR_startから小さくなるほど(車両基準位置が左側車線境界に近づくほど)、大きくなる。
 車両横位置PlatがPR_small未満になると、仮想路面負荷トルクTrlの絶対値|Trl|は、車両横位置PlatがPR_smallである場合の仮想路面負荷トルクの絶対値|Trl|に固定される。
 図12の例では、車両横位置PlatがPL_startまたはPR_start未満である場合における仮想路面負荷トルクの絶対値|Trl|が、隣接レーンがある場合、隣接レーンがない場合、防護柵がある場合の順に、大きくなるように、仮想負荷ばね剛性係数kvlおよび仮想負荷粘性減衰係数cvlが設定されている。
 図13は、運転支援モード時において仮想路面負荷トルクTrlに基づいて発生する操舵反力を説明するための模式図である。
 時点t0では、制御モードは第1モードであり、車両基準位置は車線中央にある。制御モードが第1制御モードであるため、W1=1、W2=0であり、手動操舵指令値θMD,cmdの演算に用いられる仮想路面負荷トルクTrlに基づく操舵反力は0である。
 時点t0直後にドライバが右方向への操舵を行ったため、車両が右方向へ移動し始める。そして、時点t1で車両横位置PlatがPR_startに達すると、W1が漸減されるとともにW2が漸増され、時点t2でW1=0、W2=1となる。つまり、制御モードが第2制御モードとなる。
 時点t0から時点t1までは、手動操舵指令値θMD,cmdの演算に用いられる仮想路面負荷トルクTrlに基づく操舵反力は0であるが、時点t1からt2までは、仮想路面負荷トルクTrlに基づく操舵反力の一部が反映されるため、操舵反力は徐々に大きくなる。そして、時点t2からは制御モードが第2制御モードとなるため、仮想路面負荷トルクTrlに基づく操舵反力がさらに大きくなる。
 そして、車両基準位置が右側車線境界に達すると(時点t3)、操舵反力が最大反力値となる。ドライバが操舵反力を感じて右方向への操舵を加えなくなると、車両が車線中央に向かって移動する。そして、車両基準位置が右側車線境界よりも車線センタ側に入ると(時点t4)、仮想路面負荷トルクTrlに基づく操舵反力が減少していく。そして、車両横位置PlatがPR_startに達すると(時点t5)、仮想路面負荷トルクTrlに基づく操舵反力が一定値となる。
 この後、車両横位置PlatがPR_returnに達すると(時点t6)、W1が漸増されるとともにW2が漸減され、時点t7でW1=1、W2=0となる。つまり、制御モードが第1制御モードとなる。
 時点t6からt7までは、仮想路面負荷トルクTrlに基づく操舵反力の一部が反映されるため、操舵反力は徐々に小さくなる。そして、時点t7からは制御モードが第1制御モードとなるため、仮想路面負荷トルクTrlに基づく操舵反力は0となる。
 前述の実施形態では、手動操舵指令値生成部42によってアシスト制御および運転支援のための舵角制御とは独立して操舵反力を設計することができる。
 また、前述の実施形態では、ドライバは、車両の横位置に応じた反力を操舵トルクとして感じることができるため、車線逸脱防止の効果が向上する。
 また、前述の実施形態では、第1重みW1を1から0(第2重みW1を0から1)に切り替えるための第1車両横位置と、第1重みW1を0から1(第2重みW1を1から0)に切り替えるための第2車両横位置とが異なる位置に設定されている。具体的には、第2車両横位置は、第1車両横位置よりも車線中央側に設定されている。これにより、車線逸脱方向に向かうときのドライバへの反力生成と、車線中央に戻るときの車両挙動の安定化を両立させることが可能となる。
 言い換えれば、第2車両横位置を、第1車両横位置と同じ位置に設定すると、大きな操舵反力が作用しているときに、制御モードが第2制御モードから第1制御モードに切り替えられるため、車両挙動が安定しなくなる恐れがある。
 また、前述の実施形態では、現在走行車線の外側の環境(隣接車線の有無、ガードレールの有無等)に応じた危険度をドライバがハンドルを介して直感的に認識できるようになる。
 以上、この発明の実施形態および変形例について説明したが、この発明はさらに他の形態で実施することもできる。
 前述の実施形態では、仮想負荷ばね剛性係数kvlおよび仮想負荷粘性減衰係数cvlは、車両横位置Platに応じて変化するように設定されているが、レーン境界線と車両進行方向のなす角(ヘディング角)、車両横位置Platの時間微分値、ヘディング角の微分値等に応じて変化するように設定されてよい。
 また、仮想負荷ばね剛性係数kvlおよび仮想負荷粘性減衰係数cvlは、予め設定された固定値が用いられてもよい。
 また、前述の実施形態では、車両横位置Platは、車両が現在走行している車線の境界(車線境界)から、車両基準位置までの距離であったが、車両横位置Platは、車両が現在走行している車線の中央から、車両基準位置までの距離であってもよい。
 前述の実施形態では、アシストトルク指令値Tasstに第1重みW1が乗算され、第1重み乗算後のアシストトルク指令値W1・Tasstが加算部47に与えられている。しかし、これに代えて、手動操舵指令値θMD,cmdに応じた手動トルク指令値に第1重みW1を乗算し、第1重み乗算後の手動トルク指令値を加算部47に与えるようにしてもよい。
 また、前述の実施形態では、角度制御部44(図5参照)は、フィードフォワード制御部53を備えているが、フィードフォワード制御部53を省略してもよい。この場合には、フィードバック制御部52によって演算されるフィードバック制御トルクTfbが基本目標トルクとなる。
 また、この実施形態による運転支援制御(LKA)は、車両を車線中央に沿って走行させるレーンセンタリングアシスト(LCA)制御が行われている場合にも、併用することができる。
 また、前述の実施形態では、この発明をコラムタイプEPSに適用した場合の例を示したが、この発明は、コラムタイプ以外のEPSにも適用することができる。また、この発明は、ステアバイワイヤシステムにも適用することができる。
 本発明の実施形態について詳細に説明してきたが、これらは本発明の技術的内容を明らかにするために用いられた具体例に過ぎず、本発明はこれらの具体例に限定して解釈されるべきではなく、本発明の範囲は添付の請求の範囲によってのみ限定される。
 1…電動パワーステアリング装置、3…転舵輪、4…転舵機構、18…電動モータ、41…アシストトルク指令値設定部、42…手動操舵指令値生成部、43…統合角度指令値演算部、44…角度制御部、45…第1重み乗算部、46…第2重み乗算部、47…加算部、48…トルク制御部、49…重み設定部

Claims (5)

  1.  舵角制御用の電動モータを駆動制御するためのモータ制御装置であって、
     操舵トルクを用いてアシストトルク指令値を生成するアシストトルク指令値生成部と、
     前記操舵トルクおよび前記アシストトルク指令値を用いて手動操舵指令値を生成する手動操舵指令値生成部と、
     運転支援用の自動操舵指令値に前記手動操舵指令値を加算して、統合角度指令値を演算する統合角度指令値演算部と、
     運転支援モード時において、前記アシストトルク指令値または前記手動操舵指令値に基づいて前記電動モータを制御する第1制御モードと、前記統合角度指令値に基づいて前記電動モータを制御する第2制御モードとを、車線に対する車両の横位置に応じて切り替える切替部とを含む、モータ制御装置。
  2.  前記第1制御モードから前記第2制御モードに切り替わる前記横位置である第1横位置と、前記第2制御モードから前記第1制御モードに切り替わる前記横位置である第2横位置とが、異なる位置に設定されている、請求項1に記載のモータ制御装置。
  3.  前記手動操舵指令値は、仮想路面負荷トルクを考慮して、前記手動操舵指令値を演算するように構成されている、請求項1または2に記載のモータ制御装置。
  4.  前記仮想路面負荷トルクは、車線に対する車両の横位置に応じて設定される、請求項3に記載のモータ制御装置。
  5.  前記仮想路面負荷トルクは、車両が走行している車線の外側の情報に基づいて設定される、請求項3または4に記載のモータ制御装置。
PCT/JP2021/041059 2021-11-08 2021-11-08 モータ制御装置 WO2023079765A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
PCT/JP2021/041059 WO2023079765A1 (ja) 2021-11-08 2021-11-08 モータ制御装置
PCT/JP2022/020124 WO2023079776A1 (ja) 2021-11-08 2022-05-12 モータ制御装置
JP2023557616A JPWO2023079776A1 (ja) 2021-11-08 2022-05-12
CN202280074453.1A CN118284551A (zh) 2021-11-08 2022-05-12 马达控制装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2021/041059 WO2023079765A1 (ja) 2021-11-08 2021-11-08 モータ制御装置

Publications (1)

Publication Number Publication Date
WO2023079765A1 true WO2023079765A1 (ja) 2023-05-11

Family

ID=86240925

Family Applications (2)

Application Number Title Priority Date Filing Date
PCT/JP2021/041059 WO2023079765A1 (ja) 2021-11-08 2021-11-08 モータ制御装置
PCT/JP2022/020124 WO2023079776A1 (ja) 2021-11-08 2022-05-12 モータ制御装置

Family Applications After (1)

Application Number Title Priority Date Filing Date
PCT/JP2022/020124 WO2023079776A1 (ja) 2021-11-08 2022-05-12 モータ制御装置

Country Status (3)

Country Link
JP (1) JPWO2023079776A1 (ja)
CN (1) CN118284551A (ja)
WO (2) WO2023079765A1 (ja)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1173597A (ja) * 1997-08-28 1999-03-16 Mitsubishi Motors Corp 車線逸脱防止装置
JP2001048035A (ja) * 1999-08-10 2001-02-20 Nissan Motor Co Ltd 車線追従装置
JP2007326534A (ja) * 2006-06-09 2007-12-20 Toyota Motor Corp 車両用車線維持支援装置
WO2009110151A1 (ja) * 2008-03-04 2009-09-11 日産自動車株式会社 車線維持支援装置及び車線維持支援方法
JP2016107750A (ja) * 2014-12-04 2016-06-20 日産自動車株式会社 車線維持支援装置及び車線維持支援方法
JP2019194059A (ja) * 2018-04-27 2019-11-07 株式会社ジェイテクト モータ制御装置
JP2020019346A (ja) * 2018-07-31 2020-02-06 株式会社ジェイテクト モータ制御装置
JP2020023221A (ja) * 2018-08-06 2020-02-13 マツダ株式会社 車両制御装置および車両制御方法

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5386873B2 (ja) 2008-07-30 2014-01-15 日産自動車株式会社 車両用操舵装置及び車両用操舵方法
JP6876242B2 (ja) 2015-12-24 2021-05-26 株式会社ジェイテクト ハンドル操作状態判定装置
JP6709516B2 (ja) 2018-08-06 2020-06-17 株式会社ジェイテクト ハンドル操作状態判定装置
JP7145389B2 (ja) 2018-10-09 2022-10-03 株式会社ジェイテクト 操舵装置
JP7202528B2 (ja) 2019-03-07 2023-01-12 株式会社ジェイテクト ドライバトルク推定装置

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1173597A (ja) * 1997-08-28 1999-03-16 Mitsubishi Motors Corp 車線逸脱防止装置
JP2001048035A (ja) * 1999-08-10 2001-02-20 Nissan Motor Co Ltd 車線追従装置
JP2007326534A (ja) * 2006-06-09 2007-12-20 Toyota Motor Corp 車両用車線維持支援装置
WO2009110151A1 (ja) * 2008-03-04 2009-09-11 日産自動車株式会社 車線維持支援装置及び車線維持支援方法
JP2016107750A (ja) * 2014-12-04 2016-06-20 日産自動車株式会社 車線維持支援装置及び車線維持支援方法
JP2019194059A (ja) * 2018-04-27 2019-11-07 株式会社ジェイテクト モータ制御装置
JP2020019346A (ja) * 2018-07-31 2020-02-06 株式会社ジェイテクト モータ制御装置
JP2020023221A (ja) * 2018-08-06 2020-02-13 マツダ株式会社 車両制御装置および車両制御方法

Also Published As

Publication number Publication date
JPWO2023079776A1 (ja) 2023-05-11
CN118284551A (zh) 2024-07-02
WO2023079776A1 (ja) 2023-05-11

Similar Documents

Publication Publication Date Title
JP7116888B2 (ja) モータ制御装置
JP7236037B2 (ja) 車両用操舵装置
JP7194326B2 (ja) モータ制御装置
JP7129004B2 (ja) モータ制御装置
CN110406589B (zh) 马达控制装置
JP7194340B2 (ja) モータ制御装置
JP2019098817A (ja) 車両用操舵装置
EP3626580B1 (en) Motor control device and motor control method
JP7256958B2 (ja) 電動パワーステアリング装置
CN113928410A (zh) 转向装置
WO2023144895A1 (ja) モータ制御装置
WO2023100369A1 (ja) モータ制御装置
WO2023079765A1 (ja) モータ制御装置
JP2023048867A (ja) モータ制御装置
WO2023286169A1 (ja) モータ制御装置
WO2023062748A1 (ja) モータ制御装置
WO2023032010A1 (ja) 操舵装置
WO2023084646A1 (ja) 操舵装置
WO2024106377A1 (ja) モータ制御装置
WO2023127149A1 (ja) モータ制御装置
WO2024180745A1 (ja) 操舵装置
WO2023139808A1 (ja) モータ制御装置
WO2023079764A1 (ja) モータ制御装置
JP2023069907A (ja) モータ制御装置
CN118591488A (en) Motor control device

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: 21963356

Country of ref document: EP

Kind code of ref document: A1