Show
Ignore:
Timestamp:
02/19/10 03:08:49 (2 years ago)
Author:
L. Donnie Smith <donnie.smith@…>
git-author:
L. Donnie Smith <donnie.smith@gatech.edu> / 2010-02-18T21:58:52Z-0500
Parents:
b54bd057fe6b258d6e0a99047f839891ab3bc2df
Children:
fadf11e89b579bcc0336a0692ac15c93785f3f82
git-committer:
L. Donnie Smith <donnie.smith@gatech.edu> / 2010-02-18T22:08:49Z-0500
Message:

Basic support for cwiid_listen

Location:
libcwiid
Files:
3 modified

Legend:

Unmodified
Added
Removed

  • libcwiid/connect.c

    r89233ec r1a6f467  
    3434cwiid_wiimote_t *cwiid_open(bdaddr_t *bdaddr, int flags) 
    3535{ 
    36         return cwiid_open_timeout(bdaddr, flags, 5); 
     36        return cwiid_open_timeout(bdaddr, flags, DEFAULT_TIMEOUT); 
    3737} 
    3838 
    3939cwiid_wiimote_t *cwiid_open_timeout(bdaddr_t *bdaddr, int flags, int timeout) 
    4040{ 
     41        struct sockaddr_l2 remote_addr; 
     42        int ctl_socket = -1, int_socket = -1; 
    4143        struct wiimote *wiimote = NULL; 
    42         struct sockaddr_l2 remote_addr; 
    43         char mesg_pipe_init = 0, status_pipe_init = 0, rw_pipe_init = 0, 
    44              state_mutex_init = 0, rw_mutex_init = 0, rpt_mutex_init = 0, 
    45              router_thread_init = 0, status_thread_init = 0; 
    46         void *pthread_ret; 
    47  
    48         /* Allocate wiimote */ 
    49         if ((wiimote = malloc(sizeof *wiimote)) == NULL) { 
    50                 cwiid_err(NULL, "Memory allocation error (cwiid_wiimote_t)"); 
    51                 goto ERR_HND; 
    52         } 
    53  
    54         /* set flags */ 
    55         wiimote->flags = flags; 
    56  
    57         /* For error detection */ 
    58         wiimote->ctl_socket = wiimote->int_socket = -1; 
    59  
    60         /* Global Lock, Store and Increment wiimote_id */ 
    61         if (pthread_mutex_lock(&global_mutex)) { 
    62                 cwiid_err(NULL, "Mutex lock error (global mutex)"); 
    63                 goto ERR_HND; 
    64         } 
    65         wiimote->id = wiimote_id++; 
    66         if (pthread_mutex_unlock(&global_mutex)) { 
    67                 cwiid_err(wiimote, "Mutex unlock error (global mutex) - " 
    68                                    "deadlock warning"); 
    69                 goto ERR_HND; 
    70         } 
    7144 
    7245        /* If BDADDR_ANY is given, find available wiimote */ 
    … …  
    8457        remote_addr.l2_bdaddr = *bdaddr; 
    8558        remote_addr.l2_psm = htobs(CTL_PSM); 
    86         if ((wiimote->ctl_socket = 
     59        if ((ctl_socket = 
    8760          socket(AF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_L2CAP)) == -1) { 
    88                 cwiid_err(wiimote, "Socket creation error (control socket)"); 
    89                 goto ERR_HND; 
    90         } 
    91         if (connect(wiimote->ctl_socket, (struct sockaddr *)&remote_addr, 
     61                cwiid_err(NULL, "Socket creation error (control socket)"); 
     62                goto ERR_HND; 
     63        } 
     64        if (connect(ctl_socket, (struct sockaddr *)&remote_addr, 
    9265                        sizeof remote_addr)) { 
    93                 cwiid_err(wiimote, "Socket connect error (control channel)"); 
     66                cwiid_err(NULL, "Socket connect error (control socket)"); 
    9467                goto ERR_HND; 
    9568        } 
    … …  
    9770        /* Interrupt Channel */ 
    9871        remote_addr.l2_psm = htobs(INT_PSM); 
    99         if ((wiimote->int_socket = 
     72        if ((int_socket = 
    10073          socket(AF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_L2CAP)) == -1) { 
    101                 cwiid_err(wiimote, "Socket creation error (interrupt socket)"); 
    102                 goto ERR_HND; 
    103         } 
    104         if (connect(wiimote->int_socket, (struct sockaddr *)&remote_addr, 
     74                cwiid_err(NULL, "Socket creation error (interrupt socket)"); 
     75                goto ERR_HND; 
     76        } 
     77        if (connect(int_socket, (struct sockaddr *)&remote_addr, 
    10578                        sizeof remote_addr)) { 
    106                 cwiid_err(wiimote, "Socket connect error (interrupt channel)"); 
     79                cwiid_err(NULL, "Socket connect error (interrupt socket)"); 
     80                goto ERR_HND; 
     81        } 
     82 
     83        if ((wiimote = cwiid_new(ctl_socket, int_socket, flags)) == NULL) { 
     84                /* Raises its own error */ 
     85                goto ERR_HND; 
     86        } 
     87 
     88        return wiimote; 
     89 
     90ERR_HND: 
     91        /* Close Sockets */ 
     92        if (ctl_socket != -1) { 
     93                if (close(ctl_socket)) { 
     94                        cwiid_err(NULL, "Socket close error (control socket)"); 
     95                } 
     96        } 
     97        if (int_socket != -1) { 
     98                if (close(int_socket)) { 
     99                        cwiid_err(NULL, "Socket close error (interrupt socket)"); 
     100                } 
     101        } 
     102        return NULL; 
     103} 
     104 
     105cwiid_wiimote_t *cwiid_listen(int flags) 
     106{ 
     107        struct sockaddr_l2 local_addr; 
     108        struct sockaddr_l2 remote_addr; 
     109        socklen_t socklen; 
     110        int ctl_server_socket = -1, int_server_socket = -1, 
     111            ctl_socket = -1, int_socket = -1; 
     112        struct wiimote *wiimote = NULL; 
     113 
     114        /* Connect to Wiimote */ 
     115        /* Control Channel */ 
     116        memset(&local_addr, 0, sizeof local_addr); 
     117        local_addr.l2_family = AF_BLUETOOTH; 
     118        local_addr.l2_bdaddr = *BDADDR_ANY; 
     119        local_addr.l2_psm = htobs(CTL_PSM); 
     120        if ((ctl_server_socket = 
     121          socket(AF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_L2CAP)) == -1) { 
     122                cwiid_err(NULL, "Socket creation error (control socket)"); 
     123                goto ERR_HND; 
     124        } 
     125        if (bind(ctl_server_socket, (struct sockaddr *)&local_addr, 
     126                 sizeof local_addr)) { 
     127                cwiid_err(NULL, "Socket bind error (control socket)"); 
     128                goto ERR_HND; 
     129        } 
     130        if (listen(ctl_server_socket, 1)) { 
     131                cwiid_err(NULL, "Socket listen error (control socket)"); 
     132                goto ERR_HND; 
     133        } 
     134 
     135        /* Interrupt Channel */ 
     136        local_addr.l2_psm = htobs(INT_PSM); 
     137        if ((int_server_socket = 
     138          socket(AF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_L2CAP)) == -1) { 
     139                cwiid_err(NULL, "Socket creation error (interrupt socket)"); 
     140                goto ERR_HND; 
     141        } 
     142        if (bind(int_server_socket, (struct sockaddr *)&local_addr, 
     143                 sizeof local_addr)) { 
     144                cwiid_err(NULL, "Socket bind error (interrupt socket)"); 
     145                goto ERR_HND; 
     146        } 
     147        if (listen(int_server_socket, 1)) { 
     148                cwiid_err(NULL, "Socket listen error (interrupt socket)"); 
     149                goto ERR_HND; 
     150        } 
     151 
     152        /* Block for Connections */ 
     153        if ((ctl_socket = accept(ctl_server_socket, (struct sockaddr *)&remote_addr, &socklen)) < 0) { 
     154                cwiid_err(NULL, "Socket accept error (control socket)"); 
     155                goto ERR_HND; 
     156        } 
     157        if ((int_socket = accept(int_server_socket, (struct sockaddr *)&remote_addr, &socklen)) < 0) { 
     158                cwiid_err(NULL, "Socket accept error (interrupt socket)"); 
     159                goto ERR_HND; 
     160        } 
     161 
     162        /* Close server sockets */ 
     163        if (close(ctl_server_socket)) { 
     164                cwiid_err(NULL, "Socket close error (control socket)"); 
     165        } 
     166        if (close(int_server_socket)) { 
     167                cwiid_err(NULL, "Socket close error (interrupt socket)"); 
     168        } 
     169 
     170        if ((wiimote = cwiid_new(ctl_socket, int_socket, flags)) == NULL) { 
     171                /* Raises its own error */ 
     172                goto ERR_HND; 
     173        } 
     174 
     175        return wiimote; 
     176 
     177ERR_HND: 
     178        /* Close Sockets */ 
     179        if (ctl_server_socket != -1) { 
     180                if (close(ctl_server_socket)) { 
     181                        cwiid_err(NULL, "Socket close error (control server socket)"); 
     182                } 
     183        } 
     184        if (int_server_socket != -1) { 
     185                if (close(int_server_socket)) { 
     186                        cwiid_err(NULL, "Socket close error (interrupt server socket)"); 
     187                } 
     188        } 
     189        if (ctl_socket != -1) { 
     190                if (close(ctl_socket)) { 
     191                        cwiid_err(NULL, "Socket close error (control socket)"); 
     192                } 
     193        } 
     194        if (int_socket != -1) { 
     195                if (close(int_socket)) { 
     196                        cwiid_err(NULL, "Socket close error (interrupt socket)"); 
     197                } 
     198        } 
     199 
     200        return NULL; 
     201} 
     202 
     203cwiid_wiimote_t *cwiid_new(int ctl_socket, int int_socket, int flags) 
     204{ 
     205        struct wiimote *wiimote = NULL; 
     206        char mesg_pipe_init = 0, status_pipe_init = 0, rw_pipe_init = 0, 
     207             state_mutex_init = 0, rw_mutex_init = 0, rpt_mutex_init = 0, 
     208             router_thread_init = 0, status_thread_init = 0; 
     209        void *pthread_ret; 
     210 
     211        /* Allocate wiimote */ 
     212        if ((wiimote = malloc(sizeof *wiimote)) == NULL) { 
     213                cwiid_err(NULL, "Memory allocation error (cwiid_wiimote_t)"); 
     214                goto ERR_HND; 
     215        } 
     216 
     217        /* set sockets and flags */ 
     218        wiimote->ctl_socket = ctl_socket; 
     219        wiimote->int_socket = int_socket; 
     220        wiimote->flags = flags; 
     221 
     222        /* Global Lock, Store and Increment wiimote_id */ 
     223        if (pthread_mutex_lock(&global_mutex)) { 
     224                cwiid_err(NULL, "Mutex lock error (global mutex)"); 
     225                goto ERR_HND; 
     226        } 
     227        wiimote->id = wiimote_id++; 
     228        if (pthread_mutex_unlock(&global_mutex)) { 
     229                cwiid_err(wiimote, "Mutex unlock error (global mutex) - " 
     230                                   "deadlock warning"); 
    107231                goto ERR_HND; 
    108232        } 
    … …  
    157281        wiimote->rw_status = RW_IDLE; 
    158282 
    159         /* Launch interrupt channel listener and dispatch threads */ 
     283        /* Launch interrupt socket listener and dispatch threads */ 
    160284        if (pthread_create(&wiimote->router_thread, NULL, 
    161285                           (void *(*)(void *))&router_thread, wiimote)) { 
    … …  
    203327                } 
    204328 
    205                 /* Close Sockets */ 
    206                 if (wiimote->int_socket != -1) { 
    207                         if (close(wiimote->int_socket)) { 
    208                                 cwiid_err(wiimote, "Socket close error (interrupt channel)"); 
    209                         } 
    210                 } 
    211                 if (wiimote->ctl_socket != -1) { 
    212                         if (close(wiimote->ctl_socket)) { 
    213                                 cwiid_err(wiimote, "Socket close error (control channel)"); 
    214                         } 
    215                 } 
    216329                /* Close Pipes */ 
    217330                if (mesg_pipe_init) { 
    … …  
    297410        /* Close sockets */ 
    298411        if (close(wiimote->int_socket)) { 
    299                 cwiid_err(wiimote, "Socket close error (interrupt channel)"); 
     412                cwiid_err(wiimote, "Socket close error (interrupt socket)"); 
    300413        } 
    301414        if (close(wiimote->ctl_socket)) { 
    302                 cwiid_err(wiimote, "Socket close error (control channel)"); 
     415                cwiid_err(wiimote, "Socket close error (control socket)"); 
    303416        } 
    304417        /* Close Pipes */ 

  • libcwiid/cwiid.h

    r9c5e978 r1a6f467  
    324324cwiid_wiimote_t *cwiid_open(bdaddr_t *bdaddr, int flags); 
    325325cwiid_wiimote_t *cwiid_open_timeout(bdaddr_t *bdaddr, int flags, int timeout); 
     326cwiid_wiimote_t *cwiid_listen(int flags); 
    326327int cwiid_close(cwiid_wiimote_t *wiimote); 
    327328 

  • libcwiid/cwiid_internal.h

    rb54bd05 r1a6f467  
    2424#include <sys/types.h>  /* ssize_t */ 
    2525#include "cwiid.h" 
     26 
     27#define DEFAULT_TIMEOUT 5 
    2628 
    2729/* Bluetooth magic numbers */ 
    … …  
    175177 
    176178/* prototypes */ 
     179cwiid_wiimote_t *cwiid_new(int ctl_socket, int int_socket, int flags); 
     180 
    177181/* thread.c */ 
    178182void *router_thread(struct wiimote *wiimote);