depth_tracker_ros_vr8: std.cpp Source File

Go to the documentation of this file.
00001 /*
00002  * std.cpp
00003  *
00004  * Code generation for function 'std'
00005  *
00006  * C source code generated on: Wed Jul 24 16:11:35 2013
00007  *
00008  */
00009 
00010 /* Include files */
00011 #include "rt_nonfinite.h"
00012 #include "Optimal_affine_tracking_3d16_fast_realtime.h"
00013 #include "std.h"
00014 
00015 /* Type Definitions */
00016 
00017 /* Named Constants */
00018 
00019 /* Variable Declarations */
00020 
00021 /* Variable Definitions */
00022 
00023 /* Function Declarations */
00024 
00025 /* Function Definitions */
00026 void b_std(const real_T varargin_1[3888], real_T y[3])
00027 {
00028   int32_T ix;
00029   int32_T iy;
00030   int32_T i;
00031   int32_T b_ix;
00032   real_T xbar;
00033   int32_T k;
00034   real_T r;
00035   real_T b_y;
00036   ix = -1295;
00037   iy = -1;
00038   for (i = 0; i < 3; i++) {
00039     ix += 1296;
00040     iy++;
00041     b_ix = ix;
00042     xbar = varargin_1[ix - 1];
00043     for (k = 0; k < 1295; k++) {
00044       b_ix++;
00045       xbar += varargin_1[b_ix - 1];
00046     }
00047 
00048     xbar /= 1296.0;
00049     b_ix = ix;
00050     r = varargin_1[ix - 1] - xbar;
00051     b_y = r * r;
00052     for (k = 0; k < 1295; k++) {
00053       b_ix++;
00054       r = varargin_1[b_ix - 1] - xbar;
00055       b_y += r * r;
00056     }
00057 
00058     b_y /= 1295.0;
00059     y[iy] = b_y;
00060   }
00061 
00062   for (k = 0; k < 3; k++) {
00063     y[k] = sqrt(y[k]);
00064   }
00065 }
00066 
00067 /* End of code generation (std.cpp) */