BSPTree working now