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
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
|
using System;
using System.Collections.Generic;
using System.Collections.ObjectModel;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
namespace grapher.Models.Calculations
{
public static class AccelCalculator
{
public const int MaxCombined = 100;
public const int MaxXY = 150;
public struct MagnitudeData
{
public double magnitude;
public int x;
public int y;
}
public static ReadOnlyCollection<MagnitudeData> MagnitudesCombined = GetMagnitudes();
public static ReadOnlyCollection<MagnitudeData> MagnitudesX = GetMagnitudesX();
public static ReadOnlyCollection<MagnitudeData> MagnitudesY = GetMagnitudesY();
public static void Calculate(AccelData data, ManagedAccel accel, double starterX, double starterY)
{
data.Clear();
Calculate(data.Combined, accel, starterX, MagnitudesCombined);
Calculate(data.X, accel, starterY, MagnitudesX);
Calculate(data.Y, accel, starterY, MagnitudesY);
}
public static void Calculate(AccelChartData data, ManagedAccel accel, double starter, ICollection<MagnitudeData> magnitudeData)
{
double lastInputMagnitude = 0;
double lastOutputMagnitude = 0;
foreach (var magnitudeDatum in magnitudeData)
{
var output = accel.Accelerate(magnitudeDatum.x, magnitudeDatum.y, 1);
var outMagnitude = Magnitude(output.Item1, output.Item2);
var ratio = magnitudeDatum.magnitude > 0 ? outMagnitude / magnitudeDatum.magnitude : starter;
var inDiff = magnitudeDatum.magnitude - lastInputMagnitude;
var outDiff = outMagnitude - lastOutputMagnitude;
var slope = inDiff > 0 ? outDiff / inDiff : starter;
if (!data.AccelPoints.ContainsKey(magnitudeDatum.magnitude))
{
data.AccelPoints.Add(magnitudeDatum.magnitude, ratio);
}
if (!data.VelocityPoints.ContainsKey(magnitudeDatum.magnitude))
{
data.VelocityPoints.Add(magnitudeDatum.magnitude, outMagnitude);
}
if (!data.GainPoints.ContainsKey(magnitudeDatum.magnitude))
{
data.GainPoints.Add(magnitudeDatum.magnitude, slope);
}
lastInputMagnitude = magnitudeDatum.magnitude;
lastOutputMagnitude = outMagnitude;
}
}
public static ReadOnlyCollection<MagnitudeData> GetMagnitudes()
{
var magnitudes = new List<MagnitudeData>();
for (int i = 0; i < MaxCombined; i++)
{
for (int j = 0; j <= i; j++)
{
MagnitudeData magnitudeData;
magnitudeData.magnitude = Magnitude(i, j);
magnitudeData.x = i;
magnitudeData.y = j;
magnitudes.Add(magnitudeData);
}
}
magnitudes.Sort((m1, m2) => m1.magnitude.CompareTo(m2.magnitude));
return magnitudes.AsReadOnly();
}
public static ReadOnlyCollection<MagnitudeData> GetMagnitudesX()
{
var magnitudes = new List<MagnitudeData>();
for (int i = 0; i < MaxXY; i++)
{
MagnitudeData magnitudeData;
magnitudeData.magnitude = i;
magnitudeData.x = i;
magnitudeData.y = 0;
magnitudes.Add(magnitudeData);
}
return magnitudes.AsReadOnly();
}
public static ReadOnlyCollection<MagnitudeData> GetMagnitudesY()
{
var magnitudes = new List<MagnitudeData>();
for (int i = 0; i < MaxXY; i++)
{
MagnitudeData magnitudeData;
magnitudeData.magnitude = i;
magnitudeData.x = 0;
magnitudeData.y = i;
magnitudes.Add(magnitudeData);
}
return magnitudes.AsReadOnly();
}
public static double Magnitude(int x, int y)
{
return Math.Sqrt(x * x + y * y);
}
public static double Magnitude(double x, double y)
{
return Math.Sqrt(x * x + y * y);
}
}
}
|