FCL/sf/adapt/stubs: systemswstubs/tiltcompensationstub/src/tiltcompensation/tiltcompensation.cpp@ffb8e2ddd8dc (annotated)

1 ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	1	/*
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	2	* Copyright (c) 2007 Nokia Corporation and/or its subsidiary(-ies).
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	3	* All rights reserved.
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	4	* This component and the accompanying materials are made available
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	5	* under the terms of "Eclipse Public License v1.0"
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	6	* which accompanies this distribution, and is available
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	7	* at the URL "http://www.eclipse.org/legal/epl-v10.html".
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	8	*
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	9	* Initial Contributors:
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	10	* Nokia Corporation - initial contribution.
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	11	*
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	12	* Contributors:
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	13	*
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	14	* Description: Compensate function definition.
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	15	*
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	16	*/
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	17
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	18
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	19	#include <e32math.h>
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	20	#include "tiltcompensation.h"
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	21
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	22	//-----------------------------------------------------------------------------
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	23	// Direction6D
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	24	//-----------------------------------------------------------------------------
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	25	//
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	26	EXPORT_C TInt Compensate(
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	27	const TTiltCompensationInput& aInput,
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	28	TTiltCompensationOutput& aOutput,
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	29	)
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	30	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	31	TReal target;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	32	TReal source( 0 );
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	33	TReal inputY( aInput.iMagneticVector.iY );
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	34	TReal inputZ( aInput.iMagneticVector.iZ );
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	35
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	36	if( aInput.iMagneticVector.iY > 0 && aInput.iMagneticVector.iZ > 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	37	// 0 - 90 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	38	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	39	source = inputY / inputZ;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	40	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	41	if( aInput.iMagneticVector.iY > 0 && aInput.iMagneticVector.iZ < 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	42	// 90 - 180 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	43	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	44	source = inputZ / inputY * -1;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	45	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	46	if( aInput.iMagneticVector.iY < 0 && aInput.iMagneticVector.iZ < 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	47	// 180 - 270 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	48	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	49	source = inputY / inputZ;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	50	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	51	if( aInput.iMagneticVector.iY < 0 && aInput.iMagneticVector.iZ > 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	52	// 270 - 360 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	53	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	54	source = inputZ / inputY * -1;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	55	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	56
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	57	Math::ATan( target, source );
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	58	TInt16 declination( ( target * 180 ) / 3.14 );
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	59
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	60	if( aInput.iMagneticVector.iY > 0 && aInput.iMagneticVector.iZ > 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	61	// 0 - 90 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	62	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	63	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	64	if( aInput.iMagneticVector.iY > 0 && aInput.iMagneticVector.iZ < 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	65	// 90 - 180 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	66	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	67	declination = declination + 90;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	68	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	69	if( aInput.iMagneticVector.iY < 0 && aInput.iMagneticVector.iZ < 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	70	// 180 - 270 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	71	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	72	declination = declination + 180;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	73	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	74	if( aInput.iMagneticVector.iY < 0 && aInput.iMagneticVector.iZ > 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	75	// 270 - 360 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	76	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	77	declination = declination + 270;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	78	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	79
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	80	if( inputY == 0 && inputZ > 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	81	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	82	declination = 0;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	83	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	84	if( inputY > 0 && inputZ == 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	85	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	86	declination = 90;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	87	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	88	if( inputY == 0 && inputZ < 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	89	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	90	declination = 180;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	91	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	92	if( inputY < 0 && inputZ == 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	93	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	94	declination = 270;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	95	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	96
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	97	aOutput.iTheta = declination;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	98	return KErrNone;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	99	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	100
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	101	//-----------------------------------------------------------------------------
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	102	// Direction6D
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	103	//-----------------------------------------------------------------------------
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	104	//
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	105	EXPORT_C TInt Compensate(
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	106	const TTiltCompensationInput& aInput,
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	107	TTiltCompensationOutput& aOutput,
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	108	const RParamsArray& aParamsArray )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	109	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	110	TReal target;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	111	TReal source( 0 );
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	112	TReal inputY( aInput.iMagneticVector.iY );
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	113	TReal inputZ( aInput.iMagneticVector.iZ );
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	114
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	115	// Get parameters
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	116	for( TInt i = 0; i != aParamsArray.Count(); i++ )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	117	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	118	TInt parameter = aParamsArray[ i ];
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	119	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	120
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	121	if( aInput.iMagneticVector.iY > 0 && aInput.iMagneticVector.iZ > 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	122	// 0 - 90 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	123	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	124	source = inputY / inputZ;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	125	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	126	if( aInput.iMagneticVector.iY > 0 && aInput.iMagneticVector.iZ < 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	127	// 90 - 180 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	128	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	129	source = inputZ / inputY * -1;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	130	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	131	if( aInput.iMagneticVector.iY < 0 && aInput.iMagneticVector.iZ < 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	132	// 180 - 270 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	133	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	134	source = inputY / inputZ;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	135	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	136	if( aInput.iMagneticVector.iY < 0 && aInput.iMagneticVector.iZ > 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	137	// 270 - 360 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	138	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	139	source = inputZ / inputY * -1;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	140	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	141
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	142	Math::ATan( target, source );
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	143	TInt16 declination( ( target * 180 ) / 3.14 );
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	144
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	145	if( aInput.iMagneticVector.iY > 0 && aInput.iMagneticVector.iZ > 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	146	// 0 - 90 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	147	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	148	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	149	if( aInput.iMagneticVector.iY > 0 && aInput.iMagneticVector.iZ < 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	150	// 90 - 180 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	151	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	152	declination = declination + 90;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	153	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	154	if( aInput.iMagneticVector.iY < 0 && aInput.iMagneticVector.iZ < 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	155	// 180 - 270 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	156	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	157	declination = declination + 180;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	158	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	159	if( aInput.iMagneticVector.iY < 0 && aInput.iMagneticVector.iZ > 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	160	// 270 - 360 degrees
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	161	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	162	declination = declination + 270;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	163	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	164
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	165	if( inputY == 0 && inputZ > 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	166	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	167	declination = 0;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	168	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	169	if( inputY > 0 && inputZ == 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	170	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	171	declination = 90;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	172	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	173	if( inputY == 0 && inputZ < 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	174	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	175	declination = 180;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	176	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	177	if( inputY < 0 && inputZ == 0 )
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	178	{
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	179	declination = 270;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	180	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	181
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	182	aOutput.iTheta = declination;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	183	return KErrNone;
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	184	}
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	185
ffb8e2ddd8dc Revision: 201003 Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> parents: diff changeset	186	// End of File

author	Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
	Mon, 18 Jan 2010 20:06:52 +0200
changeset 1	ffb8e2ddd8dc
permissions	-rw-r--r--