|
sl@0
|
1 |
/*
|
|
sl@0
|
2 |
* Copyright (c) 2004 Nokia Corporation and/or its subsidiary(-ies).
|
|
sl@0
|
3 |
* All rights reserved.
|
|
sl@0
|
4 |
* This component and the accompanying materials are made available
|
|
sl@0
|
5 |
* under the terms of "Eclipse Public License v1.0"
|
|
sl@0
|
6 |
* which accompanies this distribution, and is available
|
|
sl@0
|
7 |
* at the URL "http://www.eclipse.org/legal/epl-v10.html".
|
|
sl@0
|
8 |
*
|
|
sl@0
|
9 |
* Initial Contributors:
|
|
sl@0
|
10 |
* Nokia Corporation - initial contribution.
|
|
sl@0
|
11 |
*
|
|
sl@0
|
12 |
* Contributors:
|
|
sl@0
|
13 |
*
|
|
sl@0
|
14 |
* Description: Implementation of the doppler effect class
|
|
sl@0
|
15 |
*
|
|
sl@0
|
16 |
*/
|
|
sl@0
|
17 |
|
|
sl@0
|
18 |
|
|
sl@0
|
19 |
|
|
sl@0
|
20 |
|
|
sl@0
|
21 |
// INCLUDE FILES
|
|
sl@0
|
22 |
|
|
sl@0
|
23 |
#ifdef _DEBUG
|
|
sl@0
|
24 |
#include <e32svr.h>
|
|
sl@0
|
25 |
#endif
|
|
sl@0
|
26 |
|
|
sl@0
|
27 |
#include <DopplerBase.h>
|
|
sl@0
|
28 |
#include <e32math.h>
|
|
sl@0
|
29 |
#include <math.h>
|
|
sl@0
|
30 |
|
|
sl@0
|
31 |
|
|
sl@0
|
32 |
//360 degrees:
|
|
sl@0
|
33 |
#define TWO_PI 6283
|
|
sl@0
|
34 |
//180 degrees:
|
|
sl@0
|
35 |
#define PI 3142
|
|
sl@0
|
36 |
//90 degrees:
|
|
sl@0
|
37 |
#define QUARTER_PI 1570
|
|
sl@0
|
38 |
|
|
sl@0
|
39 |
// ============================ MEMBER FUNCTIONS ===============================
|
|
sl@0
|
40 |
|
|
sl@0
|
41 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
42 |
// CDoppler::CDoppler
|
|
sl@0
|
43 |
// C++ default constructor can NOT contain any code, that
|
|
sl@0
|
44 |
// might leave.
|
|
sl@0
|
45 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
46 |
//
|
|
sl@0
|
47 |
EXPORT_C CDoppler::CDoppler()
|
|
sl@0
|
48 |
: iDopplerData(),
|
|
sl@0
|
49 |
iDataPckgTo(iDopplerData),
|
|
sl@0
|
50 |
iDataPckgFrom(iDopplerData)
|
|
sl@0
|
51 |
{
|
|
sl@0
|
52 |
}
|
|
sl@0
|
53 |
|
|
sl@0
|
54 |
// Destructor
|
|
sl@0
|
55 |
EXPORT_C CDoppler::~CDoppler()
|
|
sl@0
|
56 |
{
|
|
sl@0
|
57 |
}
|
|
sl@0
|
58 |
|
|
sl@0
|
59 |
|
|
sl@0
|
60 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
61 |
// CDoppler::CartesianVelocity
|
|
sl@0
|
62 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
63 |
//
|
|
sl@0
|
64 |
|
|
sl@0
|
65 |
EXPORT_C void CDoppler::CartesianVelocity( TInt32& aX, TInt32& aY, TInt32& aZ )
|
|
sl@0
|
66 |
{
|
|
sl@0
|
67 |
aX = iDopplerData.iVelocityX;
|
|
sl@0
|
68 |
aY = iDopplerData.iVelocityY;
|
|
sl@0
|
69 |
aZ = iDopplerData.iVelocityZ;
|
|
sl@0
|
70 |
}
|
|
sl@0
|
71 |
|
|
sl@0
|
72 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
73 |
// CDoppler::Factor
|
|
sl@0
|
74 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
75 |
//
|
|
sl@0
|
76 |
|
|
sl@0
|
77 |
EXPORT_C TUint32 CDoppler::Factor() const
|
|
sl@0
|
78 |
{
|
|
sl@0
|
79 |
return iDopplerData.iFactor;
|
|
sl@0
|
80 |
}
|
|
sl@0
|
81 |
|
|
sl@0
|
82 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
83 |
// CDoppler::FactorMax
|
|
sl@0
|
84 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
85 |
//
|
|
sl@0
|
86 |
|
|
sl@0
|
87 |
EXPORT_C TUint32 CDoppler::FactorMax() const
|
|
sl@0
|
88 |
{
|
|
sl@0
|
89 |
return iDopplerData.iMaxFactor;
|
|
sl@0
|
90 |
}
|
|
sl@0
|
91 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
92 |
// CDoppler::SetCartesianVelocityL
|
|
sl@0
|
93 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
94 |
//
|
|
sl@0
|
95 |
|
|
sl@0
|
96 |
EXPORT_C void CDoppler::SetCartesianVelocityL( TInt32 aX, TInt32 aY, TInt32 aZ )
|
|
sl@0
|
97 |
{
|
|
sl@0
|
98 |
iDopplerData.iVelocityX = aX;
|
|
sl@0
|
99 |
iDopplerData.iVelocityY = aY;
|
|
sl@0
|
100 |
iDopplerData.iVelocityZ = aZ;
|
|
sl@0
|
101 |
|
|
sl@0
|
102 |
|
|
sl@0
|
103 |
TReal SqrtXYZ = 0, squareX = 0, squareY = 0, squareZ = 0;
|
|
sl@0
|
104 |
Math::Pow(squareX, aX, 2);
|
|
sl@0
|
105 |
Math::Pow(squareY, aY, 2);
|
|
sl@0
|
106 |
Math::Pow(squareZ, aZ, 2);
|
|
sl@0
|
107 |
|
|
sl@0
|
108 |
TReal sum = squareX + squareY + squareZ;
|
|
sl@0
|
109 |
|
|
sl@0
|
110 |
Math::Sqrt(SqrtXYZ, sum);
|
|
sl@0
|
111 |
|
|
sl@0
|
112 |
//Singularity region
|
|
sl@0
|
113 |
if(!((aX==0) && (aZ==0)))
|
|
sl@0
|
114 |
{
|
|
sl@0
|
115 |
|
|
sl@0
|
116 |
TReal zDividedByXAtan = atan2 (-aX, -aZ);
|
|
sl@0
|
117 |
|
|
sl@0
|
118 |
if (zDividedByXAtan > 0)
|
|
sl@0
|
119 |
iDopplerData.iAzimuth = -(TInt32) (zDividedByXAtan * 1000 + 0.5);
|
|
sl@0
|
120 |
else
|
|
sl@0
|
121 |
iDopplerData.iAzimuth = -(TInt32) (zDividedByXAtan * 1000 - 0.5);
|
|
sl@0
|
122 |
}
|
|
sl@0
|
123 |
// else { we are exactly on Y-axis and therefore azimuth is undefined; let's use the previous azimuth value instead }
|
|
sl@0
|
124 |
|
|
sl@0
|
125 |
|
|
sl@0
|
126 |
if (!((aX ==0) && (aY == 0) && (aZ == 0)))
|
|
sl@0
|
127 |
{
|
|
sl@0
|
128 |
|
|
sl@0
|
129 |
TReal result;
|
|
sl@0
|
130 |
TReal yDividedBySqrtXYZ = aY/SqrtXYZ;
|
|
sl@0
|
131 |
User::LeaveIfError(Math::ASin(result, yDividedBySqrtXYZ)); //was ACos
|
|
sl@0
|
132 |
|
|
sl@0
|
133 |
if (result > 0)
|
|
sl@0
|
134 |
iDopplerData.iElevation = (TInt32) (result * 1000 + 0.5);
|
|
sl@0
|
135 |
else
|
|
sl@0
|
136 |
iDopplerData.iElevation = (TInt32) (result * 1000 - 0.5);
|
|
sl@0
|
137 |
|
|
sl@0
|
138 |
}
|
|
sl@0
|
139 |
// else { we are exactly in origin and therefore elevation is undefined; let's use the previous elevation value instead }
|
|
sl@0
|
140 |
|
|
sl@0
|
141 |
iDopplerData.iRadius= (TInt32) (SqrtXYZ + 0.5);
|
|
sl@0
|
142 |
|
|
sl@0
|
143 |
|
|
sl@0
|
144 |
while(iDopplerData.iElevation > PI)
|
|
sl@0
|
145 |
{
|
|
sl@0
|
146 |
iDopplerData.iElevation = iDopplerData.iElevation - TWO_PI;
|
|
sl@0
|
147 |
}
|
|
sl@0
|
148 |
|
|
sl@0
|
149 |
if(iDopplerData.iElevation > QUARTER_PI)
|
|
sl@0
|
150 |
{
|
|
sl@0
|
151 |
iDopplerData.iElevation = iDopplerData.iElevation - (iDopplerData.iElevation - QUARTER_PI) * 2;
|
|
sl@0
|
152 |
iDopplerData.iAzimuth = iDopplerData.iAzimuth + PI;
|
|
sl@0
|
153 |
}
|
|
sl@0
|
154 |
|
|
sl@0
|
155 |
while(iDopplerData.iElevation < -PI)
|
|
sl@0
|
156 |
{
|
|
sl@0
|
157 |
iDopplerData.iElevation = iDopplerData.iElevation + TWO_PI;
|
|
sl@0
|
158 |
}
|
|
sl@0
|
159 |
if(iDopplerData.iElevation < -QUARTER_PI)
|
|
sl@0
|
160 |
{
|
|
sl@0
|
161 |
iDopplerData.iElevation = iDopplerData.iElevation + (QUARTER_PI - iDopplerData.iElevation) * 2;
|
|
sl@0
|
162 |
iDopplerData.iAzimuth = iDopplerData.iAzimuth + PI;
|
|
sl@0
|
163 |
}
|
|
sl@0
|
164 |
|
|
sl@0
|
165 |
while (iDopplerData.iAzimuth < 0)
|
|
sl@0
|
166 |
iDopplerData.iAzimuth = iDopplerData.iAzimuth + TWO_PI;
|
|
sl@0
|
167 |
while (iDopplerData.iAzimuth > TWO_PI)
|
|
sl@0
|
168 |
iDopplerData.iAzimuth = iDopplerData.iAzimuth - TWO_PI;
|
|
sl@0
|
169 |
|
|
sl@0
|
170 |
|
|
sl@0
|
171 |
}
|
|
sl@0
|
172 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
173 |
// CDoppler::SetFactorL
|
|
sl@0
|
174 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
175 |
//
|
|
sl@0
|
176 |
|
|
sl@0
|
177 |
EXPORT_C void CDoppler::SetFactorL( TUint32 aFactor )
|
|
sl@0
|
178 |
{
|
|
sl@0
|
179 |
if ( (aFactor <= iDopplerData.iMaxFactor) )
|
|
sl@0
|
180 |
{
|
|
sl@0
|
181 |
iDopplerData.iFactor = aFactor;
|
|
sl@0
|
182 |
}
|
|
sl@0
|
183 |
else
|
|
sl@0
|
184 |
{
|
|
sl@0
|
185 |
User::Leave(KErrArgument);
|
|
sl@0
|
186 |
}
|
|
sl@0
|
187 |
}
|
|
sl@0
|
188 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
189 |
// CDoppler::SetSphericalVelocityL
|
|
sl@0
|
190 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
191 |
//
|
|
sl@0
|
192 |
|
|
sl@0
|
193 |
EXPORT_C void CDoppler::SetSphericalVelocityL( TInt32 aAzimuth, TInt32 aElevation, TInt32 aRadius )
|
|
sl@0
|
194 |
{
|
|
sl@0
|
195 |
|
|
sl@0
|
196 |
while(aElevation > PI)
|
|
sl@0
|
197 |
{
|
|
sl@0
|
198 |
aElevation = aElevation - TWO_PI;
|
|
sl@0
|
199 |
}
|
|
sl@0
|
200 |
|
|
sl@0
|
201 |
if(aElevation > QUARTER_PI)
|
|
sl@0
|
202 |
{
|
|
sl@0
|
203 |
aElevation = aElevation - (aElevation - QUARTER_PI) * 2;
|
|
sl@0
|
204 |
aAzimuth = aAzimuth + PI;
|
|
sl@0
|
205 |
}
|
|
sl@0
|
206 |
|
|
sl@0
|
207 |
while(aElevation < -PI)
|
|
sl@0
|
208 |
{
|
|
sl@0
|
209 |
aElevation = aElevation + TWO_PI;
|
|
sl@0
|
210 |
}
|
|
sl@0
|
211 |
if(aElevation < -QUARTER_PI)
|
|
sl@0
|
212 |
{
|
|
sl@0
|
213 |
aElevation = aElevation + (QUARTER_PI - aElevation) * 2;
|
|
sl@0
|
214 |
aAzimuth = aAzimuth + PI;
|
|
sl@0
|
215 |
}
|
|
sl@0
|
216 |
|
|
sl@0
|
217 |
while (aAzimuth < 0)
|
|
sl@0
|
218 |
aAzimuth = aAzimuth + TWO_PI;
|
|
sl@0
|
219 |
while (aAzimuth > TWO_PI)
|
|
sl@0
|
220 |
aAzimuth = aAzimuth - TWO_PI;
|
|
sl@0
|
221 |
|
|
sl@0
|
222 |
|
|
sl@0
|
223 |
iDopplerData.iAzimuth = aAzimuth;
|
|
sl@0
|
224 |
iDopplerData.iElevation = aElevation;
|
|
sl@0
|
225 |
iDopplerData.iRadius = aRadius;
|
|
sl@0
|
226 |
|
|
sl@0
|
227 |
|
|
sl@0
|
228 |
TReal elevation = aElevation / 1000.0; // conversion from milliradians to radians because Sin and Cos functions eat radians
|
|
sl@0
|
229 |
|
|
sl@0
|
230 |
TReal elevationSin;
|
|
sl@0
|
231 |
TReal elevationCos;
|
|
sl@0
|
232 |
User::LeaveIfError( Math::Sin( elevationSin, elevation ) );
|
|
sl@0
|
233 |
User::LeaveIfError( Math::Cos( elevationCos, elevation ) );
|
|
sl@0
|
234 |
|
|
sl@0
|
235 |
TReal azimuthSin;
|
|
sl@0
|
236 |
TReal azimuthCos;
|
|
sl@0
|
237 |
User::LeaveIfError( Math::Sin( azimuthSin, aAzimuth / 1000.0) );
|
|
sl@0
|
238 |
User::LeaveIfError( Math::Cos(azimuthCos, aAzimuth / 1000.0) );
|
|
sl@0
|
239 |
|
|
sl@0
|
240 |
|
|
sl@0
|
241 |
iDopplerData.iVelocityX = (TInt32)(0.5 + aRadius * elevationCos * azimuthSin);
|
|
sl@0
|
242 |
iDopplerData.iVelocityY = (TInt32)(0.5 + aRadius * elevationSin);
|
|
sl@0
|
243 |
iDopplerData.iVelocityZ = (TInt32)(0.5 - aRadius * elevationCos * azimuthCos);
|
|
sl@0
|
244 |
}
|
|
sl@0
|
245 |
|
|
sl@0
|
246 |
|
|
sl@0
|
247 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
248 |
// CDoppler::SphericalVelocity
|
|
sl@0
|
249 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
250 |
//
|
|
sl@0
|
251 |
|
|
sl@0
|
252 |
EXPORT_C void CDoppler::SphericalVelocity( TInt32& aAzimuth, TInt32& aElevation, TInt32& aRadius )
|
|
sl@0
|
253 |
{
|
|
sl@0
|
254 |
aAzimuth = iDopplerData.iAzimuth;
|
|
sl@0
|
255 |
aElevation = iDopplerData.iElevation;
|
|
sl@0
|
256 |
aRadius = iDopplerData.iRadius ;
|
|
sl@0
|
257 |
|
|
sl@0
|
258 |
}
|
|
sl@0
|
259 |
|
|
sl@0
|
260 |
|
|
sl@0
|
261 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
262 |
// CDoppler::DoEffectData
|
|
sl@0
|
263 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
264 |
//
|
|
sl@0
|
265 |
EXPORT_C const TDesC8& CDoppler::DoEffectData()
|
|
sl@0
|
266 |
{
|
|
sl@0
|
267 |
#ifdef _DEBUG
|
|
sl@0
|
268 |
RDebug::Print(_L("CDoppler::DoEffectData"));
|
|
sl@0
|
269 |
#endif
|
|
sl@0
|
270 |
iDataPckgTo = iDopplerData;
|
|
sl@0
|
271 |
return iDataPckgTo;
|
|
sl@0
|
272 |
}
|
|
sl@0
|
273 |
|
|
sl@0
|
274 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
275 |
// CDoppler::SetEffectData
|
|
sl@0
|
276 |
// -----------------------------------------------------------------------------
|
|
sl@0
|
277 |
//
|
|
sl@0
|
278 |
EXPORT_C void CDoppler::SetEffectData(
|
|
sl@0
|
279 |
const TDesC8& aEffectDataBuffer )
|
|
sl@0
|
280 |
{
|
|
sl@0
|
281 |
#ifdef _DEBUG
|
|
sl@0
|
282 |
RDebug::Print(_L("CDoppler::SetEffectData"));
|
|
sl@0
|
283 |
#endif
|
|
sl@0
|
284 |
TEfDopplerDataPckg dataPckg;
|
|
sl@0
|
285 |
dataPckg.Copy(aEffectDataBuffer);
|
|
sl@0
|
286 |
iDopplerData = dataPckg();
|
|
sl@0
|
287 |
iEnabled = iDopplerData.iEnabled;
|
|
sl@0
|
288 |
iEnforced = iDopplerData.iEnforced;
|
|
sl@0
|
289 |
iHaveUpdateRights = iDopplerData.iHaveUpdateRights;
|
|
sl@0
|
290 |
|
|
sl@0
|
291 |
}
|
|
sl@0
|
292 |
|
|
sl@0
|
293 |
|
|
sl@0
|
294 |
// ========================== OTHER EXPORTED FUNCTIONS =========================
|
|
sl@0
|
295 |
|
|
sl@0
|
296 |
// End of File
|
|
sl@0
|
297 |
|