forked from Dan-Piker/K2Goals
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathOnCurve.cs
60 lines (54 loc) · 1.47 KB
/
OnCurve.cs
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using Rhino.Geometry;
namespace KangarooSolver.Goals
{
public class OnCurve : GoalObject
{
public double Strength;
public Curve _curve;
public OnCurve()
{
}
public OnCurve(List<int> V, Curve C, double k)
{
int L = V.Count;
PIndex = V.ToArray();
Move = new Vector3d[L];
Weighting = new double[L];
for (int i = 0; i < L; i++)
{
Weighting[i] = k;
}
_curve = C;
Strength = k;
}
public OnCurve(List<Point3d> V, Curve C, double k)
{
int L = V.Count;
PPos = V.ToArray();
Move = new Vector3d[L];
Weighting = new double[L];
for (int i = 0; i < L; i++)
{
Weighting[i] = k;
}
_curve = C;
Strength = k;
}
public override void Calculate(List<KangarooSolver.Particle> p)
{
for (int i = 0; i < PIndex.Length; i++)
{
Point3d ThisPt = p[PIndex[i]].Position;
double t = new double();
_curve.ClosestPoint(ThisPt, out t);
Move[i] = _curve.PointAt(t) - ThisPt;
Weighting[i] = Strength;
}
}
}
}