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