Debug msgs

Adding debug msgs for collision the simple way.
Also a realization, not fixing yet though.