aboutsummaryrefslogtreecommitdiff
path: root/apps/attitude_estimator_ekf/codegen/find.c
blob: 8f05ef146e84f8edd7904081d2f93ed8d5ae562c (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
/*
 * find.c
 *
 * Code generation for function 'find'
 *
 * C source code generated on: Fri Sep 21 13:56:43 2012
 *
 */

/* Include files */
#include "rt_nonfinite.h"
#include "attitudeKalmanfilter.h"
#include "find.h"

/* Type Definitions */

/* Named Constants */

/* Variable Declarations */

/* Variable Definitions */

/* Function Declarations */

/* Function Definitions */

/*
 *
 */
void find(const int8_T x[9], real_T i_data[9], int32_T i_sizes[1])
{
  int32_T idx;
  int32_T ii;
  boolean_T exitg1;
  boolean_T guard1 = FALSE;
  int32_T i2;
  int8_T b_i_data[9];
  idx = 0;
  i_sizes[0] = 9;
  ii = 1;
  exitg1 = 0U;
  while ((exitg1 == 0U) && (ii <= 9)) {
    guard1 = FALSE;
    if (x[ii - 1] != 0) {
      idx++;
      i_data[idx - 1] = (real_T)ii;
      if (idx >= 9) {
        exitg1 = 1U;
      } else {
        guard1 = TRUE;
      }
    } else {
      guard1 = TRUE;
    }

    if (guard1 == TRUE) {
      ii++;
    }
  }

  if (1 > idx) {
    idx = 0;
  }

  ii = idx - 1;
  for (i2 = 0; i2 <= ii; i2++) {
    b_i_data[i2] = (int8_T)i_data[i2];
  }

  i_sizes[0] = idx;
  ii = idx - 1;
  for (i2 = 0; i2 <= ii; i2++) {
    i_data[i2] = (real_T)b_i_data[i2];
  }
}

/* End of code generation (find.c) */