public WeightedWaypoint(IWeightedWaypoint waypoint)
 {
     this.Position = waypoint.Position;
     _heading      = waypoint.Heading.normalized;
     this.Strength = waypoint.Strength;
 }
 public static bool Compare(IWeightedWaypoint a, WeightedWaypoint b)
 {
     return((a.Position == b.Position) && (a.Heading == b._heading) && (a.Strength == b.Strength));
 }