use av_strdup()
[ffmpeg.git] / vhook / fish.c
1 /*
2  * Fish Detector Hook
3  * Copyright (c) 2002 Philip Gladstone
4  *
5  * This file implements a fish detector. It is used to see when a 
6  * goldfish passes in front of the camera. It does this by counting
7  * the number of input pixels that fall within a particular HSV
8  * range.
9  *
10  * It takes a multitude of arguments:
11  *
12  * -h <num>-<num>    the range of H values that are fish
13  * -s <num>-<num>    the range of S values that are fish
14  * -v <num>-<num>    the range of V values that are fish
15  * -z                zap all non-fish values to black
16  * -l <num>          limit the number of saved files to <num>
17  * -i <num>          only check frames every <num> seconds
18  * -t <num>          the threshold for the amount of fish pixels (range 0-1)
19  * -d                turn debugging on
20  * -D <directory>    where to put the fish images
21  *
22  * This library is free software; you can redistribute it and/or
23  * modify it under the terms of the GNU Lesser General Public
24  * License as published by the Free Software Foundation; either
25  * version 2 of the License, or (at your option) any later version.
26  *
27  * This library is distributed in the hope that it will be useful,
28  * but WITHOUT ANY WARRANTY; without even the implied warranty of
29  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
30  * Lesser General Public License for more details.
31  *
32  * You should have received a copy of the GNU Lesser General Public
33  * License along with this library; if not, write to the Free Software
34  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
35  */
36 #include <stdlib.h>
37 #include <fcntl.h>
38 #include <unistd.h>
39 #include <stdarg.h>
40 #include <string.h>
41 #include <time.h>
42 #include <stdio.h>
43 #include <dirent.h>
44
45 #include "framehook.h"
46 #include "dsputil.h"
47
48 #define SCALE_BITS 10
49  
50 #define C_Y  (76309 >> (16 - SCALE_BITS))
51 #define C_RV (117504 >> (16 - SCALE_BITS))
52 #define C_BU (138453 >> (16 - SCALE_BITS))
53 #define C_GU (13954 >> (16 - SCALE_BITS))
54 #define C_GV (34903 >> (16 - SCALE_BITS))                                       
55
56   
57 typedef struct {
58     int h;  /* 0 .. 360 */
59     int s;  /* 0 .. 255 */
60     int v;  /* 0 .. 255 */
61 } HSV;
62               
63 typedef struct {
64     int zapping;
65     int threshold;
66     HSV dark, bright;
67     char *dir;
68     int file_limit;
69     int debug;
70     int min_interval;
71     INT64 next_pts;
72     int inset;
73     int min_width;
74 } ContextInfo;
75
76 static void dorange(const char *s, int *first, int *second, int maxval)
77 {
78     sscanf(s, "%d-%d", first, second);
79     if (*first > maxval)
80         *first = maxval;
81     if (*second > maxval)
82         *second = maxval;
83 }
84
85 void Release(void *ctx)
86 {
87     if (ctx)
88         av_free(ctx);
89 }
90
91 int Configure(void **ctxp, int argc, char *argv[])
92 {
93     ContextInfo *ci;
94     int c;
95
96     *ctxp = av_mallocz(sizeof(ContextInfo));
97     ci = (ContextInfo *) *ctxp;
98
99     optind = 0;
100
101     ci->dir = "/tmp";
102     ci->threshold = 1000;
103     ci->file_limit = 100;
104     ci->min_interval = 1000000;
105     ci->inset = 10;     /* Percent */
106
107     while ((c = getopt(argc, argv, "w:i:dh:s:v:zl:t:D:")) > 0) {
108         switch (c) {
109             case 'h':
110                 dorange(optarg, &ci->dark.h, &ci->bright.h, 360);
111                 break;
112             case 's':
113                 dorange(optarg, &ci->dark.s, &ci->bright.s, 255);
114                 break;
115             case 'v':
116                 dorange(optarg, &ci->dark.v, &ci->bright.v, 255);
117                 break;
118             case 'z':
119                 ci->zapping = 1;
120                 break;
121             case 'l':
122                 ci->file_limit = atoi(optarg);
123                 break;
124             case 'i':
125                 ci->min_interval = 1000000 * atof(optarg);
126                 break;
127             case 't':
128                 ci->threshold = atof(optarg) * 1000;
129                 break;
130             case 'w':
131                 ci->min_width = atoi(optarg);
132                 break;
133             case 'd':
134                 ci->debug++;
135                 break;
136             case 'D':
137                 ci->dir = av_strdup(optarg);
138                 break;
139             default:
140                 fprintf(stderr, "Unrecognized argument '%s'\n", argv[optind]);
141                 return -1;
142         }
143     }
144
145     fprintf(stderr, "Fish detector configured:\n");
146     fprintf(stderr, "    HSV range: %d,%d,%d - %d,%d,%d\n",
147                         ci->dark.h,
148                         ci->dark.s,
149                         ci->dark.v,
150                         ci->bright.h,
151                         ci->bright.s,
152                         ci->bright.v);
153
154     return 0;
155 }
156
157 static void get_hsv(HSV *hsv, int r, int g, int b)
158 {
159     int i, v, x, f;
160          
161     x = (r < g) ? r : g;
162     if (b < x)
163         x = b;
164     v = (r > g) ? r : g;
165     if (b > v)
166         v = b;
167           
168     if (v == x) {
169         hsv->h = 0;
170         hsv->s = 0;
171         hsv->v = v;
172         return;
173     }
174        
175     if (r == v) {
176         f = g - b;
177         i = 0;
178     } else if (g == v) {
179         f = b - r;
180         i = 2 * 60;
181     } else {
182         f = r - g;
183         i = 4 * 60;
184     }
185         
186     hsv->h = i + (60 * f) / (v - x);
187     if (hsv->h < 0)
188         hsv->h += 360;
189
190     hsv->s = (255 * (v - x)) / v;
191     hsv->v = v;
192          
193     return;
194 }                                                                               
195
196 void Process(void *ctx, AVPicture *picture, enum PixelFormat pix_fmt, int width, int height, INT64 pts)
197 {
198     ContextInfo *ci = (ContextInfo *) ctx;
199     UINT8 *cm = cropTbl + MAX_NEG_CROP;                                         
200     int rowsize = picture->linesize[0];
201
202     if (pts < ci->next_pts)
203         return;
204
205     if (width < ci->min_width)
206         return;
207
208     ci->next_pts = pts + 1000000;    
209
210     if (pix_fmt == PIX_FMT_YUV420P) {
211         UINT8 *y, *u, *v;
212         int width2 = width >> 1;
213         int inrange = 0;
214         int pixcnt;
215         int h;
216         int h_start, h_end;
217         int w_start, w_end;
218
219         h_end = 2 * ((ci->inset * height) / 200);
220         h_start = height - h_end;
221
222         w_end = (ci->inset * width2) / 100;
223         w_start = width2 - w_end;
224
225         pixcnt = ((h_start - h_end) >> 1) * (w_start - w_end);
226
227         y = picture->data[0];
228         u = picture->data[1];
229         v = picture->data[2];
230
231         for (h = h_start; h > h_end; h -= 2) {
232             int w;
233
234             for (w = w_start; w > w_end; w--) {
235                 int r,g,b;
236                 int Y, U, V;
237                 HSV hsv;
238
239                 U = u[0] - 128;
240                 V = v[0] - 128;
241
242                 Y = (y[0] - 16) * C_Y;
243
244                 r = cm[(Y + C_RV * V + (1 << (SCALE_BITS - 1))) >> SCALE_BITS];
245                 g = cm[(Y + - C_GU * U - C_GV * V + (1 << (SCALE_BITS - 1))) >> SCALE_BITS];
246                 b = cm[(Y + C_BU * U + (1 << (SCALE_BITS - 1))) >> SCALE_BITS];
247
248                 get_hsv(&hsv, r, g, b);
249
250                 if (ci->debug > 1) 
251                     fprintf(stderr, "(%d,%d,%d) -> (%d,%d,%d)\n",
252                         r,g,b,hsv.h,hsv.s,hsv.v);
253
254
255                 if (hsv.h >= ci->dark.h && hsv.h <= ci->bright.h &&
256                     hsv.s >= ci->dark.s && hsv.s <= ci->bright.s &&
257                     hsv.v >= ci->dark.v && hsv.v <= ci->bright.v) {            
258                     inrange++;
259                 } else if (ci->zapping) {
260                     y[0] = y[1] = y[rowsize] = y[rowsize + 1] = 0;
261                 }
262
263                 y+= 2;
264                 u++;
265                 v++;
266             }
267
268             y += picture->linesize[0] * 2 - width;
269             u += picture->linesize[1] - width2;
270             v += picture->linesize[2] - width2;
271         }
272
273         if (inrange * 1000 / pixcnt >= ci->threshold) {
274             /* Save to file */
275             int size;
276             char *buf;
277             AVPicture picture1;
278             static int frame_counter;
279             static int foundfile;
280
281             if (ci->debug) 
282                 fprintf(stderr, "Fish: Inrange=%d of %d = %d threshold\n", inrange, pixcnt, 1000 * inrange / pixcnt);
283
284             if ((frame_counter++ % 20) == 0) {
285                 /* Check how many files we have */
286                 DIR *d;
287
288                 foundfile = 0;
289
290                 d = opendir(ci->dir);
291                 if (d) {
292                     struct dirent *dent;
293
294                     while ((dent = readdir(d))) {
295                         if (strncmp("fishimg", dent->d_name, 7) == 0) {
296                             if (strcmp(".ppm", dent->d_name + strlen(dent->d_name) - 4) == 0) {
297                                 foundfile++;
298                             }
299                         }
300                     }
301                     closedir(d);
302                 }
303             }
304
305             if (foundfile < ci->file_limit) {
306                 size = avpicture_get_size(PIX_FMT_RGB24, width, height);
307                 buf = av_malloc(size);
308
309                 avpicture_fill(&picture1, buf, PIX_FMT_RGB24, width, height);
310                 if (img_convert(&picture1, PIX_FMT_RGB24, 
311                                 picture, pix_fmt, width, height) >= 0) {
312                     /* Write out the PPM file */
313
314                     FILE *f;
315                     char fname[256];
316
317                     sprintf(fname, "%s/fishimg%ld_%lld.ppm", ci->dir, time(0), pts);
318                     f = fopen(fname, "w");
319                     if (f) {
320                         fprintf(f, "P6 %d %d 255\n", width, height);
321                         fwrite(buf, width * height * 3, 1, f);
322                         fclose(f);
323                     }
324                 }
325
326                 av_free(buf);
327                 ci->next_pts = pts + ci->min_interval;    
328             }
329         }
330     }
331 }
332