Add self collision avoidance constraint.
Update python binding.