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