本文整理汇总了C++中PathNode::CalcTotalCost方法的典型用法代码示例。如果您正苦于以下问题：C++ PathNode::CalcTotalCost方法的具体用法？C++ PathNode::CalcTotalCost怎么用？C++ PathNode::CalcTotalCost使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类PathNode的用法示例。
在下文中一共展示了PathNode::CalcTotalCost方法的2个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: Solve
int MicroPather::Solve( void* startNode, void* endNode, vector< void* >* path, float* cost )
{
#ifdef DEBUG_PATH
printf( "Path: " );
graph->PrintStateInfo( startNode );
printf( " --> " );
graph->PrintStateInfo( endNode );
printf( " min cost=%f\n", graph->LeastCostEstimate( startNode, endNode ) );
#endif
*cost = 0.0f;
if ( startNode == endNode )
return START_END_SAME;
++frame;
OpenQueue open( graph );
ClosedSet closed( graph );
PathNode* newPathNode = pathNodePool.GetPathNode( frame,
startNode,
0,
graph->LeastCostEstimate( startNode, endNode ),
0 );
open.Push( newPathNode );
stateCostVec.resize(0);
nodeCostVec.resize(0);
while ( !open.Empty() )
{
PathNode* node = open.Pop();
if ( node->state == endNode )
{
GoalReached( node, startNode, endNode, path );
*cost = node->costFromStart;
#ifdef DEBUG_PATH
DumpStats();
#endif
return SOLVED;
}
else
{
closed.Add( node );
// We have not reached the goal - add the neighbors.
GetNodeNeighbors( node, &nodeCostVec );
for( int i=0; i<node->numAdjacent; ++i )
{
// Not actually a neighbor, but useful. Filter out infinite cost.
if ( nodeCostVec[i].cost == FLT_MAX ) {
continue;
}
PathNode* child = nodeCostVec[i].node;
float newCost = node->costFromStart + nodeCostVec[i].cost;
PathNode* inOpen = child->inOpen ? child : 0;
PathNode* inClosed = child->inClosed ? child : 0;
PathNode* inEither = (PathNode*)( ((MP_UPTR)inOpen) | ((MP_UPTR)inClosed) );
MPASSERT( inEither != node );
MPASSERT( !( inOpen && inClosed ) );
if ( inEither ) {
if ( newCost < child->costFromStart ) {
child->parent = node;
child->costFromStart = newCost;
child->estToGoal = graph->LeastCostEstimate( child->state, endNode );
child->CalcTotalCost();
if ( inOpen ) {
open.Update( child );
}
}
}
else {
child->parent = node;
child->costFromStart = newCost;
child->estToGoal = graph->LeastCostEstimate( child->state, endNode ),
child->CalcTotalCost();
MPASSERT( !child->inOpen && !child->inClosed );
open.Push( child );
}
}
}
}
#ifdef DEBUG_PATH
DumpStats();
#endif
return NO_SOLUTION;
} 示例2: Solve
int MicroPather::Solve( void* startNode, void* endNode, MP_VECTOR< void* >* path, float* cost )
{
// Important to clear() in case the caller doesn't check the return code. There
// can easily be a left over path from a previous call.
path->clear();
#ifdef DEBUG_PATH
printf( "Path: " );
graph->PrintStateInfo( startNode );
printf( " --> " );
graph->PrintStateInfo( endNode );
printf( " min cost=%f\n", graph->LeastCostEstimate( startNode, endNode ) );
#endif
*cost = 0.0f;
if ( startNode == endNode )
return START_END_SAME;
if ( pathCache ) {
int cacheResult = pathCache->Solve( startNode, endNode, path, cost );
if ( cacheResult == SOLVED || cacheResult == NO_SOLUTION ) {
#ifdef DEBUG_CACHING
GLOUTPUT(( "PathCache hit. result=%s\n", cacheResult == SOLVED ? "solved" : "no_solution" ));
#endif
return cacheResult;
}
#ifdef DEBUG_CACHING
GLOUTPUT(( "PathCache miss\n" ));
#endif
}
++frame;
OpenQueue open( graph );
ClosedSet closed( graph );
PathNode* newPathNode = pathNodePool.GetPathNode( frame,
startNode,
0,
graph->LeastCostEstimate( startNode, endNode ),
0 );
open.Push( newPathNode );
stateCostVec.resize(0);
nodeCostVec.resize(0);
while ( !open.Empty() )
{
PathNode* node = open.Pop();
if ( node->state == endNode )
{
GoalReached( node, startNode, endNode, path );
*cost = node->costFromStart;
#ifdef DEBUG_PATH
DumpStats();
#endif
return SOLVED;
}
else
{
closed.Add( node );
// We have not reached the goal - add the neighbors.
GetNodeNeighbors( node, &nodeCostVec );
for( int i=0; i<node->numAdjacent; ++i )
{
// Not actually a neighbor, but useful. Filter out infinite cost.
if ( nodeCostVec[i].cost == FLT_MAX ) {
continue;
}
PathNode* child = nodeCostVec[i].node;
float newCost = node->costFromStart + nodeCostVec[i].cost;
PathNode* inOpen = child->inOpen ? child : 0;
PathNode* inClosed = child->inClosed ? child : 0;
PathNode* inEither = (PathNode*)( ((MP_UPTR)inOpen) | ((MP_UPTR)inClosed) );
MPASSERT( inEither != node );
MPASSERT( !( inOpen && inClosed ) );
if ( inEither ) {
if ( newCost < child->costFromStart ) {
child->parent = node;
child->costFromStart = newCost;
child->estToGoal = graph->LeastCostEstimate( child->state, endNode );
child->CalcTotalCost();
if ( inOpen ) {
open.Update( child );
}
}
}
else {
child->parent = node;
child->costFromStart = newCost;
child->estToGoal = graph->LeastCostEstimate( child->state, endNode ),
child->CalcTotalCost();
//.........这里部分代码省略.........