1 | // rotspeed.cc
|
---|
2 | // Eric Aubourg CEA/DAPNIA/SPP octobre 1999
|
---|
3 |
|
---|
4 | #include "rotspeed.h"
|
---|
5 | #include "archexc.h"
|
---|
6 | #include "archparam.h"
|
---|
7 | #include "templocator.h"
|
---|
8 |
|
---|
9 | #define rotSpeed "rotSpeed"
|
---|
10 |
|
---|
11 |
|
---|
12 | RotSpeed::RotSpeed() {
|
---|
13 | possibleTOIs.insert(TOI(rotSpeed, TOI::unspec, "interp", "deg/s"));
|
---|
14 | sn1 = sn2 = -1;
|
---|
15 | }
|
---|
16 |
|
---|
17 | string RotSpeed::getName() {
|
---|
18 | return("RotSpeed 1.0");
|
---|
19 | }
|
---|
20 |
|
---|
21 | bool RotSpeed::canGetValue(long sampleNum, TOI const& toi) {
|
---|
22 | map<TOI, TOIProducer*> & m = neededTOIs[toi];
|
---|
23 |
|
---|
24 | TOIProducer* azProd;
|
---|
25 | TOI azTOI;
|
---|
26 |
|
---|
27 | if (sn1<0 || sn2<0 || sampleNum<sn1 || sampleNum >= sn2) {
|
---|
28 | for (map<TOI, TOIProducer*>::iterator i = m.begin(); i != m.end(); i++) {
|
---|
29 | TOI const& inToi = (*i).first;
|
---|
30 | TOIProducer* prod = (*i).second;
|
---|
31 |
|
---|
32 | if (inToi.name == "rotSpeedSample1") {
|
---|
33 | if (!prod->canGetValue(sampleNum, inToi)) return false;
|
---|
34 | sn1 = (long) prod->getValue(sampleNum, inToi);
|
---|
35 | }
|
---|
36 | if (inToi.name == "rotSpeedSample2") {
|
---|
37 | if (!prod->canGetValue(sampleNum, inToi)) return false;
|
---|
38 | sn2 = (long) prod->getValue(sampleNum, inToi);
|
---|
39 | }
|
---|
40 | if (inToi.name == "azimuthFPC") {
|
---|
41 | azProd = prod;
|
---|
42 | azTOI = inToi;
|
---|
43 | }
|
---|
44 | }
|
---|
45 | } else {
|
---|
46 | for (map<TOI, TOIProducer*>::iterator i = m.begin(); i != m.end(); i++) {
|
---|
47 | TOI const& inToi = (*i).first;
|
---|
48 | TOIProducer* prod = (*i).second;
|
---|
49 | if (inToi.name == "azimuthFPC") {
|
---|
50 | azProd = prod;
|
---|
51 | azTOI = inToi;
|
---|
52 | }
|
---|
53 | }
|
---|
54 | }
|
---|
55 |
|
---|
56 | if (!azProd->canGetValue(sn1, azTOI)) return false;
|
---|
57 | if (!azProd->canGetValue(sn2, azTOI)) return false;
|
---|
58 |
|
---|
59 | return true;
|
---|
60 | }
|
---|
61 |
|
---|
62 | bool RotSpeed::canGetValueLater(long sampleNum, TOI const& toi) {
|
---|
63 | map<TOI, TOIProducer*> & m = neededTOIs[toi];
|
---|
64 |
|
---|
65 | TOIProducer* azProd;
|
---|
66 | TOI azTOI;
|
---|
67 |
|
---|
68 | if (sn1<0 || sn2<0 || sampleNum<sn1 || sampleNum >= sn2) {
|
---|
69 | for (map<TOI, TOIProducer*>::iterator i = m.begin(); i != m.end(); i++) {
|
---|
70 | TOI const& inToi = (*i).first;
|
---|
71 | TOIProducer* prod = (*i).second;
|
---|
72 |
|
---|
73 | if (inToi.name == "rotSpeedSample1") {
|
---|
74 | if (prod->canGetValueLater(sampleNum, inToi)) return true;
|
---|
75 | sn1 = (long) prod->getValue(sampleNum, inToi);
|
---|
76 | }
|
---|
77 | if (inToi.name == "rotSpeedSample2") {
|
---|
78 | if (prod->canGetValueLater(sampleNum, inToi)) return true;
|
---|
79 | sn2 = (long) prod->getValue(sampleNum, inToi);
|
---|
80 | }
|
---|
81 | if (inToi.name == "azimuthFPC") {
|
---|
82 | azProd = prod;
|
---|
83 | azTOI = inToi;
|
---|
84 | }
|
---|
85 | }
|
---|
86 | } else {
|
---|
87 | for (map<TOI, TOIProducer*>::iterator i = m.begin(); i != m.end(); i++) {
|
---|
88 | TOI const& inToi = (*i).first;
|
---|
89 | TOIProducer* prod = (*i).second;
|
---|
90 | if (inToi.name == "azimuthFPC") {
|
---|
91 | azProd = prod;
|
---|
92 | azTOI = inToi;
|
---|
93 | }
|
---|
94 | }
|
---|
95 | }
|
---|
96 |
|
---|
97 | if (azProd->canGetValueLater(sn1, azTOI)) return true;
|
---|
98 | if (azProd->canGetValueLater(sn2, azTOI)) return true;
|
---|
99 |
|
---|
100 | return false;
|
---|
101 | }
|
---|
102 |
|
---|
103 |
|
---|
104 |
|
---|
105 | double RotSpeed::getValue(long sampleNum, TOI const& toi) {
|
---|
106 | if (!canGetValue(sampleNum, toi)) return -99999;
|
---|
107 |
|
---|
108 | map<TOI, TOIProducer*> &m = neededTOIs[toi];
|
---|
109 |
|
---|
110 | TOIProducer* azProd;
|
---|
111 | TOI azTOI;
|
---|
112 |
|
---|
113 | if (sn1<0 || sn2<0 || sampleNum<sn1 || sampleNum >= sn2) {
|
---|
114 | for (map<TOI, TOIProducer*>::iterator i = m.begin(); i != m.end(); i++) {
|
---|
115 | TOI const& inToi = (*i).first;
|
---|
116 | TOIProducer* prod = (*i).second;
|
---|
117 |
|
---|
118 | if (inToi.name == "rotSpeedSample1") {
|
---|
119 | if (prod->canGetValueLater(sampleNum, inToi)) return true;
|
---|
120 | sn1 = (long) prod->getValue(sampleNum, inToi);
|
---|
121 | }
|
---|
122 | if (inToi.name == "rotSpeedSample2") {
|
---|
123 | if (prod->canGetValueLater(sampleNum, inToi)) return true;
|
---|
124 | sn2 = (long) prod->getValue(sampleNum, inToi);
|
---|
125 | }
|
---|
126 | if (inToi.name == "azimuthFPC") {
|
---|
127 | azProd = prod;
|
---|
128 | azTOI = inToi;
|
---|
129 | }
|
---|
130 | }
|
---|
131 | } else {
|
---|
132 | for (map<TOI, TOIProducer*>::iterator i = m.begin(); i != m.end(); i++) {
|
---|
133 | TOI const& inToi = (*i).first;
|
---|
134 | TOIProducer* prod = (*i).second;
|
---|
135 | if (inToi.name == "azimuthFPC") {
|
---|
136 | azProd = prod;
|
---|
137 | azTOI = inToi;
|
---|
138 | }
|
---|
139 | }
|
---|
140 | }
|
---|
141 |
|
---|
142 | double az1 = azProd->getValue(sn1, azTOI);
|
---|
143 | double az2 = azProd->getValue(sn2, azTOI);
|
---|
144 |
|
---|
145 | return (az1 - az2 + 360)/(sn2-sn1)/ archParam.acq.perEch;
|
---|
146 | }
|
---|
147 |
|
---|
148 |
|
---|
149 | set<TOI> RotSpeed::reqTOIFor(TOI const& toi) {
|
---|
150 | set<string> opts = toi.options;
|
---|
151 | set<TOI> t;
|
---|
152 | t.insert(TOI("rotSpeedSample1", TOI::unspec, opts));
|
---|
153 | t.insert(TOI("rotSpeedSample2", TOI::unspec, opts));
|
---|
154 | t.insert(TOI("azimuthFPC", TOI::unspec, opts));
|
---|
155 | return t;
|
---|
156 | }
|
---|
157 |
|
---|
158 |
|
---|
159 |
|
---|
160 |
|
---|
161 |
|
---|
162 |
|
---|
163 |
|
---|