/// <summary>
/// Performs a raycast on the navigation mesh to perform line of sight or similar checks
/// </summary>
/// <param name="start">Starting point</param>
/// <param name="end">Ending point</param>
/// <param name="querySettings">Advanced settings to be provided to the navigation mesh query</param>
/// <returns>The found raycast hit if <see cref="NavigationRaycastResult.Hit"/> is true</returns>
public NavigationRaycastResult Raycast(Vector3 start, Vector3 end, NavigationQuerySettings querySettings)
{
NavigationRaycastResult result = new NavigationRaycastResult {
Hit = false
};
Navigation.RaycastQuery query;
query.Source = start;
query.Target = end;
query.MaxPathPoints = querySettings.MaxPathPoints;
query.FindNearestPolyExtent = querySettings.FindNearestPolyExtent;
Navigation.RaycastResult queryResult;
Navigation.DoRaycastQuery(navmesh, query, new IntPtr(&queryResult));
if (!queryResult.Hit)
{
return(result);
}
result.Hit = true;
result.Position = queryResult.Position;
result.Normal = queryResult.Normal;
return(result);
}
/// <summary>
/// Finds a path from point <paramref cref="start"/> to <paramref cref="end"/>
/// </summary>
/// <param name="start">The starting location of the pathfinding query</param>
/// <param name="end">The ending location of the pathfinding query</param>
/// <param name="querySettings">Advanced settings to be provided to the navigation mesh query</param>
/// <param name="path">The waypoints for the found path, if any (at least 2 if a path was found)</param>
/// <returns>The found path points or null</returns>
public bool TryFindPath(Vector3 start, Vector3 end, ICollection <Vector3> path, NavigationQuerySettings querySettings)
{
if (path == null)
{
throw new ArgumentNullException(nameof(path));
}
if (navmesh == IntPtr.Zero)
{
return(false);
}
Navigation.PathFindQuery query;
query.Source = start;
query.Target = end;
query.MaxPathPoints = querySettings.MaxPathPoints;
query.FindNearestPolyExtent = querySettings.FindNearestPolyExtent;
Navigation.PathFindResult queryResult;
Vector3[] generatedPathPoints = new Vector3[querySettings.MaxPathPoints];
fixed(Vector3 *generatedPathPointsPtr = generatedPathPoints)
{
queryResult.PathPoints = new IntPtr(generatedPathPointsPtr);
Navigation.DoPathFindQuery(navmesh, query, new IntPtr(&queryResult));
if (!queryResult.PathFound)
{
return(false);
}
}
// Read path from unsafe result
Vector3 *points = (Vector3 *)queryResult.PathPoints;
for (int i = 0; i < queryResult.NumPathPoints; i++)
{
path.Add(points[i]);
}
return(true);
}
