Create directed graph for state space planning. Removed reverse edge addition