Done a lot of stuff. Moving into 12d, will have to rewrite the collision checker methinks. ALso goal states??