collision stuff

-cleaned, commented and optimized collision code
-switched traces with ST_Logger.logs