pointinganglecalc2.c

使用c语言及c++来实现matlab编程

/*
 * PointingAngleCalc2.c
 *
 * Embedded MATLAB Coder code generation for M-function 'PointingAngleCalc2'
 *
 * C source code generated on: Thu May 22 09:59:50 2008
 *
 */

/* Include files */
#include "PointingAngleCalc2.h"

/* Type Definitions */

/* Named Constants */

/* Variable Declarations */

/* Variable Definitions */

/* Function Declarations */

/* Function Definitions */
void PointingAngleCalc2(real_T eml_target[3], real_T eml_roll, real_T eml_pitch,
 real_T eml_heading, real_T *eml_theta, real_T *
 eml_alpha)
{
  int32_T eml_i0;
  static boolean_T eml_bv0[3] = { true, false, false };
  real_T eml_dv0[9];
  real_T eml_dv1[3];
  int32_T eml_i1;
  static boolean_T eml_bv1[3] = { false, true, false };
  static boolean_T eml_bv2[3] = { false, false, true };
  real_T eml_x;
  real_T eml_y;
  /*  This function calculates azimuth and elevation */
  /*  pointing angles for a platform displaced by angles */
  /*  roll, pitch, and heading */
  /*  Put target vector through X, Y, and Z axis rotations */
  /*  Rotate x vector alpha radians around the X-axis */
  for(eml_i0 = 0; eml_i0 < 3; eml_i0++) {
    eml_dv0[3 * eml_i0] = (real_T)eml_bv0[eml_i0];
  }
  eml_dv0[1] = 0.0;
  eml_dv0[4] = cos(eml_roll);
  eml_dv0[7] = -sin(eml_roll);
  eml_dv0[2] = 0.0;
  eml_dv0[5] = sin(eml_roll);
  eml_dv0[8] = cos(eml_roll);
  for(eml_i0 = 0; eml_i0 < 3; eml_i0++) {
    eml_dv1[eml_i0] = 0.0;
    for(eml_i1 = 0; eml_i1 < 3; eml_i1++) {
      eml_dv1[eml_i0] += eml_dv0[eml_i0 + 3 * eml_i1] * eml_target[eml_i1];
    }
  }
  /*  Rotate x vector alpha radians around the Y-axis */
  eml_dv0[0] = cos(eml_pitch);
  eml_dv0[3] = 0.0;
  eml_dv0[6] = -sin(eml_pitch);
  for(eml_i0 = 0; eml_i0 < 3; eml_i0++) {
    eml_target[eml_i0] = eml_dv1[eml_i0];
    eml_dv0[1 + 3 * eml_i0] = (real_T)eml_bv1[eml_i0];
  }
  eml_dv0[2] = sin(eml_pitch);
  eml_dv0[5] = 0.0;
  eml_dv0[8] = cos(eml_pitch);
  for(eml_i0 = 0; eml_i0 < 3; eml_i0++) {
    eml_dv1[eml_i0] = 0.0;
    for(eml_i1 = 0; eml_i1 < 3; eml_i1++) {
      eml_dv1[eml_i0] += eml_dv0[eml_i0 + 3 * eml_i1] * eml_target[eml_i1];
    }
  }
  /*  Rotate x vector alpha radians around the Z-axis */
  eml_dv0[0] = cos(eml_heading);
  eml_dv0[3] = -sin(eml_heading);
  eml_dv0[6] = 0.0;
  eml_dv0[1] = sin(eml_heading);
  eml_dv0[4] = cos(eml_heading);
  eml_dv0[7] = 0.0;
  for(eml_i0 = 0; eml_i0 < 3; eml_i0++) {
    eml_target[eml_i0] = eml_dv1[eml_i0];
    eml_dv0[2 + 3 * eml_i0] = (real_T)eml_bv2[eml_i0];
  }
  for(eml_i0 = 0; eml_i0 < 3; eml_i0++) {
    eml_dv1[eml_i0] = 0.0;
    for(eml_i1 = 0; eml_i1 < 3; eml_i1++) {
      eml_dv1[eml_i0] += eml_dv0[eml_i0 + 3 * eml_i1] * eml_target[eml_i1];
    }
  }
  for(eml_i0 = 0; eml_i0 < 3; eml_i0++) {
    eml_target[eml_i0] = eml_dv1[eml_i0];
  }
  /*  Calculate Azimuth and Elevation Pointing Angles */
  eml_x = eml_target[0];
  eml_y = eml_target[1];
  *eml_theta = rt_atan2(eml_y, eml_x) * 180.0 / 3.1415926535897931E+000;
  *eml_alpha = (-rt_atan2(eml_target[2], sqrt(pow(eml_x, 2.0) + pow(eml_y,
      2.0)))) * 180.0 / 3.1415926535897931E+000;
}

void PointingAngleCalc2_initialize(void)
{
  rt_InitInfAndNaN(8U);
}

void PointingAngleCalc2_terminate(void)
{
}

/* End of Embedded MATLAB Coder code generation (PointingAngleCalc2.c) */