diff -r 000000000000 -r 40261b775718 devsoundextensions/effects/DopplerBase/Src/DopplerBase.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/devsoundextensions/effects/DopplerBase/Src/DopplerBase.cpp Tue Feb 02 01:56:55 2010 +0200 @@ -0,0 +1,297 @@ +/* +* Copyright (c) 2004 Nokia Corporation and/or its subsidiary(-ies). +* All rights reserved. +* This component and the accompanying materials are made available +* under the terms of "Eclipse Public License v1.0" +* which accompanies this distribution, and is available +* at the URL "http://www.eclipse.org/legal/epl-v10.html". +* +* Initial Contributors: +* Nokia Corporation - initial contribution. +* +* Contributors: +* +* Description: Implementation of the doppler effect class +* +*/ + + + + +// INCLUDE FILES + +#ifdef _DEBUG +#include +#endif + +#include +#include +#include + + +//360 degrees: +#define TWO_PI 6283 +//180 degrees: +#define PI 3142 +//90 degrees: +#define QUARTER_PI 1570 + +// ============================ MEMBER FUNCTIONS =============================== + +// ----------------------------------------------------------------------------- +// CDoppler::CDoppler +// C++ default constructor can NOT contain any code, that +// might leave. +// ----------------------------------------------------------------------------- +// +EXPORT_C CDoppler::CDoppler() + : iDopplerData(), + iDataPckgTo(iDopplerData), + iDataPckgFrom(iDopplerData) + { + } + +// Destructor +EXPORT_C CDoppler::~CDoppler() + { + } + + +// ----------------------------------------------------------------------------- +// CDoppler::CartesianVelocity +// ----------------------------------------------------------------------------- +// + +EXPORT_C void CDoppler::CartesianVelocity( TInt32& aX, TInt32& aY, TInt32& aZ ) + { + aX = iDopplerData.iVelocityX; + aY = iDopplerData.iVelocityY; + aZ = iDopplerData.iVelocityZ; + } + +// ----------------------------------------------------------------------------- +// CDoppler::Factor +// ----------------------------------------------------------------------------- +// + +EXPORT_C TUint32 CDoppler::Factor() const + { + return iDopplerData.iFactor; + } + +// ----------------------------------------------------------------------------- +// CDoppler::FactorMax +// ----------------------------------------------------------------------------- +// + +EXPORT_C TUint32 CDoppler::FactorMax() const + { + return iDopplerData.iMaxFactor; + } +// ----------------------------------------------------------------------------- +// CDoppler::SetCartesianVelocityL +// ----------------------------------------------------------------------------- +// + +EXPORT_C void CDoppler::SetCartesianVelocityL( TInt32 aX, TInt32 aY, TInt32 aZ ) + { + iDopplerData.iVelocityX = aX; + iDopplerData.iVelocityY = aY; + iDopplerData.iVelocityZ = aZ; + + + TReal SqrtXYZ = 0, squareX = 0, squareY = 0, squareZ = 0; + Math::Pow(squareX, aX, 2); + Math::Pow(squareY, aY, 2); + Math::Pow(squareZ, aZ, 2); + + TReal sum = squareX + squareY + squareZ; + + Math::Sqrt(SqrtXYZ, sum); + + //Singularity region + if(!((aX==0) && (aZ==0))) + { + + TReal zDividedByXAtan = atan2 (-aX, -aZ); + + if (zDividedByXAtan > 0) + iDopplerData.iAzimuth = -(TInt32) (zDividedByXAtan * 1000 + 0.5); + else + iDopplerData.iAzimuth = -(TInt32) (zDividedByXAtan * 1000 - 0.5); + } + // else { we are exactly on Y-axis and therefore azimuth is undefined; let's use the previous azimuth value instead } + + + if (!((aX ==0) && (aY == 0) && (aZ == 0))) + { + + TReal result; + TReal yDividedBySqrtXYZ = aY/SqrtXYZ; + User::LeaveIfError(Math::ASin(result, yDividedBySqrtXYZ)); //was ACos + + if (result > 0) + iDopplerData.iElevation = (TInt32) (result * 1000 + 0.5); + else + iDopplerData.iElevation = (TInt32) (result * 1000 - 0.5); + + } + // else { we are exactly in origin and therefore elevation is undefined; let's use the previous elevation value instead } + + iDopplerData.iRadius= (TInt32) (SqrtXYZ + 0.5); + + + while(iDopplerData.iElevation > PI) + { + iDopplerData.iElevation = iDopplerData.iElevation - TWO_PI; + } + + if(iDopplerData.iElevation > QUARTER_PI) + { + iDopplerData.iElevation = iDopplerData.iElevation - (iDopplerData.iElevation - QUARTER_PI) * 2; + iDopplerData.iAzimuth = iDopplerData.iAzimuth + PI; + } + + while(iDopplerData.iElevation < -PI) + { + iDopplerData.iElevation = iDopplerData.iElevation + TWO_PI; + } + if(iDopplerData.iElevation < -QUARTER_PI) + { + iDopplerData.iElevation = iDopplerData.iElevation + (QUARTER_PI - iDopplerData.iElevation) * 2; + iDopplerData.iAzimuth = iDopplerData.iAzimuth + PI; + } + + while (iDopplerData.iAzimuth < 0) + iDopplerData.iAzimuth = iDopplerData.iAzimuth + TWO_PI; + while (iDopplerData.iAzimuth > TWO_PI) + iDopplerData.iAzimuth = iDopplerData.iAzimuth - TWO_PI; + + + } +// ----------------------------------------------------------------------------- +// CDoppler::SetFactorL +// ----------------------------------------------------------------------------- +// + +EXPORT_C void CDoppler::SetFactorL( TUint32 aFactor ) + { + if ( (aFactor <= iDopplerData.iMaxFactor) ) + { + iDopplerData.iFactor = aFactor; + } + else + { + User::Leave(KErrArgument); + } + } +// ----------------------------------------------------------------------------- +// CDoppler::SetSphericalVelocityL +// ----------------------------------------------------------------------------- +// + +EXPORT_C void CDoppler::SetSphericalVelocityL( TInt32 aAzimuth, TInt32 aElevation, TInt32 aRadius ) + { + + while(aElevation > PI) + { + aElevation = aElevation - TWO_PI; + } + + if(aElevation > QUARTER_PI) + { + aElevation = aElevation - (aElevation - QUARTER_PI) * 2; + aAzimuth = aAzimuth + PI; + } + + while(aElevation < -PI) + { + aElevation = aElevation + TWO_PI; + } + if(aElevation < -QUARTER_PI) + { + aElevation = aElevation + (QUARTER_PI - aElevation) * 2; + aAzimuth = aAzimuth + PI; + } + + while (aAzimuth < 0) + aAzimuth = aAzimuth + TWO_PI; + while (aAzimuth > TWO_PI) + aAzimuth = aAzimuth - TWO_PI; + + + iDopplerData.iAzimuth = aAzimuth; + iDopplerData.iElevation = aElevation; + iDopplerData.iRadius = aRadius; + + + TReal elevation = aElevation / 1000.0; // conversion from milliradians to radians because Sin and Cos functions eat radians + + TReal elevationSin; + TReal elevationCos; + User::LeaveIfError( Math::Sin( elevationSin, elevation ) ); + User::LeaveIfError( Math::Cos( elevationCos, elevation ) ); + + TReal azimuthSin; + TReal azimuthCos; + User::LeaveIfError( Math::Sin( azimuthSin, aAzimuth / 1000.0) ); + User::LeaveIfError( Math::Cos(azimuthCos, aAzimuth / 1000.0) ); + + + iDopplerData.iVelocityX = (TInt32)(0.5 + aRadius * elevationCos * azimuthSin); + iDopplerData.iVelocityY = (TInt32)(0.5 + aRadius * elevationSin); + iDopplerData.iVelocityZ = (TInt32)(0.5 - aRadius * elevationCos * azimuthCos); + } + + +// ----------------------------------------------------------------------------- +// CDoppler::SphericalVelocity +// ----------------------------------------------------------------------------- +// + +EXPORT_C void CDoppler::SphericalVelocity( TInt32& aAzimuth, TInt32& aElevation, TInt32& aRadius ) + { + aAzimuth = iDopplerData.iAzimuth; + aElevation = iDopplerData.iElevation; + aRadius = iDopplerData.iRadius ; + + } + + +// ----------------------------------------------------------------------------- +// CDoppler::DoEffectData +// ----------------------------------------------------------------------------- +// +EXPORT_C const TDesC8& CDoppler::DoEffectData() + { +#ifdef _DEBUG + RDebug::Print(_L("CDoppler::DoEffectData")); +#endif + iDataPckgTo = iDopplerData; + return iDataPckgTo; + } + +// ----------------------------------------------------------------------------- +// CDoppler::SetEffectData +// ----------------------------------------------------------------------------- +// +EXPORT_C void CDoppler::SetEffectData( + const TDesC8& aEffectDataBuffer ) + { +#ifdef _DEBUG + RDebug::Print(_L("CDoppler::SetEffectData")); +#endif + TEfDopplerDataPckg dataPckg; + dataPckg.Copy(aEffectDataBuffer); + iDopplerData = dataPckg(); + iEnabled = iDopplerData.iEnabled; + iEnforced = iDopplerData.iEnforced; + iHaveUpdateRights = iDopplerData.iHaveUpdateRights; + + } + + +// ========================== OTHER EXPORTED FUNCTIONS ========================= + +// End of File +