Working on cleaning stuff up, need to fix ray casting code