sparrow.h

   1 /* Copyright (C) <2010> Douglas Bagnall <douglas@halo.gen.nz>
   2  *
   3  * This library is free software; you can redistribute it and/or
   4  * modify it under the terms of the GNU Library General Public
   5  * License as published by the Free Software Foundation; either
   6  * version 2 of the License, or (at your option) any later version.
   7  *
   8  * This library is distributed in the hope that it will be useful,
   9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  11  * Library General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU Library General Public
  14  * License along with this library; if not, write to the
  15  * Free Software Foundation, Inc., 59 Temple Place - Suite 330,
  16  * Boston, MA 02111-1307, USA.
  17  */
  18 #ifndef __SPARROW_SPARROW_H__
  19 #define __SPARROW_SPARROW_H__
  20
  21 #include <stdlib.h>
  22 #include "gstsparrow.h"
  23 #include "sparrow_false_colour_lut.h"
  24 #include "sparrow_gamma_lut.h"
  25
  26 /* calibrate.c */
  27 INVISIBLE void calibrate_init_lines(GstSparrow *sparrow);
  28 INVISIBLE void reset_find_self(GstSparrow *sparrow, gint first);
  29 INVISIBLE void mode_find_edges(GstSparrow *sparrow, guint8 *in, guint8 *out);
  30 INVISIBLE void mode_find_self(GstSparrow *sparrow, guint8 *in, guint8 *out);
  31 INVISIBLE void mode_wait_for_grid(GstSparrow *sparrow, guint8 *in, guint8 *out);
  32 INVISIBLE void calibrate_init_grid(GstSparrow *sparrow);
  33
  34 /* sparrow.c */
  35 INVISIBLE void debug_frame(GstSparrow *sparrow, guint8 *data, guint32 width, guint32 height);
  36 INVISIBLE void sparrow_rotate_history(GstSparrow *sparrow, GstBuffer *inbuf);
  37 INVISIBLE void sparrow_pre_init(GstSparrow *sparrow);
  38 INVISIBLE gboolean sparrow_init(GstSparrow *sparrow, GstCaps *incaps, GstCaps *outcaps);
  39 INVISIBLE void sparrow_transform(GstSparrow *sparrow, guint8 *in, guint8 *out);
  40 INVISIBLE void sparrow_finalise(GstSparrow *sparrow);
  41
  42 /*itworks.c*/
  43 INVISIBLE void mode_process_frame(GstSparrow *sparrow, guint8 *in, guint8 *out);
  44
  45
  46 #define SPARROW_CALIBRATE_ON  1
  47
  48
  49 #define CALIBRATE_WAIT_SIGNAL_THRESHOLD 32
  50 #define ALIGNMENT 16
  51
  52
  53 /*memory allocation */
  54
  55 static inline __attribute__((malloc)) UNUSED void *
  56 malloc_or_die(size_t size){
  57   void *p = malloc(size);
  58   if (!p){
  59     GST_ERROR("malloc would not allocate %u bytes! seriously!\n", size);
  60     exit(EXIT_FAILURE);
  61   }
  62   return p;
  63 }
  64
  65 static inline __attribute__((malloc)) UNUSED void *
  66 malloc_aligned_or_die(size_t size){
  67   void *mem;
  68   int err = posix_memalign(&mem, ALIGNMENT, size);
  69   if (err){
  70     GST_ERROR("posix_memalign returned %d trying to allocate %u bytes aligned on %u byte boundaries\n",
  71         err, size, ALIGNMENT);
  72     exit(EXIT_FAILURE);
  73   }
  74   return mem;
  75 }
  76
  77 static inline __attribute__((malloc)) UNUSED void *
  78 zalloc_aligned_or_die(size_t size){
  79   void *mem = malloc_aligned_or_die(size);
  80   memset(mem, 0, size);
  81   return mem;
  82 }
  83
  84 /*RNG macros */
  85
  86 static inline UNUSED guint32
  87 rng_uniform_int(GstSparrow *sparrow, guint32 limit){
  88   double d = dsfmt_genrand_close_open(sparrow->dsfmt);
  89   double d2 = d * limit;
  90   guint32 i = (guint32)d2;
  91   return i;
  92 }
  93
  94 static inline UNUSED double
  95 rng_uniform_double(GstSparrow *sparrow, double limit){
  96     return dsfmt_genrand_close_open(sparrow->dsfmt) * limit;
  97 }
  98
  99 #define rng_uniform(sparrow) dsfmt_genrand_close_open((sparrow)->dsfmt)
 100
 101 #define RANDINT(sparrow, start, end)((start) + rng_uniform_int(sparrow, (end) - (start)))
 102
 103
 104 #define DISASTEROUS_CRASH(msg) GST_ERROR("DISASTER: %s\n%-25s  line %4d \n", (msg), __func__, __LINE__);
 105
 106
 107
 108 static inline guint32
 109 popcount64(guint64 x64)
 110 {
 111   guint32 x = x64 & (guint32)-1;
 112   guint32 y = x64 >> 32;
 113   x = x - ((x >> 1) & 0x55555555);
 114   y = y - ((y >> 1) & 0x55555555);
 115   x = (x & 0x33333333) + ((x >> 2) & 0x33333333);
 116   y = (y & 0x33333333) + ((y >> 2) & 0x33333333);
 117   x = (x + (x >> 4)) & 0x0F0F0F0F;
 118   y = (y + (y >> 4)) & 0x0F0F0F0F;
 119   x = x + (x >> 8);
 120   y = y + (y >> 8);
 121   x = x + (x >> 16);
 122   y = y + (y >> 16);
 123   return (x + y) & 0x000000FF;
 124 }
 125
 126 static inline guint32
 127 hamming_distance64(guint64 a, guint64 b, guint64 mask){
 128   a &= mask;
 129   b &= mask;
 130   /* count where the two differ */
 131   return popcount64(a ^ b);
 132 }
 133
 134 static inline gint
 135 mask_to_shift(guint32 mask){
 136   /*mask is big-endian, so these numbers are reversed */
 137   switch(mask){
 138   case 0x000000ff:
 139     return 24;
 140   case 0x0000ff00:
 141     return 16;
 142   case 0x00ff0000:
 143     return 8;
 144   case 0xff000000:
 145     return 0;
 146   }
 147   GST_WARNING("mask not byte aligned: %x\n", mask);
 148   return 0;
 149 }
 150
 151 static inline IplImage *
 152 init_ipl_image(sparrow_format *dim){
 153   CvSize size = {dim->width, dim->height};
 154   IplImage* im = cvCreateImageHeader(size, IPL_DEPTH_8U, PIXSIZE);
 155   return cvInitImageHeader(im, size, IPL_DEPTH_8U, PIXSIZE, 0, 8);
 156 }
 157
 158
 159 #endif /* __SPARROW_SPARROW_H__ */