Removed duplicate repulsion code and optimized collision pre-èconditions.
Removed more repulsion code as earlier code does the job.
Removed unused and obsolete functions.