// 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\euser\epoc\arm\uc_i64.cia
//
//
#include <u32std.h>
#include <e32math.h>
#if defined(__GCC32__)
extern "C" void __division_by_zero();
#define DIV_BY_ZERO " __division_by_zero "
#elif defined(__ARMCC__)
extern "C" void __rt_div0 (void);
#define DIV_BY_ZERO " __cpp(__rt_div0) "
#endif
EXPORT_C __NAKED__ void Math::Mul64(Int64 /*aX*/, Int64 /*aY*/, Int64& /*aOutH*/, Uint64& /*aOutL*/)
/**
Multiply aX by aY to generate a 128 bit result.
The high order 64 bits of this calculation are stored in aOutH,
and the low order 64 bits are stored in aOutL.
@param aX The first 64-bit operand.
@param aY The second 64-bit operand.
@param aOutH The high order 64 bits of the result.
@param aOutL The low order 64 bits of the result.
*/
{
// Enter with r1:r0=aX, r3:r2=aY, [sp]=&aOutH, [sp+4]=&aOutL
asm("stmfd sp!, {r4-r5,lr} ");
asm("umull r4, r5, r0, r2 "); // r5:r4 = x0 * y0
asm("mov r12, #0 "); // clear r12 initially
asm("umlal r5, r12, r0, r3 "); // r12:r5:r4 = x0 * y
asm("mov r14, #0 "); // clear r14 initially
asm("smlal r12, r14, r1, r3 "); // r14:r12:r5:r4 = x0 * y + (x1*y1)<<64
asm("and r3, r0, r3, asr #32 "); // if aY<0, r3=x0 else r3=0
asm("and r0, r2, r1, asr #32 "); // if aX<0, r0=y0 else r0=0
asm("subs r12, r12, r3 ");
asm("sbcs r14, r14, #0 ");
asm("subs r12, r12, r0 ");
asm("sbcs r14, r14, #0 ");
asm("umull r0, r3, r1, r2 "); // r3:r0 = x1 * y0
asm("ldr r1, [sp, #12] "); // r1=&aOutH
asm("ldr r2, [sp, #16] "); // r1=&aOutL
asm("adds r5, r5, r0 "); // shift left by 32 and add to give final result
asm("adcs r12, r12, r3 ");
asm("adcs r14, r14, #0 "); // final result now in r14:r12:r5:r4
asm("stmia r2, {r4,r5} "); // store low 64
asm("stmia r1, {r12,r14} "); // store high 64
__POPRET("r4-r5,");
}
EXPORT_C __NAKED__ void Math::UMul64(Uint64 /*aX*/, Uint64 /*aY*/, Uint64& /*aOutH*/, Uint64& /*aOutL*/)
/**
Multiply aX by aY to generate a 128 bit result.
The high order 64 bits of this calculation are stored in aOutH,
and the low order 64 bits are stored in aOutL.
@param aX The first 64-bit operand.
@param aY The second 64-bit operand.
@param aOutH The high order 64 bits of the result.
@param aOutL The low order 64 bits of the result.
*/
{
// Enter with r1:r0=aX, r3:r2=aY, [sp]=&aOutH, [sp+4]=&aOutL
asm("stmfd sp!, {r4-r5,lr} ");
asm("umull r4, r5, r0, r2 "); // r5:r4 = x0 * y0
asm("mov r12, #0 "); // clear r12 initially
asm("umlal r5, r12, r0, r3 "); // r12:r5:r4 = x0 * y
asm("mov r14, #0 "); // clear r14 initially
asm("umlal r12, r14, r1, r3 "); // r14:r12:r5:r4 = x0 * y + (x1*y1)<<64
// r0, r3 no longer required
asm("umull r0, r3, r1, r2 "); // r3:r0 = x1 * y0
asm("ldr r1, [sp, #12] "); // r1=&aOutH
asm("ldr r2, [sp, #16] "); // r1=&aOutL
asm("adds r5, r5, r0 "); // shift left by 32 and add to give final result
asm("adcs r12, r12, r3 ");
asm("adcs r14, r14, #0 "); // final result now in r14:r12:r5:r4
asm("stmia r2, {r4,r5} "); // store low 64
asm("stmia r1, {r12,r14} "); // store high 64
__POPRET("r4-r5,");
}
EXPORT_C __NAKED__ Int64 Math::DivMod64(Int64 /*aDividend*/, Int64 /*aDivisor*/, Int64& /*aRemainder*/)
/**
Divides aDividend by aDivisor.
The quotient is returned, and the remainder is stored in aRemainder.
The remainder has same sign as the dividend.
@param aDividend The 64-bit dividend.
@param aDivisor The 64-bit divisor.
@param aRemainder The 64-bit remainder.
@return The 64-bit quotient.
*/
{
// Enter with: r1:r0=dividend, r3:r2=divisor, [sp]=&aRemainder
// Return quotient in r1:r0
asm("stmfd sp!, {r4-r8,lr} ");
__EH_FRAME_PUSH2(r4-r8,lr)
asm("mov r8, r1, asr #1 "); // r8 bit 31 = r8 bit 30 = dividend sign
asm("eor r8, r8, r3, lsr #1 "); // r8 bit 31 = dividend sign, r8 bit 30 = quotient sign
asm("cmp r1, #0 ");
asm("bpl 1f ");
asm("rsbs r0, r0, #0 "); // r1:r0=ABS(dividend)
asm("rscs r1, r1, #0 ");
asm("1: ");
asm("cmp r3, #0 ");
asm("bpl 2f ");
asm("rsbs r2, r2, #0 "); // r3:r2=ABS(divisor)
asm("rscs r3, r3, #0 ");
asm("2: ");
#ifndef __EABI__
asm(".extern UDiv01 ");
asm("bl UDiv01 "); // do division, quotient->r5:r4, rem->r6:r3
asm("mov r2, r3"); // move to make regs same as EABI function
asm("mov r0, r4");
asm("mov r1, r5");
asm("mov r3, r6");
#else //__EABI__
asm(".extern __aeabi_uldivmod ");
asm("bl __aeabi_uldivmod "); // do division, quotient->r1:r0, rem->r3:r2
#endif //__EABI__
asm("add ip, r8, r8 "); // ip bit 31 = quotient sign
asm("ldr r6, [sp, #24] "); // r6 = &aRemainder
asm("eors r4, r0, ip, asr #32 "); // quotient into r5:r4, inverted if quotient -ve
asm("eors r5, r1, ip, asr #32 ");
asm("adcs r0, r4, #0 "); // if quotient -ve, add 1 whilst moving back to r1:r0
asm("adcs r1, r5, #0 ");
asm("cmp r8, #0 ");
asm("bpl 3f ");
asm("rsbs r2, r2, #0 "); // if dividend -ve, negate remainder
asm("rscs r3, r3, #0 ");
asm("3: ");
asm("stmia r6, {r2,r3} "); // store remainder
__POPRET("r4-r8,");
}
EXPORT_C __NAKED__ Uint64 Math::UDivMod64(Uint64 /*aDividend*/, Uint64 /*aDivisor*/, Uint64& /*aRemainder*/)
/**
Divides aDividend by aDivisor.
The quotient is returned, and the remainder is stored in aRemainder.
@param aDividend The 64-bit dividend.
@param aDivisor The 64-bit divisor.
@param aRemainder The 64-bit remainder.
@return The 64-bit quotient.
*/
{
// Enter with: r1:r0=dividend, r3:r2=divisor, [sp]=&aRemainder
// Return quotient in r1:r0
#ifdef __EABI__
// need to keep sp 8-byte aligned
asm("stmfd sp!, {r4-r8,lr} ");
__EH_FRAME_PUSH2(r4-r8,lr)
#else
asm("stmfd sp!, {r4-r7,lr} ");
#endif
#ifndef __EABI__
asm(".extern UDiv01 ");
asm("bl UDiv01 "); // do division, quotient->r5:r4, rem->r6:r3
asm("mov r2, r3"); // move to make regs same as EABI function
asm("mov r0, r4");
asm("mov r1, r5");
asm("mov r3, r6");
#else //__EABI__
asm("bl __aeabi_uldivmod "); // do division, quotient->r1:r0, rem->r3:r2
#endif //__EABI__
#ifdef __EABI__
asm("ldr r6, [sp, #24] "); // r6 = &aRemainder
#else
asm("ldr r6, [sp, #20] "); // r6 = &aRemainder
#endif
asm("stmia r6, {r2,r3} "); // store remainder
#ifdef __EABI__
__POPRET("r4-r8,");
#else
__POPRET("r4-r7,");
#endif
}