src/events/SDL_gesture.c
author Gabriel Jacobo <gabomdq@gmail.com>
Tue, 20 Aug 2013 19:49:24 -0300
changeset 7662 d31efd717578
parent 7510 dbba26bab0f8
child 7677 871d43c6968a
permissions -rw-r--r--
Fixes a few non C89 compliant comments
jim@4657
     1
/*
slouken@5535
     2
  Simple DirectMedia Layer
slouken@6885
     3
  Copyright (C) 1997-2013 Sam Lantinga <slouken@libsdl.org>
jim@4657
     4
slouken@5535
     5
  This software is provided 'as-is', without any express or implied
slouken@5535
     6
  warranty.  In no event will the authors be held liable for any damages
slouken@5535
     7
  arising from the use of this software.
jim@4657
     8
slouken@5535
     9
  Permission is granted to anyone to use this software for any purpose,
slouken@5535
    10
  including commercial applications, and to alter it and redistribute it
slouken@5535
    11
  freely, subject to the following restrictions:
jim@4657
    12
slouken@5535
    13
  1. The origin of this software must not be misrepresented; you must not
philipp@7252
    14
     claim that you wrote the original software. If you use this software
philipp@7252
    15
     in a product, an acknowledgment in the product documentation would be
philipp@7252
    16
     appreciated but is not required.
slouken@5535
    17
  2. Altered source versions must be plainly marked as such, and must not be
philipp@7252
    18
     misrepresented as being the original software.
slouken@5535
    19
  3. This notice may not be removed or altered from any source distribution.
jim@4657
    20
*/
aschiffler@4865
    21
jim@4657
    22
#include "SDL_config.h"
jim@4657
    23
jim@4657
    24
/* General mouse handling code for SDL */
jim@4657
    25
jim@4657
    26
#include "SDL_events.h"
jim@4657
    27
#include "SDL_events_c.h"
jim@4657
    28
#include "SDL_gesture_c.h"
jim@4657
    29
kimonline@7009
    30
#if !defined(__PSP__)
aschiffler@4865
    31
#include <memory.h>
kimonline@7009
    32
#endif
kimonline@7009
    33
aschiffler@4865
    34
#include <string.h>
aschiffler@4865
    35
#include <stdio.h>
aschiffler@4865
    36
#include <math.h>
aschiffler@4865
    37
slouken@7191
    38
/* TODO: Replace with malloc */
jim@4688
    39
jim@4658
    40
#define MAXPATHSIZE 1024
jim@4658
    41
jim@4658
    42
#define DOLLARNPOINTS 64
jim@4658
    43
#define DOLLARSIZE 256
jim@4658
    44
jim@4684
    45
#define ENABLE_DOLLAR
jim@4684
    46
kees@6065
    47
#define PHI 0.618033989
jim@4657
    48
jim@4657
    49
typedef struct {
kees@6065
    50
    float x,y;
jim@4688
    51
} SDL_FloatPoint;
jim@4658
    52
jim@4658
    53
typedef struct {
kees@6065
    54
    float length;
kees@6065
    55
kees@6065
    56
    int numPoints;
kees@6065
    57
    SDL_FloatPoint p[MAXPATHSIZE];
jim@4688
    58
} SDL_DollarPath;
jim@4658
    59
jim@4657
    60
typedef struct {
kees@6065
    61
    SDL_FloatPoint path[DOLLARNPOINTS];
kees@6065
    62
    unsigned long hash;
jim@4688
    63
} SDL_DollarTemplate;
jim@4657
    64
jim@4657
    65
typedef struct {
kees@6069
    66
    SDL_TouchID id;
kees@6065
    67
    SDL_FloatPoint centroid;
kees@6065
    68
    SDL_DollarPath dollarPath;
kees@6065
    69
    Uint16 numDownFingers;
jim@4658
    70
kees@6065
    71
    int numDollarTemplates;
kees@6065
    72
    SDL_DollarTemplate *dollarTemplate;
jim@4659
    73
kees@6065
    74
    SDL_bool recording;
jim@4688
    75
} SDL_GestureTouch;
jim@4657
    76
jim@4688
    77
SDL_GestureTouch *SDL_gestureTouch;
jim@4688
    78
int SDL_numGestureTouches = 0;
jim@4659
    79
SDL_bool recordAll;
jim@4659
    80
slouken@4868
    81
#if 0
kees@6065
    82
static void PrintPath(SDL_FloatPoint *path)
kees@6065
    83
{
kees@6065
    84
    int i;
kees@6065
    85
    printf("Path:");
kees@6066
    86
    for (i=0; i<DOLLARNPOINTS; i++) {
kees@6065
    87
        printf(" (%f,%f)",path[i].x,path[i].y);
kees@6065
    88
    }
kees@6065
    89
    printf("\n");
jim@4685
    90
}
slouken@4868
    91
#endif
jim@4685
    92
kees@6065
    93
int SDL_RecordGesture(SDL_TouchID touchId)
kees@6065
    94
{
kees@6065
    95
    int i;
kees@6066
    96
    if (touchId < 0) recordAll = SDL_TRUE;
kees@6066
    97
    for (i = 0; i < SDL_numGestureTouches; i++) {
kees@6066
    98
        if ((touchId < 0) || (SDL_gestureTouch[i].id == touchId)) {
kees@6065
    99
            SDL_gestureTouch[i].recording = SDL_TRUE;
kees@6066
   100
            if (touchId >= 0)
kees@6065
   101
                return 1;
kees@6065
   102
        }
kees@6065
   103
    }
kees@6065
   104
    return (touchId < 0);
jim@4659
   105
}
jim@4659
   106
icculus@6070
   107
static unsigned long SDL_HashDollar(SDL_FloatPoint* points)
kees@6065
   108
{
kees@6065
   109
    unsigned long hash = 5381;
kees@6065
   110
    int i;
kees@6066
   111
    for (i = 0; i < DOLLARNPOINTS; i++) {
kees@6065
   112
        hash = ((hash<<5) + hash) + (unsigned long)points[i].x;
kees@6065
   113
        hash = ((hash<<5) + hash) + (unsigned long)points[i].y;
kees@6065
   114
    }
kees@6065
   115
    return hash;
jim@4659
   116
}
jim@4659
   117
jim@4665
   118
kees@6065
   119
static int SaveTemplate(SDL_DollarTemplate *templ, SDL_RWops * src)
kees@6065
   120
{
kees@6066
   121
    if (src == NULL) return 0;
jim@4665
   122
jim@4682
   123
gabomdq@7662
   124
    /*No Longer storing the Hash, rehash on load*/
gabomdq@7662
   125
    /*if(SDL_RWops.write(src,&(templ->hash),sizeof(templ->hash),1) != 1) return 0;*/
kees@6065
   126
kees@6066
   127
    if (SDL_RWwrite(src,templ->path,
kees@6066
   128
                    sizeof(templ->path[0]),DOLLARNPOINTS) != DOLLARNPOINTS)
kees@6065
   129
        return 0;
kees@6065
   130
kees@6065
   131
    return 1;
jim@4659
   132
}
jim@4659
   133
jim@4659
   134
kees@6065
   135
int SDL_SaveAllDollarTemplates(SDL_RWops *src)
kees@6065
   136
{
kees@6065
   137
    int i,j,rtrn = 0;
kees@6066
   138
    for (i = 0; i < SDL_numGestureTouches; i++) {
kees@6065
   139
        SDL_GestureTouch* touch = &SDL_gestureTouch[i];
kees@6066
   140
        for (j = 0; j < touch->numDollarTemplates; j++) {
kees@6065
   141
            rtrn += SaveTemplate(&touch->dollarTemplate[i],src);
kees@6065
   142
        }
jim@4659
   143
    }
kees@6065
   144
    return rtrn;
jim@4659
   145
}
jim@4659
   146
kees@6065
   147
int SDL_SaveDollarTemplate(SDL_GestureID gestureId, SDL_RWops *src)
kees@6065
   148
{
kees@6065
   149
    int i,j;
kees@6066
   150
    for (i = 0; i < SDL_numGestureTouches; i++) {
kees@6065
   151
        SDL_GestureTouch* touch = &SDL_gestureTouch[i];
kees@6066
   152
        for (j = 0; j < touch->numDollarTemplates; j++) {
kees@6066
   153
            if (touch->dollarTemplate[i].hash == gestureId) {
kees@6065
   154
                return SaveTemplate(&touch->dollarTemplate[i],src);
kees@6065
   155
            }
kees@6065
   156
        }
jim@4659
   157
    }
icculus@7037
   158
    return SDL_SetError("Unknown gestureId");
slouken@4663
   159
}
slouken@4663
   160
gabomdq@7662
   161
/*path is an already sampled set of points
gabomdq@7662
   162
Returns the index of the gesture on success, or -1*/
kees@6067
   163
static int SDL_AddDollarGesture_one(SDL_GestureTouch* inTouch, SDL_FloatPoint* path)
kees@6065
   164
{
kees@6065
   165
    SDL_DollarTemplate* dollarTemplate;
kees@6065
   166
    SDL_DollarTemplate *templ;
kees@6067
   167
    int index;
kees@6067
   168
kees@6067
   169
    index = inTouch->numDollarTemplates;
kees@6067
   170
    dollarTemplate =
kees@6067
   171
        (SDL_DollarTemplate *)SDL_realloc(inTouch->dollarTemplate,
kees@6067
   172
                                          (index + 1) *
kees@6067
   173
                                          sizeof(SDL_DollarTemplate));
kees@6067
   174
    if (!dollarTemplate) {
icculus@7037
   175
        return SDL_OutOfMemory();
kees@6067
   176
    }
kees@6067
   177
    inTouch->dollarTemplate = dollarTemplate;
kees@6067
   178
kees@6067
   179
    templ = &inTouch->dollarTemplate[index];
kees@6067
   180
    SDL_memcpy(templ->path, path, DOLLARNPOINTS*sizeof(SDL_FloatPoint));
kees@6067
   181
    templ->hash = SDL_HashDollar(templ->path);
kees@6067
   182
    inTouch->numDollarTemplates++;
kees@6067
   183
kees@6067
   184
    return index;
kees@6067
   185
}
kees@6067
   186
kees@6067
   187
static int SDL_AddDollarGesture(SDL_GestureTouch* inTouch, SDL_FloatPoint* path)
kees@6067
   188
{
icculus@6071
   189
    int index = -1;
kees@6065
   190
    int i = 0;
kees@6066
   191
    if (inTouch == NULL) {
kees@6066
   192
        if (SDL_numGestureTouches == 0) return -1;
kees@6066
   193
        for (i = 0; i < SDL_numGestureTouches; i++) {
kees@6065
   194
            inTouch = &SDL_gestureTouch[i];
kees@6067
   195
            index = SDL_AddDollarGesture_one(inTouch, path);
kees@6067
   196
            if (index < 0)
kees@6065
   197
                return -1;
kees@6065
   198
        }
gabomdq@7662
   199
        /* Use the index of the last one added.*/
kees@6067
   200
        return index;
kees@6065
   201
    } else {
kees@6067
   202
        return SDL_AddDollarGesture_one(inTouch, path);
slouken@4663
   203
    }
kees@6065
   204
    return -1;
jim@4659
   205
}
jim@4659
   206
kees@6065
   207
int SDL_LoadDollarTemplates(SDL_TouchID touchId, SDL_RWops *src)
kees@6065
   208
{
kees@6065
   209
    int i,loaded = 0;
kees@6065
   210
    SDL_GestureTouch *touch = NULL;
kees@6066
   211
    if (src == NULL) return 0;
kees@6066
   212
    if (touchId >= 0) {
kees@6066
   213
        for (i = 0; i < SDL_numGestureTouches; i++)
kees@6066
   214
            if (SDL_gestureTouch[i].id == touchId)
kees@6065
   215
                touch = &SDL_gestureTouch[i];
kees@6066
   216
        if (touch == NULL) return -1;
kees@6065
   217
    }
jim@4659
   218
kees@6066
   219
    while (1) {
kees@6065
   220
        SDL_DollarTemplate templ;
jim@4688
   221
kees@6066
   222
        if (SDL_RWread(src,templ.path,sizeof(templ.path[0]),DOLLARNPOINTS) <
kees@6065
   223
           DOLLARNPOINTS) break;
jim@4659
   224
kees@6066
   225
        if (touchId >= 0) {
gabomdq@7662
   226
            /*printf("Adding loaded gesture to 1 touch\n");*/
kees@6068
   227
            if (SDL_AddDollarGesture(touch, templ.path) >= 0)
kees@6068
   228
                loaded++;
kees@6065
   229
        }
kees@6065
   230
        else {
gabomdq@7662
   231
            /*printf("Adding to: %i touches\n",SDL_numGestureTouches);*/
kees@6066
   232
            for (i = 0; i < SDL_numGestureTouches; i++) {
kees@6065
   233
                touch = &SDL_gestureTouch[i];
gabomdq@7662
   234
                /*printf("Adding loaded gesture to + touches\n");*/
gabomdq@7662
   235
                /*TODO: What if this fails?*/
kees@6065
   236
                SDL_AddDollarGesture(touch,templ.path);
kees@6065
   237
            }
kees@6065
   238
            loaded++;
kees@6065
   239
        }
jim@4659
   240
    }
jim@4659
   241
kees@6065
   242
    return loaded;
jim@4659
   243
}
jim@4659
   244
jim@4659
   245
icculus@6070
   246
static float dollarDifference(SDL_FloatPoint* points,SDL_FloatPoint* templ,float ang)
kees@6065
   247
{
gabomdq@7662
   248
    /*  SDL_FloatPoint p[DOLLARNPOINTS];*/
kees@6065
   249
    float dist = 0;
kees@6065
   250
    SDL_FloatPoint p;
kees@6065
   251
    int i;
kees@6066
   252
    for (i = 0; i < DOLLARNPOINTS; i++) {
kees@6065
   253
        p.x = (float)(points[i].x * SDL_cos(ang) - points[i].y * SDL_sin(ang));
kees@6065
   254
        p.y = (float)(points[i].x * SDL_sin(ang) + points[i].y * SDL_cos(ang));
kees@6065
   255
        dist += (float)(SDL_sqrt((p.x-templ[i].x)*(p.x-templ[i].x)+
kees@6065
   256
                                 (p.y-templ[i].y)*(p.y-templ[i].y)));
kees@6065
   257
    }
kees@6065
   258
    return dist/DOLLARNPOINTS;
kees@6065
   259
jim@4658
   260
}
jim@4658
   261
icculus@6070
   262
static float bestDollarDifference(SDL_FloatPoint* points,SDL_FloatPoint* templ)
kees@6065
   263
{
gabomdq@7662
   264
    /*------------BEGIN DOLLAR BLACKBOX------------------
gabomdq@7662
   265
      -TRANSLATED DIRECTLY FROM PSUDEO-CODE AVAILABLE AT-
gabomdq@7662
   266
      -"http://depts.washington.edu/aimgroup/proj/dollar/"
gabomdq@7662
   267
    */
kees@6065
   268
    double ta = -M_PI/4;
kees@6065
   269
    double tb = M_PI/4;
kees@6065
   270
    double dt = M_PI/90;
kees@6065
   271
    float x1 = (float)(PHI*ta + (1-PHI)*tb);
kees@6065
   272
    float f1 = dollarDifference(points,templ,x1);
kees@6065
   273
    float x2 = (float)((1-PHI)*ta + PHI*tb);
kees@6065
   274
    float f2 = dollarDifference(points,templ,x2);
kees@6066
   275
    while (SDL_fabs(ta-tb) > dt) {
kees@6066
   276
        if (f1 < f2) {
kees@6065
   277
            tb = x2;
kees@6065
   278
            x2 = x1;
kees@6065
   279
            f2 = f1;
kees@6065
   280
            x1 = (float)(PHI*ta + (1-PHI)*tb);
kees@6065
   281
            f1 = dollarDifference(points,templ,x1);
kees@6065
   282
        }
kees@6065
   283
        else {
kees@6065
   284
            ta = x1;
kees@6065
   285
            x1 = x2;
kees@6065
   286
            f1 = f2;
kees@6065
   287
            x2 = (float)((1-PHI)*ta + PHI*tb);
kees@6065
   288
            f2 = dollarDifference(points,templ,x2);
kees@6065
   289
        }
jim@4658
   290
    }
kees@6065
   291
    /*
kees@6066
   292
      if (f1 <= f2)
kees@6066
   293
          printf("Min angle (x1): %f\n",x1);
kees@6066
   294
      else if (f1 >  f2)
kees@6066
   295
          printf("Min angle (x2): %f\n",x2);
kees@6065
   296
    */
kees@6065
   297
    return SDL_min(f1,f2);
jim@4658
   298
}
jim@4658
   299
gabomdq@7662
   300
/*DollarPath contains raw points, plus (possibly) the calculated length*/
icculus@6070
   301
static int dollarNormalize(const SDL_DollarPath *path,SDL_FloatPoint *points)
kees@6065
   302
{
kees@6065
   303
    int i;
kees@6065
   304
    float interval;
kees@6065
   305
    float dist;
kees@6065
   306
    int numPoints = 0;
kees@6065
   307
    SDL_FloatPoint centroid;
kees@6065
   308
    float xmin,xmax,ymin,ymax;
kees@6065
   309
    float ang;
kees@6065
   310
    float w,h;
kees@6065
   311
    float length = path->length;
aschiffler@4865
   312
gabomdq@7662
   313
    /*Calculate length if it hasn't already been done*/
kees@6066
   314
    if (length <= 0) {
kees@6066
   315
        for (i=1;i < path->numPoints; i++) {
kees@6066
   316
            float dx = path->p[i  ].x - path->p[i-1].x;
kees@6066
   317
            float dy = path->p[i  ].y - path->p[i-1].y;
kees@6065
   318
            length += (float)(SDL_sqrt(dx*dx+dy*dy));
kees@6065
   319
        }
jim@4658
   320
    }
jim@4658
   321
gabomdq@7662
   322
    /*Resample*/
kees@6065
   323
    interval = length/(DOLLARNPOINTS - 1);
kees@6065
   324
    dist = interval;
jim@4658
   325
kees@6065
   326
    centroid.x = 0;centroid.y = 0;
jim@4658
   327
gabomdq@7662
   328
    /*printf("(%f,%f)\n",path->p[path->numPoints-1].x,path->p[path->numPoints-1].y);*/
kees@6066
   329
    for (i = 1; i < path->numPoints; i++) {
kees@6065
   330
        float d = (float)(SDL_sqrt((path->p[i-1].x-path->p[i].x)*(path->p[i-1].x-path->p[i].x)+
kees@6065
   331
                                   (path->p[i-1].y-path->p[i].y)*(path->p[i-1].y-path->p[i].y)));
gabomdq@7662
   332
        /*printf("d = %f dist = %f/%f\n",d,dist,interval);*/
kees@6066
   333
        while (dist + d > interval) {
kees@6065
   334
            points[numPoints].x = path->p[i-1].x +
kees@6065
   335
                ((interval-dist)/d)*(path->p[i].x-path->p[i-1].x);
kees@6065
   336
            points[numPoints].y = path->p[i-1].y +
kees@6065
   337
                ((interval-dist)/d)*(path->p[i].y-path->p[i-1].y);
kees@6065
   338
            centroid.x += points[numPoints].x;
kees@6065
   339
            centroid.y += points[numPoints].y;
kees@6065
   340
            numPoints++;
kees@6065
   341
kees@6065
   342
            dist -= interval;
kees@6065
   343
        }
kees@6065
   344
        dist += d;
jim@4658
   345
    }
kees@6066
   346
    if (numPoints < DOLLARNPOINTS-1) {
kees@6065
   347
        SDL_SetError("ERROR: NumPoints = %i\n",numPoints);
kees@6065
   348
        return 0;
kees@6065
   349
    }
gabomdq@7662
   350
    /*copy the last point*/
kees@6065
   351
    points[DOLLARNPOINTS-1] = path->p[path->numPoints-1];
kees@6065
   352
    numPoints = DOLLARNPOINTS;
jim@4685
   353
kees@6065
   354
    centroid.x /= numPoints;
kees@6065
   355
    centroid.y /= numPoints;
jim@4658
   356
gabomdq@7662
   357
    /*printf("Centroid (%f,%f)",centroid.x,centroid.y);*/
gabomdq@7662
   358
    /*Rotate Points so point 0 is left of centroid and solve for the bounding box*/
kees@6065
   359
    xmin = centroid.x;
kees@6065
   360
    xmax = centroid.x;
kees@6065
   361
    ymin = centroid.y;
kees@6065
   362
    ymax = centroid.y;
jim@4658
   363
kees@6065
   364
    ang = (float)(SDL_atan2(centroid.y - points[0].y,
kees@6065
   365
                            centroid.x - points[0].x));
jim@4658
   366
kees@6066
   367
    for (i = 0; i<numPoints; i++) {
kees@6065
   368
        float px = points[i].x;
kees@6065
   369
        float py = points[i].y;
kees@6065
   370
        points[i].x = (float)((px - centroid.x)*SDL_cos(ang) -
kees@6065
   371
                              (py - centroid.y)*SDL_sin(ang) + centroid.x);
kees@6065
   372
        points[i].y = (float)((px - centroid.x)*SDL_sin(ang) +
kees@6065
   373
                              (py - centroid.y)*SDL_cos(ang) + centroid.y);
jim@4658
   374
jim@4658
   375
kees@6066
   376
        if (points[i].x < xmin) xmin = points[i].x;
kees@6066
   377
        if (points[i].x > xmax) xmax = points[i].x;
kees@6066
   378
        if (points[i].y < ymin) ymin = points[i].y;
kees@6066
   379
        if (points[i].y > ymax) ymax = points[i].y;
kees@6065
   380
    }
kees@6065
   381
gabomdq@7662
   382
    /*Scale points to DOLLARSIZE, and translate to the origin*/
kees@6065
   383
    w = xmax-xmin;
kees@6065
   384
    h = ymax-ymin;
kees@6065
   385
kees@6066
   386
    for (i=0; i<numPoints; i++) {
kees@6065
   387
        points[i].x = (points[i].x - centroid.x)*DOLLARSIZE/w;
kees@6065
   388
        points[i].y = (points[i].y - centroid.y)*DOLLARSIZE/h;
kees@6065
   389
    }
kees@6065
   390
    return numPoints;
jim@4658
   391
}
jim@4658
   392
icculus@6070
   393
static float dollarRecognize(const SDL_DollarPath *path,int *bestTempl,SDL_GestureTouch* touch)
kees@6065
   394
{
jorgen@7510
   395
    SDL_FloatPoint points[DOLLARNPOINTS];
kees@6065
   396
    int i;
kees@6065
   397
    float bestDiff = 10000;
icculus@5981
   398
jorgen@7510
   399
    SDL_memset(points, 0, sizeof(points));
jorgen@7510
   400
kees@6065
   401
    dollarNormalize(path,points);
kees@6065
   402
gabomdq@7662
   403
    /*PrintPath(points);*/
kees@6065
   404
    *bestTempl = -1;
kees@6066
   405
    for (i = 0; i < touch->numDollarTemplates; i++) {
kees@6065
   406
        float diff = bestDollarDifference(points,touch->dollarTemplate[i].path);
kees@6066
   407
        if (diff < bestDiff) {bestDiff = diff; *bestTempl = i;}
kees@6065
   408
    }
kees@6065
   409
    return bestDiff;
slouken@4663
   410
}
slouken@4663
   411
slouken@6951
   412
int SDL_GestureAddTouch(SDL_TouchID touchId)
kees@6065
   413
{
kees@6065
   414
    SDL_GestureTouch *gestureTouch = (SDL_GestureTouch *)SDL_realloc(SDL_gestureTouch,
kees@6065
   415
                                                                     (SDL_numGestureTouches + 1) *
kees@6065
   416
                                                                     sizeof(SDL_GestureTouch));
jim@4657
   417
kees@6066
   418
    if (!gestureTouch) {
icculus@7037
   419
        return SDL_OutOfMemory();
kees@6065
   420
    }
jim@4657
   421
kees@6065
   422
    SDL_gestureTouch = gestureTouch;
jim@4658
   423
kees@6065
   424
    SDL_gestureTouch[SDL_numGestureTouches].numDownFingers = 0;
slouken@6951
   425
    SDL_gestureTouch[SDL_numGestureTouches].id = touchId;
jim@4688
   426
kees@6065
   427
    SDL_gestureTouch[SDL_numGestureTouches].numDollarTemplates = 0;
jim@4688
   428
kees@6065
   429
    SDL_gestureTouch[SDL_numGestureTouches].recording = SDL_FALSE;
jim@4688
   430
kees@6065
   431
    SDL_numGestureTouches++;
kees@6065
   432
    return 0;
jim@4657
   433
}
jim@4657
   434
icculus@6070
   435
static SDL_GestureTouch * SDL_GetGestureTouch(SDL_TouchID id)
kees@6065
   436
{
kees@6065
   437
    int i;
kees@6066
   438
    for (i = 0; i < SDL_numGestureTouches; i++) {
gabomdq@7662
   439
        /*printf("%i ?= %i\n",SDL_gestureTouch[i].id,id);*/
kees@6066
   440
        if (SDL_gestureTouch[i].id == id)
kees@6066
   441
            return &SDL_gestureTouch[i];
kees@6065
   442
    }
kees@6065
   443
    return NULL;
jim@4657
   444
}
jim@4657
   445
kees@6065
   446
int SDL_SendGestureMulti(SDL_GestureTouch* touch,float dTheta,float dDist)
kees@6065
   447
{
kees@6065
   448
    SDL_Event event;
kees@6065
   449
    event.mgesture.type = SDL_MULTIGESTURE;
kees@6065
   450
    event.mgesture.touchId = touch->id;
kees@6065
   451
    event.mgesture.x = touch->centroid.x;
kees@6065
   452
    event.mgesture.y = touch->centroid.y;
kees@6065
   453
    event.mgesture.dTheta = dTheta;
kees@6065
   454
    event.mgesture.dDist = dDist;
kees@6065
   455
    event.mgesture.numFingers = touch->numDownFingers;
kees@6065
   456
    return SDL_PushEvent(&event) > 0;
jim@4657
   457
}
jim@4657
   458
slouken@6044
   459
static int SDL_SendGestureDollar(SDL_GestureTouch* touch,
kees@6065
   460
                          SDL_GestureID gestureId,float error)
kees@6065
   461
{
kees@6065
   462
    SDL_Event event;
kees@6065
   463
    event.dgesture.type = SDL_DOLLARGESTURE;
kees@6065
   464
    event.dgesture.touchId = touch->id;
kees@6065
   465
    event.mgesture.x = touch->centroid.x;
kees@6065
   466
    event.mgesture.y = touch->centroid.y;
kees@6065
   467
    event.dgesture.gestureId = gestureId;
kees@6065
   468
    event.dgesture.error = error;
gabomdq@7662
   469
    /*A finger came up to trigger this event.*/
kees@6065
   470
    event.dgesture.numFingers = touch->numDownFingers + 1;
kees@6065
   471
    return SDL_PushEvent(&event) > 0;
jim@4658
   472
}
jim@4658
   473
jim@4659
   474
icculus@6070
   475
static int SDL_SendDollarRecord(SDL_GestureTouch* touch,SDL_GestureID gestureId)
kees@6065
   476
{
kees@6065
   477
    SDL_Event event;
kees@6065
   478
    event.dgesture.type = SDL_DOLLARRECORD;
kees@6065
   479
    event.dgesture.touchId = touch->id;
kees@6065
   480
    event.dgesture.gestureId = gestureId;
kees@6065
   481
    return SDL_PushEvent(&event) > 0;
jim@4659
   482
}
jim@4659
   483
jim@4659
   484
jim@4657
   485
void SDL_GestureProcessEvent(SDL_Event* event)
jim@4657
   486
{
kees@6065
   487
    float x,y;
kees@6065
   488
    SDL_FloatPoint path[DOLLARNPOINTS];
kees@6065
   489
    int index;
kees@6065
   490
    int i;
kees@6065
   491
    float pathDx, pathDy;
kees@6065
   492
    SDL_FloatPoint lastP;
kees@6065
   493
    SDL_FloatPoint lastCentroid;
kees@6065
   494
    float lDist;
kees@6065
   495
    float Dist;
kees@6065
   496
    float dtheta;
kees@6065
   497
    float dDist;
aschiffler@4865
   498
kees@6066
   499
    if (event->type == SDL_FINGERMOTION ||
kees@6066
   500
        event->type == SDL_FINGERDOWN ||
kees@6066
   501
        event->type == SDL_FINGERUP) {
kees@6065
   502
        SDL_GestureTouch* inTouch = SDL_GetGestureTouch(event->tfinger.touchId);
jim@4683
   503
gabomdq@7662
   504
        /*Shouldn't be possible*/
kees@6066
   505
        if (inTouch == NULL) return;
jim@4658
   506
slouken@6951
   507
        x = event->tfinger.x;
slouken@6951
   508
        y = event->tfinger.y;
kees@6065
   509
gabomdq@7662
   510
        /*Finger Up*/
kees@6066
   511
        if (event->type == SDL_FINGERUP) {
kees@6065
   512
            inTouch->numDownFingers--;
jim@4688
   513
jim@4684
   514
#ifdef ENABLE_DOLLAR
kees@6066
   515
            if (inTouch->recording) {
kees@6065
   516
                inTouch->recording = SDL_FALSE;
kees@6065
   517
                dollarNormalize(&inTouch->dollarPath,path);
gabomdq@7662
   518
                /*PrintPath(path);*/
kees@6066
   519
                if (recordAll) {
kees@6065
   520
                    index = SDL_AddDollarGesture(NULL,path);
kees@6066
   521
                    for (i = 0; i < SDL_numGestureTouches; i++)
kees@6065
   522
                        SDL_gestureTouch[i].recording = SDL_FALSE;
kees@6065
   523
                }
kees@6065
   524
                else {
kees@6065
   525
                    index = SDL_AddDollarGesture(inTouch,path);
kees@6065
   526
                }
kees@6065
   527
kees@6066
   528
                if (index >= 0) {
kees@6065
   529
                    SDL_SendDollarRecord(inTouch,inTouch->dollarTemplate[index].hash);
kees@6065
   530
                }
kees@6065
   531
                else {
kees@6065
   532
                    SDL_SendDollarRecord(inTouch,-1);
kees@6065
   533
                }
kees@6065
   534
            }
kees@6065
   535
            else {
kees@6065
   536
                int bestTempl;
kees@6065
   537
                float error;
kees@6065
   538
                error = dollarRecognize(&inTouch->dollarPath,
kees@6065
   539
                                        &bestTempl,inTouch);
kees@6066
   540
                if (bestTempl >= 0){
gabomdq@7662
   541
                    /*Send Event*/
kees@6065
   542
                    unsigned long gestureId = inTouch->dollarTemplate[bestTempl].hash;
kees@6065
   543
                    SDL_SendGestureDollar(inTouch,gestureId,error);
gabomdq@7662
   544
                    /*printf ("%s\n",);("Dollar error: %f\n",error);*/
kees@6065
   545
                }
kees@6065
   546
            }
jim@4683
   547
#endif
gabomdq@7662
   548
            /*inTouch->gestureLast[j] = inTouch->gestureLast[inTouch->numDownFingers];*/
kees@6066
   549
            if (inTouch->numDownFingers > 0) {
kees@6065
   550
                inTouch->centroid.x = (inTouch->centroid.x*(inTouch->numDownFingers+1)-
kees@6065
   551
                                       x)/inTouch->numDownFingers;
kees@6065
   552
                inTouch->centroid.y = (inTouch->centroid.y*(inTouch->numDownFingers+1)-
kees@6065
   553
                                       y)/inTouch->numDownFingers;
kees@6065
   554
            }
kees@6065
   555
        }
kees@6066
   556
        else if (event->type == SDL_FINGERMOTION) {
slouken@6951
   557
            float dx = event->tfinger.dx;
slouken@6951
   558
            float dy = event->tfinger.dy;
kees@6065
   559
#ifdef ENABLE_DOLLAR
kees@6065
   560
            SDL_DollarPath* path = &inTouch->dollarPath;
kees@6066
   561
            if (path->numPoints < MAXPATHSIZE) {
kees@6065
   562
                path->p[path->numPoints].x = inTouch->centroid.x;
kees@6065
   563
                path->p[path->numPoints].y = inTouch->centroid.y;
kees@6065
   564
                pathDx =
kees@6065
   565
                    (path->p[path->numPoints].x-path->p[path->numPoints-1].x);
kees@6065
   566
                pathDy =
kees@6065
   567
                    (path->p[path->numPoints].y-path->p[path->numPoints-1].y);
kees@6065
   568
                path->length += (float)SDL_sqrt(pathDx*pathDx + pathDy*pathDy);
kees@6065
   569
                path->numPoints++;
kees@6065
   570
            }
kees@6065
   571
#endif
kees@6065
   572
            lastP.x = x - dx;
kees@6065
   573
            lastP.y = y - dy;
kees@6065
   574
            lastCentroid = inTouch->centroid;
kees@6065
   575
kees@6065
   576
            inTouch->centroid.x += dx/inTouch->numDownFingers;
kees@6065
   577
            inTouch->centroid.y += dy/inTouch->numDownFingers;
gabomdq@7662
   578
            /*printf("Centrid : (%f,%f)\n",inTouch->centroid.x,inTouch->centroid.y);*/
kees@6066
   579
            if (inTouch->numDownFingers > 1) {
gabomdq@7662
   580
                SDL_FloatPoint lv; /*Vector from centroid to last x,y position*/
gabomdq@7662
   581
                SDL_FloatPoint v; /*Vector from centroid to current x,y position*/
gabomdq@7662
   582
                /*lv = inTouch->gestureLast[j].cv;*/
kees@6065
   583
                lv.x = lastP.x - lastCentroid.x;
kees@6065
   584
                lv.y = lastP.y - lastCentroid.y;
kees@6065
   585
                lDist = (float)SDL_sqrt(lv.x*lv.x + lv.y*lv.y);
gabomdq@7662
   586
                /*printf("lDist = %f\n",lDist);*/
kees@6065
   587
                v.x = x - inTouch->centroid.x;
kees@6065
   588
                v.y = y - inTouch->centroid.y;
gabomdq@7662
   589
                /*inTouch->gestureLast[j].cv = v;*/
kees@6065
   590
                Dist = (float)SDL_sqrt(v.x*v.x+v.y*v.y);
gabomdq@7662
   591
                /* SDL_cos(dTheta) = (v . lv)/(|v| * |lv|)*/
kees@6065
   592
gabomdq@7662
   593
                /*Normalize Vectors to simplify angle calculation*/
kees@6065
   594
                lv.x/=lDist;
kees@6065
   595
                lv.y/=lDist;
kees@6065
   596
                v.x/=Dist;
kees@6065
   597
                v.y/=Dist;
kees@6065
   598
                dtheta = (float)SDL_atan2(lv.x*v.y - lv.y*v.x,lv.x*v.x + lv.y*v.y);
kees@6065
   599
kees@6065
   600
                dDist = (Dist - lDist);
gabomdq@7662
   601
                if (lDist == 0) {dDist = 0;dtheta = 0;} /*To avoid impossible values*/
kees@6065
   602
gabomdq@7662
   603
                /*inTouch->gestureLast[j].dDist = dDist;
gabomdq@7662
   604
                inTouch->gestureLast[j].dtheta = dtheta;
kees@6065
   605
gabomdq@7662
   606
                printf("dDist = %f, dTheta = %f\n",dDist,dtheta);
gabomdq@7662
   607
                gdtheta = gdtheta*.9 + dtheta*.1;
gabomdq@7662
   608
                gdDist  =  gdDist*.9 +  dDist*.1
gabomdq@7662
   609
                knob.r += dDist/numDownFingers;
gabomdq@7662
   610
                knob.ang += dtheta;
gabomdq@7662
   611
                printf("thetaSum = %f, distSum = %f\n",gdtheta,gdDist);
gabomdq@7662
   612
                printf("id: %i dTheta = %f, dDist = %f\n",j,dtheta,dDist);*/
kees@6065
   613
                SDL_SendGestureMulti(inTouch,dtheta,dDist);
kees@6065
   614
            }
kees@6065
   615
            else {
gabomdq@7662
   616
                /*inTouch->gestureLast[j].dDist = 0;
gabomdq@7662
   617
                inTouch->gestureLast[j].dtheta = 0;
gabomdq@7662
   618
                inTouch->gestureLast[j].cv.x = 0;
gabomdq@7662
   619
                inTouch->gestureLast[j].cv.y = 0;*/
kees@6065
   620
            }
gabomdq@7662
   621
            /*inTouch->gestureLast[j].f.p.x = x;
gabomdq@7662
   622
            inTouch->gestureLast[j].f.p.y = y;
gabomdq@7662
   623
            break;
gabomdq@7662
   624
            pressure?*/
kees@6065
   625
        }
kees@6065
   626
kees@6066
   627
        if (event->type == SDL_FINGERDOWN) {
kees@6065
   628
kees@6065
   629
            inTouch->numDownFingers++;
kees@6065
   630
            inTouch->centroid.x = (inTouch->centroid.x*(inTouch->numDownFingers - 1)+
kees@6065
   631
                                   x)/inTouch->numDownFingers;
kees@6065
   632
            inTouch->centroid.y = (inTouch->centroid.y*(inTouch->numDownFingers - 1)+
kees@6065
   633
                                   y)/inTouch->numDownFingers;
gabomdq@7662
   634
            /*printf("Finger Down: (%f,%f). Centroid: (%f,%f\n",x,y,
gabomdq@7662
   635
                 inTouch->centroid.x,inTouch->centroid.y);*/
kees@6065
   636
kees@6065
   637
#ifdef ENABLE_DOLLAR
kees@6065
   638
            inTouch->dollarPath.length = 0;
kees@6065
   639
            inTouch->dollarPath.p[0].x = x;
kees@6065
   640
            inTouch->dollarPath.p[0].y = y;
kees@6065
   641
            inTouch->dollarPath.numPoints = 1;
kees@6065
   642
#endif
kees@6065
   643
        }
jim@4657
   644
    }
jim@4683
   645
}
jim@4683
   646
kees@6065
   647
/* vi: set ts=4 sw=4 expandtab: */