WO2023144895A1 - Dispositif de commande de moteur - Google Patents
Dispositif de commande de moteur Download PDFInfo
- Publication number
- WO2023144895A1 WO2023144895A1 PCT/JP2022/002733 JP2022002733W WO2023144895A1 WO 2023144895 A1 WO2023144895 A1 WO 2023144895A1 JP 2022002733 W JP2022002733 W JP 2022002733W WO 2023144895 A1 WO2023144895 A1 WO 2023144895A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- command value
- steering
- reaction force
- road surface
- surface reaction
- Prior art date
Links
- 238000006557 surface reaction Methods 0.000 claims abstract description 58
- 230000033001 locomotion Effects 0.000 claims abstract description 19
- 238000013016 damping Methods 0.000 claims description 24
- 238000006243 chemical reaction Methods 0.000 claims description 19
- 230000008859 change Effects 0.000 claims description 10
- 238000013459 approach Methods 0.000 claims description 5
- 239000011159 matrix material Substances 0.000 description 19
- 230000009467 reduction Effects 0.000 description 18
- 238000010586 diagram Methods 0.000 description 15
- 230000007246 mechanism Effects 0.000 description 11
- 238000000034 method Methods 0.000 description 7
- 230000001133 acceleration Effects 0.000 description 6
- 239000003638 chemical reducing agent Substances 0.000 description 5
- 230000008569 process Effects 0.000 description 5
- 230000000694 effects Effects 0.000 description 2
- 238000001914 filtration Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000006399 behavior Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 239000000725 suspension Substances 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D5/00—Power-assisted or power-driven steering
- B62D5/04—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
- B62D6/008—Control of feed-back to the steering input member, e.g. simulating road feel in steer-by-wire applications
Definitions
- the present invention relates to a motor control device that controls an electric motor for steering angle control.
- Patent Document 1 describes a manual steering command value calculation unit that calculates a manual steering command value using a steering torque, and an integrated angle command value that calculates an integrated angle command value by adding the manual steering command value to the automatic steering command value.
- a motor control device includes a command value calculation unit and a control unit that controls the angle of an electric motor based on an integrated angle command value.
- the manual steering command value calculation unit of Patent Document 1 uses the reference EPS model to calculate the manual steering command value. Specifically, the manual steering command value calculation section calculates the manual steering command value based on the equation of motion including the spring constant and the viscous damping coefficient for giving the virtual reaction force as coefficients.
- An object of one embodiment of the present invention is to provide a motor control device that can reduce the risk of an accident or the like due to a driver's erroneous operation or the like when the driver intervenes in steering during driving assistance.
- An embodiment of the present invention includes a manual steering command value generation unit that generates a manual steering command value, and adds the manual steering command value to an automatic steering command value given in a driving assistance mode to calculate an integrated angle command value. and a controller for angle-controlling an electric motor for steering angle control based on the integrated angle command value, wherein the manual steering command value generator calculates the road surface reaction force characteristic coefficient.
- the manual steering command value generator calculates the road surface reaction force characteristic coefficient. is configured to generate the manual steering command value based on the equation of motion including further includes a road reaction force characteristic changing unit that changes the value of at least one road reaction force characteristic coefficient of .
- 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 for explaining the electrical configuration of the motor control ECU.
- FIG. 3 is a block diagram showing the configuration of the manual steering command value generator.
- FIG. 4 is a graph showing a setting example of the assist torque command value T * m,ad with respect to the steering torque Ttb .
- FIG. 5 is a schematic diagram showing an example of a reference EPS model used in the command value setting section.
- FIG. 6 is a block diagram showing the configuration of the angle control section.
- FIG. 7 is a schematic diagram showing a configuration example of a physical model of the electric power steering system.
- 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 for explaining the electrical configuration of the motor control ECU.
- FIG. 8 is a block diagram showing the configuration of the disturbance torque estimator.
- FIG. 9 is a schematic diagram showing the configuration of the torque control section.
- FIG. 10 is a flow chart showing the procedure of the road surface reaction force characteristic setting process performed by the road surface reaction force characteristic setting unit.
- FIG. 11 shows an example of the characteristics of k ⁇ * c,md with respect to ⁇ *c,md when kL is set as k and kL is set to k1 , k2, or k0
- 10 is a graph showing an example of the characteristics of k ⁇ * c,md versus ⁇ * c,md when kR is set and kR is set to k 1 , k 2 or k 0 ;
- An embodiment of the present invention includes a manual steering command value generation unit that generates a manual steering command value, and adds the manual steering command value to an automatic steering command value given in a driving assistance mode to calculate an integrated angle command value. and a controller for angle-controlling an electric motor for steering angle control based on the integrated angle command value, wherein the manual steering command value generator calculates the road surface reaction force characteristic coefficient.
- the manual steering command value generator calculates the road surface reaction force characteristic coefficient. is configured to generate the manual steering command value based on the equation of motion including further includes a road reaction force characteristic changing unit that changes the value of at least one road reaction force characteristic coefficient of .
- the road surface reaction force characteristic coefficient includes a spring constant and a viscous damping coefficient
- the road surface reaction force characteristic changing unit adjusts the spring constant and the viscous damping coefficient based on the vehicle environment information. at least one value of is changed according to the steering intervention direction or the steering direction.
- the road surface reaction force characteristic changing unit changes the road surface reaction force characteristic coefficient included in the equation of motion with respect to a steering intervention direction or a steering direction in which the own vehicle approaches another vehicle or an obstacle. It is configured to increase the value of at least one of the road reaction force characteristic coefficients.
- the road surface reaction force characteristic changing unit changes the road surface reaction force characteristic coefficient included in the equation of motion with respect to a steering intervention direction or a steering direction in which the own vehicle moves away from another vehicle or an obstacle. It is configured to decrease the value of at least one of the road reaction force characteristic coefficients.
- FIG. 1 is a schematic diagram showing a schematic configuration of an electric power steering system to which a motor control device according to one embodiment of the 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 .
- the torque sensor 12 detects a steering torque (torsion bar torque) Ttb applied to the steering wheel 2 based on relative rotational displacement amounts of the input shaft 8 and the output shaft 9 .
- the steering torque Ttb detected by the torque sensor 12 is, for example, a positive value for torque for steering to the left and a negative value for torque for steering to the right.
- the magnitude of the steering torque Ttb increases as the absolute value increases.
- 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 rotation angle ⁇ wg of the worm gear 20 to the rotation angle ⁇ ww 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 other than the motor torque.
- the disturbance torque T lc other than the motor torque includes steering torque T tb , road surface reaction torque (road surface load torque) T rl , friction torque T f and the like.
- the steering 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 (driver torque), force generated by steering inertia, or the like.
- the road surface reaction torque Trl is generated from the steerable wheel 3 side through the rack shaft 14 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 9;
- 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, a map information memory 28 storing map information and a vehicle speed sensor 29 for detecting vehicle speed V are mounted.
- 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 (ECU: Electronic Control Unit) 201 for controlling automatic driving. 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 ⁇ * c,ad for driving assistance in the driving assistance mode.
- the driving assistance is Lane Centering Assist (LCA) to keep the vehicle position in the middle of the lane (lane center).
- the automatic steering command value ⁇ * c,ad is a target steering angle value for driving the vehicle along the center of the lane.
- the automatic steering command value ⁇ * c,ad is set based on, for example, the vehicle speed, the lateral deviation of the vehicle with respect to the target travel line, and the yaw deviation of the vehicle with respect to the target travel line. Since the processing for setting the automatic steering command value ⁇ * c,ad is well known, detailed description thereof will be omitted here.
- Automatic steering control may be, for example, lane keeping assist (LKA) control for keeping the vehicle in the lane.
- LKA lane keeping assist
- the host ECU 201 sets the automatic steering command value ⁇ * c,ad to zero.
- the host ECU 201 controls the left and right side of the vehicle according to vehicle environment information, which is information related to the vehicle's running environment, based on map information and information obtained by the CCD camera 25, GPS 26, radar 27, and vehicle speed sensor 29. Generate and output directional reaction force control information.
- vehicle environment information is information related to the vehicle's running environment, based on map information and information obtained by the CCD camera 25, GPS 26, radar 27, and vehicle speed sensor 29.
- the left-right direction reaction force control information includes four types of variables kLP, kRP, cLP, and cRP. Details of these variables kLP, kRP, cLP and cRP will be described later.
- the host ECU 201 also outputs a mode signal S mode indicating whether the operation mode is the normal mode or the automatic operation mode.
- the mode signal S mode , the automatic steering command value ⁇ * c,ad , the vehicle speed V, and the reaction force control information kLP, kRP, cLP, cRP for each left and right direction are given to the motor control ECU 202 via the vehicle-mounted network.
- the steering 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 for explaining 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 that flows through the electric motor 18 (hereinafter referred to as "motor current Im, int ”).
- 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 a rotation angle calculation unit 41, a reduction ratio division unit 42, a road surface reaction force characteristic setting unit 43, a manual steering command value generation unit 44, an integrated angle command value calculation unit 45, An angle control section 46 and a torque control section 47 are included.
- the rotation angle calculator 41 calculates the rotor rotation angle ⁇ m,int of the electric motor 18 based on the output signal of the rotation angle sensor 23 .
- a reduction ratio dividing unit 42 divides the rotor rotation angle ⁇ m ,int by the reduction ratio N to convert the rotor rotation angle ⁇ m ,int into the rotation angle (actual steering angle) ⁇ c,int of the output shaft 9. .
- the road surface reaction force characteristic setting unit 43 sets the spring constant k and the viscous damping coefficient c used by the manual steering command value generation unit 44 in the driving support mode based on the left-right direction reaction force control information kLP, kRP, It is set based on cLP, cRP, and the like. Details of the operation of the road surface reaction force characteristic setting unit 43 will be described later.
- the manual steering command value generator 44 is provided to set the steering angle corresponding to the steering wheel operation as manual steering command values ⁇ * c, md when the driver operates the steering wheel 2 .
- a manual steering command value generator 44 uses the vehicle speed V and the steering torque Ttb detected by the torque sensor 12 to generate manual steering command values ⁇ * c, md . Details of the operation of the manual steering command value generator 44 will be described later.
- the integrated angle command value calculation unit 45 adds the manual steering command values ⁇ *c, md to the automatic steering command values ⁇ * c,ad set by the host ECU 201 to calculate the integrated angle command values ⁇ * c,int . do.
- the angle control unit 46 calculates a motor torque command value T * m ,int , which is a target value of the motor torque of the electric motor 18, based on the integrated angle command value ⁇ * c ,int .
- the torque control unit 47 drives the drive circuit 31 so that the motor torque of the electric motor 18 approaches the motor torque command value T * m,int . That is, the control unit including the angle control unit 46 and the torque control unit 47 controls the actual steering angle ⁇ c,int (the rotation angle ⁇ c,int of the output shaft 9) to approach the integrated angle command value ⁇ * c,int. , drive and control the drive circuit 31 . Details of the operations of the angle control section 46 and the torque control section 47 will be described later.
- FIG. 3 is a block diagram showing the configuration of the manual steering command value generator 44. As shown in FIG.
- the manual steering command value generation section 44 includes an assist torque command value setting section 51 and a command value setting section 52 .
- the assist torque command value setting unit 51 sets assist torque command values T * m and md, which are target values of assist torque required for manual operation.
- the assist torque command value setting unit 51 sets assist torque command values T * m and md based on the vehicle speed V and the steering torque Ttb detected by the torque sensor 12 .
- a setting example of the assist torque command values T * m, md with respect to the steering torque Ttb is shown in FIG.
- the assist torque command values T * m, md are positive values when the electric motor 18 is to generate a steering assist force for left steering, and the electric motor 18 generates a steering assist force for right steering. Negative value when it should.
- the assist torque command values T * m, md are positive for a positive value of the steering torque Ttb and negative for a negative value of the steering torque Ttb .
- the assist torque command values T * m, md are set such that the absolute value thereof increases as the absolute value of the steering torque Ttb increases.
- the assist torque command values T * m, md are set such that the higher the vehicle speed V, the smaller the absolute value thereof.
- the assist torque command value setting unit 51 may calculate the assist torque command values T * m, md by multiplying the steering torque Ttb by a preset constant.
- the command value setting unit 52 uses the reference EPS model to set the manual steering command value ⁇ * c. Set md .
- FIG. 5 is a schematic diagram showing an example of the reference EPS model used by the command value setting unit 52.
- FIG. 5 is a schematic diagram showing an example of the reference EPS model used by the command value setting unit 52.
- 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 .
- Jc is the inertia of the lower column
- ⁇ c is the rotation angle of the lower column
- Ttb is the steering torque.
- This reference EPS model includes steering torque Ttb , output shaft torque command values NT * m,md acting on the output shaft 9 from the electric motor 18 based on the steering torque Ttb, assist torque command values T * m,md, and road surface reaction force
- This is a model for generating (estimating) the rotation angle ⁇ c of the lower column when the torque Trl is applied to the lower column.
- a road surface reaction torque Trl is expressed by the following equation (1) using a spring constant k and a viscous damping coefficient c.
- T rl ⁇ k ⁇ c ⁇ c(d ⁇ c /dt) (1)
- a motion equation of the reference EPS model is represented by the following equation (2).
- J c ⁇ d 2 ⁇ c /dt 2 T tb +N ⁇ T * m, md ⁇ k ⁇ c ⁇ c(d ⁇ c /dt) (2)
- the values of the spring constant k and the viscous damping coefficient c, which are the coefficients of the equation of motion of equation (2), are set by the road surface reaction force characteristic setting unit 43 .
- the spring constant k and the viscous damping coefficient c, which are the coefficients of the equation of motion of equation (2), are examples of the "road surface reaction force characteristic coefficient" in the present invention.
- the command value setting unit 52 substitutes the steering torque Ttb detected by the torque sensor 12 for Ttb , and the assist torque command value T * set by the assist torque command value setting unit 51 for N ⁇ T * m and md. By substituting m and md and solving the differential equation of equation (2), the rotation angle ⁇ c of the lower column is calculated. Then, the command value setting unit 52 sets the obtained rotation angle ⁇ c of the lower column as the manual steering command value ⁇ * c,md .
- FIG. 6 is a block diagram showing the configuration of the angle control section 46. As shown in FIG.
- the angle control unit 46 calculates a motor torque command value T * m , int based on the integrated angle command value ⁇ * c , int .
- the angle control unit 46 includes a low-pass filter (LPF) 61, a feedback control unit 62, a feedforward control unit 63, a disturbance torque estimation unit 64, a torque addition unit 65, a disturbance torque compensation unit 66, and a reduction ratio division.
- LPF low-pass filter
- a section 67 and a speed reduction ratio multiplication section 68 are included.
- the low-pass filter 61 performs low-pass filter processing on the integrated angle command value ⁇ * c,int .
- the integrated angle command value ⁇ * c, intf after low-pass filtering is given to the feedback control section 62 and the feedforward control section 63 .
- the feedback control unit 62 is provided to bring the actual steering angle ⁇ c,int calculated by the reduction ratio dividing unit 42 (see FIG. 2) closer to the integrated angle command value ⁇ * c,intf after low-pass filtering.
- the feedback control section 62 includes an angular deviation calculation section 62A and a PD control section 62B.
- the angle deviation calculation unit 62A calculates the deviation ( ⁇ * c , intf - ⁇ c,int ) may be calculated as the angular deviation ⁇ c,int .
- the PD control section 62B calculates the feedback control torque T fb ,int by performing a PD calculation (proportional differential calculation) on the angular deviation ⁇ c, int calculated by the angular deviation calculating section 62A.
- the feedback control torque T fb,int is applied to the torque adder 65 .
- the feedforward control unit 63 is provided to compensate for delay in response due to inertia of the electric power steering system 1 and improve control response.
- Feedforward control section 63 includes an angular acceleration calculation section 63A and an inertia multiplication section 63B.
- the angular acceleration calculator 63A calculates a target angular acceleration d 2 ⁇ * c,intf /dt 2 by second-order differentiating the integrated angle command value ⁇ * c, intf.
- 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 Tff ,int is given to the torque adder 65 as an inertia compensation value.
- the torque adder 65 calculates a basic torque command value (T fb,int +T ff, int ) by adding the feedforward control torque T ff,int to the feedback control torque T fb,int .
- the disturbance torque estimator 64 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).
- the disturbance torque estimation value ⁇ T lc calculated by the disturbance torque estimator 64 is given to the disturbance torque compensator 66 as a disturbance torque compensation value.
- the output shaft torque command value T * c,int is given to the reduction ratio dividing section 67 .
- a reduction ratio division unit 67 divides the output shaft torque command value T * c,int by the reduction ratio N to calculate a motor torque command value T * m,int .
- This motor torque command value T * m,int is given to the torque control section 47 (see FIG. 2).
- the disturbance torque estimator 64 will be described in detail.
- the disturbance torque estimator 64 uses, for example, the physical model 101 of the electric power steering system 1 shown in FIG. Consists of observers.
- 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 .
- the plant 102 is provided with a steering torque Ttb from the steering wheel 2 through the torsion bar 10 and a road surface reaction torque Trl from the steered wheels 3 side.
- 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 steering torque Ttb , the road surface reaction torque Trl , and the friction torque Tf . contains.
- the state equation for the physical model 101 in FIG. 7 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 feedthrough 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
- C e 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).
- ⁇ c ,int is the estimated value of ⁇ c ,int
- ⁇ Tlc is the estimated value of Tlc .
- the disturbance torque estimator 64 calculates the state variable vector ⁇ xe based on the equation (7).
- FIG. 8 is a block diagram showing the configuration of the disturbance torque estimator 64. As shown in FIG. 8
- the disturbance torque estimation unit 64 includes an input vector input unit 81, an output matrix multiplication unit 82, a first addition unit 83, a gain multiplication unit 84, an input matrix multiplication unit 85, a system matrix multiplication unit 86, a second It includes an addition section 87 , an integration section 88 and a state variable vector output section 89 .
- the input vector input unit 81 outputs an input vector u1 .
- the output of the integrator 88 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 86 multiplies the state variable vector ⁇ x e by the system matrix A e .
- the output matrix multiplier 82 multiplies the state variable vector ⁇ x e 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 the above equation (7)).
- the input matrix multiplication unit 85 multiplies the input vector u1 output from the input vector input unit 81 by the input matrix Be .
- the second adder 87 outputs the input matrix multiplier 85 output (B e ⁇ u 1 ), the system matrix multiplier 86 output (A e ⁇ x e ), and the gain multiplier 84 output (L(y ⁇ y)) is added to calculate the differential value d ⁇ x e /dt of the state variable vector.
- the integrator 88 calculates the state variable vector ⁇ x e by integrating the output (d ⁇ x e /dt) of the second adder 87 .
- a state variable vector output unit 89 calculates an estimated disturbance torque value ⁇ T lc , an estimated steering angle value ⁇ c,int, and an estimated angular velocity value d ⁇ c,int /dt based on the state variable vector ⁇ x e . .
- 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 ⁇ c,int /dt 2 and N ⁇ T * m, int . 23 noise.
- 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. 9 is a block diagram showing the electrical configuration of the torque control section 47.
- Torque control unit 48 includes motor current command value calculation unit 91 , current deviation calculation unit 92 , PI control unit 93 , and PWM (Pulse Width Modulation) control unit 94 .
- the motor current command value calculation unit 91 divides the motor torque command value T * m,int calculated by the angle control unit 46 by the torque constant Kt of the electric motor 18 to obtain the motor current command value I * m,int. to calculate
- the PI control unit 93 performs PI calculation (proportional-integral calculation) on the current deviation ⁇ I m,int calculated by the current deviation calculation unit 92, thereby converting the motor current Im, int flowing through the electric motor 18 into the motor current command value. Generate a drive command value for leading to I * m,int .
- the PWM control section 94 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 .
- the road surface reaction force characteristic setting unit 43 performs a road surface reaction force characteristic setting process for setting the spring constant k and the viscous damping coefficient c, which are used in the calculation of the manual steering command values ⁇ * c and md in the driving assistance mode. .
- the manual steering command values ⁇ * c, md are calculated by the command value setting section 52 (see FIG. 3).
- the steering intervention direction refers to the direction of the manual steering command value ⁇ * c,md when the automatic steering command value ⁇ * c, ad is used as a reference.
- the direction of steering intervention when ⁇ * c,md ⁇ 0 is called the left steering intervention direction
- the direction of steering intervention when ⁇ * c,md ⁇ 0 is called the right steering intervention direction.
- the steering direction is the direction in which the manual steering command values ⁇ * c, md are changing.
- the steering direction when d ⁇ * c,md /dt ⁇ 0 is referred to as the left steering direction, and the steering direction when d ⁇ * c,md /dt ⁇ 0 is referred to as the right steering direction.
- kL , kR , cL , and cR are variables used in the road surface reaction force characteristic setting process, and are defined as follows.
- kL Variable representing spring constant k for left steering intervention direction ( ⁇ * c, md ⁇ 0)
- kR Variable representing spring constant k for right steering intervention direction ( ⁇ * c, md ⁇ 0)
- cL Left Variable c R representing the viscous damping coefficient c for the steering direction (d ⁇ * c, md/dt ⁇ 0): Variable representing the viscous damping coefficient c for the right steering direction (d ⁇ * c, md /dt ⁇ 0)
- k 0 , k 1 , and k 2 are candidate values for the spring constant k pre-stored in the memory of the motor control ECU 202, and are set to the following values.
- c 0 , c 1 , and c 2 are the motor It is a candidate value of the viscous damping coefficient c preliminarily stored in the memory of the control ECU 202, and is set to the following value.
- c0 intermediate viscous damping coefficient candidate value
- c1 viscous damping coefficient candidate value smaller than c0
- c2 viscous damping coefficient candidate value larger than c0
- the force control information kLP, kRP, cLP and cRP have the following meanings.
- kLP A parameter representing “small”, “medium” or “large” with respect to kL , and takes a value of 1 (small), 0 (medium) and 2 (large) .
- kRP A parameter representing "small”, “medium” or “large” with respect to kR , and takes one of the values 1 (small), 0 (medium) and 2 (large) .
- cLP A parameter representing "small”, “moderate” or “large” relative to cL , taking values of 1 (small), 0 (moderate) and 2 (large) .
- cRP A parameter representing “small”, “medium” or “large” relative to cR , and takes values of 1 (small), 0 (medium) and 2 (large) .
- the host ECU 201 determines the respective values of the left-right direction reaction force control information kLP, kRP, cLP, and cRP, and provides them to the motor control ECU 202 .
- the host ECU 201 may determine the respective values of kLP, kRP, cLP, and cRP, for example, for the purpose of avoiding danger.
- the higher-level ECU 201 detects other vehicles in the vicinity and detects the direction in which the other vehicle is present (the direction in which the own vehicle approaches the other vehicle).
- the values of kLP, kRP, cLP, and cRP are determined so that the reaction force (both or either one of k and c) increases.
- the host ECU 201 sets kLP and cLP to 0, and sets kRP and cRP to 2. In this case, host ECU 201 may set kLP, cLP and cRP to 0 and set kRP to 2. Also, in this case, the host ECU 201 may set kLP, kRP, and cLP to 0 and set cRP to 2. In this case, host ECU 201 may set kLP and cLP to 1 and set kRP and cRP to 0.
- the host ECU 201 detects obstacles such as walls, pedestrians, bicycles, and the like while the vehicle is running, and detects reaction forces (k, c (both or either one of) is increased.
- steering to the outside of the curve has a smaller margin for lane departure than steering to the inside of the curve. or one of them) is determined to increase kLP, kRP, cLP, and cRP.
- the host ECU 201 may determine the respective values of kLP, kRP, cLP, and cRP, for example, for the purpose of driving instruction.
- the higher-level ECU 201 controls the reaction force (k, c Each value of kLP, kRP, cLP, and cRP is determined such that both or either one) is decreased.
- host ECU 201 determines the respective values of kLP, kRP, cLP, and cRP so as to increase the reaction force (both or either one of k and c) with respect to the steering direction that causes unpleasant vehicle behavior.
- FIG. 10 is a flow chart showing the procedure of the road surface reaction force characteristic setting process performed by the road surface reaction force characteristic setting unit 43 .
- the road surface reaction force characteristic setting process shown in FIG. 10 is started each time the driving assistance mode is started, and is repeatedly executed at predetermined calculation cycles until the driving assistance mode is canceled.
- the road surface reaction force characteristic setting unit 43 first acquires kLP, kRP, cLP and cRP given from the host ECU 201 (step S1).
- the road surface reaction force characteristic setting unit 43 sets k(kLP) corresponding to kLP to kL , sets k (kRP) to kR corresponding to kRP, sets cL to cLP, and sets k (kRP) to kR.
- c (cLP) is set according to cRP
- the road surface reaction force characteristic setting unit 43 determines whether or not the previous value ( ⁇ * c, md(n ⁇ 1) ) of ⁇ * c,md is 0 or more (step S3).
- step S6 it is determined whether or not the previous value (d ⁇ * c ,md /dt) (n ⁇ 1) of d ⁇ * c,md/dt is 0 or more.
- step S6 If (d ⁇ * c,md / dt) (n ⁇ 1) ⁇ 0 (step S6: YES), the road surface reaction force characteristic setting unit 43 sets the viscosity
- the target value k target may be switched to by gradually approaching the target value k target from k before change. In this case, k before change is switched to the target value k target after a plurality of calculation cycles.
- the new value (target value c target ) of the viscous damping coefficient c used when calculating ⁇ * c, md this time is changed, the Over time, the target value c before change may be gradually brought closer to the target value c target and then switched to the target value c target . In this case, c before change is switched to the target value c target after a plurality of calculation cycles.
- FIG. 11 shows an example of the characteristics of k ⁇ * c,md with respect to ⁇ *c,md when kL is set as k and kL is set to k1 , k2, or k0
- 10 is a graph showing an example of the characteristics of k ⁇ * c,md versus ⁇ * c,md when kR is set and kR is set to k 1 , k 2 or k 0 ;
- FIG. 12 shows an example of the characteristics of c ⁇ d ⁇ * c,md /dt with respect to d ⁇ md / dt when cL is set as c and cL is set to c1, c2, or c0, and c and cR is set to c 1 , c 2 or c 0 , and an example of the characteristics of c ⁇ d ⁇ * c,md /dt versus d ⁇ md /dt.
- the road surface reaction force characteristic setting unit 43 sets k 0 and c 0 as the spring constant k and the viscous damping coefficient c, respectively. That is, in the normal mode, the spring constant k and the viscous damping coefficient c are not changed.
- the road surface reaction force characteristic setting unit 43 may change both the spring constant k and the viscous damping coefficient c, or may change either one of the spring constant k and the viscous damping coefficient c. You may make it change. That is, the road surface reaction force characteristic setting unit 43 may change at least one of the spring constant k and the viscous damping coefficient c in the driving assistance mode.
- three types of candidate values k 0 , k 1 , and k 2 are prepared as candidate values of k L and k R , but two types of candidate values are prepared as candidate values of k L and k R.
- a value may be prepared, or four types of candidate values may be prepared.
- three types of candidate values c 0 , c 1 , and c 2 are prepared as candidate values for c L and c R
- two types of candidate values are prepared as candidate values for c L and c R.
- four types of candidate values may be prepared.
- the types of values taken by the lateral reaction force control information kLP, kRP, cLP, and cRP also change.
- the higher-level ECU 201 determines the respective values of the left-right direction reaction force control information kLP, kRP, cLP, and cRP based on the vehicle environment information, and provides them to the motor control ECU 202 .
- the road surface reaction force characteristic setting unit 43 sets the left-right direction reaction force control information kLP, kRP, cLP, cRP given from the host ECU 201 and both or either of the steering intervention direction and the steering direction. At least one value of the spring constant k and the viscous damping coefficient c can be changed based on. As a result, when the driver intervenes in steering during driving assistance, it is possible to reduce the risk of an accident or the like occurring due to an erroneous operation by the driver or the like.
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
Ce dispositif de commande de moteur comporte : une unité de génération de valeur d'instruction de direction manuelle qui génère une valeur d'instruction de direction manuelle; une unité de calcul de valeur d'instruction d'angle intégré qui ajoute la valeur d'instruction de direction manuelle à une valeur d'instruction de direction automatique appliquée lorsqu'elle est dans un mode d'aide à la conduite et calcule une valeur d'instruction d'angle intégrée; et une unité de commande qui utilise la valeur d'instruction d'angle intégrée comme base pour réaliser une commande d'angle d'un moteur électrique pour une commande de direction. L'unité de génération de valeur d'instruction de direction manuelle est configurée de manière à générer la valeur d'instruction de direction manuelle sur la base d'une équation de mouvement comportant des coefficients caractéristiques de force de réaction de surface de route, et ladite unité de génération de valeur d'instruction de direction manuelle comporte en outre une unité de changement de caractéristique de force de réaction de surface de route qui modifie au moins un coefficient de caractéristique de force de réaction de surface de route parmi les coefficients de caractéristique de force de réaction de surface de route inclus dans l'équation de mouvement sur la base d'informations d'environnement de véhicule qui sont des informations relatives à l'environnement de déplacement d'un véhicule.
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2022/002733 WO2023144895A1 (fr) | 2022-01-25 | 2022-01-25 | Dispositif de commande de moteur |
CN202280089808.4A CN118591488A (zh) | 2022-01-25 | 2022-01-25 | 马达控制装置 |
JP2023576295A JPWO2023144895A1 (fr) | 2022-01-25 | 2022-01-25 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2022/002733 WO2023144895A1 (fr) | 2022-01-25 | 2022-01-25 | Dispositif de commande de moteur |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2023144895A1 true WO2023144895A1 (fr) | 2023-08-03 |
Family
ID=87471210
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2022/002733 WO2023144895A1 (fr) | 2022-01-25 | 2022-01-25 | Dispositif de commande de moteur |
Country Status (3)
Country | Link |
---|---|
JP (1) | JPWO2023144895A1 (fr) |
CN (1) | CN118591488A (fr) |
WO (1) | WO2023144895A1 (fr) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024106377A1 (fr) * | 2022-11-14 | 2024-05-23 | 株式会社ジェイテクト | Dispositif de commande de moteur |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019014468A (ja) * | 2017-07-07 | 2019-01-31 | 株式会社ジェイテクト | 操舵装置 |
US20190031231A1 (en) * | 2017-07-27 | 2019-01-31 | Steering Solutions Ip Holding Corporation | Tire load estimation using steering system signals |
JP2019182393A (ja) * | 2018-04-17 | 2019-10-24 | 株式会社ジェイテクト | ドライバトルク推定装置およびそれを備えた操舵装置 |
JP2019194059A (ja) | 2018-04-27 | 2019-11-07 | 株式会社ジェイテクト | モータ制御装置 |
WO2019225289A1 (fr) * | 2018-05-21 | 2019-11-28 | 株式会社ジェイテクト | Dispositif de commande de moteur |
JP2020019346A (ja) * | 2018-07-31 | 2020-02-06 | 株式会社ジェイテクト | モータ制御装置 |
JP2020049962A (ja) * | 2018-09-21 | 2020-04-02 | 株式会社ジェイテクト | モータ制御装置 |
JP2020132008A (ja) * | 2019-02-21 | 2020-08-31 | 株式会社ジェイテクト | 操舵装置 |
JP2020168918A (ja) * | 2019-04-02 | 2020-10-15 | 株式会社ジェイテクト | 操舵装置 |
JP2021000950A (ja) * | 2019-06-24 | 2021-01-07 | 株式会社ジェイテクト | 操舵角演算装置およびそれを利用したモータ制御装置 |
-
2022
- 2022-01-25 CN CN202280089808.4A patent/CN118591488A/zh active Pending
- 2022-01-25 JP JP2023576295A patent/JPWO2023144895A1/ja active Pending
- 2022-01-25 WO PCT/JP2022/002733 patent/WO2023144895A1/fr unknown
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019014468A (ja) * | 2017-07-07 | 2019-01-31 | 株式会社ジェイテクト | 操舵装置 |
US20190031231A1 (en) * | 2017-07-27 | 2019-01-31 | Steering Solutions Ip Holding Corporation | Tire load estimation using steering system signals |
JP2019182393A (ja) * | 2018-04-17 | 2019-10-24 | 株式会社ジェイテクト | ドライバトルク推定装置およびそれを備えた操舵装置 |
JP2019194059A (ja) | 2018-04-27 | 2019-11-07 | 株式会社ジェイテクト | モータ制御装置 |
WO2019225289A1 (fr) * | 2018-05-21 | 2019-11-28 | 株式会社ジェイテクト | Dispositif de commande de moteur |
JP2020019346A (ja) * | 2018-07-31 | 2020-02-06 | 株式会社ジェイテクト | モータ制御装置 |
JP2020049962A (ja) * | 2018-09-21 | 2020-04-02 | 株式会社ジェイテクト | モータ制御装置 |
JP2020132008A (ja) * | 2019-02-21 | 2020-08-31 | 株式会社ジェイテクト | 操舵装置 |
JP2020168918A (ja) * | 2019-04-02 | 2020-10-15 | 株式会社ジェイテクト | 操舵装置 |
JP2021000950A (ja) * | 2019-06-24 | 2021-01-07 | 株式会社ジェイテクト | 操舵角演算装置およびそれを利用したモータ制御装置 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024106377A1 (fr) * | 2022-11-14 | 2024-05-23 | 株式会社ジェイテクト | Dispositif de commande de moteur |
Also Published As
Publication number | Publication date |
---|---|
JPWO2023144895A1 (fr) | 2023-08-03 |
CN118591488A (zh) | 2024-09-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3608203B1 (fr) | Appareil de commande de moteur | |
JP7236038B2 (ja) | 車両用操舵装置 | |
JP7194326B2 (ja) | モータ制御装置 | |
EP3798099B1 (fr) | Dispositif de commande de moteur | |
JP2019098817A (ja) | 車両用操舵装置 | |
EP3626580B1 (fr) | Dispositif et procédé de commande de moteur | |
EP3744611B1 (fr) | Système de direction fonctionnant à l'énergie électrique | |
EP3939861B1 (fr) | Dispositif de direction | |
WO2023144895A1 (fr) | Dispositif de commande de moteur | |
WO2023100369A1 (fr) | Dispositif de commande de moteur | |
JP2023048867A (ja) | モータ制御装置 | |
WO2023062748A1 (fr) | Dispositif de commande de moteur | |
WO2023079765A1 (fr) | Dispositif de commande de moteur | |
WO2024106377A1 (fr) | Dispositif de commande de moteur | |
WO2024180745A1 (fr) | Dispositif de direction | |
WO2023286169A1 (fr) | Dispositif de commande de moteur | |
JP2023069907A (ja) | モータ制御装置 | |
WO2023032010A1 (fr) | Dispositif de direction | |
WO2023084646A1 (fr) | Dispositif de direction | |
WO2022264309A1 (fr) | Dispositif de direction pour véhicule | |
WO2023127149A1 (fr) | Dispositif de commande de moteur | |
WO2023139808A1 (fr) | Dispositif de commande de moteur | |
WO2023079764A1 (fr) | Dispositif de commande de moteur |
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: 22923764 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2023576295 Country of ref document: JP Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2022923764 Country of ref document: EP Effective date: 20240826 |