vec3d.c
上传用户:xk288cn
上传日期:2007-05-28
资源大小:4876k
文件大小:2k
源码类别:

GIS编程

开发平台:

Visual C++

  1. /* Copyright (c) Mark J. Kilgard, 1997. */
  2. /* This program is freely distributable without licensing fees 
  3.    and is provided without guarantee or warrantee expressed or 
  4.    implied. This program is -not- in the public domain. */
  5. /* Simple 3D vector routines.  This file is meant to be included in
  6.    a .c file, hence all the routines are defined statically.  A
  7.    good C compiler should be able to automatically inline all
  8.    these routines. */
  9. #include <math.h>
  10. static void
  11. vnorm(float vec[3])
  12. {
  13.   float len;
  14.   len = (float)sqrt(vec[0] * vec[0] + vec[1] * vec[1] + vec[2] * vec[2]);
  15.   vec[0] = vec[0] / len;
  16.   vec[1] = vec[1] / len;
  17.   vec[2] = vec[2] / len;
  18. }
  19. static float
  20. vdot(float a[3], float b[3])
  21. {
  22.   return a[0] * b[0] + a[1] * b[1] + a[2] * b[2];
  23. }
  24. static void
  25. vdiff(float dst[3], float a[3], float b[3])
  26. {
  27.   dst[0] = a[0] - b[0];
  28.   dst[1] = a[1] - b[1];
  29.   dst[2] = a[2] - b[2];
  30. }
  31. static void
  32. vadd(float dst[3], float a[3], float b[3])
  33. {
  34.   dst[0] = a[0] + b[0];
  35.   dst[1] = a[1] + b[1];
  36.   dst[2] = a[2] + b[2];
  37. }
  38. static void
  39. vcopy(float dst[3], float src[3])
  40. {
  41.   dst[0] = src[0];
  42.   dst[1] = src[1];
  43.   dst[2] = src[2];
  44. }
  45. static void
  46. vscale(float dst[3], float src[3], float scale)
  47. {
  48.   dst[0] = src[0] * scale;
  49.   dst[1] = src[1] * scale;
  50.   dst[2] = src[2] * scale;
  51. }
  52. static void
  53. vcross(float cross[3], const float v1[3], const float v2[3])
  54. {
  55.   float tmp[3];
  56.   tmp[0] = (v1[1] * v2[2]) - (v1[2] * v2[1]);
  57.   tmp[1] = (v1[2] * v2[0]) - (v1[0] * v2[2]);
  58.   tmp[2] = (v1[0] * v2[1]) - (v1[1] * v2[0]);
  59.   vcopy(cross, tmp);
  60. }