KD Node working (still need to verify triangle-box intersection algorithm)