- [x] Add a parameter to the CBF that tells how close the robot can approach the obstacles - [ ] Provide robot's initial state as input to the MPC - [ ] Provide seed to obstacles generation
