Statistics
| Branch: | Tag: | Revision:

amiro-os / components / bluetooth / bluetooth-connector.cpp @ 58fe0e0b

History | View | Annotate | Download (2.79 KB)

1
#include <ch.hpp>
2
#include <hal.h>
3

    
4
#include <string.h>
5
#include <chprintf.h>
6

    
7
#include <amiro/bluetooth/bluetooth-connector.hpp>
8
#include <amiro/bluetooth/bluetooth-serial.hpp>
9
#include <amiro/bluetooth/bluetooth-wiimote.hpp>
10

    
11
using namespace chibios_rt;
12
using namespace amiro;
13

    
14
/*
15
 * Class constructor
16
 */
17
BluetoothConnector::BluetoothConnector(BLUETOOTH *bluetooth, void *bluetoothDev, const char *typeConn) {
18
  iwrap = &(bluetooth->iwrap);
19
  objDev = bluetoothDev;
20
  typeDev = typeConn;
21
}
22

    
23
//----------------------------------------------------------------
24

    
25

    
26
void BluetoothConnector::bluetoothConnectorListen(const char *addr) {
27
  BluetoothProfile profile;
28
  profile.addr = (strstr(addr, "ALL")) ? "free" : addr;
29
  profile.connector = this;
30
  profile.connect = &BluetoothConnector::bluetoothConnectorActivate;
31
  profile.disconnect = &BluetoothConnector::bluetoothConnectorDeactivate;
32
  profile.linkid = 0xFF;
33

    
34
  /* Listen all address can have only one profile at the last profile,
35
     otherwise a fixed address will take it at first */
36
  if (strstr(addr, "ALL") && (iwrap->profiles[7].addr == NULL)) {
37
    iwrap->profiles[7] = profile;
38
    return;
39
  }
40

    
41
  for(int i = 0; i < 8; i++) {
42
    if(iwrap->profiles[i].addr == NULL) {
43
      iwrap->profiles[i] = profile;
44
      break;
45
    }
46
  }
47
}
48

    
49
void BluetoothConnector::bluetoothConnectorConnect(const char *addr) {
50
  int size = strlen(addr) + 17;
51
  char cmd[size];
52
  strcpy(cmd, "CALL ");
53
  strcat(cmd, addr);
54

    
55
  for (int i = 0; i < 8; i++) {
56
    if (strstr(iwrap->profiles[i].addr, addr) && (iwrap->profiles[i].linkid == 0xFF)) {
57
      switch (typeDev[0]) {
58
      case 'S':           // 'S' for "SERIAL"
59
        strcat(cmd, " 1101 RFCOMM");
60
        break;
61
      case 'W':           // 'W' for "WIIMOTE"
62
        strcat(cmd, " 0013 L2CAP ");
63
        break;
64
      }
65
      iwrap->bluetoothIwrapSendCommand(cmd);
66
      BaseThread::sleep(MS2ST(5000));    // waiting connection establish
67
      break;
68
    }
69
  }
70
}
71

    
72
void BluetoothConnector::bluetoothConnectorDisconnect(const char *addr) {
73
  char cmd[8];
74
  strcpy(cmd, "CLOSE ");
75

    
76
  for (int i = 0; i < 8; i++) {
77
    if (strstr(iwrap->profiles[i].addr, addr) && (iwrap->profiles[i].linkid != 0xFF)) {
78
      cmd[6] = iwrap->profiles[i].linkid + 0x30;
79
      cmd[7]= '\0';
80
      iwrap->bluetoothIwrapSendCommand(cmd);
81
      BaseThread::sleep(MS2ST(2000));    // waiting disconnection
82
      break;
83
    }
84
  }
85
}
86

    
87
void BluetoothConnector::bluetoothConnectorActivate(uint8_t linkid) {
88
  if (strstr(typeDev, "SERIAL"))
89
    ((BluetoothSerial *) objDev)->bluetoothSerialStart(linkid);
90
  else
91
    ((BluetoothWiimote *) objDev)->bluetoothWiimoteStart(linkid);
92
}
93

    
94
void BluetoothConnector::bluetoothConnectorDeactivate() {
95
  if (strstr(typeDev, "SERIAL"))
96
    ((BluetoothSerial *) objDev)->bluetoothSerialStop();
97
  else
98
    ((BluetoothWiimote *) objDev)->bluetoothWiimoteStop();
99
}