コード例 #1
0
ファイル: RoadGraphBuilder.cs プロジェクト: kabirules/Kenny
        public static RoadGraph BakeRoadGraph(IEnumerable <RoadGraphBuildNode> buildNodes)
        {
            var bakedNodes     = new List <RoadGraphNode>();
            int _edgeIdCounter = 0;

            foreach (var node in buildNodes)
            {
                var bakedNode = new RoadGraphNode();
                bakedNode.nodeId   = node.nodeId;
                bakedNode.position = node.position;

                var edges = new List <RoadGraphEdge>();
                for (int i = 0; i < node.connectedNodes.Count; i++)
                {
                    var connectedNode = node.connectedNodes[i];
                    var edgeThickness = node.edgeThickness[i];
                    var edge          = new RoadGraphEdge();
                    edge.edgeId      = ++_edgeIdCounter;
                    edge.ownerNodeId = node.nodeId;
                    edge.otherNodeId = connectedNode.nodeId;
                    edge.thickness   = edgeThickness;

                    // Find the dot product with the x axis
                    Vector3 direction = (connectedNode.position - node.position).normalized;
                    var     dot       = Vector3.Dot(new Vector3(1, 0, 0), direction);
                    float   angle     = Mathf.Acos(dot);
                    if (direction.z < 0)
                    {
                        angle = 2 * Mathf.PI - angle;
                    }

                    edge.angleToXAxis = angle;

                    edges.Add(edge);
                }

                bakedNode.adjacentEdges = edges.ToArray();
                System.Array.Sort(bakedNode.adjacentEdges, SortEdgesByAngle);
                bakedNodes.Add(bakedNode);
            }

            var graph = new RoadGraph();

            graph.nodes = bakedNodes.ToArray();
            return(graph);
        }
コード例 #2
0
ファイル: RoadGraphBuilder.cs プロジェクト: kabirules/Kenny
 public RoadGraphBuildNode(RoadGraphNode graphNode)
 {
     nodeId   = graphNode.nodeId;
     position = graphNode.position;
 }