Fixed a bunch of issues which made inserting into the collisiontree problematic. The issue at hand was that the thread for the entity was still alive, so it basically, by trying to continue moving the entity, caused it to be reinserted into the collisiontree even though the instance was no longer active (i.e. dead). The issue was solved by deleting all relevant threads.