consensus-cbf The main code is in mpc_trajectory_follow.py, the parameter needs to be tunning, which could change if using CBF or multi-object in the code.