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

   1 #include <stdio.h>
   2 #include <string.h>
   3 #include <assert.h>
   4
   5 #include <math.h>
   6 #include "util.h"
   7 #include "opengl.h"
   8
   9 void hsv2rgb(float h, float s, float v, float *r, float *g, float *b)
  10 {
  11         if (h < 0.0f) {
  12                 h += 2.0f * M_PI;
  13         }
  14         float c = v * s;
  15         float hp = (h * 180.0 / M_PI) / 60.0;
  16         float x = c * (1 - fabs(fmod(hp, 2.0f) - 1.0f));
  17
  18         if (hp >= 0 && hp < 1) {
  19                 *r = c;
  20                 *g = x;
  21                 *b = 0.0f;
  22         } else if (hp >= 1 && hp < 2) {
  23                 *r = x;
  24                 *g = c;
  25                 *b = 0.0f;
  26         } else if (hp >= 2 && hp < 3) {
  27                 *r = 0.0f;
  28                 *g = c;
  29                 *b = x;
  30         } else if (hp >= 3 && hp < 4) {
  31                 *r = 0.0f;
  32                 *g = x;
  33                 *b = c;
  34         } else if (hp >= 4 && hp < 5) {
  35                 *r = x;
  36                 *g = 0.0f;
  37                 *b = c;
  38         } else {
  39                 *r = c;
  40                 *g = 0.0f;
  41                 *b = x;
  42         }
  43
  44         float m = v - c;
  45         *r += m;
  46         *g += m;
  47         *b += m;
  48 }
  49
  50 void hsv2rgb_normalized(float h, float s, float v, float *r, float *g, float *b)
  51 {
  52         float ref_r, ref_g, ref_b;
  53         hsv2rgb(h, s, v, r, g, b);
  54         hsv2rgb(h, 0.0f, v, &ref_r, &ref_g, &ref_b);
  55         float lum = 0.2126 * *r + 0.7152 * *g + 0.0722 * *b;
  56         float ref_lum = 0.2126 * ref_r + 0.7152 * ref_g + 0.0722 * ref_b;
  57         if (lum > 1e-3) {
  58                 float fac = ref_lum / lum;
  59                 *r *= fac;
  60                 *g *= fac;
  61                 *b *= fac;
  62         }
  63 }
  64
  65 std::string read_file(const std::string &filename)
  66 {
  67         static char buf[131072];
  68         FILE *fp = fopen(filename.c_str(), "r");
  69         if (fp == NULL) {
  70                 perror(filename.c_str());
  71                 exit(1);
  72         }
  73
  74         int len = fread(buf, 1, sizeof(buf), fp);
  75         fclose(fp);
  76
  77         return std::string(buf, len);
  78 }
  79
  80 GLuint compile_shader(const std::string &shader_src, GLenum type)
  81 {
  82         GLuint obj = glCreateShader(type);
  83         const GLchar* source[] = { shader_src.data() };
  84         const GLint length[] = { (GLint)shader_src.size() };
  85         glShaderSource(obj, 1, source, length);
  86         glCompileShader(obj);
  87
  88         GLchar info_log[4096];
  89         GLsizei log_length = sizeof(info_log) - 1;
  90         glGetShaderInfoLog(obj, log_length, &log_length, info_log);
  91         info_log[log_length] = 0;
  92         if (strlen(info_log) > 0) {
  93                 printf("shader compile log: %s\n", info_log);
  94         }
  95
  96         GLint status;
  97         glGetShaderiv(obj, GL_COMPILE_STATUS, &status);
  98         if (status == GL_FALSE) {
  99                 exit(1);
 100         }
 101
 102         return obj;
 103 }
 104
 105 void multiply_3x3_matrices(const Matrix3x3 a, const Matrix3x3 b, Matrix3x3 result)
 106 {
 107         result[0] = a[0] * b[0] + a[3] * b[1] + a[6] * b[2];
 108         result[1] = a[1] * b[0] + a[4] * b[1] + a[7] * b[2];
 109         result[2] = a[2] * b[0] + a[5] * b[1] + a[8] * b[2];
 110
 111         result[3] = a[0] * b[3] + a[3] * b[4] + a[6] * b[5];
 112         result[4] = a[1] * b[3] + a[4] * b[4] + a[7] * b[5];
 113         result[5] = a[2] * b[3] + a[5] * b[4] + a[8] * b[5];
 114
 115         result[6] = a[0] * b[6] + a[3] * b[7] + a[6] * b[8];
 116         result[7] = a[1] * b[6] + a[4] * b[7] + a[7] * b[8];
 117         result[8] = a[2] * b[6] + a[5] * b[7] + a[8] * b[8];
 118 }
 119
 120 void multiply_3x3_matrix_float3(const Matrix3x3 M, float x0, float x1, float x2, float *y0, float *y1, float *y2)
 121 {
 122         *y0 = M[0] * x0 + M[3] * x1 + M[6] * x2;
 123         *y1 = M[1] * x0 + M[4] * x1 + M[7] * x2;
 124         *y2 = M[2] * x0 + M[5] * x1 + M[8] * x2;
 125 }
 126
 127 void invert_3x3_matrix(const Matrix3x3 m, Matrix3x3 result)
 128 {
 129         double inv_det = 1.0 / (
 130                 m[6] * m[1] * m[5] - m[6] * m[2] * m[4] -
 131                 m[3] * m[1] * m[8] + m[3] * m[2] * m[7] +
 132                 m[0] * m[4] * m[8] - m[0] * m[5] * m[7]);
 133
 134         result[0] = inv_det * (m[4] * m[8] - m[5] * m[7]);
 135         result[1] = inv_det * (m[2] * m[7] - m[1] * m[8]);
 136         result[2] = inv_det * (m[1] * m[5] - m[2] * m[4]);
 137
 138         result[3] = inv_det * (m[6] * m[5] - m[3] * m[8]);
 139         result[4] = inv_det * (m[0] * m[8] - m[6] * m[2]);
 140         result[5] = inv_det * (m[3] * m[2] - m[0] * m[5]);
 141
 142         result[6] = inv_det * (m[3] * m[7] - m[6] * m[4]);
 143         result[7] = inv_det * (m[6] * m[1] - m[0] * m[7]);
 144         result[8] = inv_det * (m[0] * m[4] - m[3] * m[1]);
 145 }
 146
 147 void print_3x3_matrix(const Matrix3x3 m)
 148 {
 149         printf("%6.4f %6.4f %6.4f\n", m[0], m[3], m[6]);
 150         printf("%6.4f %6.4f %6.4f\n", m[1], m[4], m[7]);
 151         printf("%6.4f %6.4f %6.4f\n", m[2], m[5], m[8]);
 152         printf("\n");
 153 }