1 1.1 jakllsch /* $NetBSD: math.c,v 1.1 2014/04/01 16:16:07 jakllsch Exp $ */ 2 1.1 jakllsch 3 1.1 jakllsch /*++ 4 1.1 jakllsch 5 1.1 jakllsch Copyright (c) 1998 Intel Corporation 6 1.1 jakllsch 7 1.1 jakllsch Module Name: 8 1.1 jakllsch 9 1.1 jakllsch math.c 10 1.1 jakllsch 11 1.1 jakllsch Abstract: 12 1.1 jakllsch 13 1.1 jakllsch 14 1.1 jakllsch 15 1.1 jakllsch 16 1.1 jakllsch Revision History 17 1.1 jakllsch 18 1.1 jakllsch --*/ 19 1.1 jakllsch 20 1.1 jakllsch #include "lib.h" 21 1.1 jakllsch 22 1.1 jakllsch 23 1.1 jakllsch // 24 1.1 jakllsch // Declare runtime functions 25 1.1 jakllsch // 26 1.1 jakllsch 27 1.1 jakllsch #ifdef RUNTIME_CODE 28 1.1 jakllsch #ifndef __GNUC__ 29 1.1 jakllsch #pragma RUNTIME_CODE(LShiftU64) 30 1.1 jakllsch #pragma RUNTIME_CODE(RShiftU64) 31 1.1 jakllsch #pragma RUNTIME_CODE(MultU64x32) 32 1.1 jakllsch #pragma RUNTIME_CODE(DivU64x32) 33 1.1 jakllsch #endif 34 1.1 jakllsch #endif 35 1.1 jakllsch 36 1.1 jakllsch // 37 1.1 jakllsch // 38 1.1 jakllsch // 39 1.1 jakllsch 40 1.1 jakllsch 41 1.1 jakllsch 42 1.1 jakllsch 43 1.1 jakllsch UINT64 44 1.1 jakllsch LShiftU64 ( 45 1.1 jakllsch IN UINT64 Operand, 46 1.1 jakllsch IN UINTN Count 47 1.1 jakllsch ) 48 1.1 jakllsch // Left shift 64bit by 32bit and get a 64bit result 49 1.1 jakllsch { 50 1.1 jakllsch return Operand << Count; 51 1.1 jakllsch } 52 1.1 jakllsch 53 1.1 jakllsch UINT64 54 1.1 jakllsch RShiftU64 ( 55 1.1 jakllsch IN UINT64 Operand, 56 1.1 jakllsch IN UINTN Count 57 1.1 jakllsch ) 58 1.1 jakllsch // Right shift 64bit by 32bit and get a 64bit result 59 1.1 jakllsch { 60 1.1 jakllsch return Operand >> Count; 61 1.1 jakllsch } 62 1.1 jakllsch 63 1.1 jakllsch 64 1.1 jakllsch UINT64 65 1.1 jakllsch MultU64x32 ( 66 1.1 jakllsch IN UINT64 Multiplicand, 67 1.1 jakllsch IN UINTN Multiplier 68 1.1 jakllsch ) 69 1.1 jakllsch // Multiple 64bit by 32bit and get a 64bit result 70 1.1 jakllsch { 71 1.1 jakllsch return Multiplicand * Multiplier; 72 1.1 jakllsch } 73 1.1 jakllsch 74 1.1 jakllsch UINT64 75 1.1 jakllsch DivU64x32 ( 76 1.1 jakllsch IN UINT64 Dividend, 77 1.1 jakllsch IN UINTN Divisor, 78 1.1 jakllsch OUT UINTN *Remainder OPTIONAL 79 1.1 jakllsch ) 80 1.1 jakllsch // divide 64bit by 32bit and get a 64bit result 81 1.1 jakllsch // N.B. only works for 31bit divisors!! 82 1.1 jakllsch { 83 1.1 jakllsch ASSERT (Divisor != 0); 84 1.1 jakllsch 85 1.1 jakllsch if (Remainder) { 86 1.1 jakllsch *Remainder = Dividend % Divisor; 87 1.1 jakllsch } 88 1.1 jakllsch 89 1.1 jakllsch return Dividend / Divisor; 90 1.1 jakllsch } 91