private Point Find(Vehicle vehicle)
{
var currentPoint = GetStartPoint(vehicle);
var route = vehicle.CreateRouteOf(30, currentPoint);
double nextWaypointX = (route[0].X + 0.5D) * vehicle.Game.TrackTileSize;
double nextWaypointY = (route[0].Y + 0.5D) * vehicle.Game.TrackTileSize;
if (Math.Abs(vehicle.Self.GetAngleTo(nextWaypointX, nextWaypointY)) > Math.PI / 1.57)
{
var excludeCell = vehicle.GetCurrentCell(new Point(nextWaypointX, nextWaypointY));
var routeNoBackPoint = vehicle.CreateRouteOf(30, currentPoint, excludeCell);
var nextCell = vehicle.GetCellByIndex(vehicle.Self.NextWaypointIndex + 1);
if (routeNoBackPoint.IndexOf(nextCell) - route.IndexOf(nextCell) < 8) //TODO: speed check here
{
nextWaypointX = (routeNoBackPoint[0].X + 0.5D) * vehicle.Game.TrackTileSize;
nextWaypointY = (routeNoBackPoint[0].Y + 0.5D) * vehicle.Game.TrackTileSize;
route = routeNoBackPoint;
}
}
var addOn = vehicle.Game.TrackTileSize * 0.4D;
left = 0.0D;
right = 0.0D;
top = 0.0D;
bottom = 0.0D;
var startCell = vehicle.GetCurrentCell(currentPoint);
var prevCell = vehicle.GetCurrentCell(vehicle.Self.CurrentPoint());
if (MovementHelper.IsOnLine(prevCell, startCell, route[0], route[1]))
{
nextWaypointX = (route[0].X + 0.5D) * vehicle.Game.TrackTileSize;
nextWaypointY = (route[0].Y + 0.5D) * vehicle.Game.TrackTileSize;
NextWaypointApdate(route[1], route[0], 0.49 * vehicle.Game.TrackTileSize);
//TODO: Move nitro in other place
vehicle.CanUseNitro = MovementHelper.IsOnLine(prevCell, startCell, route[2], route[3]) &&
MovementHelper.IsOnLine(prevCell, startCell, route[4], route[5]);// &&
// MovementHelper.IsOnLine(prevCell, startCell, route[6], route[7]);
return(OptimalPoint(nextWaypointX, nextWaypointY));
}
// NextWaypointApdate(route[0], startCell, addOn);
NextWaypointApdate(route[1], route[0], addOn);
return(OptimalPoint(nextWaypointX, nextWaypointY));
}