4 changed files with 0 additions and 233 deletions
@ -1,78 +0,0 @@
@@ -1,78 +0,0 @@
|
||||
/*
|
||||
* diag.c |
||||
* |
||||
* Code generation for function 'diag' |
||||
* |
||||
* C source code generated on: Tue Oct 16 15:27:58 2012 |
||||
* |
||||
*/ |
||||
|
||||
/* Include files */ |
||||
#include "rt_nonfinite.h" |
||||
#include "attitudeKalmanfilter.h" |
||||
#include "diag.h" |
||||
|
||||
/* Type Definitions */ |
||||
|
||||
/* Named Constants */ |
||||
|
||||
/* Variable Declarations */ |
||||
|
||||
/* Variable Definitions */ |
||||
|
||||
/* Function Declarations */ |
||||
|
||||
/* Function Definitions */ |
||||
|
||||
/*
|
||||
* |
||||
*/ |
||||
void b_diag(const real32_T v[9], real32_T d[81]) |
||||
{ |
||||
int32_T j; |
||||
memset(&d[0], 0, 81U * sizeof(real32_T)); |
||||
for (j = 0; j < 9; j++) { |
||||
d[j + 9 * j] = v[j]; |
||||
} |
||||
} |
||||
|
||||
/*
|
||||
* |
||||
*/ |
||||
void c_diag(const real32_T v[3], real32_T d[9]) |
||||
{ |
||||
int32_T j; |
||||
for (j = 0; j < 9; j++) { |
||||
d[j] = 0.0F; |
||||
} |
||||
|
||||
for (j = 0; j < 3; j++) { |
||||
d[j + 3 * j] = v[j]; |
||||
} |
||||
} |
||||
|
||||
/*
|
||||
* |
||||
*/ |
||||
void d_diag(const real32_T v[6], real32_T d[36]) |
||||
{ |
||||
int32_T j; |
||||
memset(&d[0], 0, 36U * sizeof(real32_T)); |
||||
for (j = 0; j < 6; j++) { |
||||
d[j + 6 * j] = v[j]; |
||||
} |
||||
} |
||||
|
||||
/*
|
||||
* |
||||
*/ |
||||
void diag(const real32_T v[12], real32_T d[144]) |
||||
{ |
||||
int32_T j; |
||||
memset(&d[0], 0, 144U * sizeof(real32_T)); |
||||
for (j = 0; j < 12; j++) { |
||||
d[j + 12 * j] = v[j]; |
||||
} |
||||
} |
||||
|
||||
/* End of code generation (diag.c) */ |
@ -1,37 +0,0 @@
@@ -1,37 +0,0 @@
|
||||
/*
|
||||
* diag.h |
||||
* |
||||
* Code generation for function 'diag' |
||||
* |
||||
* C source code generated on: Tue Oct 16 15:27:58 2012 |
||||
* |
||||
*/ |
||||
|
||||
#ifndef __DIAG_H__ |
||||
#define __DIAG_H__ |
||||
/* Include files */ |
||||
#include <math.h> |
||||
#include <stddef.h> |
||||
#include <stdlib.h> |
||||
#include <string.h> |
||||
#include "rt_defines.h" |
||||
#include "rt_nonfinite.h" |
||||
|
||||
#include "rtwtypes.h" |
||||
#include "attitudeKalmanfilter_types.h" |
||||
|
||||
/* Type Definitions */ |
||||
|
||||
/* Named Constants */ |
||||
|
||||
/* Variable Declarations */ |
||||
|
||||
/* Variable Definitions */ |
||||
|
||||
/* Function Declarations */ |
||||
extern void b_diag(const real32_T v[9], real32_T d[81]); |
||||
extern void c_diag(const real32_T v[3], real32_T d[9]); |
||||
extern void d_diag(const real32_T v[6], real32_T d[36]); |
||||
extern void diag(const real32_T v[12], real32_T d[144]); |
||||
#endif |
||||
/* End of code generation (diag.h) */ |
@ -1,84 +0,0 @@
@@ -1,84 +0,0 @@
|
||||
/*
|
||||
* power.c |
||||
* |
||||
* Code generation for function 'power' |
||||
* |
||||
* C source code generated on: Tue Oct 16 15:27:58 2012 |
||||
* |
||||
*/ |
||||
|
||||
/* Include files */ |
||||
#include "rt_nonfinite.h" |
||||
#include "attitudeKalmanfilter.h" |
||||
#include "power.h" |
||||
|
||||
/* Type Definitions */ |
||||
|
||||
/* Named Constants */ |
||||
|
||||
/* Variable Declarations */ |
||||
|
||||
/* Variable Definitions */ |
||||
|
||||
/* Function Declarations */ |
||||
static real32_T rt_powf_snf(real32_T u0, real32_T u1); |
||||
|
||||
/* Function Definitions */ |
||||
static real32_T rt_powf_snf(real32_T u0, real32_T u1) |
||||
{ |
||||
real32_T y; |
||||
real32_T f1; |
||||
real32_T f2; |
||||
if (rtIsNaNF(u0) || rtIsNaNF(u1)) { |
||||
y = ((real32_T)rtNaN); |
||||
} else { |
||||
f1 = (real32_T)fabs(u0); |
||||
f2 = (real32_T)fabs(u1); |
||||
if (rtIsInfF(u1)) { |
||||
if (f1 == 1.0F) { |
||||
y = ((real32_T)rtNaN); |
||||
} else if (f1 > 1.0F) { |
||||
if (u1 > 0.0F) { |
||||
y = ((real32_T)rtInf); |
||||
} else { |
||||
y = 0.0F; |
||||
} |
||||
} else if (u1 > 0.0F) { |
||||
y = 0.0F; |
||||
} else { |
||||
y = ((real32_T)rtInf); |
||||
} |
||||
} else if (f2 == 0.0F) { |
||||
y = 1.0F; |
||||
} else if (f2 == 1.0F) { |
||||
if (u1 > 0.0F) { |
||||
y = u0; |
||||
} else { |
||||
y = 1.0F / u0; |
||||
} |
||||
} else if (u1 == 2.0F) { |
||||
y = u0 * u0; |
||||
} else if ((u1 == 0.5F) && (u0 >= 0.0F)) { |
||||
y = (real32_T)sqrt(u0); |
||||
} else if ((u0 < 0.0F) && (u1 > (real32_T)floor(u1))) { |
||||
y = ((real32_T)rtNaN); |
||||
} else { |
||||
y = (real32_T)pow(u0, u1); |
||||
} |
||||
} |
||||
|
||||
return y; |
||||
} |
||||
|
||||
/*
|
||||
* |
||||
*/ |
||||
void power(const real32_T a[12], real32_T y[12]) |
||||
{ |
||||
int32_T k; |
||||
for (k = 0; k < 12; k++) { |
||||
y[k] = rt_powf_snf(a[k], 2.0F); |
||||
} |
||||
} |
||||
|
||||
/* End of code generation (power.c) */ |
@ -1,34 +0,0 @@
@@ -1,34 +0,0 @@
|
||||
/*
|
||||
* power.h |
||||
* |
||||
* Code generation for function 'power' |
||||
* |
||||
* C source code generated on: Tue Oct 16 15:27:58 2012 |
||||
* |
||||
*/ |
||||
|
||||
#ifndef __POWER_H__ |
||||
#define __POWER_H__ |
||||
/* Include files */ |
||||
#include <math.h> |
||||
#include <stddef.h> |
||||
#include <stdlib.h> |
||||
#include <string.h> |
||||
#include "rt_defines.h" |
||||
#include "rt_nonfinite.h" |
||||
|
||||
#include "rtwtypes.h" |
||||
#include "attitudeKalmanfilter_types.h" |
||||
|
||||
/* Type Definitions */ |
||||
|
||||
/* Named Constants */ |
||||
|
||||
/* Variable Declarations */ |
||||
|
||||
/* Variable Definitions */ |
||||
|
||||
/* Function Declarations */ |
||||
extern void power(const real32_T a[12], real32_T y[12]); |
||||
#endif |
||||
/* End of code generation (power.h) */ |
Loading…
Reference in new issue