Implemented Diagonal Scoring

Still needs some code cleanup (comments, check-expects and the like) but wholly functional. Moved constants to the top, as some heuristic functions rely on them.