bugfix

[minwii.git] / src / pywiiuse / pygame_wiimouse.py

diff --git a/src/pywiiuse/pygame_wiimouse.py b/src/pywiiuse/pygame_wiimouse.py
index 2c5911c..3328eff 100755 (executable)
--- a/src/pywiiuse/pygame_wiimouse.py
+++ b/src/pywiiuse/pygame_wiimouse.py
@@ -22,11 +22,16 @@ class wiimote_thread(Thread):
         self.queue = Queue()
         self.startup = Queue()
         self.nmotes = nmotes
         self.queue = Queue()
         self.startup = Queue()
         self.nmotes = nmotes

+        self.selectedWiimoteIndex = 0

         self.timeout = timeout
         self.setDaemon(1)
         self._paused = False
         self.start()
         self.startup.get(True) # wait for the thread to get started and acquire the motes
         self.timeout = timeout
         self.setDaemon(1)
         self._paused = False
         self.start()
         self.startup.get(True) # wait for the thread to get started and acquire the motes

+        self.eventCallBack = _default_event_cb
+    
+    def setEventCallBack(self, func) :
+        self.eventCallBack = func

 
     def run(self):
         '''This runs in a separate thread'''
 
     def run(self):
         '''This runs in a separate thread'''


@@ -48,25 +53,18 @@ class wiimote_thread(Thread):
             if self._paused : continue
             try :
                 if wiiuse.poll(self.wiimotes, self.nmotes) :
             if self._paused : continue
             try :
                 if wiiuse.poll(self.wiimotes, self.nmotes) :

-                    for i in range(self.nmotes):
+                    for i in range(self.nmotes) :

                         m = self.wiimotes[i]
                         if m[0].event == wiiuse.EVENT:
                         m = self.wiimotes[i]
                         if m[0].event == wiiuse.EVENT:

-                            self.event_cb(m)
-            except :
-                pass
+                            self.eventCallBack(self, i, m)
+            except Exception, e:
+                print e

                 
                 

-            #try:
-            #    wiiuse.poll(self.wiimotes, self.nmotes)
-            #except:
-            #    pass
-
-            # allow executing functions in this thread

             while True:
                 try:
                     func, args = self.queue.get_nowait()
                 except Empty:
                     break
             while True:
                 try:
                     func, args = self.queue.get_nowait()
                 except Empty:
                     break

-                print 'do:', func.__name__, args

                 func(*args)
     
     def pause(self) :
                 func(*args)
     
     def pause(self) :


@@ -74,15 +72,13 @@ class wiimote_thread(Thread):
     
     def resume(self) :
         self._paused = False
     
     def resume(self) :
         self._paused = False

+    
+    def selectWiimote(self, wiimoteIndex) :
+        self.selectedWiimoteIndex = wiimoteIndex

 
     def do(self, func, *args):
         '''Run the function in the thread handling the wiimote'''
 
     def do(self, func, *args):
         '''Run the function in the thread handling the wiimote'''

-        self.queue.put((func, args))
-
-    def event_cb(self, wmp):
-        '''Called when the library has some data for the user.'''
-        wm = wmp[0]
-        pygame.mouse.set_pos((wm.ir.x, wm.ir.y))
+        self.queue.put((func, args))                    

 
     def control_cb(self, wmp, attachment, speaker, ir, led, battery):
         '''Could check the battery level and such here'''
 
     def control_cb(self, wmp, attachment, speaker, ir, led, battery):
         '''Could check the battery level and such here'''


@@ -106,18 +102,104 @@ class wiimote_thread(Thread):
             wiiuse.disconnect(self.wiimotes[i])
         self.go = False
 
             wiiuse.disconnect(self.wiimotes[i])
         self.go = False
 

+    def get_count(self):
+        return self.actual_nmotes
+
+
+def _default_event_cb(self, id, wmp):
+    ''' default callback that emulate a one button mouse '''
+    if id != self.selectedWiimoteIndex : return
+    wm = wmp[0]
+    pos = (wm.ir.x, wm.ir.y)
+    pygame.mouse.set_pos(pos)
+
+    eventType = None
+
+    if wm.btns and \
+        wiiuse.is_just_pressed(wm, wiiuse.button['B']) :
+            event = pygame.event.Event(pygame.MOUSEBUTTONDOWN,
+                                       pos = pos,
+                                       button = 1)
+            pygame.event.post(event)
+
+    if wm.btns_released and \
+        wiiuse.is_released(wm, wiiuse.button['B']):
+            event = pygame.event.Event(pygame.MOUSEBUTTONUP,
+                                       pos = pos,
+                                       button = 1)
+            pygame.event.post(event)
+
+def _full_mouse_event_cb(self, id, wmp):
+    ''' callback that emulate a 2 buttons mouse with wheel '''
+    if id != self.selectedWiimoteIndex : return
+    wm = wmp[0]
+    pos = (wm.ir.x, wm.ir.y)
+    pygame.mouse.set_pos(pos)
+
+    eventType = None
+
+    if wm.btns :
+        button = 0
+        if wiiuse.is_just_pressed(wm, wiiuse.button['B']) :
+            button = 1
+        elif wiiuse.is_just_pressed(wm, wiiuse.button['A']) :
+            button = 2
+        elif wiiuse.is_just_pressed(wm, wiiuse.button['Up']) :
+            button = 4
+        elif wiiuse.is_just_pressed(wm, wiiuse.button['Down']) :
+            button = 5
+
+        if button :
+            event = pygame.event.Event(pygame.MOUSEBUTTONDOWN,
+                                       pos = pos,
+                                       button = button)
+            pygame.event.post(event)
+
+    if wm.btns_released :
+        button = 0
+        if wiiuse.is_released(wm, wiiuse.button['B']) :
+            button = 1
+        elif wiiuse.is_released(wm, wiiuse.button['A']) :
+            button = 2
+        elif wiiuse.is_released(wm, wiiuse.button['Up']) :
+            button = 4
+        elif wiiuse.is_released(wm, wiiuse.button['Down']) :
+            button = 5
+        
+        if button :
+            event = pygame.event.Event(pygame.MOUSEBUTTONUP,
+                                       pos = pos,
+                                       button = button)
+            pygame.event.post(event)
+
+

 WT = None
 
 WT = None
 

-def init(nmotes, timeout):
+def init(nmotes, timeout, screenResolution=(660, 370), position='ABOVE'):

     '''Initialize the module.'''
     global WT
     if WT:
         return
     WT = wiimote_thread(nmotes, timeout)
     '''Initialize the module.'''
     global WT
     if WT:
         return
     WT = wiimote_thread(nmotes, timeout)

+    
+    if position == 'ABOVE' :
+        position = wiiuse.IR_ABOVE
+    elif position == 'BELOW' :
+        position = wiiuse.IR_BELOW
+    else :
+        position = wiiuse.IR_ABOVE
+    
+    
+    nmotes = get_count()
+    for i in range(nmotes) :
+        wm = Wiimote(i) # access the wiimote object
+        wm.enable_accels(0) # turn off acceleration reporting
+        wm.enable_ir(1, vres = screenResolution, position=position)
+

 
 def get_count():
     '''How many Wiimotes were found?'''
 
 def get_count():
     '''How many Wiimotes were found?'''

-    return WT.actual_nmotes
+    return WT.get_count()

 
 def quit():
     '''Gracefully shutdown the connection and turn off the wiimote leds'''
 
 def quit():
     '''Gracefully shutdown the connection and turn off the wiimote leds'''


@@ -169,7 +251,6 @@ class wiimote(object):
                 enable |= wiiuse.ORIENT_THRESH
             else:
                 disable |= wiiuse.ORIENT_THRESH
                 enable |= wiiuse.ORIENT_THRESH
             else:
                 disable |= wiiuse.ORIENT_THRESH

-        print enable, disable

         WT.do(wiiuse.set_flags, self.wm, enable, disable)
 
     def set_orient_thresh(self, thresh):
         WT.do(wiiuse.set_flags, self.wm, enable, disable)
 
     def set_orient_thresh(self, thresh):