Go to the documentation of this file.00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011 #include "rt_nonfinite.h"
00012 #include "Optimal_affine_tracking_3d16_fast_realtime.h"
00013 #include "LoadKinectMesh_realtime.h"
00014 #include "rand.h"
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027 void LoadKinectMesh_realtime(real_T Ixyz[504063], real_T Irgb[504063])
00028 {
00029 static real_T mesh[1843200];
00030 static real_T y[307200];
00031 static real_T b_y[307200];
00032 static real_T c_y[307200];
00033 int32_T k;
00034 int32_T i3;
00035
00036
00037
00038
00039
00040
00041
00042
00043
00044
00045 b_rand(mesh);
00046 for (k = 0; k < 307200; k++) {
00047 y[k] = mesh[k];
00048 b_y[k] = mesh[307200 + k];
00049 c_y[k] = mesh[614400 + k];
00050 }
00051
00052 memset(&Ixyz[0], 0, 504063U * sizeof(real_T));
00053 for (k = 0; k < 441; k++) {
00054 for (i3 = 0; i3 < 381; i3++) {
00055 Ixyz[i3 + 381 * k] = y[(k + 640 * (49 + i3)) + 99];
00056 Ixyz[168021 + (i3 + 381 * k)] = b_y[(k + 640 * (49 + i3)) + 99];
00057 Ixyz[336042 + (i3 + 381 * k)] = c_y[(k + 640 * (49 + i3)) + 99];
00058 }
00059 }
00060
00061 for (k = 0; k < 307200; k++) {
00062 y[k] = mesh[921600 + k];
00063 b_y[k] = mesh[1228800 + k];
00064 c_y[k] = mesh[1536000 + k];
00065 }
00066
00067 memset(&Irgb[0], 0, 504063U * sizeof(real_T));
00068 for (k = 0; k < 441; k++) {
00069 for (i3 = 0; i3 < 381; i3++) {
00070 Irgb[i3 + 381 * k] = y[(k + 640 * (49 + i3)) + 99];
00071 Irgb[168021 + (i3 + 381 * k)] = b_y[(k + 640 * (49 + i3)) + 99];
00072 Irgb[336042 + (i3 + 381 * k)] = c_y[(k + 640 * (49 + i3)) + 99];
00073 }
00074 }
00075
00076
00077
00078
00079 }
00080
00081