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