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 "Optimal_affine_tracking_3d16_fast_realtime_rtwutil.h"
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026 real_T rt_hypotd_snf(real_T u0, real_T u1)
00027 {
00028 real_T y;
00029 real_T a;
00030 a = fabs(u0);
00031 y = fabs(u1);
00032 if (a < y) {
00033 a /= y;
00034 y *= sqrt(a * a + 1.0);
00035 } else if (a > y) {
00036 y /= a;
00037 y = a * sqrt(y * y + 1.0);
00038 } else if (rtIsNaN(y)) {
00039 } else {
00040 y = a * 1.4142135623730951;
00041 }
00042
00043 return y;
00044 }
00045
00046 real_T rt_roundd_snf(real_T u)
00047 {
00048 real_T y;
00049 if (fabs(u) < 4.503599627370496E+15) {
00050 if (u >= 0.5) {
00051 y = floor(u + 0.5);
00052 } else if (u > -0.5) {
00053 y = -0.0;
00054 } else {
00055 y = ceil(u - 0.5);
00056 }
00057 } else {
00058 y = u;
00059 }
00060
00061 return y;
00062 }
00063
00064