AA277 Formation Control ADMM
Questions:
- 1/N in front of the constraints?
- need to write f(u) in terms of teoplitz
- if a robot is isolated, collision avoidance is kinda useless (cuz if you don't have a neighbro you can't have the distance greater than eps)
-I actually need to vectorize this