1ec3ed6a5ebf6f2c406d7bcf94b6bc34fcaeb976eepoger@google.com
28a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com/*
3ec3ed6a5ebf6f2c406d7bcf94b6bc34fcaeb976eepoger@google.com * Copyright 2006 The Android Open Source Project
48a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com *
5ec3ed6a5ebf6f2c406d7bcf94b6bc34fcaeb976eepoger@google.com * Use of this source code is governed by a BSD-style license that can be
6ec3ed6a5ebf6f2c406d7bcf94b6bc34fcaeb976eepoger@google.com * found in the LICENSE file.
78a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com */
88a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com
9ec3ed6a5ebf6f2c406d7bcf94b6bc34fcaeb976eepoger@google.com
108a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com#ifndef SkMath_DEFINED
118a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com#define SkMath_DEFINED
128a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com
138a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com#include "SkTypes.h"
148a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com
1557212f9469c8056bab3c85243dbb904e386eab95reed@google.com// 64bit -> 32bit utilities
1657212f9469c8056bab3c85243dbb904e386eab95reed@google.com
1757212f9469c8056bab3c85243dbb904e386eab95reed@google.com/**
1857212f9469c8056bab3c85243dbb904e386eab95reed@google.com *  Return true iff the 64bit value can exactly be represented in signed 32bits
1957212f9469c8056bab3c85243dbb904e386eab95reed@google.com */
2057212f9469c8056bab3c85243dbb904e386eab95reed@google.comstatic inline bool sk_64_isS32(int64_t value) {
2157212f9469c8056bab3c85243dbb904e386eab95reed@google.com    return (int32_t)value == value;
2257212f9469c8056bab3c85243dbb904e386eab95reed@google.com}
2357212f9469c8056bab3c85243dbb904e386eab95reed@google.com
2457212f9469c8056bab3c85243dbb904e386eab95reed@google.com/**
2557212f9469c8056bab3c85243dbb904e386eab95reed@google.com *  Return the 64bit argument as signed 32bits, asserting in debug that the arg
2657212f9469c8056bab3c85243dbb904e386eab95reed@google.com *  exactly fits in signed 32bits. In the release build, no checks are preformed
2757212f9469c8056bab3c85243dbb904e386eab95reed@google.com *  and the return value if the arg does not fit is undefined.
2857212f9469c8056bab3c85243dbb904e386eab95reed@google.com */
2957212f9469c8056bab3c85243dbb904e386eab95reed@google.comstatic inline int32_t sk_64_asS32(int64_t value) {
3057212f9469c8056bab3c85243dbb904e386eab95reed@google.com    SkASSERT(sk_64_isS32(value));
3157212f9469c8056bab3c85243dbb904e386eab95reed@google.com    return (int32_t)value;
3257212f9469c8056bab3c85243dbb904e386eab95reed@google.com}
3357212f9469c8056bab3c85243dbb904e386eab95reed@google.com
3457212f9469c8056bab3c85243dbb904e386eab95reed@google.com// Handy util that can be passed two ints, and will automatically promote to
3557212f9469c8056bab3c85243dbb904e386eab95reed@google.com// 64bits before the multiply, so the caller doesn't have to remember to cast
3657212f9469c8056bab3c85243dbb904e386eab95reed@google.com// e.g. (int64_t)a * b;
3757212f9469c8056bab3c85243dbb904e386eab95reed@google.comstatic inline int64_t sk_64_mul(int64_t a, int64_t b) {
3857212f9469c8056bab3c85243dbb904e386eab95reed@google.com    return a * b;
3957212f9469c8056bab3c85243dbb904e386eab95reed@google.com}
4057212f9469c8056bab3c85243dbb904e386eab95reed@google.com
414b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com///////////////////////////////////////////////////////////////////////////////
428a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com
430f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org/**
440f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org *  Computes numer1 * numer2 / denom in full 64 intermediate precision.
450f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org *  It is an error for denom to be 0. There is no special handling if
460f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org *  the result overflows 32bits.
470f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org */
480f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.orgstatic inline int32_t SkMulDiv(int32_t numer1, int32_t numer2, int32_t denom) {
490f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org    SkASSERT(denom);
50f7927dd60761ca45f26059a8ab434018676cb2e7skia.committer@gmail.com
510f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org    int64_t tmp = sk_64_mul(numer1, numer2) / denom;
520f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org    return sk_64_asS32(tmp);
530f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org}
540f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org
550f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org/**
560f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org *  Computes (numer1 << shift) / denom in full 64 intermediate precision.
570f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org *  It is an error for denom to be 0. There is no special handling if
580f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org *  the result overflows 32bits.
590f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org */
600f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.orgint32_t SkDivBits(int32_t numer, int32_t denom, int shift);
610f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org
620f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org/**
630f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org *  Return the integer square root of value, with a bias of bitBias
640f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org */
650f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.orgint32_t SkSqrtBits(int32_t value, int bitBias);
660f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org
670f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org/** Return the integer square root of n, treated as a SkFixed (16.16)
680f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org */
690f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org#define SkSqrt32(n)         SkSqrtBits(n, 15)
700f1fef834c73cb4f38023de0f98d05562d24f2bccommit-bot@chromium.org
714b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com//! Returns the number of leading zero bits (0...32)
724b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.comint SkCLZ_portable(uint32_t);
738a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com
7444d37d9d7228e7409f4feea722c26f570434b8fdreed@google.com#ifndef SkCLZ
757729534da419436ea6127545e9f79b0b47ccffb4reed@google.com    #if defined(_MSC_VER) && _MSC_VER >= 1400
767729534da419436ea6127545e9f79b0b47ccffb4reed@google.com        #include <intrin.h>
777729534da419436ea6127545e9f79b0b47ccffb4reed@google.com
787729534da419436ea6127545e9f79b0b47ccffb4reed@google.com        static inline int SkCLZ(uint32_t mask) {
797729534da419436ea6127545e9f79b0b47ccffb4reed@google.com            if (mask) {
807729534da419436ea6127545e9f79b0b47ccffb4reed@google.com                DWORD index;
817729534da419436ea6127545e9f79b0b47ccffb4reed@google.com                _BitScanReverse(&index, mask);
82aea85dc3d332c963f5b85460036951ae3386683abrucedawson                // Suppress this bogus /analyze warning. The check for non-zero
83aea85dc3d332c963f5b85460036951ae3386683abrucedawson                // guarantees that _BitScanReverse will succeed.
84aea85dc3d332c963f5b85460036951ae3386683abrucedawson#pragma warning(suppress : 6102) // Using 'index' from failed function call
857729534da419436ea6127545e9f79b0b47ccffb4reed@google.com                return index ^ 0x1F;
867729534da419436ea6127545e9f79b0b47ccffb4reed@google.com            } else {
877729534da419436ea6127545e9f79b0b47ccffb4reed@google.com                return 32;
887729534da419436ea6127545e9f79b0b47ccffb4reed@google.com            }
897729534da419436ea6127545e9f79b0b47ccffb4reed@google.com        }
903a2682a77f996f649de7699c9f7bee046c6d4f17mtklein    #elif defined(SK_CPU_ARM32) || defined(__GNUC__) || defined(__clang__)
915c341d1ff1b58cc2b88c52f4ee41faf53a2a7578reed@google.com        static inline int SkCLZ(uint32_t mask) {
925c341d1ff1b58cc2b88c52f4ee41faf53a2a7578reed@google.com            // __builtin_clz(0) is undefined, so we have to detect that case.
935c341d1ff1b58cc2b88c52f4ee41faf53a2a7578reed@google.com            return mask ? __builtin_clz(mask) : 32;
945c341d1ff1b58cc2b88c52f4ee41faf53a2a7578reed@google.com        }
957729534da419436ea6127545e9f79b0b47ccffb4reed@google.com    #else
967729534da419436ea6127545e9f79b0b47ccffb4reed@google.com        #define SkCLZ(x)    SkCLZ_portable(x)
977729534da419436ea6127545e9f79b0b47ccffb4reed@google.com    #endif
984b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com#endif
99eebf5cb6c0f5ed2630de2e7712d61b4ec1d49015reed@android.com
1004b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com/**
1014b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  Returns (value < 0 ? 0 : value) efficiently (i.e. no compares or branches)
1024b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com */
1038a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.comstatic inline int SkClampPos(int value) {
1048a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    return value & ~(value >> 31);
1058a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com}
1068a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com
1078a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com/** Given an integer and a positive (max) integer, return the value
1084b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  pinned against 0 and max, inclusive.
1094b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  @param value    The value we want returned pinned between [0...max]
1104b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  @param max      The positive max value
1114b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  @return 0 if value < 0, max if value > max, else value
1124b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com */
1138a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.comstatic inline int SkClampMax(int value, int max) {
1148a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    // ensure that max is positive
1158a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    SkASSERT(max >= 0);
1168a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    if (value < 0) {
1178a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com        value = 0;
1188a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    }
1198a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    if (value > max) {
1208a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com        value = max;
1218a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    }
1228a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    return value;
1238a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com}
1248a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com
1254b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com/**
1264b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  Returns the smallest power-of-2 that is >= the specified value. If value
1274b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  is already a power of 2, then it is returned unchanged. It is undefined
1284b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  if value is <= 0.
1294b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com */
1308a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.comstatic inline int SkNextPow2(int value) {
1318a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    SkASSERT(value > 0);
1328a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    return 1 << (32 - SkCLZ(value - 1));
1338a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com}
1348a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com
1354b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com/**
1364b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  Returns the log2 of the specified value, were that value to be rounded up
1374b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  to the next power of 2. It is undefined to pass 0. Examples:
1384b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  SkNextLog2(1) -> 0
1394b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  SkNextLog2(2) -> 1
1404b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  SkNextLog2(3) -> 2
1414b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  SkNextLog2(4) -> 2
1424b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  SkNextLog2(5) -> 3
1434b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com */
1448a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.comstatic inline int SkNextLog2(uint32_t value) {
1458a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    SkASSERT(value != 0);
1468a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    return 32 - SkCLZ(value - 1);
1478a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com}
1488a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com
1494b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com/**
1504b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  Returns true if value is a power of 2. Does not explicitly check for
1514b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  value <= 0.
152f2b98d67dcb6fcb3120feede9c72016fc7b3ead8reed@android.com */
1532880df2609eba09b555ca37be04b6ad89290c765Tom Hudsontemplate <typename T> inline bool SkIsPow2(T value) {
154f2b98d67dcb6fcb3120feede9c72016fc7b3ead8reed@android.com    return (value & (value - 1)) == 0;
155f2b98d67dcb6fcb3120feede9c72016fc7b3ead8reed@android.com}
156f2b98d67dcb6fcb3120feede9c72016fc7b3ead8reed@android.com
1578a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com///////////////////////////////////////////////////////////////////////////////
1588a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com
1594b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com/**
1604b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  Return a*b/((1 << shift) - 1), rounding any fractional bits.
1614b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com *  Only valid if a and b are unsigned and <= 32767 and shift is > 0 and <= 8
1628a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com */
163ea774d2a5a049bf89474c0f047ed6a4e521de126reed@google.comstatic inline unsigned SkMul16ShiftRound(U16CPU a, U16CPU b, int shift) {
1648a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    SkASSERT(a <= 32767);
1658a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    SkASSERT(b <= 32767);
1668a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    SkASSERT(shift > 0 && shift <= 8);
1672880df2609eba09b555ca37be04b6ad89290c765Tom Hudson    unsigned prod = a*b + (1 << (shift - 1));
1688a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com    return (prod + (prod >> shift)) >> shift;
1698a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com}
1708a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com
1714b163ed2c22facbe8891616874ae07ba7827d9c9reed@google.com/**
172ea774d2a5a049bf89474c0f047ed6a4e521de126reed@google.com *  Return a*b/255, rounding any fractional bits.
173ea774d2a5a049bf89474c0f047ed6a4e521de126reed@google.com *  Only valid if a and b are unsigned and <= 32767.
174a0f5d1546d499ef0cd7dbfba9a866ae5a27e1541reed@android.com */
175ea774d2a5a049bf89474c0f047ed6a4e521de126reed@google.comstatic inline U8CPU SkMulDiv255Round(U16CPU a, U16CPU b) {
176ea774d2a5a049bf89474c0f047ed6a4e521de126reed@google.com    SkASSERT(a <= 32767);
177ea774d2a5a049bf89474c0f047ed6a4e521de126reed@google.com    SkASSERT(b <= 32767);
1782880df2609eba09b555ca37be04b6ad89290c765Tom Hudson    unsigned prod = a*b + 128;
179a0f5d1546d499ef0cd7dbfba9a866ae5a27e1541reed@android.com    return (prod + (prod >> 8)) >> 8;
180a0f5d1546d499ef0cd7dbfba9a866ae5a27e1541reed@android.com}
181a0f5d1546d499ef0cd7dbfba9a866ae5a27e1541reed@android.com
1822c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org/**
1832c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org * Stores numer/denom and numer%denom into div and mod respectively.
1842c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org */
1852c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.orgtemplate <typename In, typename Out>
1862c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.orginline void SkTDivMod(In numer, In denom, Out* div, Out* mod) {
1873a2682a77f996f649de7699c9f7bee046c6d4f17mtklein#ifdef SK_CPU_ARM32
1882c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org    // If we wrote this as in the else branch, GCC won't fuse the two into one
1892c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org    // divmod call, but rather a div call followed by a divmod.  Silly!  This
1902c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org    // version is just as fast as calling __aeabi_[u]idivmod manually, but with
1912c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org    // prettier code.
1922c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org    //
1932c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org    // This benches as around 2x faster than the code in the else branch.
1942c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org    const In d = numer/denom;
1952c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org    *div = static_cast<Out>(d);
1962c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org    *mod = static_cast<Out>(numer-d*denom);
1972c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org#else
1982c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org    // On x86 this will just be a single idiv.
1992c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org    *div = static_cast<Out>(numer/denom);
2002c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org    *mod = static_cast<Out>(numer%denom);
2013a2682a77f996f649de7699c9f7bee046c6d4f17mtklein#endif
2022c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org}
2032c86fbb0b14a1f674bf56ea5ad6a086cc004a76ecommit-bot@chromium.org
2048a1c16ff38322f0210116fa7293eb8817c7e477ereed@android.com#endif
205