Skip to content

Commit 4d529ba

Browse files
authored
chore(autoware_mpc_lateral_controller): fix formula description in vehicle_model_bicycle_kinematics.hpp (#8971)
fix formula description in vehicle_model_bicycle_kinematics.hpp Signed-off-by: Autumn60 <harada.akiro@gmail.com>
1 parent ddfacd3 commit 4d529ba

File tree

1 file changed

+6
-3
lines changed

1 file changed

+6
-3
lines changed

control/autoware_mpc_lateral_controller/include/autoware/mpc_lateral_controller/vehicle_model/vehicle_model_bicycle_kinematics.hpp

+6-3
Original file line numberDiff line numberDiff line change
@@ -14,6 +14,7 @@
1414

1515
/*
1616
* Representation
17+
* k : reference curvature (input)
1718
* e : lateral error
1819
* th : heading angle error
1920
* steer : steering angle
@@ -32,10 +33,12 @@
3233
* dx3/dt = -(x3 - u) / tau
3334
*
3435
* Linearized model around reference point (v = v_r, th = th_r, steer = steer_r)
35-
* [0, vr, 0] [ 0] [ 0]
36-
* dx/dt = [0, 0, vr/W/cos(steer_r)^2] * x + [ 0] * u + [-vr*steer_r/W/cos(steer_r)^2]
37-
* [0, 0, 1/tau] [1/tau] [ 0]
36+
* [0, vr, 0] [ 0] [ 0]
37+
* dx/dt = [0, 0, B] * x + [ 0] * u + [-vr*k + A - B*steer_r]
38+
* [0, 0, -1/tau] [1/tau] [ 0]
3839
*
40+
* where A = vr*tan(steer_r)/W
41+
* B = vr/(W*cos(steer_r)^2) (partial derivative of A with respect to steer_r)
3942
*/
4043

4144
#ifndef AUTOWARE__MPC_LATERAL_CONTROLLER__VEHICLE_MODEL__VEHICLE_MODEL_BICYCLE_KINEMATICS_HPP_

0 commit comments

Comments
 (0)