/lib/msun/src/s_csqrt.c

https://bitbucket.org/iorivur/freebsd-bhyve-with-suspend-resume · C · 112 lines · 53 code · 12 blank · 47 comment · 13 complexity · c4f94d7a0deeac6d356f753773fd9675 MD5 · raw file

  1. /*-
  2. * Copyright (c) 2007 David Schultz <das@FreeBSD.ORG>
  3. * All rights reserved.
  4. *
  5. * Redistribution and use in source and binary forms, with or without
  6. * modification, are permitted provided that the following conditions
  7. * are met:
  8. * 1. Redistributions of source code must retain the above copyright
  9. * notice, this list of conditions and the following disclaimer.
  10. * 2. Redistributions in binary form must reproduce the above copyright
  11. * notice, this list of conditions and the following disclaimer in the
  12. * documentation and/or other materials provided with the distribution.
  13. *
  14. * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15. * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17. * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18. * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19. * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20. * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22. * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23. * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24. * SUCH DAMAGE.
  25. */
  26. #include <sys/cdefs.h>
  27. __FBSDID("$FreeBSD: head/lib/msun/src/s_csqrt.c 181402 2008-08-08 00:15:16Z das $");
  28. #include <complex.h>
  29. #include <float.h>
  30. #include <math.h>
  31. #include "math_private.h"
  32. /*
  33. * gcc doesn't implement complex multiplication or division correctly,
  34. * so we need to handle infinities specially. We turn on this pragma to
  35. * notify conforming c99 compilers that the fast-but-incorrect code that
  36. * gcc generates is acceptable, since the special cases have already been
  37. * handled.
  38. */
  39. #pragma STDC CX_LIMITED_RANGE ON
  40. /* We risk spurious overflow for components >= DBL_MAX / (1 + sqrt(2)). */
  41. #define THRESH 0x1.a827999fcef32p+1022
  42. double complex
  43. csqrt(double complex z)
  44. {
  45. double complex result;
  46. double a, b;
  47. double t;
  48. int scale;
  49. a = creal(z);
  50. b = cimag(z);
  51. /* Handle special cases. */
  52. if (z == 0)
  53. return (cpack(0, b));
  54. if (isinf(b))
  55. return (cpack(INFINITY, b));
  56. if (isnan(a)) {
  57. t = (b - b) / (b - b); /* raise invalid if b is not a NaN */
  58. return (cpack(a, t)); /* return NaN + NaN i */
  59. }
  60. if (isinf(a)) {
  61. /*
  62. * csqrt(inf + NaN i) = inf + NaN i
  63. * csqrt(inf + y i) = inf + 0 i
  64. * csqrt(-inf + NaN i) = NaN +- inf i
  65. * csqrt(-inf + y i) = 0 + inf i
  66. */
  67. if (signbit(a))
  68. return (cpack(fabs(b - b), copysign(a, b)));
  69. else
  70. return (cpack(a, copysign(b - b, b)));
  71. }
  72. /*
  73. * The remaining special case (b is NaN) is handled just fine by
  74. * the normal code path below.
  75. */
  76. /* Scale to avoid overflow. */
  77. if (fabs(a) >= THRESH || fabs(b) >= THRESH) {
  78. a *= 0.25;
  79. b *= 0.25;
  80. scale = 1;
  81. } else {
  82. scale = 0;
  83. }
  84. /* Algorithm 312, CACM vol 10, Oct 1967. */
  85. if (a >= 0) {
  86. t = sqrt((a + hypot(a, b)) * 0.5);
  87. result = cpack(t, b / (2 * t));
  88. } else {
  89. t = sqrt((-a + hypot(a, b)) * 0.5);
  90. result = cpack(fabs(b) / (2 * t), copysign(t, b));
  91. }
  92. /* Rescale. */
  93. if (scale)
  94. return (result * 2);
  95. else
  96. return (result);
  97. }
  98. #if LDBL_MANT_DIG == 53
  99. __weak_reference(csqrt, csqrtl);
  100. #endif