ZJU-FAST-Lab / ego-planner-swarm

An efficient single/multi-agent trajectory planner for multicopters.
GNU General Public License v3.0
1.14k stars 223 forks source link

Yaw speed and height constraints #6

Closed robin-shaun closed 3 years ago

robin-shaun commented 3 years ago

Hello, I see that there are constraints for velocity max_veland acceleration max_acc in the launch file. Is there any way to constraint the yaw speed because the large yaw speed may cause VIO failure.

Moreover, I see grid_map/virtual_ceil_height, grid_map/visualization_truncate_height and map_size_z in the launch files. But it seems that they cannot limit the z position setpoint.

bigsuperZZZX commented 3 years ago

First question: the way to constrain yaw speed is trivial, which can be changed here.

Second question: is the "setpoint" refer to the goal you give? There is no way to limit it, you have to take of it yourself.

robin-shaun commented 3 years ago

Thanks a lot. The setpoint is the trajectory given by ego_planner. For example, generally in the indoor simulation, there is no ceiling. If there is no height limit, ego_planner may give a trajectory over the wall, which is not the same as the real world.

bigsuperZZZX commented 3 years ago

Do you mean that the planner outputs some setpoints above the "grid_map/virtual_ceil_height"? It should not happen. First, make sure the "grid_map/virtual_ceil_height" is lower than the "map_size_z". Then, maybe you can set "grid_map/visualization_truncate_height" higher than the "grid_map/virtual_ceil_height" to see how the virtual ceil looks like by visualizing the inflated grid map and check if the planned trajectory can break the ceiling limit.

robin-shaun commented 3 years ago

Ok, I 'll try it~

bigsuperZZZX commented 3 years ago

Hello! If you have no other questions, please close this issue.