SaturatedArithmetic.h 2.5 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667
  1. /*
  2. * Copyright (c) 2012, Google Inc. All rights reserved.
  3. *
  4. * Redistribution and use in source and binary forms, with or without
  5. * modification, are permitted provided that the following conditions are
  6. * met:
  7. *
  8. * * Redistributions of source code must retain the above copyright
  9. * notice, this list of conditions and the following disclaimer.
  10. * * Redistributions in binary form must reproduce the above
  11. * copyright notice, this list of conditions and the following disclaimer
  12. * in the documentation and/or other materials provided with the
  13. * distribution.
  14. * * Neither the name of Google Inc. nor the names of its
  15. * contributors may be used to endorse or promote products derived from
  16. * this software without specific prior written permission.
  17. *
  18. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  19. * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  20. * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  21. * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  22. * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  23. * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  24. * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  25. * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  26. * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  27. * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  28. * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  29. */
  30. #ifndef SaturatedArithmetic_h
  31. #define SaturatedArithmetic_h
  32. #include <limits>
  33. #include <stdint.h>
  34. #include <stdlib.h>
  35. inline int32_t saturatedAddition(int32_t a, int32_t b)
  36. {
  37. uint32_t ua = a;
  38. uint32_t ub = b;
  39. uint32_t result = ua + ub;
  40. // Can only overflow if the signed bit of the two values match. If the signed
  41. // bit of the result and one of the values differ it did overflow.
  42. if (!((ua ^ ub) >> 31) & (result ^ ua) >> 31)
  43. result = std::numeric_limits<int>::max() + (ua >> 31);
  44. return result;
  45. }
  46. inline int32_t saturatedSubtraction(int32_t a, int32_t b)
  47. {
  48. uint32_t ua = a;
  49. uint32_t ub = b;
  50. uint32_t result = ua - ub;
  51. // Can only overflow if the signed bit of the two values do not match. If the
  52. // signed bit of the result and the first value differ it did overflow.
  53. if ((ua ^ ub) >> 31 & (result ^ ua) >> 31)
  54. result = std::numeric_limits<int>::max() + (ua >> 31);
  55. return result;
  56. }
  57. #endif // SaturatedArithmetic_h