ZJU-FAST-Lab / ego-planner

GNU General Public License v3.0
1.41k stars 281 forks source link

a question in file "SO3Control.cpp" #42

Closed 19ohh closed 2 years ago

19ohh commented 2 years ago

Hi, Gao, in SO3Control.cpp of the uav-simulator module in your Ego planner code, there are several parameters A, B, C, s (about in line 82-87), they are used to calculate the variable force_ (force.noalias() = s f + mass_ g * Eigen::Vector3d(0, 0, 1);) Can you please explain what is the theoretical basis for this calculation? Thank you!

bigsuperZZZX commented 2 years ago

It's just a geometry problem. The code changes the direction of the body-z vector to a limited angle to world-z. In fact, any reasonable engineering consideration works.