Subversion Repositories Projects

#include "bluetooth_handler.h"

int bt_device_count=0;

char names[MAX_BT_DEVICES][248];
char addrs[MAX_BT_DEVICES][19];

char BtHostRxBuffer[150];


int scan_bt()
{
  inquiry_info *ii = NULL;

  int dev_id, sock, len, flags;
  int i;
  char addr[19] = { 0 };
  char name[248] = { 0 };
 
  dev_id = hci_get_route(NULL);
  sock = hci_open_dev( dev_id );
  if (dev_id < 0 || sock < 0) {
    perror("opening socket");
    return 0;
  }

  len  = 8;
 
  flags = IREQ_CACHE_FLUSH;
  ii = (inquiry_info*)malloc(MAX_BT_DEVICES * sizeof(inquiry_info));
 
  bt_device_count = hci_inquiry(dev_id, len, MAX_BT_DEVICES, NULL, &ii, flags);
  if(  bt_device_count < 0 ) perror("hci_inquiry");
 
  for (i = 0; i <  bt_device_count; i++) {
    ba2str(&(ii+i)->bdaddr, addr);
    sprintf(addrs[i],"%s",addr);

    memset(name, 0, sizeof(name));
   
    if (hci_read_remote_name(sock, &(ii+i)->bdaddr, sizeof(name),
                             name, 0) < 0)
      sprintf(names[i],"[unknown]");
    else
      sprintf(names[i],"%s",name);

  }

 
  free( ii );
  close( sock );
  return 1;
}

//struct timeval timeout;
fd_set readfds, writefds;
int s;
struct sockaddr_rc loc_addr = { 0 }, rem_addr = { 0 };
char buf[1024] = { 0 };
int  client, bytes_read, status;
unsigned int opt = sizeof(rem_addr);

int maxfd, sock_flags;



int bt_host_init()
{
 
  // allocate socket
  s = socket(AF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
 
  // bind socket to port 1 of the first available bluetooth adapter
  loc_addr.rc_family = AF_BLUETOOTH;
  loc_addr.rc_bdaddr = *BDADDR_ANY;
  loc_addr.rc_channel = 1;
  bind(s, (struct sockaddr *)&loc_addr, sizeof(loc_addr));
 
  // put server socket into listening mode
  listen(s, 1);
 
  // put server socket into nonblocking mode
  sock_flags = fcntl( s, F_GETFL, 0 );
  fcntl( s, F_SETFL, sock_flags | O_NONBLOCK );

  return 1;
}


int bt_host_connected=0;

int bt_host_send(char RxBuffer[150],int len)
{
  if (bt_host_connected)
    {
      send(client,"\r",1,0);
      send(client,RxBuffer,len,0);
      send(client,"\r",1,0);
    }
  return 1;
}

int bt_host_tick(int mk_fd)
{

  // try to accept connection if none yet
  if (!bt_host_connected)
  {
    //    timeout.tv_sec = 0;
    // timeout.tv_usec = 100;
    FD_ZERO(&readfds);
    FD_ZERO(&writefds);
    FD_SET(s, &readfds);
    maxfd = s;
   
    printf("waiting for connection\n");
    //    status = select(maxfd + 1, &readfds, &writefds, 0, &timeout);
    status = select(maxfd + 1, &readfds, &writefds, 0,& (struct timeval) { 0, 100 });
    if( status > 0 && FD_ISSET( s, &readfds ) ) {
      // incoming connection
      client = accept( s, (struct sockaddr*)&rem_addr, &opt );
      if( client >= 0 )
        {
          bt_host_connected=1;

          // close the server socket, leaving only the client socket open
          //      close(s);
 
         
          ba2str( &rem_addr.rc_bdaddr, buf );
          fprintf(stderr, "accepted connection from %s!!!!!!!\n", buf);
          memset(buf, 0, sizeof(buf));
         
          // put client socket into nonblocking mode
          sock_flags = fcntl( client, F_GETFL, 0 );
          fcntl( client, F_SETFL, sock_flags | O_NONBLOCK );
        }
       
    }

  }
  else
    {
      printf("reading from bt_host");
      char in_char='#';
      int count=0;
      int r=0;

      //      timeout.tv_sec = 0;
      //timeout.tv_usec = 100;
      FD_ZERO(&readfds);
      FD_ZERO(&writefds);
      FD_SET(client, &readfds);
      maxfd = client;
     
      printf("waiting for connection\n");
      //status = select(maxfd + 1, &readfds, 0, 0, &timeout);
      if( status >0 )
        {
          send(mk_fd,"\r",1,0);
          while(in_char!='\r')
            {
       
              count=read(client,&in_char,1);
              if (count==-1)  
                {
                  bt_host_connected=0;
                  return 0;    
                }
              printf("count: %d in  %d chr %c\n",count,in_char,in_char);
              send(mk_fd,&in_char,1,0);
              BtHostRxBuffer[r]=in_char;
            }
          send(mk_fd,"\r",1,0);
        }
          else
        return 0;
    }
 
  return 1;    
}