public void AddPoint(PointLatLngAlt Point, double Velocity, double Curvature, double Psi_f, double Theta_f)
{
pointsList.Add(Point);
_pointsList.Add(Point.GetPointLatLng());
velocity.Add(Velocity);
Cc.Add(Curvature);
psi_f.Add(Psi_f);
theta_f.Add(Theta_f);
//initialPosition = pointsList[pointsList.Count - 1];
}
public double GetDistance(PointLatLngAlt InitialPosition, PointLatLngAlt FinalPosition)
{
return(GetDistance(InitialPosition.GetPointLatLng(), FinalPosition.GetPointLatLng()));
}
public bool IsInsideCircle(PointLatLngAlt Point, PointLatLngAlt Center, double Radius)
{
return(IsInsideCircle(Point.GetPointLatLng(), Center.GetPointLatLng(), Radius));
}
public double GetAngleMeassuredFromNord(PointLatLngAlt InitialPosition, PointLatLngAlt FinalPosition)
{
return(GetAngleMeassuredFromNord(InitialPosition.GetPointLatLng(), FinalPosition.GetPointLatLng()));
}
public double GetSlopeFromNord(PointLatLngAlt InitialPosition, PointLatLngAlt FinalPosition)
{
return(GetSlopeFromNord(InitialPosition.GetPointLatLng(), FinalPosition.GetPointLatLng()));
}
public void NewGeofence(PointLatLngAlt GeofencePoint)
{
NewGeofence(GeofencePoint.GetPointLatLng());
}
public void NewWaypoint(PointLatLngAlt waypoint)
{
NewWaypoint(waypoint.GetPointLatLng());
}
