support additional args
Cluster obstacles to reduce redundant linear constraints
Some videos of clustered obstacles