Zoltan Hudak / UsbHostMAX3421E

MAX3421E-based USB Host Shield Library

Dependents:   UsbHostMAX3421E_Hello

SPP.cpp@0:84353c479782, 2020-07-12 (annotated)

Committer:
hudakz
Date:
Sun Jul 12 20:39:26 2020 +0000
Revision:
0:84353c479782
MAX3421E-based USB Host Shield Library

Who changed what in which revision?

UserRevisionLine numberNew contents of line
hudakz 0:84353c479782 1 /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved.
hudakz 0:84353c479782 2
hudakz 0:84353c479782 3 This software may be distributed and modified under the terms of the GNU
hudakz 0:84353c479782 4 General Public License version 2 (GPL2) as published by the Free Software
hudakz 0:84353c479782 5 Foundation and appearing in the file GPL2.TXT included in the packaging of
hudakz 0:84353c479782 6 this file. Please note that GPL2 Section 2[b] requires that all works based
hudakz 0:84353c479782 7 on this software must also be made publicly available under the terms of
hudakz 0:84353c479782 8 the GPL2 ("Copyleft").
hudakz 0:84353c479782 9
hudakz 0:84353c479782 10 Contact information
hudakz 0:84353c479782 11 -------------------
hudakz 0:84353c479782 12
hudakz 0:84353c479782 13 Kristian Lauszus, TKJ Electronics
hudakz 0:84353c479782 14 Web : http://www.tkjelectronics.com
hudakz 0:84353c479782 15 e-mail : kristianl@tkjelectronics.com
hudakz 0:84353c479782 16 */
hudakz 0:84353c479782 17
hudakz 0:84353c479782 18 #include "SPP.h"
hudakz 0:84353c479782 19 // To enable serial debugging see "settings.h"
hudakz 0:84353c479782 20 //#define EXTRADEBUG // Uncomment to get even more debugging data
hudakz 0:84353c479782 21 //#define PRINTREPORT // Uncomment to print the report sent to the Arduino
hudakz 0:84353c479782 22
hudakz 0:84353c479782 23 /*
hudakz 0:84353c479782 24 * CRC (reversed crc) lookup table as calculated by the table generator in ETSI TS 101 369 V6.3.0.
hudakz 0:84353c479782 25 */
hudakz 0:84353c479782 26 const uint8_t rfcomm_crc_table[256] PROGMEM = {/* reversed, 8-bit, poly=0x07 */
hudakz 0:84353c479782 27 0x00, 0x91, 0xE3, 0x72, 0x07, 0x96, 0xE4, 0x75, 0x0E, 0x9F, 0xED, 0x7C, 0x09, 0x98, 0xEA, 0x7B,
hudakz 0:84353c479782 28 0x1C, 0x8D, 0xFF, 0x6E, 0x1B, 0x8A, 0xF8, 0x69, 0x12, 0x83, 0xF1, 0x60, 0x15, 0x84, 0xF6, 0x67,
hudakz 0:84353c479782 29 0x38, 0xA9, 0xDB, 0x4A, 0x3F, 0xAE, 0xDC, 0x4D, 0x36, 0xA7, 0xD5, 0x44, 0x31, 0xA0, 0xD2, 0x43,
hudakz 0:84353c479782 30 0x24, 0xB5, 0xC7, 0x56, 0x23, 0xB2, 0xC0, 0x51, 0x2A, 0xBB, 0xC9, 0x58, 0x2D, 0xBC, 0xCE, 0x5F,
hudakz 0:84353c479782 31 0x70, 0xE1, 0x93, 0x02, 0x77, 0xE6, 0x94, 0x05, 0x7E, 0xEF, 0x9D, 0x0C, 0x79, 0xE8, 0x9A, 0x0B,
hudakz 0:84353c479782 32 0x6C, 0xFD, 0x8F, 0x1E, 0x6B, 0xFA, 0x88, 0x19, 0x62, 0xF3, 0x81, 0x10, 0x65, 0xF4, 0x86, 0x17,
hudakz 0:84353c479782 33 0x48, 0xD9, 0xAB, 0x3A, 0x4F, 0xDE, 0xAC, 0x3D, 0x46, 0xD7, 0xA5, 0x34, 0x41, 0xD0, 0xA2, 0x33,
hudakz 0:84353c479782 34 0x54, 0xC5, 0xB7, 0x26, 0x53, 0xC2, 0xB0, 0x21, 0x5A, 0xCB, 0xB9, 0x28, 0x5D, 0xCC, 0xBE, 0x2F,
hudakz 0:84353c479782 35 0xE0, 0x71, 0x03, 0x92, 0xE7, 0x76, 0x04, 0x95, 0xEE, 0x7F, 0x0D, 0x9C, 0xE9, 0x78, 0x0A, 0x9B,
hudakz 0:84353c479782 36 0xFC, 0x6D, 0x1F, 0x8E, 0xFB, 0x6A, 0x18, 0x89, 0xF2, 0x63, 0x11, 0x80, 0xF5, 0x64, 0x16, 0x87,
hudakz 0:84353c479782 37 0xD8, 0x49, 0x3B, 0xAA, 0xDF, 0x4E, 0x3C, 0xAD, 0xD6, 0x47, 0x35, 0xA4, 0xD1, 0x40, 0x32, 0xA3,
hudakz 0:84353c479782 38 0xC4, 0x55, 0x27, 0xB6, 0xC3, 0x52, 0x20, 0xB1, 0xCA, 0x5B, 0x29, 0xB8, 0xCD, 0x5C, 0x2E, 0xBF,
hudakz 0:84353c479782 39 0x90, 0x01, 0x73, 0xE2, 0x97, 0x06, 0x74, 0xE5, 0x9E, 0x0F, 0x7D, 0xEC, 0x99, 0x08, 0x7A, 0xEB,
hudakz 0:84353c479782 40 0x8C, 0x1D, 0x6F, 0xFE, 0x8B, 0x1A, 0x68, 0xF9, 0x82, 0x13, 0x61, 0xF0, 0x85, 0x14, 0x66, 0xF7,
hudakz 0:84353c479782 41 0xA8, 0x39, 0x4B, 0xDA, 0xAF, 0x3E, 0x4C, 0xDD, 0xA6, 0x37, 0x45, 0xD4, 0xA1, 0x30, 0x42, 0xD3,
hudakz 0:84353c479782 42 0xB4, 0x25, 0x57, 0xC6, 0xB3, 0x22, 0x50, 0xC1, 0xBA, 0x2B, 0x59, 0xC8, 0xBD, 0x2C, 0x5E, 0xCF
hudakz 0:84353c479782 43 };
hudakz 0:84353c479782 44
hudakz 0:84353c479782 45 SPP::SPP(BTD *p, const char* name, const char* pin) :
hudakz 0:84353c479782 46 BluetoothService(p) // Pointer to BTD class instance - mandatory
hudakz 0:84353c479782 47 {
hudakz 0:84353c479782 48 pBtd->btdName = name;
hudakz 0:84353c479782 49 pBtd->btdPin = pin;
hudakz 0:84353c479782 50
hudakz 0:84353c479782 51 /* Set device cid for the SDP and RFCOMM channelse */
hudakz 0:84353c479782 52 sdp_dcid[0] = 0x50; // 0x0050
hudakz 0:84353c479782 53 sdp_dcid[1] = 0x00;
hudakz 0:84353c479782 54 rfcomm_dcid[0] = 0x51; // 0x0051
hudakz 0:84353c479782 55 rfcomm_dcid[1] = 0x00;
hudakz 0:84353c479782 56
hudakz 0:84353c479782 57 Reset();
hudakz 0:84353c479782 58 }
hudakz 0:84353c479782 59
hudakz 0:84353c479782 60 void SPP::Reset() {
hudakz 0:84353c479782 61 connected = false;
hudakz 0:84353c479782 62 RFCOMMConnected = false;
hudakz 0:84353c479782 63 SDPConnected = false;
hudakz 0:84353c479782 64 waitForLastCommand = false;
hudakz 0:84353c479782 65 l2cap_sdp_state = L2CAP_SDP_WAIT;
hudakz 0:84353c479782 66 l2cap_rfcomm_state = L2CAP_RFCOMM_WAIT;
hudakz 0:84353c479782 67 l2cap_event_flag = 0;
hudakz 0:84353c479782 68 sppIndex = 0;
hudakz 0:84353c479782 69 creditSent = false;
hudakz 0:84353c479782 70 }
hudakz 0:84353c479782 71
hudakz 0:84353c479782 72 void SPP::disconnect() {
hudakz 0:84353c479782 73 connected = false;
hudakz 0:84353c479782 74 // First the two L2CAP channels has to be disconnected and then the HCI connection
hudakz 0:84353c479782 75 if(RFCOMMConnected)
hudakz 0:84353c479782 76 pBtd->l2cap_disconnection_request(hci_handle, ++identifier, rfcomm_scid, rfcomm_dcid);
hudakz 0:84353c479782 77 if(RFCOMMConnected && SDPConnected)
hudakz 0:84353c479782 78 wait_ms(1); // Add delay between commands
hudakz 0:84353c479782 79 if(SDPConnected)
hudakz 0:84353c479782 80 pBtd->l2cap_disconnection_request(hci_handle, ++identifier, sdp_scid, sdp_dcid);
hudakz 0:84353c479782 81 l2cap_sdp_state = L2CAP_DISCONNECT_RESPONSE;
hudakz 0:84353c479782 82 }
hudakz 0:84353c479782 83
hudakz 0:84353c479782 84 void SPP::ACLData(uint8_t* l2capinbuf) {
hudakz 0:84353c479782 85 if(!connected) {
hudakz 0:84353c479782 86 if(l2capinbuf[8] == L2CAP_CMD_CONNECTION_REQUEST) {
hudakz 0:84353c479782 87 if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == SDP_PSM && !pBtd->sdpConnectionClaimed) {
hudakz 0:84353c479782 88 pBtd->sdpConnectionClaimed = true;
hudakz 0:84353c479782 89 hci_handle = pBtd->hci_handle; // Store the HCI Handle for the connection
hudakz 0:84353c479782 90 l2cap_sdp_state = L2CAP_SDP_WAIT; // Reset state
hudakz 0:84353c479782 91 } else if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == RFCOMM_PSM && !pBtd->rfcommConnectionClaimed) {
hudakz 0:84353c479782 92 pBtd->rfcommConnectionClaimed = true;
hudakz 0:84353c479782 93 hci_handle = pBtd->hci_handle; // Store the HCI Handle for the connection
hudakz 0:84353c479782 94 l2cap_rfcomm_state = L2CAP_RFCOMM_WAIT; // Reset state
hudakz 0:84353c479782 95 }
hudakz 0:84353c479782 96 }
hudakz 0:84353c479782 97 }
hudakz 0:84353c479782 98
hudakz 0:84353c479782 99 if(checkHciHandle(l2capinbuf, hci_handle)) { // acl_handle_ok
hudakz 0:84353c479782 100 if((l2capinbuf[6] | (l2capinbuf[7] << 8)) == 0x0001U) { // l2cap_control - Channel ID for ACL-U
hudakz 0:84353c479782 101 if(l2capinbuf[8] == L2CAP_CMD_COMMAND_REJECT) {
hudakz 0:84353c479782 102 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 103 Notify(PSTR("\r\nL2CAP Command Rejected - Reason: "), 0x80);
hudakz 0:84353c479782 104 D_PrintHex<uint8_t > (l2capinbuf[13], 0x80);
hudakz 0:84353c479782 105 Notify(PSTR(" "), 0x80);
hudakz 0:84353c479782 106 D_PrintHex<uint8_t > (l2capinbuf[12], 0x80);
hudakz 0:84353c479782 107 Notify(PSTR(" Data: "), 0x80);
hudakz 0:84353c479782 108 D_PrintHex<uint8_t > (l2capinbuf[17], 0x80);
hudakz 0:84353c479782 109 Notify(PSTR(" "), 0x80);
hudakz 0:84353c479782 110 D_PrintHex<uint8_t > (l2capinbuf[16], 0x80);
hudakz 0:84353c479782 111 Notify(PSTR(" "), 0x80);
hudakz 0:84353c479782 112 D_PrintHex<uint8_t > (l2capinbuf[15], 0x80);
hudakz 0:84353c479782 113 Notify(PSTR(" "), 0x80);
hudakz 0:84353c479782 114 D_PrintHex<uint8_t > (l2capinbuf[14], 0x80);
hudakz 0:84353c479782 115 #endif
hudakz 0:84353c479782 116 } else if(l2capinbuf[8] == L2CAP_CMD_CONNECTION_REQUEST) {
hudakz 0:84353c479782 117 #ifdef EXTRADEBUG
hudakz 0:84353c479782 118 Notify(PSTR("\r\nL2CAP Connection Request - PSM: "), 0x80);
hudakz 0:84353c479782 119 D_PrintHex<uint8_t > (l2capinbuf[13], 0x80);
hudakz 0:84353c479782 120 Notify(PSTR(" "), 0x80);
hudakz 0:84353c479782 121 D_PrintHex<uint8_t > (l2capinbuf[12], 0x80);
hudakz 0:84353c479782 122 Notify(PSTR(" SCID: "), 0x80);
hudakz 0:84353c479782 123 D_PrintHex<uint8_t > (l2capinbuf[15], 0x80);
hudakz 0:84353c479782 124 Notify(PSTR(" "), 0x80);
hudakz 0:84353c479782 125 D_PrintHex<uint8_t > (l2capinbuf[14], 0x80);
hudakz 0:84353c479782 126 Notify(PSTR(" Identifier: "), 0x80);
hudakz 0:84353c479782 127 D_PrintHex<uint8_t > (l2capinbuf[9], 0x80);
hudakz 0:84353c479782 128 #endif
hudakz 0:84353c479782 129 if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == SDP_PSM) { // It doesn't matter if it receives another reqeust, since it waits for the channel to disconnect in the L2CAP_SDP_DONE state, and the l2cap_event_flag will be cleared if so
hudakz 0:84353c479782 130 identifier = l2capinbuf[9];
hudakz 0:84353c479782 131 sdp_scid[0] = l2capinbuf[14];
hudakz 0:84353c479782 132 sdp_scid[1] = l2capinbuf[15];
hudakz 0:84353c479782 133 l2cap_set_flag(L2CAP_FLAG_CONNECTION_SDP_REQUEST);
hudakz 0:84353c479782 134 } else if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == RFCOMM_PSM) { // ----- || -----
hudakz 0:84353c479782 135 identifier = l2capinbuf[9];
hudakz 0:84353c479782 136 rfcomm_scid[0] = l2capinbuf[14];
hudakz 0:84353c479782 137 rfcomm_scid[1] = l2capinbuf[15];
hudakz 0:84353c479782 138 l2cap_set_flag(L2CAP_FLAG_CONNECTION_RFCOMM_REQUEST);
hudakz 0:84353c479782 139 }
hudakz 0:84353c479782 140 } else if(l2capinbuf[8] == L2CAP_CMD_CONFIG_RESPONSE) {
hudakz 0:84353c479782 141 if((l2capinbuf[16] | (l2capinbuf[17] << 8)) == 0x0000) { // Success
hudakz 0:84353c479782 142 if(l2capinbuf[12] == sdp_dcid[0] && l2capinbuf[13] == sdp_dcid[1]) {
hudakz 0:84353c479782 143 //Notify(PSTR("\r\nSDP Configuration Complete"), 0x80);
hudakz 0:84353c479782 144 l2cap_set_flag(L2CAP_FLAG_CONFIG_SDP_SUCCESS);
hudakz 0:84353c479782 145 } else if(l2capinbuf[12] == rfcomm_dcid[0] && l2capinbuf[13] == rfcomm_dcid[1]) {
hudakz 0:84353c479782 146 //Notify(PSTR("\r\nRFCOMM Configuration Complete"), 0x80);
hudakz 0:84353c479782 147 l2cap_set_flag(L2CAP_FLAG_CONFIG_RFCOMM_SUCCESS);
hudakz 0:84353c479782 148 }
hudakz 0:84353c479782 149 }
hudakz 0:84353c479782 150 } else if(l2capinbuf[8] == L2CAP_CMD_CONFIG_REQUEST) {
hudakz 0:84353c479782 151 if(l2capinbuf[12] == sdp_dcid[0] && l2capinbuf[13] == sdp_dcid[1]) {
hudakz 0:84353c479782 152 //Notify(PSTR("\r\nSDP Configuration Request"), 0x80);
hudakz 0:84353c479782 153 pBtd->l2cap_config_response(hci_handle, l2capinbuf[9], sdp_scid);
hudakz 0:84353c479782 154 } else if(l2capinbuf[12] == rfcomm_dcid[0] && l2capinbuf[13] == rfcomm_dcid[1]) {
hudakz 0:84353c479782 155 //Notify(PSTR("\r\nRFCOMM Configuration Request"), 0x80);
hudakz 0:84353c479782 156 pBtd->l2cap_config_response(hci_handle, l2capinbuf[9], rfcomm_scid);
hudakz 0:84353c479782 157 }
hudakz 0:84353c479782 158 } else if(l2capinbuf[8] == L2CAP_CMD_DISCONNECT_REQUEST) {
hudakz 0:84353c479782 159 if(l2capinbuf[12] == sdp_dcid[0] && l2capinbuf[13] == sdp_dcid[1]) {
hudakz 0:84353c479782 160 //Notify(PSTR("\r\nDisconnect Request: SDP Channel"), 0x80);
hudakz 0:84353c479782 161 identifier = l2capinbuf[9];
hudakz 0:84353c479782 162 l2cap_set_flag(L2CAP_FLAG_DISCONNECT_SDP_REQUEST);
hudakz 0:84353c479782 163 } else if(l2capinbuf[12] == rfcomm_dcid[0] && l2capinbuf[13] == rfcomm_dcid[1]) {
hudakz 0:84353c479782 164 //Notify(PSTR("\r\nDisconnect Request: RFCOMM Channel"), 0x80);
hudakz 0:84353c479782 165 identifier = l2capinbuf[9];
hudakz 0:84353c479782 166 l2cap_set_flag(L2CAP_FLAG_DISCONNECT_RFCOMM_REQUEST);
hudakz 0:84353c479782 167 }
hudakz 0:84353c479782 168 } else if(l2capinbuf[8] == L2CAP_CMD_DISCONNECT_RESPONSE) {
hudakz 0:84353c479782 169 if(l2capinbuf[12] == sdp_scid[0] && l2capinbuf[13] == sdp_scid[1]) {
hudakz 0:84353c479782 170 //Notify(PSTR("\r\nDisconnect Response: SDP Channel"), 0x80);
hudakz 0:84353c479782 171 identifier = l2capinbuf[9];
hudakz 0:84353c479782 172 l2cap_set_flag(L2CAP_FLAG_DISCONNECT_RESPONSE);
hudakz 0:84353c479782 173 } else if(l2capinbuf[12] == rfcomm_scid[0] && l2capinbuf[13] == rfcomm_scid[1]) {
hudakz 0:84353c479782 174 //Notify(PSTR("\r\nDisconnect Response: RFCOMM Channel"), 0x80);
hudakz 0:84353c479782 175 identifier = l2capinbuf[9];
hudakz 0:84353c479782 176 l2cap_set_flag(L2CAP_FLAG_DISCONNECT_RESPONSE);
hudakz 0:84353c479782 177 }
hudakz 0:84353c479782 178 } else if(l2capinbuf[8] == L2CAP_CMD_INFORMATION_REQUEST) {
hudakz 0:84353c479782 179 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 180 Notify(PSTR("\r\nInformation request"), 0x80);
hudakz 0:84353c479782 181 #endif
hudakz 0:84353c479782 182 identifier = l2capinbuf[9];
hudakz 0:84353c479782 183 pBtd->l2cap_information_response(hci_handle, identifier, l2capinbuf[12], l2capinbuf[13]);
hudakz 0:84353c479782 184 }
hudakz 0:84353c479782 185 #ifdef EXTRADEBUG
hudakz 0:84353c479782 186 else {
hudakz 0:84353c479782 187 Notify(PSTR("\r\nL2CAP Unknown Signaling Command: "), 0x80);
hudakz 0:84353c479782 188 D_PrintHex<uint8_t > (l2capinbuf[8], 0x80);
hudakz 0:84353c479782 189 }
hudakz 0:84353c479782 190 #endif
hudakz 0:84353c479782 191 } else if(l2capinbuf[6] == sdp_dcid[0] && l2capinbuf[7] == sdp_dcid[1]) { // SDP
hudakz 0:84353c479782 192 if(l2capinbuf[8] == SDP_SERVICE_SEARCH_ATTRIBUTE_REQUEST_PDU) {
hudakz 0:84353c479782 193 if(((l2capinbuf[16] << 8 | l2capinbuf[17]) == SERIALPORT_UUID) || ((l2capinbuf[16] << 8 | l2capinbuf[17]) == 0x0000 && (l2capinbuf[18] << 8 | l2capinbuf[19]) == SERIALPORT_UUID)) { // Check if it's sending the full UUID, see: https://www.bluetooth.org/Technical/AssignedNumbers/service_discovery.htm, we will just check the first four bytes
hudakz 0:84353c479782 194 if(firstMessage) {
hudakz 0:84353c479782 195 serialPortResponse1(l2capinbuf[9], l2capinbuf[10]);
hudakz 0:84353c479782 196 firstMessage = false;
hudakz 0:84353c479782 197 } else {
hudakz 0:84353c479782 198 serialPortResponse2(l2capinbuf[9], l2capinbuf[10]); // Serialport continuation state
hudakz 0:84353c479782 199 firstMessage = true;
hudakz 0:84353c479782 200 }
hudakz 0:84353c479782 201 } else if(((l2capinbuf[16] << 8 | l2capinbuf[17]) == L2CAP_UUID) || ((l2capinbuf[16] << 8 | l2capinbuf[17]) == 0x0000 && (l2capinbuf[18] << 8 | l2capinbuf[19]) == L2CAP_UUID)) {
hudakz 0:84353c479782 202 if(firstMessage) {
hudakz 0:84353c479782 203 l2capResponse1(l2capinbuf[9], l2capinbuf[10]);
hudakz 0:84353c479782 204 firstMessage = false;
hudakz 0:84353c479782 205 } else {
hudakz 0:84353c479782 206 l2capResponse2(l2capinbuf[9], l2capinbuf[10]); // L2CAP continuation state
hudakz 0:84353c479782 207 firstMessage = true;
hudakz 0:84353c479782 208 }
hudakz 0:84353c479782 209 } else
hudakz 0:84353c479782 210 serviceNotSupported(l2capinbuf[9], l2capinbuf[10]); // The service is not supported
hudakz 0:84353c479782 211 #ifdef EXTRADEBUG
hudakz 0:84353c479782 212 Notify(PSTR("\r\nUUID: "), 0x80);
hudakz 0:84353c479782 213 uint16_t uuid;
hudakz 0:84353c479782 214 if((l2capinbuf[16] << 8 | l2capinbuf[17]) == 0x0000) // Check if it's sending the UUID as a 128-bit UUID
hudakz 0:84353c479782 215 uuid = (l2capinbuf[18] << 8 | l2capinbuf[19]);
hudakz 0:84353c479782 216 else // Short UUID
hudakz 0:84353c479782 217 uuid = (l2capinbuf[16] << 8 | l2capinbuf[17]);
hudakz 0:84353c479782 218 D_PrintHex<uint16_t > (uuid, 0x80);
hudakz 0:84353c479782 219
hudakz 0:84353c479782 220 Notify(PSTR("\r\nLength: "), 0x80);
hudakz 0:84353c479782 221 uint16_t length = l2capinbuf[11] << 8 | l2capinbuf[12];
hudakz 0:84353c479782 222 D_PrintHex<uint16_t > (length, 0x80);
hudakz 0:84353c479782 223 Notify(PSTR("\r\nData: "), 0x80);
hudakz 0:84353c479782 224 for(uint8_t i = 0; i < length; i++) {
hudakz 0:84353c479782 225 D_PrintHex<uint8_t > (l2capinbuf[13 + i], 0x80);
hudakz 0:84353c479782 226 Notify(PSTR(" "), 0x80);
hudakz 0:84353c479782 227 }
hudakz 0:84353c479782 228 #endif
hudakz 0:84353c479782 229 }
hudakz 0:84353c479782 230 #ifdef EXTRADEBUG
hudakz 0:84353c479782 231 else {
hudakz 0:84353c479782 232 Notify(PSTR("\r\nUnknown PDU: "), 0x80);
hudakz 0:84353c479782 233 D_PrintHex<uint8_t > (l2capinbuf[8], 0x80);
hudakz 0:84353c479782 234 }
hudakz 0:84353c479782 235 #endif
hudakz 0:84353c479782 236 } else if(l2capinbuf[6] == rfcomm_dcid[0] && l2capinbuf[7] == rfcomm_dcid[1]) { // RFCOMM
hudakz 0:84353c479782 237 rfcommChannel = l2capinbuf[8] & 0xF8;
hudakz 0:84353c479782 238 rfcommDirection = l2capinbuf[8] & 0x04;
hudakz 0:84353c479782 239 rfcommCommandResponse = l2capinbuf[8] & 0x02;
hudakz 0:84353c479782 240 rfcommChannelType = l2capinbuf[9] & 0xEF;
hudakz 0:84353c479782 241 rfcommPfBit = l2capinbuf[9] & 0x10;
hudakz 0:84353c479782 242
hudakz 0:84353c479782 243 if(rfcommChannel >> 3 != 0x00)
hudakz 0:84353c479782 244 rfcommChannelConnection = rfcommChannel;
hudakz 0:84353c479782 245
hudakz 0:84353c479782 246 #ifdef EXTRADEBUG
hudakz 0:84353c479782 247 Notify(PSTR("\r\nRFCOMM Channel: "), 0x80);
hudakz 0:84353c479782 248 D_PrintHex<uint8_t > (rfcommChannel >> 3, 0x80);
hudakz 0:84353c479782 249 Notify(PSTR(" Direction: "), 0x80);
hudakz 0:84353c479782 250 D_PrintHex<uint8_t > (rfcommDirection >> 2, 0x80);
hudakz 0:84353c479782 251 Notify(PSTR(" CommandResponse: "), 0x80);
hudakz 0:84353c479782 252 D_PrintHex<uint8_t > (rfcommCommandResponse >> 1, 0x80);
hudakz 0:84353c479782 253 Notify(PSTR(" ChannelType: "), 0x80);
hudakz 0:84353c479782 254 D_PrintHex<uint8_t > (rfcommChannelType, 0x80);
hudakz 0:84353c479782 255 Notify(PSTR(" PF_BIT: "), 0x80);
hudakz 0:84353c479782 256 D_PrintHex<uint8_t > (rfcommPfBit, 0x80);
hudakz 0:84353c479782 257 #endif
hudakz 0:84353c479782 258 if(rfcommChannelType == RFCOMM_DISC) {
hudakz 0:84353c479782 259 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 260 Notify(PSTR("\r\nReceived Disconnect RFCOMM Command on channel: "), 0x80);
hudakz 0:84353c479782 261 D_PrintHex<uint8_t > (rfcommChannel >> 3, 0x80);
hudakz 0:84353c479782 262 #endif
hudakz 0:84353c479782 263 connected = false;
hudakz 0:84353c479782 264 sendRfcomm(rfcommChannel, rfcommDirection, rfcommCommandResponse, RFCOMM_UA, rfcommPfBit, rfcommbuf, 0x00); // UA Command
hudakz 0:84353c479782 265 }
hudakz 0:84353c479782 266 if(connected) {
hudakz 0:84353c479782 267 /* Read the incoming message */
hudakz 0:84353c479782 268 if(rfcommChannelType == RFCOMM_UIH && rfcommChannel == rfcommChannelConnection) {
hudakz 0:84353c479782 269 uint8_t length = l2capinbuf[10] >> 1; // Get length
hudakz 0:84353c479782 270 uint8_t offset = l2capinbuf[4] - length - 4; // Check if there is credit
hudakz 0:84353c479782 271 if(checkFcs(&l2capinbuf[8], l2capinbuf[11 + length + offset])) {
hudakz 0:84353c479782 272 uint8_t i = 0;
hudakz 0:84353c479782 273 for(; i < length; i++) {
hudakz 0:84353c479782 274 if(rfcommAvailable + i >= sizeof (rfcommDataBuffer)) {
hudakz 0:84353c479782 275 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 276 Notify(PSTR("\r\nWarning: Buffer is full!"), 0x80);
hudakz 0:84353c479782 277 #endif
hudakz 0:84353c479782 278 break;
hudakz 0:84353c479782 279 }
hudakz 0:84353c479782 280 rfcommDataBuffer[rfcommAvailable + i] = l2capinbuf[11 + i + offset];
hudakz 0:84353c479782 281 }
hudakz 0:84353c479782 282 rfcommAvailable += i;
hudakz 0:84353c479782 283 #ifdef EXTRADEBUG
hudakz 0:84353c479782 284 Notify(PSTR("\r\nRFCOMM Data Available: "), 0x80);
hudakz 0:84353c479782 285 Notify(rfcommAvailable, 0x80);
hudakz 0:84353c479782 286 if(offset) {
hudakz 0:84353c479782 287 Notify(PSTR(" - Credit: 0x"), 0x80);
hudakz 0:84353c479782 288 D_PrintHex<uint8_t > (l2capinbuf[11], 0x80);
hudakz 0:84353c479782 289 }
hudakz 0:84353c479782 290 #endif
hudakz 0:84353c479782 291 }
hudakz 0:84353c479782 292 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 293 else
hudakz 0:84353c479782 294 Notify(PSTR("\r\nError in FCS checksum!"), 0x80);
hudakz 0:84353c479782 295 #endif
hudakz 0:84353c479782 296 #ifdef PRINTREPORT // Uncomment "#define PRINTREPORT" to print the report send to the Arduino via Bluetooth
hudakz 0:84353c479782 297 for(uint8_t i = 0; i < length; i++)
hudakz 0:84353c479782 298 Notifyc(l2capinbuf[i + 11 + offset], 0x80);
hudakz 0:84353c479782 299 #endif
hudakz 0:84353c479782 300 } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[11] == BT_RFCOMM_RPN_CMD) { // UIH Remote Port Negotiation Command
hudakz 0:84353c479782 301 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 302 Notify(PSTR("\r\nReceived UIH Remote Port Negotiation Command"), 0x80);
hudakz 0:84353c479782 303 #endif
hudakz 0:84353c479782 304 rfcommbuf[0] = BT_RFCOMM_RPN_RSP; // Command
hudakz 0:84353c479782 305 rfcommbuf[1] = l2capinbuf[12]; // Length and shiftet like so: length << 1 | 1
hudakz 0:84353c479782 306 rfcommbuf[2] = l2capinbuf[13]; // Channel: channel << 1 | 1
hudakz 0:84353c479782 307 rfcommbuf[3] = l2capinbuf[14]; // Pre difined for Bluetooth, see 5.5.3 of TS 07.10 Adaption for RFCOMM
hudakz 0:84353c479782 308 rfcommbuf[4] = l2capinbuf[15]; // Priority
hudakz 0:84353c479782 309 rfcommbuf[5] = l2capinbuf[16]; // Timer
hudakz 0:84353c479782 310 rfcommbuf[6] = l2capinbuf[17]; // Max Fram Size LSB
hudakz 0:84353c479782 311 rfcommbuf[7] = l2capinbuf[18]; // Max Fram Size MSB
hudakz 0:84353c479782 312 rfcommbuf[8] = l2capinbuf[19]; // MaxRatransm.
hudakz 0:84353c479782 313 rfcommbuf[9] = l2capinbuf[20]; // Number of Frames
hudakz 0:84353c479782 314 sendRfcomm(rfcommChannel, rfcommDirection, 0, RFCOMM_UIH, rfcommPfBit, rfcommbuf, 0x0A); // UIH Remote Port Negotiation Response
hudakz 0:84353c479782 315 } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[11] == BT_RFCOMM_MSC_CMD) { // UIH Modem Status Command
hudakz 0:84353c479782 316 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 317 Notify(PSTR("\r\nSend UIH Modem Status Response"), 0x80);
hudakz 0:84353c479782 318 #endif
hudakz 0:84353c479782 319 rfcommbuf[0] = BT_RFCOMM_MSC_RSP; // UIH Modem Status Response
hudakz 0:84353c479782 320 rfcommbuf[1] = 2 << 1 | 1; // Length and shiftet like so: length << 1 | 1
hudakz 0:84353c479782 321 rfcommbuf[2] = l2capinbuf[13]; // Channel: (1 << 0) | (1 << 1) | (0 << 2) | (channel << 3)
hudakz 0:84353c479782 322 rfcommbuf[3] = l2capinbuf[14];
hudakz 0:84353c479782 323 sendRfcomm(rfcommChannel, rfcommDirection, 0, RFCOMM_UIH, rfcommPfBit, rfcommbuf, 0x04);
hudakz 0:84353c479782 324 }
hudakz 0:84353c479782 325 } else {
hudakz 0:84353c479782 326 if(rfcommChannelType == RFCOMM_SABM) { // SABM Command - this is sent twice: once for channel 0 and then for the channel to establish
hudakz 0:84353c479782 327 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 328 Notify(PSTR("\r\nReceived SABM Command"), 0x80);
hudakz 0:84353c479782 329 #endif
hudakz 0:84353c479782 330 sendRfcomm(rfcommChannel, rfcommDirection, rfcommCommandResponse, RFCOMM_UA, rfcommPfBit, rfcommbuf, 0x00); // UA Command
hudakz 0:84353c479782 331 } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[11] == BT_RFCOMM_PN_CMD) { // UIH Parameter Negotiation Command
hudakz 0:84353c479782 332 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 333 Notify(PSTR("\r\nReceived UIH Parameter Negotiation Command"), 0x80);
hudakz 0:84353c479782 334 #endif
hudakz 0:84353c479782 335 rfcommbuf[0] = BT_RFCOMM_PN_RSP; // UIH Parameter Negotiation Response
hudakz 0:84353c479782 336 rfcommbuf[1] = l2capinbuf[12]; // Length and shiftet like so: length << 1 | 1
hudakz 0:84353c479782 337 rfcommbuf[2] = l2capinbuf[13]; // Channel: channel << 1 | 1
hudakz 0:84353c479782 338 rfcommbuf[3] = 0xE0; // Pre difined for Bluetooth, see 5.5.3 of TS 07.10 Adaption for RFCOMM
hudakz 0:84353c479782 339 rfcommbuf[4] = 0x00; // Priority
hudakz 0:84353c479782 340 rfcommbuf[5] = 0x00; // Timer
hudakz 0:84353c479782 341 rfcommbuf[6] = BULK_MAXPKTSIZE - 14; // Max Fram Size LSB - set to the size of received data (50)
hudakz 0:84353c479782 342 rfcommbuf[7] = 0x00; // Max Fram Size MSB
hudakz 0:84353c479782 343 rfcommbuf[8] = 0x00; // MaxRatransm.
hudakz 0:84353c479782 344 rfcommbuf[9] = 0x00; // Number of Frames
hudakz 0:84353c479782 345 sendRfcomm(rfcommChannel, rfcommDirection, 0, RFCOMM_UIH, rfcommPfBit, rfcommbuf, 0x0A);
hudakz 0:84353c479782 346 } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[11] == BT_RFCOMM_MSC_CMD) { // UIH Modem Status Command
hudakz 0:84353c479782 347 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 348 Notify(PSTR("\r\nSend UIH Modem Status Response"), 0x80);
hudakz 0:84353c479782 349 #endif
hudakz 0:84353c479782 350 rfcommbuf[0] = BT_RFCOMM_MSC_RSP; // UIH Modem Status Response
hudakz 0:84353c479782 351 rfcommbuf[1] = 2 << 1 | 1; // Length and shiftet like so: length << 1 | 1
hudakz 0:84353c479782 352 rfcommbuf[2] = l2capinbuf[13]; // Channel: (1 << 0) | (1 << 1) | (0 << 2) | (channel << 3)
hudakz 0:84353c479782 353 rfcommbuf[3] = l2capinbuf[14];
hudakz 0:84353c479782 354 sendRfcomm(rfcommChannel, rfcommDirection, 0, RFCOMM_UIH, rfcommPfBit, rfcommbuf, 0x04);
hudakz 0:84353c479782 355
hudakz 0:84353c479782 356 wait_ms(1);
hudakz 0:84353c479782 357 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 358 Notify(PSTR("\r\nSend UIH Modem Status Command"), 0x80);
hudakz 0:84353c479782 359 #endif
hudakz 0:84353c479782 360 rfcommbuf[0] = BT_RFCOMM_MSC_CMD; // UIH Modem Status Command
hudakz 0:84353c479782 361 rfcommbuf[1] = 2 << 1 | 1; // Length and shiftet like so: length << 1 | 1
hudakz 0:84353c479782 362 rfcommbuf[2] = l2capinbuf[13]; // Channel: (1 << 0) | (1 << 1) | (0 << 2) | (channel << 3)
hudakz 0:84353c479782 363 rfcommbuf[3] = 0x8D; // Can receive frames (YES), Ready to Communicate (YES), Ready to Receive (YES), Incomig Call (NO), Data is Value (YES)
hudakz 0:84353c479782 364
hudakz 0:84353c479782 365 sendRfcomm(rfcommChannel, rfcommDirection, 0, RFCOMM_UIH, rfcommPfBit, rfcommbuf, 0x04);
hudakz 0:84353c479782 366 } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[11] == BT_RFCOMM_MSC_RSP) { // UIH Modem Status Response
hudakz 0:84353c479782 367 if(!creditSent) {
hudakz 0:84353c479782 368 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 369 Notify(PSTR("\r\nSend UIH Command with credit"), 0x80);
hudakz 0:84353c479782 370 #endif
hudakz 0:84353c479782 371 sendRfcommCredit(rfcommChannelConnection, rfcommDirection, 0, RFCOMM_UIH, 0x10, sizeof (rfcommDataBuffer)); // Send credit
hudakz 0:84353c479782 372 creditSent = true;
hudakz 0:84353c479782 373 timer = (uint32_t)millis();
hudakz 0:84353c479782 374 waitForLastCommand = true;
hudakz 0:84353c479782 375 }
hudakz 0:84353c479782 376 } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[10] == 0x01) { // UIH Command with credit
hudakz 0:84353c479782 377 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 378 Notify(PSTR("\r\nReceived UIH Command with credit"), 0x80);
hudakz 0:84353c479782 379 #endif
hudakz 0:84353c479782 380 } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[11] == BT_RFCOMM_RPN_CMD) { // UIH Remote Port Negotiation Command
hudakz 0:84353c479782 381 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 382 Notify(PSTR("\r\nReceived UIH Remote Port Negotiation Command"), 0x80);
hudakz 0:84353c479782 383 #endif
hudakz 0:84353c479782 384 rfcommbuf[0] = BT_RFCOMM_RPN_RSP; // Command
hudakz 0:84353c479782 385 rfcommbuf[1] = l2capinbuf[12]; // Length and shiftet like so: length << 1 | 1
hudakz 0:84353c479782 386 rfcommbuf[2] = l2capinbuf[13]; // Channel: channel << 1 | 1
hudakz 0:84353c479782 387 rfcommbuf[3] = l2capinbuf[14]; // Pre difined for Bluetooth, see 5.5.3 of TS 07.10 Adaption for RFCOMM
hudakz 0:84353c479782 388 rfcommbuf[4] = l2capinbuf[15]; // Priority
hudakz 0:84353c479782 389 rfcommbuf[5] = l2capinbuf[16]; // Timer
hudakz 0:84353c479782 390 rfcommbuf[6] = l2capinbuf[17]; // Max Fram Size LSB
hudakz 0:84353c479782 391 rfcommbuf[7] = l2capinbuf[18]; // Max Fram Size MSB
hudakz 0:84353c479782 392 rfcommbuf[8] = l2capinbuf[19]; // MaxRatransm.
hudakz 0:84353c479782 393 rfcommbuf[9] = l2capinbuf[20]; // Number of Frames
hudakz 0:84353c479782 394 sendRfcomm(rfcommChannel, rfcommDirection, 0, RFCOMM_UIH, rfcommPfBit, rfcommbuf, 0x0A); // UIH Remote Port Negotiation Response
hudakz 0:84353c479782 395 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 396 Notify(PSTR("\r\nRFCOMM Connection is now established\r\n"), 0x80);
hudakz 0:84353c479782 397 #endif
hudakz 0:84353c479782 398 onInit();
hudakz 0:84353c479782 399 }
hudakz 0:84353c479782 400 #ifdef EXTRADEBUG
hudakz 0:84353c479782 401 else if(rfcommChannelType != RFCOMM_DISC) {
hudakz 0:84353c479782 402 Notify(PSTR("\r\nUnsupported RFCOMM Data - ChannelType: "), 0x80);
hudakz 0:84353c479782 403 D_PrintHex<uint8_t > (rfcommChannelType, 0x80);
hudakz 0:84353c479782 404 Notify(PSTR(" Command: "), 0x80);
hudakz 0:84353c479782 405 D_PrintHex<uint8_t > (l2capinbuf[11], 0x80);
hudakz 0:84353c479782 406 }
hudakz 0:84353c479782 407 #endif
hudakz 0:84353c479782 408 }
hudakz 0:84353c479782 409 }
hudakz 0:84353c479782 410 #ifdef EXTRADEBUG
hudakz 0:84353c479782 411 else {
hudakz 0:84353c479782 412 Notify(PSTR("\r\nUnsupported L2CAP Data - Channel ID: "), 0x80);
hudakz 0:84353c479782 413 D_PrintHex<uint8_t > (l2capinbuf[7], 0x80);
hudakz 0:84353c479782 414 Notify(PSTR(" "), 0x80);
hudakz 0:84353c479782 415 D_PrintHex<uint8_t > (l2capinbuf[6], 0x80);
hudakz 0:84353c479782 416 }
hudakz 0:84353c479782 417 #endif
hudakz 0:84353c479782 418 SDP_task();
hudakz 0:84353c479782 419 RFCOMM_task();
hudakz 0:84353c479782 420 }
hudakz 0:84353c479782 421 }
hudakz 0:84353c479782 422
hudakz 0:84353c479782 423 void SPP::Run() {
hudakz 0:84353c479782 424 if(waitForLastCommand && (int32_t)((uint32_t)millis() - timer) > 100) { // We will only wait 100ms and see if the UIH Remote Port Negotiation Command is send, as some deviced don't send it
hudakz 0:84353c479782 425 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 426 Notify(PSTR("\r\nRFCOMM Connection is now established - Automatic\r\n"), 0x80);
hudakz 0:84353c479782 427 #endif
hudakz 0:84353c479782 428 onInit();
hudakz 0:84353c479782 429 }
hudakz 0:84353c479782 430 send(); // Send all bytes currently in the buffer
hudakz 0:84353c479782 431 }
hudakz 0:84353c479782 432
hudakz 0:84353c479782 433 void SPP::onInit() {
hudakz 0:84353c479782 434 creditSent = false;
hudakz 0:84353c479782 435 waitForLastCommand = false;
hudakz 0:84353c479782 436 connected = true; // The RFCOMM channel is now established
hudakz 0:84353c479782 437 sppIndex = 0;
hudakz 0:84353c479782 438 if(pFuncOnInit)
hudakz 0:84353c479782 439 pFuncOnInit(); // Call the user function
hudakz 0:84353c479782 440 };
hudakz 0:84353c479782 441
hudakz 0:84353c479782 442 void SPP::SDP_task() {
hudakz 0:84353c479782 443 switch(l2cap_sdp_state) {
hudakz 0:84353c479782 444 case L2CAP_SDP_WAIT:
hudakz 0:84353c479782 445 if(l2cap_check_flag(L2CAP_FLAG_CONNECTION_SDP_REQUEST)) {
hudakz 0:84353c479782 446 l2cap_clear_flag(L2CAP_FLAG_CONNECTION_SDP_REQUEST); // Clear flag
hudakz 0:84353c479782 447 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 448 Notify(PSTR("\r\nSDP Incoming Connection Request"), 0x80);
hudakz 0:84353c479782 449 #endif
hudakz 0:84353c479782 450 pBtd->l2cap_connection_response(hci_handle, identifier, sdp_dcid, sdp_scid, PENDING);
hudakz 0:84353c479782 451 wait_ms(1);
hudakz 0:84353c479782 452 pBtd->l2cap_connection_response(hci_handle, identifier, sdp_dcid, sdp_scid, SUCCESSFUL);
hudakz 0:84353c479782 453 identifier++;
hudakz 0:84353c479782 454 wait_ms(1);
hudakz 0:84353c479782 455 pBtd->l2cap_config_request(hci_handle, identifier, sdp_scid);
hudakz 0:84353c479782 456 l2cap_sdp_state = L2CAP_SDP_SUCCESS;
hudakz 0:84353c479782 457 } else if(l2cap_check_flag(L2CAP_FLAG_DISCONNECT_SDP_REQUEST)) {
hudakz 0:84353c479782 458 l2cap_clear_flag(L2CAP_FLAG_DISCONNECT_SDP_REQUEST); // Clear flag
hudakz 0:84353c479782 459 SDPConnected = false;
hudakz 0:84353c479782 460 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 461 Notify(PSTR("\r\nDisconnected SDP Channel"), 0x80);
hudakz 0:84353c479782 462 #endif
hudakz 0:84353c479782 463 pBtd->l2cap_disconnection_response(hci_handle, identifier, sdp_dcid, sdp_scid);
hudakz 0:84353c479782 464 }
hudakz 0:84353c479782 465 break;
hudakz 0:84353c479782 466 case L2CAP_SDP_SUCCESS:
hudakz 0:84353c479782 467 if(l2cap_check_flag(L2CAP_FLAG_CONFIG_SDP_SUCCESS)) {
hudakz 0:84353c479782 468 l2cap_clear_flag(L2CAP_FLAG_CONFIG_SDP_SUCCESS); // Clear flag
hudakz 0:84353c479782 469 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 470 Notify(PSTR("\r\nSDP Successfully Configured"), 0x80);
hudakz 0:84353c479782 471 #endif
hudakz 0:84353c479782 472 firstMessage = true; // Reset bool
hudakz 0:84353c479782 473 SDPConnected = true;
hudakz 0:84353c479782 474 l2cap_sdp_state = L2CAP_SDP_WAIT;
hudakz 0:84353c479782 475 }
hudakz 0:84353c479782 476 break;
hudakz 0:84353c479782 477
hudakz 0:84353c479782 478 case L2CAP_DISCONNECT_RESPONSE: // This is for both disconnection response from the RFCOMM and SDP channel if they were connected
hudakz 0:84353c479782 479 if(l2cap_check_flag(L2CAP_FLAG_DISCONNECT_RESPONSE)) {
hudakz 0:84353c479782 480 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 481 Notify(PSTR("\r\nDisconnected L2CAP Connection"), 0x80);
hudakz 0:84353c479782 482 #endif
hudakz 0:84353c479782 483 pBtd->hci_disconnect(hci_handle);
hudakz 0:84353c479782 484 hci_handle = -1; // Reset handle
hudakz 0:84353c479782 485 Reset();
hudakz 0:84353c479782 486 }
hudakz 0:84353c479782 487 break;
hudakz 0:84353c479782 488 }
hudakz 0:84353c479782 489 }
hudakz 0:84353c479782 490
hudakz 0:84353c479782 491 void SPP::RFCOMM_task() {
hudakz 0:84353c479782 492 switch(l2cap_rfcomm_state) {
hudakz 0:84353c479782 493 case L2CAP_RFCOMM_WAIT:
hudakz 0:84353c479782 494 if(l2cap_check_flag(L2CAP_FLAG_CONNECTION_RFCOMM_REQUEST)) {
hudakz 0:84353c479782 495 l2cap_clear_flag(L2CAP_FLAG_CONNECTION_RFCOMM_REQUEST); // Clear flag
hudakz 0:84353c479782 496 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 497 Notify(PSTR("\r\nRFCOMM Incoming Connection Request"), 0x80);
hudakz 0:84353c479782 498 #endif
hudakz 0:84353c479782 499 pBtd->l2cap_connection_response(hci_handle, identifier, rfcomm_dcid, rfcomm_scid, PENDING);
hudakz 0:84353c479782 500 wait_ms(1);
hudakz 0:84353c479782 501 pBtd->l2cap_connection_response(hci_handle, identifier, rfcomm_dcid, rfcomm_scid, SUCCESSFUL);
hudakz 0:84353c479782 502 identifier++;
hudakz 0:84353c479782 503 wait_ms(1);
hudakz 0:84353c479782 504 pBtd->l2cap_config_request(hci_handle, identifier, rfcomm_scid);
hudakz 0:84353c479782 505 l2cap_rfcomm_state = L2CAP_RFCOMM_SUCCESS;
hudakz 0:84353c479782 506 } else if(l2cap_check_flag(L2CAP_FLAG_DISCONNECT_RFCOMM_REQUEST)) {
hudakz 0:84353c479782 507 l2cap_clear_flag(L2CAP_FLAG_DISCONNECT_RFCOMM_REQUEST); // Clear flag
hudakz 0:84353c479782 508 RFCOMMConnected = false;
hudakz 0:84353c479782 509 connected = false;
hudakz 0:84353c479782 510 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 511 Notify(PSTR("\r\nDisconnected RFCOMM Channel"), 0x80);
hudakz 0:84353c479782 512 #endif
hudakz 0:84353c479782 513 pBtd->l2cap_disconnection_response(hci_handle, identifier, rfcomm_dcid, rfcomm_scid);
hudakz 0:84353c479782 514 }
hudakz 0:84353c479782 515 break;
hudakz 0:84353c479782 516 case L2CAP_RFCOMM_SUCCESS:
hudakz 0:84353c479782 517 if(l2cap_check_flag(L2CAP_FLAG_CONFIG_RFCOMM_SUCCESS)) {
hudakz 0:84353c479782 518 l2cap_clear_flag(L2CAP_FLAG_CONFIG_RFCOMM_SUCCESS); // Clear flag
hudakz 0:84353c479782 519 #ifdef DEBUG_USB_HOST
hudakz 0:84353c479782 520 Notify(PSTR("\r\nRFCOMM Successfully Configured"), 0x80);
hudakz 0:84353c479782 521 #endif
hudakz 0:84353c479782 522 rfcommAvailable = 0; // Reset number of bytes available
hudakz 0:84353c479782 523 bytesRead = 0; // Reset number of bytes received
hudakz 0:84353c479782 524 RFCOMMConnected = true;
hudakz 0:84353c479782 525 l2cap_rfcomm_state = L2CAP_RFCOMM_WAIT;
hudakz 0:84353c479782 526 }
hudakz 0:84353c479782 527 break;
hudakz 0:84353c479782 528 }
hudakz 0:84353c479782 529 }
hudakz 0:84353c479782 530 /************************************************************/
hudakz 0:84353c479782 531 /* SDP Commands */
hudakz 0:84353c479782 532
hudakz 0:84353c479782 533 /************************************************************/
hudakz 0:84353c479782 534 void SPP::SDP_Command(uint8_t* data, uint8_t nbytes) { // See page 223 in the Bluetooth specs
hudakz 0:84353c479782 535 pBtd->L2CAP_Command(hci_handle, data, nbytes, sdp_scid[0], sdp_scid[1]);
hudakz 0:84353c479782 536 }
hudakz 0:84353c479782 537
hudakz 0:84353c479782 538 void SPP::serviceNotSupported(uint8_t transactionIDHigh, uint8_t transactionIDLow) { // See page 235 in the Bluetooth specs
hudakz 0:84353c479782 539 l2capoutbuf[0] = SDP_SERVICE_SEARCH_ATTRIBUTE_RESPONSE_PDU;
hudakz 0:84353c479782 540 l2capoutbuf[1] = transactionIDHigh;
hudakz 0:84353c479782 541 l2capoutbuf[2] = transactionIDLow;
hudakz 0:84353c479782 542 l2capoutbuf[3] = 0x00; // MSB Parameter Length
hudakz 0:84353c479782 543 l2capoutbuf[4] = 0x05; // LSB Parameter Length = 5
hudakz 0:84353c479782 544 l2capoutbuf[5] = 0x00; // MSB AttributeListsByteCount
hudakz 0:84353c479782 545 l2capoutbuf[6] = 0x02; // LSB AttributeListsByteCount = 2
hudakz 0:84353c479782 546
hudakz 0:84353c479782 547 /* Attribute ID/Value Sequence: */
hudakz 0:84353c479782 548 l2capoutbuf[7] = 0x35; // Data element sequence - length in next byte
hudakz 0:84353c479782 549 l2capoutbuf[8] = 0x00; // Length = 0
hudakz 0:84353c479782 550 l2capoutbuf[9] = 0x00; // No continuation state
hudakz 0:84353c479782 551
hudakz 0:84353c479782 552 SDP_Command(l2capoutbuf, 10);
hudakz 0:84353c479782 553 }
hudakz 0:84353c479782 554
hudakz 0:84353c479782 555 void SPP::serialPortResponse1(uint8_t transactionIDHigh, uint8_t transactionIDLow) {
hudakz 0:84353c479782 556 l2capoutbuf[0] = SDP_SERVICE_SEARCH_ATTRIBUTE_RESPONSE_PDU;
hudakz 0:84353c479782 557 l2capoutbuf[1] = transactionIDHigh;
hudakz 0:84353c479782 558 l2capoutbuf[2] = transactionIDLow;
hudakz 0:84353c479782 559 l2capoutbuf[3] = 0x00; // MSB Parameter Length
hudakz 0:84353c479782 560 l2capoutbuf[4] = 0x2B; // LSB Parameter Length = 43
hudakz 0:84353c479782 561 l2capoutbuf[5] = 0x00; // MSB AttributeListsByteCount
hudakz 0:84353c479782 562 l2capoutbuf[6] = 0x26; // LSB AttributeListsByteCount = 38
hudakz 0:84353c479782 563
hudakz 0:84353c479782 564 /* Attribute ID/Value Sequence: */
hudakz 0:84353c479782 565 l2capoutbuf[7] = 0x36; // Data element sequence - length in next two bytes
hudakz 0:84353c479782 566 l2capoutbuf[8] = 0x00; // MSB Length
hudakz 0:84353c479782 567 l2capoutbuf[9] = 0x3C; // LSB Length = 60
hudakz 0:84353c479782 568
hudakz 0:84353c479782 569 l2capoutbuf[10] = 0x36; // Data element sequence - length in next two bytes
hudakz 0:84353c479782 570 l2capoutbuf[11] = 0x00; // MSB Length
hudakz 0:84353c479782 571 l2capoutbuf[12] = 0x39; // LSB Length = 57
hudakz 0:84353c479782 572
hudakz 0:84353c479782 573 l2capoutbuf[13] = 0x09; // Unsigned Integer - length 2 bytes
hudakz 0:84353c479782 574 l2capoutbuf[14] = 0x00; // MSB ServiceRecordHandle
hudakz 0:84353c479782 575 l2capoutbuf[15] = 0x00; // LSB ServiceRecordHandle
hudakz 0:84353c479782 576 l2capoutbuf[16] = 0x0A; // Unsigned int - length 4 bytes
hudakz 0:84353c479782 577 l2capoutbuf[17] = 0x00; // ServiceRecordHandle value - TODO: Is this related to HCI_Handle?
hudakz 0:84353c479782 578 l2capoutbuf[18] = 0x01;
hudakz 0:84353c479782 579 l2capoutbuf[19] = 0x00;
hudakz 0:84353c479782 580 l2capoutbuf[20] = 0x06;
hudakz 0:84353c479782 581
hudakz 0:84353c479782 582 l2capoutbuf[21] = 0x09; // Unsigned Integer - length 2 bytes
hudakz 0:84353c479782 583 l2capoutbuf[22] = 0x00; // MSB ServiceClassIDList
hudakz 0:84353c479782 584 l2capoutbuf[23] = 0x01; // LSB ServiceClassIDList
hudakz 0:84353c479782 585 l2capoutbuf[24] = 0x35; // Data element sequence - length in next byte
hudakz 0:84353c479782 586 l2capoutbuf[25] = 0x03; // Length = 3
hudakz 0:84353c479782 587 l2capoutbuf[26] = 0x19; // UUID (universally unique identifier) - length = 2 bytes
hudakz 0:84353c479782 588 l2capoutbuf[27] = 0x11; // MSB SerialPort
hudakz 0:84353c479782 589 l2capoutbuf[28] = 0x01; // LSB SerialPort
hudakz 0:84353c479782 590
hudakz 0:84353c479782 591 l2capoutbuf[29] = 0x09; // Unsigned Integer - length 2 bytes
hudakz 0:84353c479782 592 l2capoutbuf[30] = 0x00; // MSB ProtocolDescriptorList
hudakz 0:84353c479782 593 l2capoutbuf[31] = 0x04; // LSB ProtocolDescriptorList
hudakz 0:84353c479782 594 l2capoutbuf[32] = 0x35; // Data element sequence - length in next byte
hudakz 0:84353c479782 595 l2capoutbuf[33] = 0x0C; // Length = 12
hudakz 0:84353c479782 596
hudakz 0:84353c479782 597 l2capoutbuf[34] = 0x35; // Data element sequence - length in next byte
hudakz 0:84353c479782 598 l2capoutbuf[35] = 0x03; // Length = 3
hudakz 0:84353c479782 599 l2capoutbuf[36] = 0x19; // UUID (universally unique identifier) - length = 2 bytes
hudakz 0:84353c479782 600 l2capoutbuf[37] = 0x01; // MSB L2CAP
hudakz 0:84353c479782 601 l2capoutbuf[38] = 0x00; // LSB L2CAP
hudakz 0:84353c479782 602
hudakz 0:84353c479782 603 l2capoutbuf[39] = 0x35; // Data element sequence - length in next byte
hudakz 0:84353c479782 604 l2capoutbuf[40] = 0x05; // Length = 5
hudakz 0:84353c479782 605 l2capoutbuf[41] = 0x19; // UUID (universally unique identifier) - length = 2 bytes
hudakz 0:84353c479782 606 l2capoutbuf[42] = 0x00; // MSB RFCOMM
hudakz 0:84353c479782 607 l2capoutbuf[43] = 0x03; // LSB RFCOMM
hudakz 0:84353c479782 608 l2capoutbuf[44] = 0x08; // Unsigned Integer - length 1 byte
hudakz 0:84353c479782 609
hudakz 0:84353c479782 610 l2capoutbuf[45] = 0x02; // ContinuationState - Two more bytes
hudakz 0:84353c479782 611 l2capoutbuf[46] = 0x00; // MSB length
hudakz 0:84353c479782 612 l2capoutbuf[47] = 0x19; // LSB length = 25 more bytes to come
hudakz 0:84353c479782 613
hudakz 0:84353c479782 614 SDP_Command(l2capoutbuf, 48);
hudakz 0:84353c479782 615 }
hudakz 0:84353c479782 616
hudakz 0:84353c479782 617 void SPP::serialPortResponse2(uint8_t transactionIDHigh, uint8_t transactionIDLow) {
hudakz 0:84353c479782 618 l2capoutbuf[0] = SDP_SERVICE_SEARCH_ATTRIBUTE_RESPONSE_PDU;
hudakz 0:84353c479782 619 l2capoutbuf[1] = transactionIDHigh;
hudakz 0:84353c479782 620 l2capoutbuf[2] = transactionIDLow;
hudakz 0:84353c479782 621 l2capoutbuf[3] = 0x00; // MSB Parameter Length
hudakz 0:84353c479782 622 l2capoutbuf[4] = 0x1C; // LSB Parameter Length = 28
hudakz 0:84353c479782 623 l2capoutbuf[5] = 0x00; // MSB AttributeListsByteCount
hudakz 0:84353c479782 624 l2capoutbuf[6] = 0x19; // LSB AttributeListsByteCount = 25
hudakz 0:84353c479782 625
hudakz 0:84353c479782 626 /* Attribute ID/Value Sequence: */
hudakz 0:84353c479782 627 l2capoutbuf[7] = 0x01; // Channel 1 - TODO: Try different values, so multiple servers can be used at once
hudakz 0:84353c479782 628
hudakz 0:84353c479782 629 l2capoutbuf[8] = 0x09; // Unsigned Integer - length 2 bytes
hudakz 0:84353c479782 630 l2capoutbuf[9] = 0x00; // MSB LanguageBaseAttributeIDList
hudakz 0:84353c479782 631 l2capoutbuf[10] = 0x06; // LSB LanguageBaseAttributeIDList
hudakz 0:84353c479782 632 l2capoutbuf[11] = 0x35; // Data element sequence - length in next byte
hudakz 0:84353c479782 633 l2capoutbuf[12] = 0x09; // Length = 9
hudakz 0:84353c479782 634
hudakz 0:84353c479782 635 // Identifier representing the natural language = en = English - see: "ISO 639:1988"
hudakz 0:84353c479782 636 l2capoutbuf[13] = 0x09; // Unsigned Integer - length 2 bytes
hudakz 0:84353c479782 637 l2capoutbuf[14] = 0x65; // 'e'
hudakz 0:84353c479782 638 l2capoutbuf[15] = 0x6E; // 'n'
hudakz 0:84353c479782 639
hudakz 0:84353c479782 640 // "The second element of each triplet contains an identifier that specifies a character encoding used for the language"
hudakz 0:84353c479782 641 // Encoding is set to 106 (UTF-8) - see: http://www.iana.org/assignments/character-sets/character-sets.xhtml
hudakz 0:84353c479782 642 l2capoutbuf[16] = 0x09; // Unsigned Integer - length 2 bytes
hudakz 0:84353c479782 643 l2capoutbuf[17] = 0x00; // MSB of character encoding
hudakz 0:84353c479782 644 l2capoutbuf[18] = 0x6A; // LSB of character encoding (106)
hudakz 0:84353c479782 645
hudakz 0:84353c479782 646 // Attribute ID that serves as the base attribute ID for the natural language in the service record
hudakz 0:84353c479782 647 // "To facilitate the retrieval of human-readable universal attributes in a principal language, the base attribute ID value for the primary language supported by a service record shall be 0x0100"
hudakz 0:84353c479782 648 l2capoutbuf[19] = 0x09; // Unsigned Integer - length 2 bytes
hudakz 0:84353c479782 649 l2capoutbuf[20] = 0x01;
hudakz 0:84353c479782 650 l2capoutbuf[21] = 0x00;
hudakz 0:84353c479782 651
hudakz 0:84353c479782 652 l2capoutbuf[22] = 0x09; // Unsigned Integer - length 2 bytes
hudakz 0:84353c479782 653 l2capoutbuf[23] = 0x01; // MSB ServiceDescription
hudakz 0:84353c479782 654 l2capoutbuf[24] = 0x00; // LSB ServiceDescription
hudakz 0:84353c479782 655
hudakz 0:84353c479782 656 l2capoutbuf[25] = 0x25; // Text string - length in next byte
hudakz 0:84353c479782 657 l2capoutbuf[26] = 0x05; // Name length
hudakz 0:84353c479782 658 l2capoutbuf[27] = 'T';
hudakz 0:84353c479782 659 l2capoutbuf[28] = 'K';
hudakz 0:84353c479782 660 l2capoutbuf[29] = 'J';
hudakz 0:84353c479782 661 l2capoutbuf[30] = 'S';
hudakz 0:84353c479782 662 l2capoutbuf[31] = 'P';
hudakz 0:84353c479782 663 l2capoutbuf[32] = 0x00; // No continuation state
hudakz 0:84353c479782 664
hudakz 0:84353c479782 665 SDP_Command(l2capoutbuf, 33);
hudakz 0:84353c479782 666 }
hudakz 0:84353c479782 667
hudakz 0:84353c479782 668 void SPP::l2capResponse1(uint8_t transactionIDHigh, uint8_t transactionIDLow) {
hudakz 0:84353c479782 669 serialPortResponse1(transactionIDHigh, transactionIDLow); // These has to send all the supported functions, since it only supports virtual serialport it just sends the message again
hudakz 0:84353c479782 670 }
hudakz 0:84353c479782 671
hudakz 0:84353c479782 672 void SPP::l2capResponse2(uint8_t transactionIDHigh, uint8_t transactionIDLow) {
hudakz 0:84353c479782 673 serialPortResponse2(transactionIDHigh, transactionIDLow); // Same data as serialPortResponse2
hudakz 0:84353c479782 674 }
hudakz 0:84353c479782 675 /************************************************************/
hudakz 0:84353c479782 676 /* RFCOMM Commands */
hudakz 0:84353c479782 677
hudakz 0:84353c479782 678 /************************************************************/
hudakz 0:84353c479782 679 void SPP::RFCOMM_Command(uint8_t* data, uint8_t nbytes) {
hudakz 0:84353c479782 680 pBtd->L2CAP_Command(hci_handle, data, nbytes, rfcomm_scid[0], rfcomm_scid[1]);
hudakz 0:84353c479782 681 }
hudakz 0:84353c479782 682
hudakz 0:84353c479782 683 void SPP::sendRfcomm(uint8_t channel, uint8_t direction, uint8_t CR, uint8_t channelType, uint8_t pfBit, uint8_t* data, uint8_t length) {
hudakz 0:84353c479782 684 l2capoutbuf[0] = channel | direction | CR | extendAddress; // RFCOMM Address
hudakz 0:84353c479782 685 l2capoutbuf[1] = channelType | pfBit; // RFCOMM Control
hudakz 0:84353c479782 686 l2capoutbuf[2] = length << 1 | 0x01; // Length and format (always 0x01 bytes format)
hudakz 0:84353c479782 687 uint8_t i = 0;
hudakz 0:84353c479782 688 for(; i < length; i++)
hudakz 0:84353c479782 689 l2capoutbuf[i + 3] = data[i];
hudakz 0:84353c479782 690 l2capoutbuf[i + 3] = calcFcs(l2capoutbuf);
hudakz 0:84353c479782 691 #ifdef EXTRADEBUG
hudakz 0:84353c479782 692 Notify(PSTR(" - RFCOMM Data: "), 0x80);
hudakz 0:84353c479782 693 for(i = 0; i < length + 4; i++) {
hudakz 0:84353c479782 694 D_PrintHex<uint8_t > (l2capoutbuf[i], 0x80);
hudakz 0:84353c479782 695 Notify(PSTR(" "), 0x80);
hudakz 0:84353c479782 696 }
hudakz 0:84353c479782 697 #endif
hudakz 0:84353c479782 698 RFCOMM_Command(l2capoutbuf, length + 4);
hudakz 0:84353c479782 699 }
hudakz 0:84353c479782 700
hudakz 0:84353c479782 701 void SPP::sendRfcommCredit(uint8_t channel, uint8_t direction, uint8_t CR, uint8_t channelType, uint8_t pfBit, uint8_t credit) {
hudakz 0:84353c479782 702 l2capoutbuf[0] = channel | direction | CR | extendAddress; // RFCOMM Address
hudakz 0:84353c479782 703 l2capoutbuf[1] = channelType | pfBit; // RFCOMM Control
hudakz 0:84353c479782 704 l2capoutbuf[2] = 0x01; // Length = 0
hudakz 0:84353c479782 705 l2capoutbuf[3] = credit; // Credit
hudakz 0:84353c479782 706 l2capoutbuf[4] = calcFcs(l2capoutbuf);
hudakz 0:84353c479782 707 #ifdef EXTRADEBUG
hudakz 0:84353c479782 708 Notify(PSTR(" - RFCOMM Credit Data: "), 0x80);
hudakz 0:84353c479782 709 for(uint8_t i = 0; i < 5; i++) {
hudakz 0:84353c479782 710 D_PrintHex<uint8_t > (l2capoutbuf[i], 0x80);
hudakz 0:84353c479782 711 Notify(PSTR(" "), 0x80);
hudakz 0:84353c479782 712 }
hudakz 0:84353c479782 713 #endif
hudakz 0:84353c479782 714 RFCOMM_Command(l2capoutbuf, 5);
hudakz 0:84353c479782 715 }
hudakz 0:84353c479782 716
hudakz 0:84353c479782 717 /* CRC on 2 bytes */
hudakz 0:84353c479782 718 uint8_t SPP::crc(uint8_t *data) {
hudakz 0:84353c479782 719 return (pgm_read_byte(&rfcomm_crc_table[pgm_read_byte(&rfcomm_crc_table[0xFF ^ data[0]]) ^ data[1]]));
hudakz 0:84353c479782 720 }
hudakz 0:84353c479782 721
hudakz 0:84353c479782 722 /* Calculate FCS */
hudakz 0:84353c479782 723 uint8_t SPP::calcFcs(uint8_t *data) {
hudakz 0:84353c479782 724 uint8_t temp = crc(data);
hudakz 0:84353c479782 725 if((data[1] & 0xEF) == RFCOMM_UIH)
hudakz 0:84353c479782 726 return (0xFF - temp); // FCS on 2 bytes
hudakz 0:84353c479782 727 else
hudakz 0:84353c479782 728 return (0xFF - pgm_read_byte(&rfcomm_crc_table[temp ^ data[2]])); // FCS on 3 bytes
hudakz 0:84353c479782 729 }
hudakz 0:84353c479782 730
hudakz 0:84353c479782 731 /* Check FCS */
hudakz 0:84353c479782 732 bool SPP::checkFcs(uint8_t *data, uint8_t fcs) {
hudakz 0:84353c479782 733 uint8_t temp = crc(data);
hudakz 0:84353c479782 734 if((data[1] & 0xEF) != RFCOMM_UIH)
hudakz 0:84353c479782 735 temp = pgm_read_byte(&rfcomm_crc_table[temp ^ data[2]]); // FCS on 3 bytes
hudakz 0:84353c479782 736 return (pgm_read_byte(&rfcomm_crc_table[temp ^ fcs]) == 0xCF);
hudakz 0:84353c479782 737 }
hudakz 0:84353c479782 738
hudakz 0:84353c479782 739 /* Serial commands */
hudakz 0:84353c479782 740 #if defined(ARDUINO) && ARDUINO >=100
hudakz 0:84353c479782 741
hudakz 0:84353c479782 742 size_t SPP::write(uint8_t data) {
hudakz 0:84353c479782 743 return write(&data, 1);
hudakz 0:84353c479782 744 }
hudakz 0:84353c479782 745 #else
hudakz 0:84353c479782 746
hudakz 0:84353c479782 747 void SPP::write(uint8_t data) {
hudakz 0:84353c479782 748 write(&data, 1);
hudakz 0:84353c479782 749 }
hudakz 0:84353c479782 750 #endif
hudakz 0:84353c479782 751
hudakz 0:84353c479782 752 #if defined(ARDUINO) && ARDUINO >=100
hudakz 0:84353c479782 753
hudakz 0:84353c479782 754 size_t SPP::write(const uint8_t *data, size_t size) {
hudakz 0:84353c479782 755 #else
hudakz 0:84353c479782 756
hudakz 0:84353c479782 757 void SPP::write(const uint8_t *data, size_t size) {
hudakz 0:84353c479782 758 #endif
hudakz 0:84353c479782 759 for(uint8_t i = 0; i < size; i++) {
hudakz 0:84353c479782 760 if(sppIndex >= sizeof (sppOutputBuffer) / sizeof (sppOutputBuffer[0]))
hudakz 0:84353c479782 761 send(); // Send the current data in the buffer
hudakz 0:84353c479782 762 sppOutputBuffer[sppIndex++] = data[i]; // All the bytes are put into a buffer and then send using the send() function
hudakz 0:84353c479782 763 }
hudakz 0:84353c479782 764 #if defined(ARDUINO) && ARDUINO >=100
hudakz 0:84353c479782 765 return size;
hudakz 0:84353c479782 766 #endif
hudakz 0:84353c479782 767 }
hudakz 0:84353c479782 768
hudakz 0:84353c479782 769 void SPP::send() {
hudakz 0:84353c479782 770 if(!connected || !sppIndex)
hudakz 0:84353c479782 771 return;
hudakz 0:84353c479782 772 uint8_t length; // This is the length of the string we are sending
hudakz 0:84353c479782 773 uint8_t offset = 0; // This is used to keep track of where we are in the string
hudakz 0:84353c479782 774
hudakz 0:84353c479782 775 l2capoutbuf[0] = rfcommChannelConnection | 0 | 0 | extendAddress; // RFCOMM Address
hudakz 0:84353c479782 776 l2capoutbuf[1] = RFCOMM_UIH; // RFCOMM Control
hudakz 0:84353c479782 777
hudakz 0:84353c479782 778 while(sppIndex) { // We will run this while loop until this variable is 0
hudakz 0:84353c479782 779 if(sppIndex > (sizeof (l2capoutbuf) - 4)) // Check if the string is larger than the outgoing buffer
hudakz 0:84353c479782 780 length = sizeof (l2capoutbuf) - 4;
hudakz 0:84353c479782 781 else
hudakz 0:84353c479782 782 length = sppIndex;
hudakz 0:84353c479782 783
hudakz 0:84353c479782 784 l2capoutbuf[2] = length << 1 | 1; // Length
hudakz 0:84353c479782 785 uint8_t i = 0;
hudakz 0:84353c479782 786 for(; i < length; i++)
hudakz 0:84353c479782 787 l2capoutbuf[i + 3] = sppOutputBuffer[i + offset];
hudakz 0:84353c479782 788 l2capoutbuf[i + 3] = calcFcs(l2capoutbuf); // Calculate checksum
hudakz 0:84353c479782 789
hudakz 0:84353c479782 790 RFCOMM_Command(l2capoutbuf, length + 4);
hudakz 0:84353c479782 791
hudakz 0:84353c479782 792 sppIndex -= length;
hudakz 0:84353c479782 793 offset += length; // Increment the offset
hudakz 0:84353c479782 794 }
hudakz 0:84353c479782 795 }
hudakz 0:84353c479782 796
hudakz 0:84353c479782 797 int SPP::available(void) {
hudakz 0:84353c479782 798 return rfcommAvailable;
hudakz 0:84353c479782 799 };
hudakz 0:84353c479782 800
hudakz 0:84353c479782 801 void SPP::discard(void) {
hudakz 0:84353c479782 802 rfcommAvailable = 0;
hudakz 0:84353c479782 803 }
hudakz 0:84353c479782 804
hudakz 0:84353c479782 805 int SPP::peek(void) {
hudakz 0:84353c479782 806 if(rfcommAvailable == 0) // Don't read if there is nothing in the buffer
hudakz 0:84353c479782 807 return -1;
hudakz 0:84353c479782 808 return rfcommDataBuffer[0];
hudakz 0:84353c479782 809 }
hudakz 0:84353c479782 810
hudakz 0:84353c479782 811 int SPP::read(void) {
hudakz 0:84353c479782 812 if(rfcommAvailable == 0) // Don't read if there is nothing in the buffer
hudakz 0:84353c479782 813 return -1;
hudakz 0:84353c479782 814 uint8_t output = rfcommDataBuffer[0];
hudakz 0:84353c479782 815 for(uint8_t i = 1; i < rfcommAvailable; i++)
hudakz 0:84353c479782 816 rfcommDataBuffer[i - 1] = rfcommDataBuffer[i]; // Shift the buffer one left
hudakz 0:84353c479782 817 rfcommAvailable--;
hudakz 0:84353c479782 818 bytesRead++;
hudakz 0:84353c479782 819 if(bytesRead > (sizeof (rfcommDataBuffer) - 5)) { // We will send the command just before it runs out of credit
hudakz 0:84353c479782 820 bytesRead = 0;
hudakz 0:84353c479782 821 sendRfcommCredit(rfcommChannelConnection, rfcommDirection, 0, RFCOMM_UIH, 0x10, sizeof (rfcommDataBuffer)); // Send more credit
hudakz 0:84353c479782 822 #ifdef EXTRADEBUG
hudakz 0:84353c479782 823 Notify(PSTR("\r\nSent "), 0x80);
hudakz 0:84353c479782 824 Notify((uint8_t)sizeof (rfcommDataBuffer), 0x80);
hudakz 0:84353c479782 825 Notify(PSTR(" more credit"), 0x80);
hudakz 0:84353c479782 826 #endif
hudakz 0:84353c479782 827 }
hudakz 0:84353c479782 828 return output;
hudakz 0:84353c479782 829 }