test/testgesture.c
author Sam Lantinga <slouken@libsdl.org>
Tue, 30 Nov 2010 18:08:01 -0800
changeset 4921 40a43c6d9220
parent 4918 f5f70fed2c4c
child 5062 e8916fe9cfc8
permissions -rw-r--r--
Fixed crash if the gesture coordinates go negative - FIXME: Should this protection be at a lower level?
jim@4689
     1
/*  Usage:
jim@4689
     2
 *  Spacebar to begin recording a gesture on all touches.
jim@4689
     3
 *  s to save all touches into "./gestureSave"
jim@4689
     4
 *  l to load all touches from "./gestureSave"
jim@4689
     5
 */
jim@4689
     6
jim@4689
     7
#include <stdio.h>
jim@4689
     8
#include <SDL.h>
jim@4689
     9
#include <math.h>
jim@4689
    10
#include <SDL_touch.h>
jim@4689
    11
#include <SDL_gesture.h>
jim@4689
    12
jim@4689
    13
jim@4689
    14
/* Make sure we have good macros for printing 32 and 64 bit values */
jim@4689
    15
#ifndef PRIs32
jim@4689
    16
#define PRIs32 "d"
jim@4689
    17
#endif
jim@4689
    18
#ifndef PRIu32
jim@4689
    19
#define PRIu32 "u"
jim@4689
    20
#endif
jim@4689
    21
#ifndef PRIs64
jim@4689
    22
#ifdef __WIN32__
jim@4689
    23
#define PRIs64 "I64"
jim@4689
    24
#else
jim@4689
    25
#define PRIs64 "lld"
jim@4689
    26
#endif
jim@4689
    27
#endif
jim@4689
    28
#ifndef PRIu64
jim@4689
    29
#ifdef __WIN32__
jim@4689
    30
#define PRIu64 "I64u"
jim@4689
    31
#else
jim@4689
    32
#define PRIu64 "llu"
jim@4689
    33
#endif
jim@4689
    34
#endif
jim@4689
    35
jim@4689
    36
#define WIDTH 640
jim@4689
    37
#define HEIGHT 480
jim@4689
    38
#define BPP 4
jim@4689
    39
#define DEPTH 32
jim@4689
    40
jim@4689
    41
//MUST BE A POWER OF 2!
jim@4689
    42
#define EVENT_BUF_SIZE 256
jim@4689
    43
jim@4689
    44
jim@4689
    45
#define VERBOSE SDL_FALSE
jim@4689
    46
jim@4689
    47
SDL_Event events[EVENT_BUF_SIZE];
jim@4689
    48
int eventWrite;
jim@4689
    49
jim@4689
    50
int colors[7] = {0xFF,0xFF00,0xFF0000,0xFFFF00,0x00FFFF,0xFF00FF,0xFFFFFF};
jim@4689
    51
jim@4689
    52
typedef struct {
jim@4689
    53
  float x,y;
jim@4689
    54
} Point;
jim@4689
    55
jim@4689
    56
typedef struct {
jim@4689
    57
  float ang,r;
jim@4689
    58
  Point p;
jim@4689
    59
} Knob;
jim@4689
    60
jim@4689
    61
Knob knob;
jim@4689
    62
jim@4689
    63
void handler (int sig)
jim@4689
    64
{
slouken@4918
    65
  printf ("exiting...(%d)\n", sig);
jim@4689
    66
  exit (0);
jim@4689
    67
}
jim@4689
    68
jim@4689
    69
void perror_exit (char *error)
jim@4689
    70
{
jim@4689
    71
  perror (error);
jim@4689
    72
  handler (9);
jim@4689
    73
}
jim@4689
    74
slouken@4918
    75
void setpix(SDL_Surface *screen, float _x, float _y, unsigned int col)
jim@4689
    76
{
jim@4689
    77
  Uint32 *pixmem32;
jim@4689
    78
  Uint32 colour;
slouken@4918
    79
  Uint8 r,g,b;
slouken@4918
    80
  int x = (int)_x;
slouken@4918
    81
  int y = (int)_y;
slouken@4918
    82
  float a;
jim@4689
    83
  
slouken@4921
    84
  if(x < 0 || x > screen->w) return;
slouken@4921
    85
  if(y < 0 || y > screen->h) return;
jim@4689
    86
jim@4689
    87
  pixmem32 = (Uint32*) screen->pixels  + y*screen->pitch/BPP + x;
jim@4689
    88
  
slouken@4918
    89
  SDL_memcpy(&colour,pixmem32,screen->format->BytesPerPixel);
jim@4689
    90
jim@4689
    91
  SDL_GetRGB(colour,screen->format,&r,&g,&b);
jim@4689
    92
  //r = 0;g = 0; b = 0;
slouken@4918
    93
  a = (float)((col>>24)&0xFF);
jim@4689
    94
  if(a == 0) a = 0xFF; //Hack, to make things easier.
jim@4689
    95
  a /= 0xFF;
slouken@4918
    96
  r = (Uint8)(r*(1-a) + ((col>>16)&0xFF)*(a));
slouken@4918
    97
  g = (Uint8)(g*(1-a) + ((col>> 8)&0xFF)*(a));
slouken@4918
    98
  b = (Uint8)(b*(1-a) + ((col>> 0)&0xFF)*(a));
jim@4689
    99
  colour = SDL_MapRGB( screen->format,r, g, b);
jim@4689
   100
  
jim@4689
   101
jim@4689
   102
  *pixmem32 = colour;
jim@4689
   103
}
jim@4689
   104
slouken@4918
   105
void drawLine(SDL_Surface *screen,float x0,float y0,float x1,float y1,unsigned int col) {
jim@4689
   106
  float t;
slouken@4918
   107
  for(t=0;t<1;t+=(float)(1.f/SDL_max(SDL_fabs(x0-x1),SDL_fabs(y0-y1))))
jim@4689
   108
    setpix(screen,x1+t*(x0-x1),y1+t*(y0-y1),col);
jim@4689
   109
}
jim@4689
   110
slouken@4918
   111
void drawCircle(SDL_Surface* screen,float x,float y,float r,unsigned int c)
jim@4689
   112
{
slouken@4918
   113
  float tx,ty;
jim@4689
   114
  float xr;
slouken@4918
   115
  for(ty = (float)-SDL_fabs(r);ty <= (float)SDL_fabs((int)r);ty++) {
slouken@4918
   116
    xr = (float)sqrt(r*r - ty*ty);
jim@4689
   117
    if(r > 0) { //r > 0 ==> filled circle
slouken@4918
   118
      for(tx=-xr+.5f;tx<=xr-.5;tx++) {
jim@4689
   119
	setpix(screen,x+tx,y+ty,c);
jim@4689
   120
      }
jim@4689
   121
    }
jim@4689
   122
    else {
slouken@4918
   123
      setpix(screen,x-xr+.5f,y+ty,c);
slouken@4918
   124
      setpix(screen,x+xr-.5f,y+ty,c);
jim@4689
   125
    }
jim@4689
   126
  }
jim@4689
   127
}
jim@4689
   128
jim@4689
   129
void drawKnob(SDL_Surface* screen,Knob k) {
jim@4689
   130
  drawCircle(screen,k.p.x*screen->w,k.p.y*screen->h,k.r*screen->w,0xFFFFFF);  
slouken@4918
   131
  drawCircle(screen,(k.p.x+k.r/2*cosf(k.ang))*screen->w,
slouken@4918
   132
  	            (k.p.y+k.r/2*sinf(k.ang))*screen->h,k.r/4*screen->w,0);
jim@4689
   133
}
jim@4689
   134
jim@4689
   135
void DrawScreen(SDL_Surface* screen)
jim@4689
   136
{
slouken@4918
   137
  int x, y, i;
jim@4689
   138
  if(SDL_MUSTLOCK(screen))
jim@4689
   139
    {                                              
jim@4689
   140
      if(SDL_LockSurface(screen) < 0) return;
jim@4689
   141
    }
jim@4689
   142
  for(y = 0;y < screen->h;y++)
jim@4689
   143
    for(x = 0;x < screen->w;x++)
slouken@4918
   144
	setpix(screen,(float)x,(float)y,((x%255)<<16) + ((y%255)<<8) + (x+y)%255);
jim@4689
   145
jim@4689
   146
  //draw Touch History
jim@4689
   147
  for(i = SDL_max(0,eventWrite - EVENT_BUF_SIZE);i < eventWrite;i++) {
jim@4689
   148
    SDL_Event event = events[i&(EVENT_BUF_SIZE-1)];
jim@4689
   149
    int age = eventWrite - i - 1;
slouken@4918
   150
	float x, y;
slouken@4918
   151
	unsigned int c, col;
slouken@4918
   152
jim@4689
   153
    if(event.type == SDL_FINGERMOTION || 
jim@4689
   154
       event.type == SDL_FINGERDOWN ||
jim@4689
   155
       event.type == SDL_FINGERUP) {
jim@4689
   156
      SDL_Touch* inTouch = SDL_GetTouch(event.tfinger.touchId);
jim@4689
   157
      if(inTouch == NULL) continue;
jim@4689
   158
slouken@4918
   159
      x = ((float)event.tfinger.x)/inTouch->xres;
slouken@4918
   160
      y = ((float)event.tfinger.y)/inTouch->yres;      
jim@4689
   161
      
jim@4689
   162
      //draw the touch:      
slouken@4918
   163
      c = colors[event.tfinger.touchId%7]; 
slouken@4918
   164
      col = 
jim@4689
   165
	((unsigned int)(c*(.1+.85))) |
jim@4689
   166
	((unsigned int)((0xFF*(1-((float)age)/EVENT_BUF_SIZE))) & 0xFF)<<24;
jim@4689
   167
jim@4689
   168
      if(event.type == SDL_FINGERMOTION)
jim@4689
   169
	drawCircle(screen,x*screen->w,y*screen->h,5,col);
jim@4689
   170
      else if(event.type == SDL_FINGERDOWN)
jim@4689
   171
	drawCircle(screen,x*screen->w,y*screen->h,-10,col);     
jim@4689
   172
    }
jim@4689
   173
  }
jim@4689
   174
  
jim@4689
   175
  if(knob.p.x > 0)
jim@4689
   176
    drawKnob(screen,knob);
jim@4689
   177
  
jim@4689
   178
  if(SDL_MUSTLOCK(screen)) SDL_UnlockSurface(screen);
jim@4689
   179
  SDL_Flip(screen);
jim@4689
   180
}
jim@4689
   181
jim@4689
   182
SDL_Surface* initScreen(int width,int height)
jim@4689
   183
{
jim@4689
   184
  return SDL_SetVideoMode(width, height, DEPTH,
jim@4689
   185
			  SDL_HWSURFACE | SDL_RESIZABLE);
jim@4689
   186
}
jim@4689
   187
jim@4689
   188
int main(int argc, char* argv[])
jim@4689
   189
{  
jim@4689
   190
  SDL_Surface *screen;
jim@4689
   191
  SDL_Event event;
slouken@4918
   192
  SDL_bool quitting = SDL_FALSE;
slouken@4918
   193
  SDL_RWops *src;
jim@4689
   194
jim@4689
   195
  //gesture variables
slouken@4918
   196
  knob.r = .1f;
jim@4689
   197
  knob.ang = 0;
jim@4689
   198
jim@4689
   199
  if (SDL_Init(SDL_INIT_VIDEO) < 0 ) return 1;
jim@4689
   200
  
jim@4689
   201
  if (!(screen = initScreen(WIDTH,HEIGHT)))
jim@4689
   202
    {
jim@4689
   203
      SDL_Quit();
jim@4689
   204
      return 1;
jim@4689
   205
    }
jim@4689
   206
jim@4689
   207
  while(!quitting) {
jim@4689
   208
    while(SDL_PollEvent(&event)) 
jim@4689
   209
      {
jim@4689
   210
	//Record _all_ events
jim@4689
   211
	events[eventWrite & (EVENT_BUF_SIZE-1)] = event;
jim@4689
   212
	eventWrite++;
jim@4689
   213
	
jim@4689
   214
	switch (event.type) 
jim@4689
   215
	  {
jim@4689
   216
	  case SDL_QUIT:
jim@4689
   217
	    quitting = SDL_TRUE;
jim@4689
   218
	    break;
jim@4689
   219
	  case SDL_KEYDOWN:
jim@4689
   220
	    switch (event.key.keysym.sym)
jim@4689
   221
	      {
jim@4689
   222
	      case SDLK_SPACE:
jim@4689
   223
		SDL_RecordGesture(-1);
jim@4689
   224
		break;
jim@4689
   225
	      case SDLK_s:
jim@4689
   226
		src = SDL_RWFromFile("gestureSave","w");
jim@4689
   227
		printf("Wrote %i templates\n",SDL_SaveAllDollarTemplates(src));
jim@4689
   228
		SDL_RWclose(src);
jim@4689
   229
		break;
jim@4689
   230
	      case SDLK_l:
jim@4689
   231
		src = SDL_RWFromFile("gestureSave","r");
jim@4689
   232
		printf("Loaded: %i\n",SDL_LoadDollarTemplates(-1,src));
jim@4689
   233
		SDL_RWclose(src);
jim@4689
   234
		break;
jim@4689
   235
	      case SDLK_ESCAPE:
jim@4689
   236
		quitting = SDL_TRUE;
jim@4689
   237
		break;
jim@4689
   238
	    }
jim@4689
   239
	    break;
jim@4689
   240
	  case SDL_VIDEORESIZE:
jim@4689
   241
	    if (!(screen = initScreen(event.resize.w,
jim@4689
   242
				      event.resize.h)))
jim@4689
   243
	      {
jim@4689
   244
		SDL_Quit();
jim@4689
   245
		return 1;
jim@4689
   246
	      }
jim@4689
   247
	    break;
slouken@4918
   248
	  case SDL_FINGERMOTION:
jim@4689
   249
#if VERBOSE
jim@4689
   250
	    printf("Finger: %i,x: %i, y: %i\n",event.tfinger.fingerId,
jim@4689
   251
	    	   event.tfinger.x,event.tfinger.y);
jim@4689
   252
#endif
slouken@4918
   253
		{
slouken@4918
   254
			SDL_Touch* inTouch = SDL_GetTouch(event.tfinger.touchId);
slouken@4918
   255
			SDL_Finger* inFinger = SDL_GetFinger(inTouch,event.tfinger.fingerId);
slouken@4918
   256
		}
jim@4689
   257
	    break;	    
jim@4689
   258
	  case SDL_FINGERDOWN:
jim@4689
   259
#if VERBOSE
jim@4689
   260
	    printf("Finger: %"PRIs64" down - x: %i, y: %i\n",
jim@4689
   261
		   event.tfinger.fingerId,event.tfinger.x,event.tfinger.y);
jim@4689
   262
#endif
jim@4689
   263
	    break;
jim@4689
   264
	  case SDL_FINGERUP:
jim@4689
   265
#if VERBOSE
jim@4689
   266
	    printf("Finger: %"PRIs64" up - x: %i, y: %i\n",
jim@4689
   267
	    	   event.tfinger.fingerId,event.tfinger.x,event.tfinger.y);
jim@4689
   268
#endif
jim@4689
   269
	    break;
jim@4689
   270
	  case SDL_MULTIGESTURE:
jim@4689
   271
#if VERBOSE	    
jim@4689
   272
	    printf("Multi Gesture: x = %f, y = %f, dAng = %f, dR = %f\n",
jim@4689
   273
		   event.mgesture.x,
jim@4689
   274
		   event.mgesture.y,
jim@4689
   275
		   event.mgesture.dTheta,
jim@4689
   276
		   event.mgesture.dDist);
jim@4689
   277
	    printf("MG: numDownTouch = %i\n",event.mgesture.numFingers);
jim@4689
   278
#endif
jim@4689
   279
	    knob.p.x = event.mgesture.x;
jim@4689
   280
	    knob.p.y = event.mgesture.y;
jim@4689
   281
	    knob.ang += event.mgesture.dTheta;
jim@4689
   282
	    knob.r += event.mgesture.dDist;
jim@4689
   283
	    break;
jim@4689
   284
	  case SDL_DOLLARGESTURE:
jim@4689
   285
	    printf("Gesture %"PRIs64" performed, error: %f\n",
jim@4689
   286
		   event.dgesture.gestureId,
jim@4689
   287
		   event.dgesture.error);
jim@4689
   288
	    break;
jim@4689
   289
	  case SDL_DOLLARRECORD:
jim@4689
   290
	    printf("Recorded gesture: %"PRIs64"\n",event.dgesture.gestureId);
jim@4689
   291
	    break;
jim@4689
   292
	  }
jim@4689
   293
      }
jim@4689
   294
    DrawScreen(screen);
jim@4689
   295
  }  
jim@4689
   296
  SDL_Quit();  
jim@4689
   297
  return 0;
jim@4689
   298
}
jim@4689
   299