Cleaned up Navigation and IsNodeBlocked code.