-
Notifications
You must be signed in to change notification settings - Fork 0
/
macmote.py
310 lines (253 loc) · 8.75 KB
/
macmote.py
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
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
from __future__ import with_statement
# {{{ MultitouchSupport
import time
import ctypes
import threading
from ctypes.util import find_library
CFArrayRef = ctypes.c_void_p
CFMutableArrayRef = ctypes.c_void_p
CFIndex = ctypes.c_long
MultitouchSupport = ctypes.CDLL("/System/Library/PrivateFrameworks/MultitouchSupport.framework/MultitouchSupport")
CFArrayGetCount = MultitouchSupport.CFArrayGetCount
CFArrayGetCount.argtypes = [CFArrayRef]
CFArrayGetCount.restype = CFIndex
CFArrayGetValueAtIndex = MultitouchSupport.CFArrayGetValueAtIndex
CFArrayGetValueAtIndex.argtypes = [CFArrayRef, CFIndex]
CFArrayGetValueAtIndex.restype = ctypes.c_void_p
MTDeviceCreateList = MultitouchSupport.MTDeviceCreateList
MTDeviceCreateList.argtypes = []
MTDeviceCreateList.restype = CFMutableArrayRef
class MTPoint(ctypes.Structure):
_fields_ = [("x", ctypes.c_float),
("y", ctypes.c_float)]
class MTVector(ctypes.Structure):
_fields_ = [("position", MTPoint),
("velocity", MTPoint)]
class MTData(ctypes.Structure):
_fields_ = [
("frame", ctypes.c_int),
("timestamp", ctypes.c_double),
("identifier", ctypes.c_int),
("state", ctypes.c_int), # Current state (of unknown meaning).
("unknown1", ctypes.c_int),
("unknown2", ctypes.c_int),
("normalized", MTVector), # Normalized position and vector of
# the touch (0 to 1).
("size", ctypes.c_float), # The area of the touch.
("unknown3", ctypes.c_int),
# The following three define the ellipsoid of a finger.
("angle", ctypes.c_float),
("major_axis", ctypes.c_float),
("minor_axis", ctypes.c_float),
("unknown4", MTVector),
("unknown5_1", ctypes.c_int),
("unknown5_2", ctypes.c_int),
("unknown6", ctypes.c_float),
]
MTDataRef = ctypes.POINTER(MTData)
MTContactCallbackFunction = ctypes.CFUNCTYPE(ctypes.c_int, ctypes.c_int, MTDataRef,
ctypes.c_int, ctypes.c_double, ctypes.c_int)
MTDeviceRef = ctypes.c_void_p
MTRegisterContactFrameCallback = MultitouchSupport.MTRegisterContactFrameCallback
MTRegisterContactFrameCallback.argtypes = [MTDeviceRef, MTContactCallbackFunction]
MTRegisterContactFrameCallback.restype = None
MTDeviceStart = MultitouchSupport.MTDeviceStart
MTDeviceStart.argtypes = [MTDeviceRef, ctypes.c_int]
MTDeviceStart.restype = None
MTDeviceStop = MultitouchSupport.MTDeviceStop
MTDeviceStop.argtypes = [MTDeviceRef]
#MTDeviceStop.restype = None
def _cfarray_to_list(arr):
rv = []
n = CFArrayGetCount(arr)
for i in xrange(n):
rv.append(CFArrayGetValueAtIndex(arr, i))
return rv
# }}}
from Queue import Queue
touches_lock = threading.Lock()
touches = []
def init_multitouch(cb):
devices = _cfarray_to_list(MultitouchSupport.MTDeviceCreateList())
for device in devices:
MTRegisterContactFrameCallback(device, cb)
MTDeviceStart(device, 0)
return devices
def stop_multitouch(devices):
for device in devices:
MTDeviceStop(device)
@MTContactCallbackFunction
def touch_callback(device, data_ptr, n_fingers, timestamp, frame):
fingers = []
for i in xrange(n_fingers):
fingers.append(data_ptr[i])
touches[:] = [(frame, timestamp, fingers)]
return 0
import pygame
from pygame import draw, display, mouse
from pygame.locals import *
from numpy import *
pygame.init()
#n_samples = 22050 * 4
#sa = zeros((n_samples, 2))
#sound = sndarray.make_sound(sa)
#sa = sndarray.samples(sound)
#sound.play(-1)
devs = init_multitouch(touch_callback)
flags = FULLSCREEN | HWSURFACE | DOUBLEBUF
mode = max(display.list_modes(0, flags))
display.set_mode(mode, flags)
#display.set_mode((640, 480))
screen = display.get_surface()
width, height = screen.get_size()
txtfont = pygame.font.SysFont(None, 40)
mouse.set_visible(False)
fingers = []
start = None
prevtime = None
df = 0
curpos = (0, 0)
curvel = (0, 0)
from xbmc_client import DummyClient
ws = DummyClient('ws://bh:9090/', protocols=['http-only', 'chat'])
ws.connect()
print 'Connected'
prevspeed = 0
volume = 0
ppsent = False
yvel = None
while True:
if touches:
frame, timestamp, fingers = touches.pop()
#print frame, timestamp
screen.fill((0xef, 0xef, 0xef))
draw.line(screen, (0, 0, 0), (620, 0), (620, height), 4)
draw.line(screen, (0, 0, 0), (540, height/2+20), (540, height/2-20), 4)
draw.line(screen, (0, 0, 0), (700, height/2+20), (700, height/2-20), 4)
draw.line(screen, (0, 0, 0), (840, height/2+20), (840, height/2-20), 4)
draw.line(screen, (0, 0, 0), (400, height/2+20), (400, height/2-20), 4)
draw.line(screen, (0, 0, 0), (980, height/2+20), (980, height/2-20), 4)
draw.line(screen, (0, 0, 0), (280, height/2+20), (280, height/2-20), 4)
draw.line(screen, (0, 0, 0), (600, height/2-100), (640, height/2-100), 4)
draw.line(screen, (0, 0, 0), (600, height/2-200), (640, height/2-200), 4)
draw.line(screen, (0, 0, 0), (600, height/2-300), (640, height/2-300), 4)
draw.line(screen, (0, 0, 0), (600, height/2), (640, height/2), 4)
draw.line(screen, (0, 0, 0), (600, height/2+100), (640, height/2+100), 4)
draw.line(screen, (0, 0, 0), (600, height/2+200), (640, height/2+200), 4)
draw.line(screen, (0, 0, 0), (600, height/2+300), (640, height/2+300), 4)
event = pygame.event.poll()
if event.type == pygame.QUIT or (event.type == KEYDOWN and event.key == K_ESCAPE):
ws.close()
print 'Exiting'
break
prev = None
for i, finger in enumerate(fingers):
pos = finger.normalized.position
vel = finger.normalized.velocity
x = int(pos.x * width)
y = int((1 - pos.y) * height)
p = (x, y)
r = int(finger.size * 10)
if i == 0:
curpos = p
curvel = (vel.x, vel.y)
if prev:
draw.line(screen, (0xd0, 0xd0, 0xd0), p, prev[0], 3)
draw.circle(screen, 0, prev[0], prev[1], 0)
if prev:
draw.line(screen, (0xd0, 0xd0, 0xd0), p, prev[0], 3)
draw.circle(screen, 0, prev[0], prev[1], 0)
prev = p, r
draw.circle(screen, 0, p, r, 0)
vx = vel.x
vy = -vel.y
posvx = x + vx / 10 * width
posvy = y + vy / 10 * height
draw.line(screen, 0, p, (posvx, posvy))
# EXIT! One finger still, four motioning quickly downward.
end = time.time()
if start: df = end - start
if len(fingers) == 1:
if not start: start = time.time()
elif len(fingers) == 5:
n_still = 0
n_down = 0
for i, finger in enumerate(fingers):
vel = finger.normalized.velocity
t = 0.1
if -t <= vel.x < t and -t <= vel.y < t:
n_still += 1
elif -2 <= vel.x < 2 and vel.y < -4:
n_down += 1
if n_still == 1 and n_down == 4:
break
else:
start = None
ppsent = False
df = 0
if df > 0 and df <= 0.1875:
if not ppsent:
ws.play_pause()
ppsent = True
elif df > 0.1875:
if curvel[0] > 0.15 or curvel[0] < -0.15:
if curpos[0] <= 280:
if prevspeed != -16:
ws.set_speed(-16)
prevspeed = -16
elif curpos[0] > 280 and curpos[0] <= 400:
if prevspeed != -8:
ws.set_speed(-8)
prevspeed = -8
elif curpos[0] > 400 and curpos[0] <= 540:
if prevspeed != -4:
ws.set_speed(-4)
prevspeed = -4
elif curpos[0] > 540 and curpos[0] <= 700:
if prevspeed != 1:
ws.set_speed(1)
prevspeed = 1
elif curpos[0] > 700 and curpos[0] <= 840:
if prevspeed != 4:
ws.set_speed(4)
prevspeed = 4
elif curpos[0] > 840 and curpos[0] <= 980:
if prevspeed != 8:
ws.set_speed(8)
prevspeed = 8
elif curpos[0] > 980:
if prevspeed != 16:
ws.set_speed(16)
prevspeed = 16
if curpos[1] > 20:
if not prevtime: prevtime = time.time()
curtime = time.time() - prevtime
if curtime > 0.1:
if volume <=100: volume += 1
ws.set_volume(volume)
prevtime = time.time()
if not start: start = time.time()
elif len(fingers) == 5:
n_still = 0
n_down = 0
for i, finger in enumerate(fingers):
vel = finger.normalized.velocity
t = 0.1
if -t <= vel.x < t and -t <= vel.y < t:
n_still += 1
elif -2 <= vel.x < 2 and vel.y < -4:
n_down += 1
if n_still == 1 and n_down == 4:
break
else:
end = time.time()
if start: df = end - start
start = None
if df >= 0.1875:
ws.play_pause()
label = txtfont.render(str(df), 1, (0, 0, 0))
screen.blit(label, (100,100))
else:
pass
display.flip()
stop_multitouch(devs)