Some fixes to the body to body collision detector. WIP
Added a first version of the debug drawer. With box support