// Copyright (c) 1997-2009 Nokia Corporation and/or its subsidiary(-ies).

// All rights reserved.

// This component and the accompanying materials are made available

// under the terms of the License "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:

// e32\common\arm\cdes16.cia

// 

//

#include <e32cia.h>

#include "../common.h"

#if defined(__DES16_MACHINE_CODED__) || defined(__EABI__)

GLREF_C void Des16PanicBadDesType();

GLREF_C void Des16PanicPosOutOfRange();

#endif

#ifdef __DES16_MACHINE_CODED__

GLREF_C void Des16PanicLengthNegative();

GLREF_C void Des16PanicMaxLengthNegative();

GLREF_C void Des16PanicLengthOutOfRange();

GLREF_C void Des16PanicDesOverflow();

GLREF_C void Des16PanicDesIndexOutOfRange();

__NAKED__ EXPORT_C const TUint16 *TDesC16::Ptr() const

//

// Return a pointer to the buffer.

//

	{

	asm("ldr r1, [r0], #4 ");

	asm("cmp r1, #0x50000000 ");

	asm("bcs  " CSM_Z20Des16PanicBadDesTypev);

	asm("eor r1, r1, r1, lsr #1 ");

	asm("msr cpsr_flg, r1 ");

	asm("addcs r0, r0, #4 ");

	asm("ldrle r0, [r0] ");

	asm("addeq r0, r0, #4 ");

	__JUMP(,lr);

	}

#ifndef __EABI_CTORS__

__NAKED__ EXPORT_C TPtrC16::TPtrC16()

//

// Default constructor

//

	{

	asm("mov r1, #0x10000000 ");	// type=EPtrC, length=0

	asm("mov r2, #0 ");				// ptr=NULL

	asm("stmia r0, {r1,r2} ");

	__JUMP(,lr);

	}

__NAKED__ EXPORT_C TPtrC16::TPtrC16(const TDesC16& /*aDes*/)

//

// Constructor

//

	{

	asm("ldr r2, [r1], #4 ");		// r2 = type/length

	asm("bic r3, r2, #0xF0000000");	// r3 = length

	asm("orr r3, r3, #0x10000000");	// r3 = EPtrC + length

	asm("cmp r2, #0x50000000 ");

	asm("bcs  " CSM_Z20Des16PanicBadDesTypev);

	asm("eor r2, r2, r2, lsr #1 ");

	asm("msr cpsr_flg, r2 ");

	asm("addcs r1, r1, #4 ");

	asm("ldrle r1, [r1] ");

	asm("addeq r1, r1, #4 ");		// r1 = aDes.Ptr()

	asm("str r3, [r0] ");

	asm("str r1, [r0, #4] ");

	__JUMP(,lr);

	}

#ifdef __DES16_MACHINE_CODED_HWORD__

__NAKED__ EXPORT_C TPtrC16::TPtrC16(const TUint16* /*aString*/)

//

// Constructor

//

	{

	asm("mov r2, r1 ");				// save aString address

	asm("1: ");

	asm("ldrh r3, [r1], #2 ");

	asm("cmp r3, #0 ");

	asm("bne 1b ");					// loop until we reach zero terminator

	asm("rsb r1, r2, r1 ");			// r1 = 2*length + 2

	asm("sub r1, r1, #2 ");			// r1 = 2*length

	asm("mov r1, r1, lsr #1 ");		// r1 = length

	asm("orr r1, r1, #0x10000000 ");	// r1=EPtrC + length

	asm("stmia r0, {r1, r2} ");		// store type/length and ptr fields

	__JUMP(,lr);

	}

#endif

__NAKED__ EXPORT_C TPtrC16::TPtrC16(const TUint16* /*aBuf*/,TInt /*aLength*/)

//

// Constructor

//

	{

	asm("orrs r2, r2, #0x10000000 ");

	asm("strpl r2, [r0] ");

	asm("strpl r1, [r0, #4] ");

	__JUMP(pl,lr);

	asm("b  " CSM_Z24Des16PanicLengthNegativev);

	}

__NAKED__ EXPORT_C TPtr16::TPtr16(TUint16* /*aBuf*/,TInt /*aMaxLength*/)

//

// Constructor

//

	{

	asm("cmp r2, #0 ");

	asm("movpl r3, r1 ");

	asm("movpl r1, #0x20000000 ");	// length=0, EPtr

	asm("stmplia r0, {r1,r2,r3} ");

	__JUMP(pl,lr);

	asm("b  " CSM_Z27Des16PanicMaxLengthNegativev);

	}

__NAKED__ EXPORT_C TPtr16::TPtr16(TUint16* /*aBuf*/,TInt /*aLength*/,TInt /*aMaxLength*/)

//

// Constructor

//

	{

	asm("cmp r2, #0 ");				// check length>=0

	asm("cmpge r3, r2 ");			// if so, check maxlength>=length

	asm("movge r12, r1 ");

	asm("orrge r2, r2, #0x20000000 ");	// r2 = length + EPtr

	asm("stmgeia r0, {r2,r3,r12} ");

	__JUMP(ge,lr);

	asm("cmp r2, #0 ");

	asm("bmi  " CSM_Z24Des16PanicLengthNegativev);

	asm("cmp r3, #0 ");

	asm("bmi  " CSM_Z27Des16PanicMaxLengthNegativev);

	asm("b  " CSM_Z26Des16PanicLengthOutOfRangev);

	}

__NAKED__ EXPORT_C TPtr16::TPtr16(TBufCBase16& /*aLcb*/,TInt /*aMaxLength*/)

//

// Constructor

//

	{

	asm("mov r3, r1 ");

	asm("ldr r1, [r3] ");

	asm("bic r1, r1, #0xF0000000 ");		// r1=aLcb.Length()

	asm("cmp r1, r2 ");						// check against maxlength

	asm("orrle r1, r1, #0x40000000 ");		// r1=aLcb.Length() + EBufCPtr

	asm("stmleia r0, {r1,r2,r3} ");

	__JUMP(le,lr);

	asm("b  " CSM_Z26Des16PanicLengthOutOfRangev);

	}

__NAKED__ EXPORT_C TBufCBase16::TBufCBase16()

//

// Constructor

//

	{

	asm("mov r1, #0 ");

	asm("str r1, [r0] ");

	__JUMP(,lr);

	}

#ifdef __DES16_MACHINE_CODED_HWORD__

__NAKED__ EXPORT_C TBufCBase16::TBufCBase16(const TUint16* /*aString*/,TInt /*aMaxLength*/)

//

// Constructor

//

	{

	asm("sub r3, r1, #2 ");				// r3=aString address-2

	asm("1: ");

	asm("ldrh r12, [r3, #2]! ");

	asm("cmp r12, #0 ");

	asm("bne 1b ");						// loop until we reach zero terminator

	asm("sub r3, r3, r1 ");				// r3 = 2*length

	asm("mov r3, r3, lsr #1 ");			// r3 = length (+EBufC)

	asm("cmp r3, r2 ");					// check against max length

	asm("bgt " CSM_Z26Des16PanicLengthOutOfRangev);

	asm("stmfd sp!, {r0,lr} ");			// save registers for function call

	asm("str r3, [r0], #4 ");			// save length/type field, r0->buffer

	asm("add r2, r3, r3 ");				// size=2*length into r2 for function call

	asm("bl memmove ");					// call memmove

	__POPRET("r0,");

	}

#endif

__NAKED__ EXPORT_C TBufCBase16::TBufCBase16(const TDesC16& /*aDes*/,TInt /*aMaxLength*/)

//

// Constructor

//

	{

	asm("ldr r3, [r1], #4 ");			// r3 = type/length

	asm("bic r12, r3, #0xF0000000");	// r12 = length

	asm("cmp r12, r2 ");				// compare with maxlength

	asm("bgt  " CSM_Z26Des16PanicLengthOutOfRangev);

	asm("cmp r3, #0x50000000 ");

	asm("bcs  " CSM_Z20Des16PanicBadDesTypev);

	asm("eor r3, r3, r3, lsr #1 ");

	asm("msr cpsr_flg, r3 ");

	asm("addcs r1, r1, #4 ");

	asm("ldrle r1, [r1] ");

	asm("addeq r1, r1, #4 ");			// r1 = aDes.Ptr()

	asm("stmfd sp!, {r0,lr} ");			// save registers for function call

	asm("str r12, [r0], #4 ");			// store length/type, r0->buffer

	asm("add r2, r12, r12 ");			// size=2*length into r2 for function call

	asm("bl memmove ");					// call memmove

	__POPRET("r0,");

	}

#endif

#ifdef __DES16_MACHINE_CODED_HWORD__

__NAKED__ EXPORT_C void TBufCBase16::Copy(const TUint16* /*aString*/,TInt /*aMaxLength*/)

//

// Copy from a string.

//

	{

	asm("sub r3, r1, #2 ");				// r3=aString address-2

	asm("1: ");

	asm("ldrh r12, [r3, #2]! ");

	asm("cmp r12, #0 ");

	asm("bne 1b ");						// loop until we reach zero terminator

	asm("sub r3, r3, r1 ");				// r3 = 2*length

	asm("mov r3, r3, lsr #1 ");			// r3 = length (+EBufC)

	asm("cmp r3, r2 ");					// check against max length

	asm("bgt " CSM_Z26Des16PanicLengthOutOfRangev);

	asm("str r3, [r0], #4 ");			// save length/type field, r0->buffer

	asm("add r2, r3, r3 ");				// size=2*length into r2 for function call

	asm("b memmove ");					// call memmove

	}

#endif

__NAKED__ EXPORT_C void TBufCBase16::Copy(const TDesC16& /*aDes*/,TInt /*aMaxLength*/)

//

// Copy from a descriptor.

//

	{

	asm("ldr r3, [r1], #4 ");			// r3 = type/length

	asm("bic r12, r3, #0xF0000000");	// r12 = length

	asm("cmp r12, r2 ");				// compare with maxlength

	asm("bgt  " CSM_Z21Des16PanicDesOverflowv);

	asm("cmp r3, #0x50000000 ");

	asm("bcs  " CSM_Z20Des16PanicBadDesTypev);

	asm("eor r3, r3, r3, lsr #1 ");

	asm("msr cpsr_flg, r3 ");

	asm("addcs r1, r1, #4 ");

	asm("ldrle r1, [r1] ");

	asm("addeq r1, r1, #4 ");			// r1 = aDes.Ptr()

	asm("str r12, [r0], #4 ");			// store length/type, r0->buffer

	asm("add r2, r12, r12 ");			// size=2*length into r2 for function call

	asm("b memmove ");					// call memmove

	}

#ifndef __EABI_CTORS__

__NAKED__ EXPORT_C TBufBase16::TBufBase16(TInt /*aMaxLength*/)

	{

	asm("mov r2, #0x30000000 ");		// EBuf + zero length

	asm("str r2, [r0] ");

	asm("str r1, [r0, #4] ");

	__JUMP(,lr);

	}

__NAKED__ EXPORT_C TBufBase16::TBufBase16(TInt /*aLength*/, TInt /*aMaxLength*/)

	{

	asm("cmp r1, #0 ");					// check length>=0

	asm("cmpge r2, r1 ");				// if so, check maxlength>=length

	asm("orrge r1, r1, #0x30000000 ");	// r1=length + EBuf

	asm("stmgeia r0, {r1,r2} ");		// store length/type and maxlength fields

	__JUMP(ge,lr);

	asm("cmp r2, #0 ");

	asm("bmi  " CSM_Z27Des16PanicMaxLengthNegativev);

	asm("b  " CSM_Z26Des16PanicLengthOutOfRangev);

	}

#ifdef __DES16_MACHINE_CODED_HWORD__

__NAKED__ EXPORT_C TBufBase16::TBufBase16(const TUint16* /*aString*/, TInt /*aMaxLength*/)

	{

	asm("mov r12, r1, lsr #1 ");		// save aString pointer (lose bottom bit which should be 0)

	asm("1: ");

	asm("ldrh r3, [r1], #2 ");

	asm("cmp r3, #0 ");

	asm("bne 1b ");						// loop until we reach zero terminator

	asm("rsb r3, r12, r1, lsr #1 ");	// r3 = length + 1

	asm("sub r3, r3, #1 ");				// r3 = length

	asm("cmp r3, r2 ");					// compare to max length

	asm("bgt " CSM_Z26Des16PanicLengthOutOfRangev);	// length too big, so panic

	asm("orr r1, r3, #0x30000000 ");	// if length<=max, r1=EBuf + length

	asm("stmfd sp!, {r0, lr} ");		// save registers for function call

	asm("stmia r0!, {r1, r2} ");		// store type/length and max length fields, r0->buffer

	asm("mov r2, r3, lsl #1 ");			// r2=Size()

	asm("mov r1, r12, lsl #1 ");		// r1=aString

	asm("bl memmove ");					// call memmove

	__POPRET("r0,");

	}

#endif

__NAKED__ EXPORT_C TBufBase16::TBufBase16(const TDesC16& /*aDes*/, TInt /*aMaxLength*/)

	{

	asm("ldr r3, [r1], #4 ");			// r3 = type/length

	asm("bic r12, r3, #0xF0000000");	// r12 = length

	asm("cmp r12, r2 ");				// compare with maxlength

	asm("bgt  " CSM_Z26Des16PanicLengthOutOfRangev);

	asm("cmp r3, #0x50000000 ");

	asm("bcs  " CSM_Z20Des16PanicBadDesTypev);

	asm("eor r3, r3, r3, lsr #1 ");

	asm("msr cpsr_flg, r3 ");

	asm("addcs r1, r1, #4 ");

	asm("ldrle r1, [r1] ");

	asm("addeq r1, r1, #4 ");			// r1 = aDes.Ptr()

	asm("stmfd sp!, {r0,lr} ");			// save registers for function call

	asm("orr r3, r12, #0x30000000 ");	// add EBuf type field

	asm("str r3, [r0], #4 ");			// store length/type, r0->max length

	asm("str r2, [r0], #4 ");			// store max length, r0->buffer

	asm("mov r2, r12, lsl #1 ");		// Size() into r2 for function call

	asm("bl memmove ");					// call memmove

	__POPRET("r0,");

	}

#endif

__NAKED__ EXPORT_C void TDes16::SetLength(TInt /*aLength*/)

//

// Set the length of the descriptor, checking the length is O.K.

//

	{

	asm("ldmia r0, {r2,r3} ");			// r2=length/type, r3=maxlength

	asm("cmp r1, r3 ");					// check aLength against maxlength and for -ve values

	asm("bhi  " CSM_Z21Des16PanicDesOverflowv);

	asm("and r2, r2, #0xF0000000 ");	// r2=type field

	asm("cmp r2, #0x40000000 ");		// check for EBufCPtr

	asm("orr r2, r2, r1 ");				// r2=type + new length

	asm("str r2, [r0] ");				// store new length

	__JUMP(ne,lr);

	asm("ldr r2, [r0, #8] ");			// r2=pointer to TBufCBase

	asm("str r1, [r2] ");				// update length of TBufCBase

	__JUMP(,lr);

  	}

__NAKED__ EXPORT_C void TDes16::SetMax()

//

// Set the length to MaxLength().

//

	{

	asm("ldmia r0, {r1,r2} ");			// r1=length/type, r2=maxlength

	asm("and r1, r1, #0xF0000000 ");	// r1=type field

	asm("cmp r1, #0x40000000 ");		// check for EBufCPtr

	asm("orr r1, r1, r2 ");				// r1=type field + maxlength

	asm("str r1, [r0] ");				// store new length

	__JUMP(ne,lr);

	asm("ldr r1, [r0, #8] ");			// r1 = pointer to TBufCBase

	asm("str r2, [r1] ");				// update length of TBufCBase

	__JUMP(,lr);

	}

#ifdef __DES16_MACHINE_CODED_HWORD__

__NAKED__ EXPORT_C void TDes16::Copy(const TUint16* /*aString*/)

//

// Copy a string to this descriptor.

//

	{

	asm("sub r2, r1, #2 ");				// r2=aString-2

	asm("1: ");

	asm("ldrh r3, [r2, #2]! ");

	asm("cmp r3, #0 ");

	asm("bne 1b ");						// loop until zero terminator reached

	asm("sub r2, r2, r1 ");				// r2=2*length of string

	asm("mov r2, r2, lsr #1 ");			// r2=length of string

	asm("ldmia r0, {r3,r12} ");			// r3=type/length of this, r12=maxlength

	asm("cmp r2, r12 ");				// compare new length against maxlength

	asm("bgt " CSM_Z21Des16PanicDesOverflowv);

	asm("cmp r3, #0x50000000 ");

	asm("bcs " CSM_Z20Des16PanicBadDesTypev);

	asm("and r3, r3, #0xF0000000 ");	// r3=type of this

	asm("orr r3, r3, r2 ");				// r3=new type/length

	asm("str r3, [r0], #4 ");			// store it

	asm("eor r3, r3, r3, lsr #1 ");

	asm("msr cpsr_flg, r3 ");

	asm("addcs r0, r0, #4 ");

	asm("ldrle r0, [r0] ");

	asm("streq r2, [r0], #4 ");			// if EBufCPtr, update length of TBufCBase, r0=Ptr()

	asm("add r2, r2, r2 ");				// r2=size=2*length

	asm("b memmove ");					// call memmove

	}

#endif

__NAKED__ EXPORT_C void TDes16::Copy(const TUint16* /*aBuf*/,TInt /*aLength*/)

//

// Copy the aLength characters to the descriptor.

//

	{

	asm("ldmia r0, {r3,r12} ");			// r3=type/length of this, r12=maxlength

	asm("cmp r2, r12 ");				// compare new length against maxlength

	asm("bhi  " CSM_Z21Des16PanicDesOverflowv);	// Des16Panic if >MaxLength or -ve

	asm("cmp r3, #0x50000000 ");

	asm("bcs  " CSM_Z20Des16PanicBadDesTypev);

	asm("and r3, r3, #0xF0000000 ");	// r3=type of this

	asm("orr r3, r3, r2 ");				// r3=new type/length

	asm("str r3, [r0], #4 ");			// store it

	asm("eor r3, r3, r3, lsr #1 ");

	asm("msr cpsr_flg, r3 ");

	asm("addcs r0, r0, #4 ");

	asm("ldrle r0, [r0] ");

	asm("streq r2, [r0], #4 ");			// if EBufCPtr, update length of TBufCBase, r0=Ptr()

	asm("add r2, r2, r2 ");				// r2=size=2*length

	asm("b memmove ");					// call memmove

	}

__NAKED__ EXPORT_C void TDes16::Copy(const TDesC16& /*aDes*/)

//

// Copy a descriptor to this descriptor.

//

	{

	asm("ldr r3, [r1], #4 ");			// r3 = type/length of aDes

	asm("bic r12, r3, #0xF0000000");	// r12 = aDes.length

	asm("ldr r2, [r0, #4] ");			// r2=this.maxlength

	asm("cmp r12, r2 ");				// compare with maxlength

	asm("bgt  " CSM_Z21Des16PanicDesOverflowv);

	asm("ldr r2, [r0] ");				// get type of this

	asm("cmp r2, #0x50000000 ");		// check both descriptor types

	asm("cmpcc r3, #0x50000000 ");

	asm("bcs  " CSM_Z20Des16PanicBadDesTypev);

	asm("and r2, r2, #0xF0000000 ");

	asm("orr r2, r12, r2 ");			// r2=new type/length of this

	asm("str r2, [r0], #4 ");			// store it

	asm("eor r3, r3, r3, lsr #1 ");

	asm("msr cpsr_flg, r3 ");

	asm("addcs r1, r1, #4 ");

	asm("ldrle r1, [r1] ");

	asm("addeq r1, r1, #4 ");			// r1 = aDes.Ptr()

	asm("eor r2, r2, r2, lsr #1 ");

	asm("msr cpsr_flg, r2 ");

	asm("addcs r0, r0, #4 ");

	asm("ldrle r0, [r0] ");

	asm("streq r12, [r0], #4 ");		// if EBufCPtr, update length of TBufCBase, r0=Ptr()

	asm("add r2, r12, r12 ");			// size=2*length into r2 for function call

	asm("b memmove ");					// call memmove

	}

__NAKED__ EXPORT_C TPtr16 TDes16::LeftTPtr(TInt /*aLength*/) const

//

// Extract the left portion of the descriptor.

//

	{

	// On entry r0=return store ptr, r1=this, r2=aLength

	// Return TPtr8 ([r0]=length/type,[r0,#4]=maxLength,[r0,#8]=Ptr)

	asm("ldr r3, [r1], #4 ");				// r3=this.length/type

	asm("cmp r2, #0 ");						// check aLength>=0

	asm("blt " CSM_Z23Des16PanicPosOutOfRangev);	// if not, panic

	asm("bic r12, r3, #0xF0000000 ");		// r12=this.Length()

	asm("cmp r2, r12 ");					// else limit aLength to Length()

	asm("movgt r2, r12 ");

	asm("cmp r3, #0x50000000 ");

	asm("bcs " CSM_Z20Des16PanicBadDesTypev);

	asm("eor r3, r3, r3, lsr #1 ");

	asm("msr cpsr_flg, r3 ");

	asm("addcs r1, r1, #4 ");

	asm("ldrle r1, [r1] ");

	asm("addeq r1, r1, #4 ");				// r1=this.Ptr()

	asm("mov r3, r1 ");						// r3=this.Ptr()

	asm("orr r1, r2, #0x20000000 ");		// r1=aLength + EPtr

	asm("stmia r0, {r1-r3} ");				

	__JUMP(,lr);

	}

__NAKED__ EXPORT_C TPtr16 TDes16::RightTPtr(TInt /*aLength*/) const

//

// Extract the right portion of the descriptor.

//

	{

	// On entry r0=return store ptr, r1=this, r2=aLength

	// Return TPtr8 ([r0]=length/type,[r0,#4]=maxLength,[r0,#8]=Ptr)

	asm("ldr r3, [r1], #4 ");				// r3=this.length/type

	asm("cmp r2, #0 ");						// check aLength>=0

	asm("blt " CSM_Z23Des16PanicPosOutOfRangev);	// if not, panic

	asm("bic r12, r3, #0xF0000000 ");		// r12=this.Length()

	asm("cmp r2, r12 ");					// else limit aLength to Length()

	asm("movgt r2, r12 ");

	asm("cmp r3, #0x50000000 ");

	asm("bcs " CSM_Z20Des16PanicBadDesTypev);

	asm("eor r3, r3, r3, lsr #1 ");

	asm("msr cpsr_flg, r3 ");

	asm("addcs r1, r1, #4 ");

	asm("ldrle r1, [r1] ");

	asm("addeq r1, r1, #4 ");				// r0=this.Ptr()

	asm("add r3, r1, r12, lsl #1 ");		// r3=this.Ptr()+len*2

	asm("orr r1, r2, #0x20000000 ");		// r1=aLength + EPtr

	asm("sub r3, r3, r2, lsl #1 ");			// r2=Ptr()+len*2-aLength*2

	asm("stmia r0, {r1-r3} ");

	__JUMP(,lr);

	}

__NAKED__ EXPORT_C TPtr16 TDes16::MidTPtr(TInt /*aPos*/) const

//

// Extract the middle portion of the descriptor.

//

	{

	// On entry r0=return store ptr, r1=this, r2=aPos

	// Return TPtr8 ([r0]=length/type,[r0,#4]=maxLength,[r0,#8]=Ptr)

	asm("ldr r3, [r1], #4 ");				// r3=this.length/type

	asm("bic r12, r3, #0xF0000000 ");		// r12=this.Length()

	asm("cmp r2, #0 ");						// check aPos>=0

	asm("cmpge r12, r2 ");					// if so check Length()>=aPos

	asm("blt " CSM_Z23Des16PanicPosOutOfRangev);

	asm("cmp r3, #0x50000000 ");

	asm("bcs " CSM_Z20Des16PanicBadDesTypev);

	asm("eor r3, r3, r3, lsr #1 ");

	asm("msr cpsr_flg, r3 ");

	asm("addcs r1, r1, #4 ");

	asm("ldrle r1, [r1] ");

	asm("addeq r1, r1, #4 ");				// r0=this.Ptr()

	asm("add r3, r1, r2, lsl #1 ");			// r3=this.Ptr()+aPos*2

	asm("sub r2, r12, r2 ");				// r2=len-aPos (=newMaxLen)

	asm("orr r1, r2, #0x20000000 ");		// r1=len-aPos + EPtr (=newLen/Type)

	asm("stmia r0, {r1-r3} ");

	__JUMP(,lr);

	}

__NAKED__ EXPORT_C TPtr16 TDes16::MidTPtr(TInt /*aPos*/,TInt /*aLength*/) const

//

// Extract the middle portion of the descriptor.