point.c

Go to the documentation of this file.

 
/***********************************************************************/
 
/***********************************************************************/
#include "libtpcimgp.h"
/***********************************************************************/
 
/***********************************************************************/
int pRound(
  float number
) {
  if(number - floor(number) < 0.5){
    return floor(number);
  }
  return ceil(number);
}
/***********************************************************************/
 
/***********************************************************************/
float getDistance(
  point begin, 
  point end
) {
  float dx, dy, dz;
 
  dx = begin.x - end.x; // Difference in x coordinates.
  dy = begin.y - end.y; // Difference in y coordinates.
  dz = begin.z - end.z; // Difference in z coordinates.
  return sqrt(dx*dx + dy*dy + dz*dz);
}
/***********************************************************************/
 
/***********************************************************************/
float getAngle(
  point begin, 
  point center
) {
  float dx, dy;
  dx = begin.x - center.x;  // Difference in x coordinates.
  dy = begin.y - center.y;  // Difference in y coordinates.
 
  // Check trivial cases.
  if(dx == 0.0){
    if(dy == 0.0) return -360.0;
    if(dy > 0.0) return 90.0;
    else return 270.0;
  }
  if(dy==0.0){
    if(dx > 0.0) return 0.0;
    else return 180.0;
  }
 
  // If it was not a trivial case, then calculate angle in...
  // ...the second and the third quarter.
  if(dx<0.0) return 180.0 + atan(dy/dx)*180.0/M_PI;
 
  // ...the first quarter.
  if(dy>0.0) return atan(dy/dx)*180.0/M_PI;
 
  // ...the fourth quarter.
  return 360.0 + atan(dy/dx)*180.0/M_PI;
}
/***********************************************************************/
 
/***********************************************************************/