public bool IsOnTheRight(Street other, int intersectCheckPoint)
{
Vector3 curStreetVector = this.StreetInVector3().normalized;
Vector3 otherStreetVector = other.StreetInVector3().normalized;
if (!other.IsTwoWay && other.CheckPointIndex(this.points[intersectCheckPoint]) == 1) return false;
if (intersectCheckPoint == 0)
{
curStreetVector = -curStreetVector;
}
float sinDelta = curStreetVector.x * otherStreetVector.z - curStreetVector.z * otherStreetVector.x;
float cosDelta = curStreetVector.x * otherStreetVector.x + curStreetVector.z * otherStreetVector.z;
if (!other.IsTwoWay||(other.IsTwoWay&& other.CheckPointIndex(this.points[intersectCheckPoint]) == 0))
{
if (Constants.sinBoundary > sinDelta &&
-Constants.cosBoundary < cosDelta && cosDelta < Constants.cosBoundary)
return true;
}
else
{
if (Constants.sinBoundary > -sinDelta &&
-Constants.cosBoundary < -cosDelta && -cosDelta < Constants.cosBoundary)
return true;
}
return false;
}
public GameObject CheckPointOnTheRight(GameObject target, GameObject lastOne)
{
Street currentStreet = FindStreetFromCheckPoint(target, lastOne);
bool direction = false;
if (currentStreet.CheckPointIndex(target) == 1)
{
direction = true;
}
int checkPointIntersect = 1;
List <Street> intersectStreet = new List <Street>();
if (!direction)
{
checkPointIntersect = 0;
}
foreach (Street street in streets)
{
if (street == currentStreet)
{
continue;
}
if (street.ContentCheckPoint(currentStreet.points[checkPointIntersect]))
{
intersectStreet.Add(street);
}
}
if (intersectStreet.Count == 0)
{
return(null);
}
else
{
foreach (Street street in intersectStreet)
{
if (currentStreet.IsOnTheRight(street, checkPointIntersect))
{
return(street.OtherCheckPoint(currentStreet.points[checkPointIntersect]));
}
}
Debug.Log("Cant found one in the right");
return(null);
}
}
public GameObject NextRandomCheckpoint(GameObject lastCheckpoint, GameObject nextCheckpoint, float speed)
{
if (lastCheckpoint == null)
{
for (int i = 0; i < streets.Count; i++)
{
if (streets[i].ContentCheckPoint(nextCheckpoint))
{
return(streets[i].OtherCheckPoint(nextCheckpoint));
}
}
}
List <GameObject> targets = new List <GameObject>();
Street currentStreet = FindStreetFromCheckPoint(nextCheckpoint, lastCheckpoint);
bool direction = false;
if (currentStreet.CheckPointIndex(nextCheckpoint) == 1)
{
direction = true;
}
int checkPointIntersect = 1;
List <Street> intersectStreet = new List <Street>();
if (!direction)
{
checkPointIntersect = 0;
}
foreach (Street street in streets)
{
if (street == currentStreet)
{
continue;
}
if (street.ContentCheckPoint(currentStreet.points[checkPointIntersect]))
{
intersectStreet.Add(street);
}
}
if (intersectStreet.Count == 0)
{
// Debug.Log("Not intersect");
if (currentStreet.IsTwoWay)
{
return(currentStreet.OtherCheckPoint(currentStreet.points[checkPointIntersect]));
}
return(null);
}
else
{
foreach (Street street in intersectStreet)
{
if (street.CanGoIn(currentStreet.points[checkPointIntersect], (int)speed))
{
targets.Add(street.OtherCheckPoint(currentStreet.points[checkPointIntersect]));
}
}
}
if (targets.Count > 0)
{
//GameObject streetOnTheRight=
if (targets.Count > 1)
{
GameObject checkpointOnTheRight = CheckPointOnTheRight(nextCheckpoint, lastCheckpoint);
if (checkpointOnTheRight != null)
{
targets.Remove(checkpointOnTheRight);
}
}
return(targets[UnityEngine.Random.Range(0, targets.Count)]);
}
else
if (currentStreet.IsTwoWay)
{
return(currentStreet.OtherCheckPoint(currentStreet.points[checkPointIntersect]));
}
return(null);
}
