sincos.c
上传用户:nvosite88
上传日期:2007-01-17
资源大小:4983k
文件大小:3k
源码类别:

VxWorks

开发平台:

C/C++

  1. /* sincos.c - math routines */
  2. /* Copyright 1992-1993 Wind River Systems, Inc. */
  3. /*
  4. modification history
  5. --------------------
  6. 01f,05feb93,jdi  doc changes based on kdl review.
  7. 01e,02dec92,jdi  doc tweaks.
  8. 01d,28oct92,jdi  documentation cleanup.
  9. 01c,21sep92,smb  changed function headers for mg.
  10. 01b,20sep92,smb  documentation additions
  11. 01a,08jul92,smb  documentation.
  12. */
  13. /*
  14. DESCRIPTION
  15. * Copyright (c) 1987 Regents of the University of California.
  16. * All rights reserved.
  17. *
  18. * Redistribution and use in source and binary forms are permitted
  19. * provided that the above copyright notice and this paragraph are
  20. * duplicated in all such forms and that any documentation,
  21. * advertising materials, and other materials related to such
  22. * distribution and use acknowledge that the software was developed
  23. * by the University of California, Berkeley.  The name of the
  24. * University may not be used to endorse or promote products derived
  25. * from this software without specific prior written permission.
  26. * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
  27. * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
  28. * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  29. *
  30. * All recipients should regard themselves as participants in an ongoing
  31. * research project and hence should feel obligated to report their
  32. * experiences (good or bad) with these elementary function codes, using
  33. * the sendbug(8) program, to the authors.
  34. *
  35. SEE ALSO: American National Standard X3.159-1989
  36. NOMANUAL
  37. */
  38. #include "vxWorks.h"
  39. #include "math.h"
  40. #include "private/trigP.h"
  41. /*******************************************************************************
  42. *
  43. * sin - compute a sine (ANSI)
  44. *
  45. * This routine computes the sine of <x> in double precision.
  46. * The angle <x> is expressed in radians.
  47. *
  48. * INCLUDE FILES: math.h
  49. *
  50. * RETURNS: The double-precision sine of <x>.
  51. *
  52. * SEE ALSO: mathALib
  53. */
  54. double sin
  55.     (
  56.     double x /* angle in radians */
  57.     )
  58.     {
  59. double a,c,z;
  60.         if(!finite(x)) /* sin(NaN) and sin(INF) must be NaN */
  61. return x-x;
  62. x=drem(x,PI2); /* reduce x into [-PI,PI] */
  63. a=copysign(x,one);
  64. if (a >= PIo4) {
  65. if(a >= PI3o4) /* ... in [3PI/4,PI] */
  66. x = copysign((a = PI-a),x);
  67. else { /* ... in [PI/4,3PI/4]  */
  68. a = PIo2-a; /* rtn. sign(x)*C(PI/2-|x|) */
  69. z = a*a;
  70. c = cos__C(z);
  71. z *= half;
  72. a = (z >= thresh ? half-((z-half)-c) : one-(z-c));
  73. return copysign(a,x);
  74. }
  75. }
  76. if (a < small) { /* rtn. S(x) */
  77. big+a;
  78. return x;
  79. }
  80. return x+x*sin__S(x*x);
  81.     }
  82. /*******************************************************************************
  83. *
  84. * cos - compute a cosine (ANSI)
  85. *
  86. * This routine computes the cosine of <x> in double precision.
  87. * The angle <x> is expressed in radians.
  88. *
  89. * INCLUDE FILES: math.h
  90. *
  91. * RETURNS: The double-precision cosine of <x>.
  92. *
  93. * SEE ALSO: mathALib
  94. */
  95. double cos
  96.     (
  97.     double x /* angle in radians */
  98.     )
  99.     {
  100. double a,c,z,s = 1.0;
  101. if(!finite(x)) /* cos(NaN) and cos(INF) must be NaN */
  102. return x-x;
  103. x=drem(x,PI2); /* reduce x into [-PI,PI] */
  104. a=copysign(x,one);
  105. if (a >= PIo4) {
  106. if (a >= PI3o4) { /* ... in [3PI/4,PI] */
  107. a = PI-a;
  108. s = negone;
  109. }
  110. else { /* ... in [PI/4,3PI/4] */
  111. a = PIo2-a;
  112. return a+a*sin__S(a*a); /* rtn. S(PI/2-|x|) */
  113. }
  114. }
  115. if (a < small) {
  116. big+a;
  117. return s; /* rtn. s*C(a) */
  118. }
  119. z = a*a;
  120. c = cos__C(z);
  121. z *= half;
  122. a = (z >= thresh ? half-((z-half)-c) : one-(z-c));
  123. return copysign(a,s);
  124.     }