git.sesse.net Git - movit/blob - util.cpp

   1 #include <GL/glew.h>
   2 #include <assert.h>
   3 #include <math.h>
   4 #include <stdio.h>
   5 #include <stdlib.h>
   6 #include <string.h>
   7 #include <Eigen/Core>
   8
   9 #include "init.h"
  10 #include "util.h"
  11
  12 using namespace std;
  13
  14 extern string *movit_data_directory;
  15
  16 void hsv2rgb(float h, float s, float v, float *r, float *g, float *b)
  17 {
  18         if (h < 0.0f) {
  19                 h += 2.0f * M_PI;
  20         }
  21         float c = v * s;
  22         float hp = (h * 180.0 / M_PI) / 60.0;
  23         float x = c * (1 - fabs(fmod(hp, 2.0f) - 1.0f));
  24
  25         if (hp >= 0 && hp < 1) {
  26                 *r = c;
  27                 *g = x;
  28                 *b = 0.0f;
  29         } else if (hp >= 1 && hp < 2) {
  30                 *r = x;
  31                 *g = c;
  32                 *b = 0.0f;
  33         } else if (hp >= 2 && hp < 3) {
  34                 *r = 0.0f;
  35                 *g = c;
  36                 *b = x;
  37         } else if (hp >= 3 && hp < 4) {
  38                 *r = 0.0f;
  39                 *g = x;
  40                 *b = c;
  41         } else if (hp >= 4 && hp < 5) {
  42                 *r = x;
  43                 *g = 0.0f;
  44                 *b = c;
  45         } else {
  46                 *r = c;
  47                 *g = 0.0f;
  48                 *b = x;
  49         }
  50
  51         float m = v - c;
  52         *r += m;
  53         *g += m;
  54         *b += m;
  55 }
  56
  57 void hsv2rgb_normalized(float h, float s, float v, float *r, float *g, float *b)
  58 {
  59         float ref_r, ref_g, ref_b;
  60         hsv2rgb(h, s, v, r, g, b);
  61         hsv2rgb(h, 0.0f, v, &ref_r, &ref_g, &ref_b);
  62         float lum = 0.2126 * *r + 0.7152 * *g + 0.0722 * *b;
  63         float ref_lum = 0.2126 * ref_r + 0.7152 * ref_g + 0.0722 * ref_b;
  64         if (lum > 1e-3) {
  65                 float fac = ref_lum / lum;
  66                 *r *= fac;
  67                 *g *= fac;
  68                 *b *= fac;
  69         }
  70 }
  71
  72 string read_file(const string &filename)
  73 {
  74         const string full_pathname = *movit_data_directory + "/" + filename;
  75
  76         static char buf[131072];
  77         FILE *fp = fopen(full_pathname.c_str(), "r");
  78         if (fp == NULL) {
  79                 perror(full_pathname.c_str());
  80                 exit(1);
  81         }
  82
  83         int len = fread(buf, 1, sizeof(buf), fp);
  84         fclose(fp);
  85
  86         return string(buf, len);
  87 }
  88
  89 GLuint compile_shader(const string &shader_src, GLenum type)
  90 {
  91         GLuint obj = glCreateShader(type);
  92         const GLchar* source[] = { shader_src.data() };
  93         const GLint length[] = { (GLint)shader_src.size() };
  94         glShaderSource(obj, 1, source, length);
  95         glCompileShader(obj);
  96
  97         GLchar info_log[4096];
  98         GLsizei log_length = sizeof(info_log) - 1;
  99         glGetShaderInfoLog(obj, log_length, &log_length, info_log);
 100         info_log[log_length] = 0;
 101         if (strlen(info_log) > 0) {
 102                 printf("shader compile log: %s\n", info_log);
 103         }
 104
 105         GLint status;
 106         glGetShaderiv(obj, GL_COMPILE_STATUS, &status);
 107         if (status == GL_FALSE) {
 108                 exit(1);
 109         }
 110
 111         return obj;
 112 }
 113
 114 void print_3x3_matrix(const Eigen::Matrix3d& m)
 115 {
 116         printf("%6.4f %6.4f %6.4f\n", m(0,0), m(0,1), m(0,2));
 117         printf("%6.4f %6.4f %6.4f\n", m(1,0), m(1,1), m(1,2));
 118         printf("%6.4f %6.4f %6.4f\n", m(2,0), m(2,1), m(2,2));
 119         printf("\n");
 120 }
 121
 122 string output_glsl_mat3(const string &name, const Eigen::Matrix3d &m)
 123 {
 124         char buf[1024];
 125         sprintf(buf,
 126                 "const mat3 %s = mat3(\n"
 127                 "    %.8f, %.8f, %.8f,\n"
 128                 "    %.8f, %.8f, %.8f,\n"
 129                 "    %.8f, %.8f, %.8f);\n\n",
 130                 name.c_str(),
 131                 m(0,0), m(1,0), m(2,0),
 132                 m(0,1), m(1,1), m(2,1),
 133                 m(0,2), m(1,2), m(2,2));
 134         return buf;
 135 }
 136
 137 void combine_two_samples(float w1, float w2, float *offset, float *total_weight, float *sum_sq_error)
 138 {
 139         assert(movit_initialized);
 140         assert(w1 * w2 >= 0.0f);  // Should not have differing signs.
 141         float z;  // Just a shorter name for offset.
 142         if (fabs(w1 + w2) < 1e-6) {
 143                 z = 0.5f;
 144         } else {
 145                 z = w2 / (w1 + w2);
 146         }
 147
 148         // Round to the minimum number of bits we have measured earlier.
 149         // The card will do this for us anyway, but if we know what the real z
 150         // is, we can pick a better total_weight below.
 151         z = lrintf(z / movit_texel_subpixel_precision) * movit_texel_subpixel_precision;
 152
 153         // Choose total weight w so that we minimize total squared error
 154         // for the effective weights:
 155         //
 156         //   e = (w(1-z) - a)² + (wz - b)²
 157         //
 158         // Differentiating by w and setting equal to zero:
 159         //
 160         //   2(w(1-z) - a)(1-z) + 2(wz - b)z = 0
 161         //   w(1-z)² - a(1-z) + wz² - bz = 0
 162         //   w((1-z)² + z²) = a(1-z) + bz
 163         //   w = (a(1-z) + bz) / ((1-z)² + z²)
 164         //
 165         // If z had infinite precision, this would simply reduce to w = w1 + w2.
 166         *total_weight = (w1 * (1 - z) + w2 * z) / (z * z + (1 - z) * (1 - z));
 167         *offset = z;
 168
 169         if (sum_sq_error != NULL) {
 170                 float err1 = *total_weight * (1 - z) - w1;
 171                 float err2 = *total_weight * z - w2;
 172                 *sum_sq_error = err1 * err1 + err2 * err2;
 173         }
 174
 175         assert(*offset >= 0.0f);
 176         assert(*offset <= 1.0f);
 177 }