4 * Copyright (C) 2008 Adam Williams <broadcast at earthling dot net>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
27 #define SQR(x) ((x) * (x))
29 #define CLIP(x, y, z) ((x) < (y) ? (y) : ((x) > (z) ? (z) : (x)))
31 #define RECLIP(x, y, z) ((x) = ((x) < (y) ? (y) : ((x) > (z) ? (z) : (x))))
33 #define CLAMP(x, y, z) ((x) = ((x) < (y) ? (y) : ((x) > (z) ? (z) : (x))))
35 #define MAX(x, y) ((x) > (y) ? (x) : (y))
37 #define MIN(x, y) ((x) < (y) ? (x) : (y))
39 #define EQUIV(x, y) (fabs((x) - (y)) < 0.001)
41 #define DISTANCE(x1, y1, x2, y2) \
42 (sqrt(((x2) - (x1)) * ((x2) - (x1)) + ((y2) - (y1)) * ((y2) - (y1))))
43 #define TO_RAD(x) ((x) * 2 * M_PI / 360)
44 #define TO_DEG(x) ((x) * 360 / 2 / M_PI)
46 static inline int bmin(int a, int b) { return a < b ? a : b; }
47 static inline float bmin(float a, float b) { return a < b ? a : b; }
48 static inline double bmin(double a, double b) { return a < b ? a : b; }
49 static inline int bmax(int a, int b) { return a > b ? a : b; }
50 static inline float bmax(float a, float b) { return a > b ? a : b; }
51 static inline double bmax(double a, double b) { return a > b ? a : b; }
53 static inline int bclip(int &iv, int imn, int imx) {
54 return iv < imn ? imn : iv > imx ? imx : iv;
56 static inline float bclip(float &fv, float fmn, float fmx) {
57 return fv < fmn ? fmn : fv > fmx ? fmx : fv;
59 static inline double bclip(double &dv, double dmn, double dmx) {
60 return dv < dmn ? dmn : dv > dmx ? dmx : dv;
62 static inline void bclamp(int &iv, int imn, int imx) {
63 if( iv < imn ) iv = imn; else if( iv > imx ) iv = imx;
65 static inline void bclamp(float &fv, float fmn, float fmx) {
66 if( fv < fmn ) fv = fmn; else if( fv > fmx ) fv = fmx;
68 static inline void bclamp(double &dv, double dmn, double dmx) {
69 if( dv < dmn ) dv = dmn; else if( dv > dmx ) dv = dmx;
71 static inline void bc_rgb2yuv(float r, float g, float b, float &y, float &u, float &v)
72 { //bt601, jpeg, unclipped
73 y = 0.29900*r + 0.58700*g + 0.11400*b;
74 u = -0.16874*r - 0.33126*g + 0.50000*b + 0.5;
75 v = 0.50000*r - 0.41869*g - 0.08131*b + 0.5;
77 static inline void bc_rgb2yuv(int r, int g, int b, int &y, int &u, int &v, int max=255)
79 float mx = max, fr = r/mx, fg = g/mx, fb = b/mx, fy, fu, fv;
80 bc_rgb2yuv(fr,fg,fb, fy,fu,fv);
81 y = (int)(fy * mx + 0.5); bclamp(y,0,max);
82 u = (int)(fu * mx + 0.5); bclamp(u,0,max);
83 v = (int)(fv * mx + 0.5); bclamp(v,0,max);
85 static inline void bc_yuv2rgb(float y, float u, float v, float &r, float &g, float &b)
86 { //bt601, jpeg, unclipped
88 g = y - 0.34414*u - 0.71414*v;
91 static inline void bc_yuv2rgb(int y, int u, int v, int &r, int &g, int &b, int max=255)
93 int ofs = (max + 1) / 2;
94 float mx = max, fy = y/mx, fu = (u-ofs)/mx, fv = (v-ofs)/mx, fr, fg, fb;
95 bc_yuv2rgb(fy,fu,fv, fr,fg,fb);
96 r = (int)(fr * mx + 0.5); bclamp(r,0,max);
97 g = (int)(fg * mx + 0.5); bclamp(g,0,max);
98 b = (int)(fb * mx + 0.5); bclamp(b,0,max);