File: tilt_leapmotion.cpp

package info (click to toggle)
neverball 1.6.0%2Bgit20180603-2
  • links: PTS, VCS
  • area: main
  • in suites: buster
  • size: 152,384 kB
  • sloc: ansic: 27,402; makefile: 454; cpp: 208; xml: 177; sh: 161
file content (109 lines) | stat: -rw-r--r-- 2,429 bytes parent folder | download | duplicates (2)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
/*
 * Copyright (C) 2003 Robert Kooima
 *
 * NEVERBALL is  free software; you can redistribute  it and/or modify
 * it under the  terms of the GNU General  Public License as published
 * by the Free  Software Foundation; either version 2  of the License,
 * or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT  ANY  WARRANTY;  without   even  the  implied  warranty  of
 * MERCHANTABILITY or  FITNESS FOR A PARTICULAR PURPOSE.   See the GNU
 * General Public License for more details.
 */

extern "C" {
#include "config.h"
}

#include <Leap.h>

using namespace Leap;

static Controller leapctrl;

extern "C" {

void tilt_init(void)
{
    // nothing to do
}

void tilt_free(void)
{
    // nothing to do
}

int tilt_stat(void)
{
    return leapctrl.isConnected();
}

int tilt_get_button(int *b, int *s)
{
    static bool btn_l1 = 0;
    static bool btn_r1 = 0;
    static bool btn_start = 0;

    HandList hands = leapctrl.frame().hands();
    Hand hand;
    Finger thumb;
    float angle;
    bool cond;

    if (!tilt_stat() || hands.count() != 1)
    {
        return 0;
    }

    hand = hands.frontmost();
    thumb = hand.fingers().fingerType(Finger::TYPE_THUMB)[0];
    angle = hand.direction().angleTo(thumb.direction()) * 180.0f / 3.14159f;

    if ((cond = (angle < 20.0f && hand.isRight()) ||
                (angle > 55.0f && hand.isLeft())) != btn_l1)
    {
        *b = config_get_d(CONFIG_JOYSTICK_BUTTON_L1);
        return (*s = btn_l1 = cond) + 1;
    }
    else if ((cond = (angle > 55.0f && hand.isRight()) ||
                     (angle < 20.0f && hand.isLeft())) != btn_r1)
    {
        *b = config_get_d(CONFIG_JOYSTICK_BUTTON_R1);
        return (*s = btn_r1 = cond) + 1;
    }
    else if ((cond = hand.grabStrength() == 1.0f) != btn_start)
    {
        *b = config_get_d(CONFIG_JOYSTICK_BUTTON_START);
        return (*s = btn_start = cond) + 1;
    }

    return 0;
}

float tilt_get_x(void)
{
    HandList hands = leapctrl.frame().hands();

    if (!tilt_stat() || hands.count() != 1)
    {
        return 0.0f;
    }

    return -hands.frontmost().direction().pitch() * 180.0f / 3.14159f + 10.0f;
}

float tilt_get_z(void)
{
    HandList hands = leapctrl.frame().hands();

    if (!tilt_stat() || hands.count() != 1)
    {
        return 0.0f;
    }

    return -hands.frontmost().palmNormal().roll() * 180.0f / 3.14159f;
}

}