Statistics
| Branch: | Tag: | Revision:

amiro-os / components / bluetooth / bluetooth-iwrap.cpp @ f3972840

History | View | Annotate | Download (4.871 KB)

1 58fe0e0b Thomas Schöpping
#include <ch.hpp>
2
#include <hal.h>
3
4
#include <string.h>
5
6
#include <amiro/bluetooth/bluetooth-iwrap.hpp>
7
#include <amiro/bluetooth/bluetooth-connector.hpp>
8
9 f8cf404d Thomas Schöpping
#include <global.hpp>
10
11 58fe0e0b Thomas Schöpping
using namespace chibios_rt;
12
using namespace amiro;
13
14 f8cf404d Thomas Schöpping
extern Global global;
15
16 58fe0e0b Thomas Schöpping
/*
17
 * Class constructor
18
 */
19
BluetoothIwrap::BluetoothIwrap(UARTDriver* uart) :
20
  BaseStaticThread<128>(), transport(uart), profiles{},
21
  mailbox(mailboxBuffer, BLUETOOTH_IWRAP_MAILBOX_SIZE), connAddr{0} {
22
  iwrapblock = 0;
23
}
24
25
//----------------------------------------------------------------
26
27
msg_t BluetoothIwrap::main(void) {
28
  setName("BluetoothIwrap");
29
30
  // To set the receive mailbox[9] for plain communication (WT12->host)
31
  transport.bluetoothTransportSetReceiveMailbox(HOST_IWRAP_PLAIN_LINKID, &this->mailbox);
32
33
  transport.start(NORMALPRIO);
34
35
  while (!this->shouldTerminate()) {
36
    iwrapReceive();
37
  }
38
  return RDY_OK;
39
}
40
41
/*
42
 * Member functions
43
 */
44
msg_t BluetoothIwrap::iwrapReceive() {
45
  BluetoothDescriptor* descriptor = NULL;
46
  const char* buffer;
47
  size_t length;
48
  msg_t msg;
49
50
  msg = mailbox.fetch((msg_t*) &descriptor, TIME_INFINITE);
51
  if (msg == RDY_RESET)
52
    return RDY_RESET;
53
54
  buffer = (const char*)descriptor->bluetoothDescriptorGetPayload();
55
  length = descriptor->bluetoothDescriptorGetPayloadLength();
56
57
  for (size_t i = 0; i < length; i++) {
58
    // print out received chars
59 f8cf404d Thomas Schöpping
    chSequentialStreamPut((BaseSequentialStream*) &global.sercanmux1, buffer[i]);
60 58fe0e0b Thomas Schöpping
  }
61
62
  // reset block
63
  iwrapblock = 0;
64
65
  // if RING or CONNECT event is received, then look for profile with correct MAC-address and connect.
66
  if (strstr(buffer, "CONNECT ") && (strstr(buffer, " RFCOMM 1") || strstr(buffer, " L2CAP 1"))) {
67
  // if CONNECT event serial RFCOMM 1 or wiimote (control) L2CAP 11 or wiimote (data) L2CAP 13
68
    for (int i = 0; i < 8; i++) {
69
      if ((profiles[i].addr != NULL) && strstr(connAddr, profiles[i].addr)) {
70
        BluetoothProfile* bp =  &(profiles[i]);
71
        bp->linkid = buffer[8] - '0';     // look for linkid and convert linkid to int
72
        (((BluetoothConnector*)(bp->connector))->*(bp->connect))(bp->linkid);
73
        break;
74
      }
75
    }
76
  } else if (strstr(buffer, "RING") && strstr(buffer, "1 RFCOMM ")) {
77
  // if RING event (be called by other device) in 1 RFCOMM mode
78
    for (int i = 0; i < 8; i++) {
79
      if ((profiles[i].addr != NULL) && (strstr(buffer, profiles[i].addr) || strstr(profiles[i].addr, "free"))) {
80
        BluetoothProfile* bp =  &(profiles[i]);
81
        bp->linkid  = buffer[5] - '0';    // look for linkid and convert linkid to int
82
        (((BluetoothConnector*)(bp->connector))->*(bp->connect))(bp->linkid );
83
        break;
84
      }
85
    }
86
  } else if (strstr(buffer, "NO CARRIER ") && strstr(buffer, "ERROR ")) {
87
  // if NO CARRIER ERROR 0 event, then look for profile and disconnect
88
    uint8_t linkid = buffer[11] - '0';
89
    for (int i = 0; i < 8; i++) {
90
      if ((profiles[i].addr != NULL) && (profiles[i].linkid == linkid)) {
91
        BluetoothProfile* bp =  &(profiles[i]);
92
        bp->linkid = 0xFF;
93
        (((BluetoothConnector*)(bp->connector))->*(bp->disconnect))();
94
        break;
95
      }
96
    }
97
  }
98
99
  msg = (transport.bluetoothTransportGetStorageMailbox())->post((msg_t) descriptor, TIME_INFINITE);
100
  if (msg == RDY_RESET)
101
    return RDY_RESET;
102
103
  return RDY_OK;
104
}
105
106
msg_t BluetoothIwrap::iwrapTransmit(uint8_t linkid, const uint8_t* txdata, size_t length) {
107
  BluetoothDescriptor* descriptor = NULL;
108
  uint8_t *buffer;
109
  msg_t msg;
110
111
  msg = transport.bluetoothTransportGetStorageMailbox()->fetch((msg_t*) &descriptor, TIME_INFINITE);
112
  if (msg == RDY_RESET)
113
    return RDY_RESET;
114
115
  buffer = descriptor->bluetoothDescriptorGetPayload();
116
  memcpy(buffer, txdata, length);
117
118
  descriptor->bluetoothDescriptorSetLinkId(linkid);
119
  descriptor->bluetoothDescriptorSetPayloadLength(length);
120
121
  msg = transport.bluetoothTransportGetTransmitMailbox()->post((msg_t) descriptor, TIME_INFINITE);
122
  if (msg == RDY_RESET)
123
    return RDY_RESET;
124
125
  return RDY_OK;
126
}
127
128
void BluetoothIwrap::bluetoothIwrapSendCommand(const char* cmd) {
129
  // Wait until another previous command finished.
130
  while(iwrapblock == 1) {
131
    BaseThread::sleep(MS2ST(500));
132
  }
133
134
  iwrapblock = 1;
135
136
  if (strstr(cmd, "CALL ") && (strstr(cmd, " RFCOMM") || strstr(cmd, " L2CAP"))) {
137
    memcpy(connAddr, cmd+5, 17);
138
  }
139
140
  size_t length = strlen(cmd);
141
//  for (size_t i = 0; i < length; i++)
142 f8cf404d Thomas Schöpping
//    chSequentialStreamPut((BaseSequentialStream*) &global.sercanmux1, cmd[i]);   // To display the command
143 58fe0e0b Thomas Schöpping
144
  // To send the string command to WT12 bluetooth chip
145
  iwrapTransmit(HOST_IWRAP_PLAIN_LINKID,(uint8_t*) cmd, length);
146
147
  // Clear iwrapblock flag because these commands don't return an answer
148
  if(strstr(cmd, "SET BT NAME") || strstr(cmd, "SET BT AUTH") || strstr(cmd, "SET BT SSP")
149
    || strstr(cmd, "SET BT PAGEMODE") || strstr(cmd, "SET BT PAIR *")
150
    || strstr(cmd, "SET CONTROL MUX") || (strstr(cmd, "SET") && strlen(cmd) == 3)) {
151
    iwrapblock = 0;
152
  }
153
154
  BaseThread::sleep(MS2ST(500));
155
}