src2/bt_hw.c

   1 /*
   2 *  C Implementation: bt_hw
   3 *
   4 * Description: hardweare function for sockets
   5 *
   6 *
   7 * Author: root <root@ubuntu>, (C) 2008
   8 *
   9 * Copyright: See COPYING file that comes with this distribution
  10 *
  11 */
  12
  13 #include <sys/socket.h>
  14 #include <stdio.h>
  15 #include <stdlib.h>
  16 #include <sys/ioctl.h>
  17 #include <errno.h>
  18 #include <string.h>
  19 #include <fcntl.h>
  20 #include <unistd.h>
  21 #include <stdint.h>
  22 #include "bt_hw.h"
  23 #include "hciembeded.h"
  24
  25 static int hw_dd; /*TODO: this is only for one socket connection */
  26
  27 int hw_bt_open_device(__u8 dev_id)
  28 {
  29         struct sockaddr_hci address;
  30         int dd;
  31         int oldflag;
  32         int err;
  33
  34         if ((dd = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI)) < 0) {
  35                 perror("socket no created");
  36                 return dd; /*it return -1 when socket isn't created*/
  37         }
  38
  39         oldflag = fcntl(dd, F_GETFL, 0);
  40         if (fcntl(dd, F_SETFL, oldflag | O_NONBLOCK) < 0) {
  41                 perror("problem with socket flag setting");
  42                 err = -1;
  43                 goto close_socket;
  44         }
  45
  46         memset(&address, 0, sizeof(address));
  47         address.hci_family = AF_BLUETOOTH;
  48         address.hci_dev = dev_id;
  49         if (bind(dd, (struct sockaddr *) &address, sizeof(address)) < 0) {
  50                 perror("Socket not binded to hci device");
  51                 err = -1;
  52                 goto close_socket;
  53         }
  54
  55         if(ioctl(dd, HCISETRAW, 1) < 0) {
  56                 perror("error in ioctl HCISETRAW");
  57                 err = -1;
  58                 goto close_socket;
  59         }
  60
  61         hw_dd = dd;
  62         return dd;
  63 close_socket:
  64         close(dd);
  65         return err;
  66 }
  67
  68 int hw_bt_close_dev()
  69 {
  70         while (close(hw_dd) < 0) {
  71                 perror("file closing interrupted\n");
  72                 if (errno == EINTR || errno == EIO)
  73                         continue;
  74                 return -1;
  75         }
  76         return 0;
  77 }
  78
  79 int hw_bt_write(__u8 *p_array, __u16 length)
  80 {
  81         while (write(hw_dd, p_array, length) < 0) {
  82                 perror("write interrupted");
  83                 if (errno == EAGAIN || errno == EINTR)
  84                         continue;
  85                 return -1;
  86
  87         }
  88         return 0;
  89 }
  90
  91 int hw_bt_read(__u8 *p_recbuf)
  92 {
  93         int len;
  94
  95         while ((len = read(hw_dd, p_recbuf,
  96                          sizeof(p_recbuf) * HCI_MAX_EVENT_SIZE)) < 0) {
  97                 if (errno == EINTR)
  98                         continue;
  99                 if (errno == EAGAIN)
 100                         return 0;
 101                 perror("Problem with reading\n");
 102                         return -1;
 103         }
 104         return len;
 105 }
 106