Real-time reporting and estimating of mass of vehicles using drive characteristics
11754434 · 2023-09-12
Assignee
Inventors
- Tai-Sik Hwang (Foster City, CA, US)
- Justin Tomlin (San Francisco, CA, US)
- Elias Stein (San Francisco, CA, US)
- James Michael Castelaz (Alameda, CA, US)
Cpc classification
G07C5/08
PHYSICS
International classification
Abstract
A vehicle includes a vehicle mass estimator circuit. The vehicle mass estimator circuit is configurable to estimate a mass of vehicle during real-time operation of the vehicle without employing a scale or dedicated mass sensing system. The vehicle mass estimator circuit generates the vehicle mass M.sub.v from: (1) an estimated torque or sensed torque, (2) an estimated motor angular velocity or sensed motor angular velocity, and (3) sensed acceleration or without any sensed acceleration. In one embodiment, the vehicle mass estimator circuit senses motor current during vehicle operation and estimates a mass of the vehicle using the motor current without any dedicated acceleration sensor such as an accelerometer. A motor angular velocity is estimated from the motor current. In another embodiment, the vehicle mass estimator circuit senses motor current during vehicle operation and estimates a mass of the vehicle using the motor current and acceleration information provided by an accelerometer.
Claims
1. A method comprising: (a) sensing motor current during operation of a vehicle, wherein the vehicle has a motor that is mechanically coupled to wheels of the vehicle, and wherein the motor is on the vehicle; (b) estimating a mass of the vehicle using the motor current sensed in (a) ; and (c) estimating around slope using the motor current and vehicle acceleration, wherein the ground slope is estimated while the vehicle is moving, and wherein the ground slope is used in (b) to estimate the mass.
2. The method of claim 1, wherein motor angular velocity is determined using the motor current of (a), and wherein the motor angular velocity is used in (b).
3. The method of claim 1, wherein the motor angular velocity is determined by using a sensor, and wherein the motor angular velocity is used in (b).
4. The method of claim 1, wherein a vehicle acceleration sensor is used to sense vehicle acceleration, and the vehicle acceleration is also used in (b) to estimate the mass.
5. The method of claim 1, wherein no wheel speed sensor is used to estimate mass in (b).
6. The method of claim 1, wherein no torque sensor is used to estimate mass in (b).
7. A vehicle comprising: a wheel; a motor coupled to drive the wheel, wherein the motor is on the vehicle; a motor current sensor; and a controller that generates a vehicle mass estimation using motor current information detected by the motor current sensor, wherein in generating the vehicle mass estimation, the controller estimates ground slope using the motor current information in addition to a vehicle acceleration that is sensed while the vehicle is moving.
8. The vehicle of claim 7, wherein the motor current sensor is coupled in series with a winding of the motor.
9. The vehicle of claim 7, wherein the motor current sensor is taken from the group consisting of: a hall effect current sensor, a resistive shunt, and a current sense circuit.
10. The vehicle of claim 7, further comprising: a motor angular velocity sensor, wherein the motor angular velocity sensor is taken from the group consisting of: an encoder or a resolver.
11. The vehicle of claim 7, wherein the controller generates the vehicle mass estimation using motor current information and without using motor angular velocity information provided by a dedicated motor angular velocity sensor.
12. The vehicle of claim 7, further comprising: a vehicle acceleration sensor, wherein the vehicle acceleration sensor is used to sense vehicle acceleration, and wherein the vehicle acceleration sensed by the vehicle acceleration sensor is used by the controller in generating the vehicle mass estimation in addition to using motor current information.
13. The vehicle of claim 7, wherein the controller generates the vehicle mass estimation using motor current information.
14. The vehicle of claim 7, wherein the controller does not use any wheel speed sensor in generating the vehicle mass estimation.
15. A vehicle comprising: a motor current sensor that senses motor current of a motor coupled to drive a wheel, wherein the motor is disposed on the vehicle; and means for generating a vehicle mass estimation using the motor current sensed by the motor current sensor, wherein in generating the vehicle mass estimation. a controller estimates ground slope using the motor current that is sensed in addition to a vehicle acceleration that is sensed while the vehicle is moving.
16. The vehicle of claim 15, wherein the means for generating is a vehicle mass estimator circuit.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) The accompanying drawings, where like numerals indicate like components, illustrate embodiments of the invention.
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
DETAILED DESCRIPTION
(15) Reference will now be made in detail to some embodiments of the invention, examples of which are illustrated in the accompanying drawings.
(16)
(17) In accordance with one novel aspect, an estimate of vehicle mass is obtained using techniques discussed below. The vehicle mass is useful in providing more robust control of the electric vehicle. In addition, numerous entities desire vehicle mass information of vehicles during vehicle operation.
(18) Longitudinal dynamics of the electric vehicle can be expressed as:
(19)
(20) where M.sub.ν represents vehicle mass, ν.sub.x represents longitudinal velocity, F.sub.T represents traction force, α represents grade slope angle, .Math. represents rolling resistance coefficient, g.sub.α represents gravity acceleration(=9.8 m/s), ρ represents air density, C.sub.d represents drag coefficient, and A.sub.ƒ represents frontal area.
(21) This technique assumes that the electric vehicle has no tire slip, is driving without a braking torque, and has a contact force that does not depend on distribution of forces. Therefore, rotational dynamics of the wheel can be expressed as:
(22)
(23) where J.sub.R represents rotor inertia, ω.sub.w represents wheel angular velocity, T.sub.w represents wheel torque, and r.sub.w represents wheel (tire) radius. The wheel angular velocity can be determined by:
(24)
(25) where r.sub.w represents wheel(tire) radius.
(26)
(27) The vehicle mass estimator circuit 101 generates the vehicle mass M.sub.v131 from: (1) a sensed torque (involving torque sensor 110) or estimated torque (involving torque model 106), (2) an estimated motor angular velocity (involving motor back EMF model 107) or sensed motor angular velocity (involving position sensor 109), and (3) sensed acceleration in a first mode (Mode A involves accelerometer 113) or no acceleration information (Mode B). The sensed or estimated torque select switch 112 selects between supplying an estimated or detected motor torque T.sub.m to the vehicle mass estimator circuit 101 that is used to generate the vehicle mass M.sub.v. The sensed or estimated angular velocity select switch 108 selects between supplying an estimated or measured motor angular velocity ω.sub.m123 to the vehicle mass estimator circuit 101 that is used to generate the vehicle mass M.sub.v. The mode switch 114 selects between a first mode (Mode A) and a second mode (Mode B). In the first mode (Mode A), an accelerometer 113 detects acceleration 128 of the vehicle 100 and the detected acceleration a.sub.g129 is supplied to the vehicle mass estimator circuit 101. In the second mode (Mode B), no accelerometer is used to detect acceleration of the vehicle 100 and the acceleration a.sub.g129 supplied to the vehicle mass estimator circuit 101 is zero. It is understood that the vehicle mass estimator circuit 101 provides more accurate estimates of vehicle mass in Mode A when an accelerometer measures and supplies vehicle acceleration as compared to Mode B where no acclerometer is employed to supply acceleration information to the vehicle mass estimator circuit 101.
(28) During operation, the MCU 103 supplies gating signals S.sub.A, S.sub.B and Sc 126 to the motor and inverter 102. In the case where the sensed or estimated torque select switch switch 112 is set to supply an estimated motor torque 120 to the vehicle mass estimator circuit 101, the current sensor 104 measures motor currents 115 and supplies current signals 118 i.sub.a and i.sub.b to D-Q transformation block 105. The D-Q transformation block 105 also receives angular position 121 θ.sub.m which is either esimated or sensed. The transformation block 105 in turn generates and supplies direct and quadrature currents 119 i.sub.d and i.sub.q to torque model block 106. The torque model block 106 generates and outputs an estimate of motor torque 120.
(29) In the case where the sensed or estimated torque select switch 112 is set to supply sensed motor torque 127 to the vehicle mass estimator circuit 101, position sensor 109 detects angular position information from motor 102 as indicated by reference numeral 116. The position sensor 109 outputs the angular position θ.sub.m to the MCU 103 as indicated by reference numeral 124, to the sensed or estimated angular velocity select switch 108 indicated by reference numeral 125. The torque sensor 110 generates and outputs sensed motor torque 127 T.sub.m to the vehicle mass estimator circuit 101.
(30) In the case where the sensed or estimated angular velocity select switch 108 is set to supply estimated motor velocity to the vehicle mass estimator circuit 101, the motor back EMF model block 107 receives the gating signals SA, SB and SC as indicated by reference numeral 126. The motor back EMF model block 107 also receives current signals i.sub.a and i.sub.b from current sensor 104 as indicated by reference numeral 117. The motor back EMF model block 107 generates and outputs estimated angular position θ.sub.m133 to the sensed or estimated angular velocity select switch 108. Differentiator 111 receives the estimated angular position θ.sub.m133 and generates and supplies motor angular velocity ω.sub.m123 to the vehicle mass estimator circuit 101.
(31) In the case where the sensed or estimated angular velocity select switch 108 is set to supply sensed motor velocity to the vehicle mass estimator circuit 101, the position sensor 109 detects angular position information from motor 102 as indicated by reference numeral 116 and supplies sensed angular position θ.sub.m125 to the sensed or estimated angular velocity select switch 108. Differentiator 111 receives the sensed angular position θ.sub.m125, and generates and supplies motor angular velocity w.sub.m123 to the vehicle mass estimator circuit 101.
(32) When an accelerometer is available, the vehicle mass estimator circuit 101 operates in a first mode (Mode A) set by mode switch 114. In the first mode (Mode A), an accelerometer 113 senses acceleration of vehicle 100 and generates acceleration information 128 a.sub.g. The acceleration information 128 a.sub.g is supplied to the mode switch 114. The mode switch 114 supplies acceleration 129 to the vehicle mass estimator circuit 101.
(33) When no accelerometer is available, the vehicle mass estimator circuit 101 operates in a second mode (Mode B) set by mode switch 114. In the second mode (Mode B), no accelerometer is used to sense an acceleration of vehicle 100. The mode switch 114 receives a ground signal 130. The mode switch 114 supplies acceleration 129 to the vehicle mass estimator circuit 101 which in the second mode (Mode B) is zero.
(34)
(35) During operation, the road grade estimator circuit 140 receives motor angular velocity ω.sub.m123 and acceleration a.sub.g129. The road grade estimator circuit 140 generates and outputs a filtered motor angular velocity ω.sub.m_LPF147 and road grade sin α 148 onto inertia estimation circuitry 142. The inertia estimation circuitry 142 also receives rotor inertia J.sub.R150 that is stored in data register 132 onto the inertia estimator circuit 144 used in Mode A. The inertia estimation circuitry 142 generates total inertia J.sub.T149 and supplies the total inertia J.sub.T149 to the mass estimator circuit 143. The mass estimator circuit 143 in turn generates and outputs vehicle mass M.sub.v131.
(36) When accelerometer sensing is available, and the vehicle mass estimator circuit is operating in the first mode (Mode A), then mode select switch 146 uses inertia estimator circuit 144 to generate total inertia J.sub.T149. On the other hand, when no accelerometer sensing is available, and the vehicle mass estimator circuit is operating in the second mode (Mode B), then mode select switch 146 uses inertia estimator circuit 145 to generate total inertia J.sub.T149. A detailed diagram of inertia estimator circuit 144 is shown in
(37) The vehicle mass estimator circuit 101 is configured for a particular vehicle chassis. To operate the vehicle mass estimator circuit 101 on a vehicle, the rotor inertia JT 150 for the vehicle chassis type is determined before operation of the vehicle mass estimator circuit 101.
(38) To develop road grade estimator circuit 140, a relationship between wheel speed, road grade, and measured acceleration is defined. If the accelerometer is tilted from the horizontal plane by the slope angle α, a measured acceleration α.sub.g that the component of gravity is projected onto its measurement axis is given as:
(39)
(40) Since wheel speed is not directly measured, a relationship must then be defined between motor angular velocity (which is available) and wheel speed. The wheel is coupled to a drivetrain with the motor. Dynamics of the drivetrain can be modeled by a transfer function G.sub.m(s) . Therefore, the wheel angular velocity from the motor angular velocity is calculated by:
(41)
(42) where K.sub.r represents the gear ratio of drivetrain and where ω.sub.m represents the motor angular velocity. G.sub.m(s) is approximated with a first order low pass filter model since the vehicle dynamics is much slower than the powertrain dynamics:
(43)
(44) where ω.sub.LPF represents the bandwidth.
(45) By combining Eq. (4) - (6), road grade sin α is calculated as follows:
(46)
(47) where R.sub.eff = r.sub.w/K.sub.r represents the effective wheel radius.
(48)
(49) To generate the road grade sin α 148, the summing element 152 determines a difference between the motor angular velocity ω.sub.m123 and the filtered motor angular velocity ω.sub.m_LPF147. The difference 161 is supplied to gain element 153 which multiplies the difference 161 by
(50)
(51) Output 162 of the gain element 153 is supplied to negative input of summing element 154. In the first mode (Mode A), the acceleration 129 is supplied to gain element 155 which divides the acceleration 129 by gravity acceleration g.sub.a and the result 163 is supplied to the summing element 154 via mode select switch 157. In the second mode (Mode B), mode select switch 157 is coupled to ground node 158 and a zero value is supplied to the summing element 154.
(52) To develop an inertia estimator circuit for the first mode (Mode A) 144 in
(53)
(54) where ω.sub.m_LPF represents the filtered motor angular velocity.
(55) Total inertia, J.sub.T, and the vehicle mass, M.sub.v, are defined as:
(56)
(57) where R.sub.eff = r.sub.w/K.sub.r represents the effective wheel radius.
(58) From Eqs. (1)-(3), (8) and (9), equivalent dynamics from the motor to the vehicle can be represented as:
(59)
(60) where T.sub.mg(J.sub.R,T.sub.m,sinα) represents the motor and grade torque model, and
(61)
(62) represents the disturbance model. The motor and grade torque model, and the disturbance model can be calculated with the known parameters of the drivetrain. Then, the state space model from Eq. (10) is given as:
(63)
(64) where
(65)
(66) .
(67) This technique uses a state estimator. In control theory, a state estimator is an algorithm that estimates the internal state variables of the state space model of the real system from the measured input and output through physical sensors. The state estimator is generally implemented with a differential equation as follows:
(68)
(69) where K.sub.1,K.sub.2 represent estimator gains.
(70)
(71) The summing element 174 detects a velocity error 186 by detecting a difference between the filtered motor angular velocity ω.sub.m_LPF147 and a velocity estimate 184 generated by the velocity model circuitry 169. The velocity error 186 is fed back to the velocity model circuitry 169 and the velocity error 186 is also supplied to the disturbance model circuitry 180. The velocity model circuitry 169 generates the velocity estimate 184 by receiving output 182 of gain element 171 onto a negative input of the summing element 172, by receiving output 192 onto another negative input of the summing element 172, by receiving result 191 onto a positive input of the summing element 172, and by receiving output 185 of gain element 175 onto another positive input of the summing element 172. The output 183 of the summing element 172 is supplied to integrator 173 which in turn generates the velocity estimate 184.
(72) The inverse inertia model circuitry 170 receives the velocity error 186 and output 190 of the motor and grade torque model 181 and generates inverse inertia 189. The inverse inertia 189 is supplied to inverse function 182 to obtain total inertia J.sub.T149. The velocity error 186 and output 190 of the motor and grade torque model 181 are multiplied together by multiplier 176. Result 187 is supplied to gain element 177 which outputs 188 to the integrator 178. Multiplier 179 multiplies output 189 of the integrator 178 with output 190 of the motor and grade torque model 181 and supplies result 191 to a positive input of the summing element 172.
(73) If the acceleration is not measured (mode B), the inertia estimator circuit 145 in
(74)
(75) where
(76)
(77) represents the disturbance model. The disturbance model includes the variations of the road grade and the known parameters of the drivetrain. An implemented differential equation for the state estimator is shown as follows:
(78)
(79) where K.sub.1,K.sub.2 are estimator gains.
(80)
(81) The summing element 202 detects a velocity error 212 by detecting a difference between the filtered motor angular velocity ω.sub.m_LPF147 and a velocity estimate 211 generated by the velocity model circuitry 193. The velocity error 212 is fed back to the velocity model circuitry 193 and the velocity error 212 is also supplied to the disturbance model circuitry 208. The velocity model circuitry 193 generates the velocity estimate 211 by receiving output 196 of multiplier 195 onto a negative input of the summing element 200, by receiving output 218 onto another negative input of the summing element 200, by receiving output 214 onto a positive input of the summing element 200, and output 213 of gain element 203 onto another positive input of the summing element 200. The output 210 of the summing element 200 is supplied to integrator 201 which in turn generates the velocity estimate 211.
(82) The inverse inertia model circuitry 194 receives the velocity error 212 and output 196 of multiplier 195 and generates inverse inertia 217. The inverse inertia 217 is supplied to inverse function 209 to obtain total inertia J.sub.T149. The velocity error 212 and output 196 of multiplier 195 are multiplied together by multiplier 204. Result 215 is supplied to gain element 205 which outputs 216 to the integrator 206. Multiplier 207 multiplies the inverse inertia 217 with output 196 of multiplier 195 and supplies the result 214 to a positive input of the summing element 200.
(83)
(84) Each mass and inertia sample is obtained by supplying a filtered motor angular velocity 225 and the motor torque 122 T.sub.m to the inertia estimator circuit 221. In this example, the inertia estimator circuit 221 is the same as the inertia estimator circuit 145 shown in
(85)
(86) In a second step (step 302), the total inertia J.sub.T and vehicle mass M.sub.V of the vehicle are stored.
(87) In a third step (step 303), a determination is made as to whether enough mass and inertia data has been collected for the specific type of chassis. If it is not determined that sufficient data has been collected, then the method proceeds to step 301. If, on the other hand, it is determined that sufficient mass and inertia data has been collected for the specific type of chassis, then the method proceeds to step 304.
(88) In a fourth step (step 304), rotor inertia J.sub.R is determined from the collected mass and inertia data. For example, regression analysis is performed on the collected data as shown in
(89) In a fifth step (step 305), the rotor inertia J.sub.R is stored such that the rotor inertia J.sub.R is available to a vehicle mass estimator circuit disposed on a vehicle having the chassis type determined from the collected mass and inertia data. For example, in
(90)
(91) In a second step (step 402), states and parameters are initialized.
(92) In a third step (step 403), a determination is made as to whether acceleration sensing is available. If it is determined that acceleration sensing is available, then the method proceeds to step 404. For example, in
(93) In a sixth step (step 406), operating characteristics are obtained, such as motor torque, velocity, and acceleration if available.
(94) In a seventh step (step 407), a determination is made as to whether operating conditions are satisfied. The operating conditions are that the motor torque is above a minimum torque, motor velocity is above a minimum velocity, and that brakes are OFF. This condition is checked to determine whether the estimator has sufficient information to update the vehicle mass estimate. If the operating conditions are satisfied, then the method proceeds to an eighth step (step 408) where vehicle mass is estimated and then updated to represent this estimation. On the other hand, if the operating conditions are not satisfied, then the method proceeds to a ninth step (step 409) where vehicle mass is updated with the prior estimated vehicle mass. In a tenth step (step 410), the vehicle mass MV is output.
(95)
(96)
(97)
(98)
(99) Although certain specific exemplary embodiments are described above in order to illustrate the invention, the invention is not limited to the specific embodiments. For example, although the vehicle 100 of