Optimization of collision solving algorithm
Accurate positioning
Some unused imports has been removed
Little collision bug fixed