2013-02-05 20:02:12 +01:00
<!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "http://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd">
< html xmlns = "http://www.w3.org/1999/xhtml" >
< head >
< meta http-equiv = "Content-Type" content = "text/xhtml;charset=UTF-8" / >
< meta http-equiv = "X-UA-Compatible" content = "IE=9" / >
< meta name = "generator" content = "Doxygen 1.8.3.1" / >
2013-02-17 01:37:13 +01:00
< title > USB Host Shield 2.0: SPP.cpp Source File< / title >
2013-02-05 20:02:12 +01:00
< link href = "tabs.css" rel = "stylesheet" type = "text/css" / >
< script type = "text/javascript" src = "jquery.js" > < / script >
< script type = "text/javascript" src = "dynsections.js" > < / script >
< link href = "search/search.css" rel = "stylesheet" type = "text/css" / >
< script type = "text/javascript" src = "search/search.js" > < / script >
< script type = "text/javascript" >
$(document).ready(function() { searchBox.OnSelectItem(0); });
< / script >
< link href = "doxygen.css" rel = "stylesheet" type = "text/css" / >
2013-02-05 22:39:56 +01:00
< link href = "imageStyle.css" rel = "stylesheet" type = "text/css" / >
2013-02-05 20:02:12 +01:00
< / head >
< body >
< div id = "top" > <!-- do not remove this div, it is closed by doxygen! -->
< div id = "titlearea" >
< table cellspacing = "0" cellpadding = "0" >
< tbody >
< tr style = "height: 56px;" >
< td style = "padding-left: 0.5em;" >
2013-02-17 01:37:13 +01:00
< div id = "projectname" > USB Host Shield 2.0
2013-02-05 20:02:12 +01:00
< / div >
< / td >
< / tr >
< / tbody >
< / table >
< / div >
<!-- end header part -->
<!-- Generated by Doxygen 1.8.3.1 -->
< script type = "text/javascript" >
var searchBox = new SearchBox("searchBox", "search",false,'Search');
< / script >
< div id = "navrow1" class = "tabs" >
< ul class = "tablist" >
< li > < a href = "index.html" > < span > Main  Page< / span > < / a > < / li >
< li > < a href = "pages.html" > < span > Related  Pages< / span > < / a > < / li >
< li > < a href = "annotated.html" > < span > Classes< / span > < / a > < / li >
< li class = "current" > < a href = "files.html" > < span > Files< / span > < / a > < / li >
< li >
< div id = "MSearchBox" class = "MSearchBoxInactive" >
< span class = "left" >
< img id = "MSearchSelect" src = "search/mag_sel.png"
onmouseover="return searchBox.OnSearchSelectShow()"
onmouseout="return searchBox.OnSearchSelectHide()"
alt=""/>
< input type = "text" id = "MSearchField" value = "Search" accesskey = "S"
onfocus="searchBox.OnSearchFieldFocus(true)"
onblur="searchBox.OnSearchFieldFocus(false)"
onkeyup="searchBox.OnSearchFieldChange(event)"/>
< / span > < span class = "right" >
< a id = "MSearchClose" href = "javascript:searchBox.CloseResultsWindow()" > < img id = "MSearchCloseImg" border = "0" src = "search/close.png" alt = "" / > < / a >
< / span >
< / div >
< / li >
< / ul >
< / div >
< div id = "navrow2" class = "tabs2" >
< ul class = "tablist" >
< li > < a href = "files.html" > < span > File  List< / span > < / a > < / li >
< li > < a href = "globals.html" > < span > File  Members< / span > < / a > < / li >
< / ul >
< / div >
<!-- window showing the filter options -->
< div id = "MSearchSelectWindow"
onmouseover="return searchBox.OnSearchSelectShow()"
onmouseout="return searchBox.OnSearchSelectHide()"
onkeydown="return searchBox.OnSearchSelectKey(event)">
< a class = "SelectItem" href = "javascript:void(0)" onclick = "searchBox.OnSelectItem(0)" > < span class = "SelectionMark" >   < / span > All< / a > < a class = "SelectItem" href = "javascript:void(0)" onclick = "searchBox.OnSelectItem(1)" > < span class = "SelectionMark" >   < / span > Classes< / a > < a class = "SelectItem" href = "javascript:void(0)" onclick = "searchBox.OnSelectItem(2)" > < span class = "SelectionMark" >   < / span > Files< / a > < a class = "SelectItem" href = "javascript:void(0)" onclick = "searchBox.OnSelectItem(3)" > < span class = "SelectionMark" >   < / span > Functions< / a > < a class = "SelectItem" href = "javascript:void(0)" onclick = "searchBox.OnSelectItem(4)" > < span class = "SelectionMark" >   < / span > Variables< / a > < a class = "SelectItem" href = "javascript:void(0)" onclick = "searchBox.OnSelectItem(5)" > < span class = "SelectionMark" >   < / span > Typedefs< / a > < a class = "SelectItem" href = "javascript:void(0)" onclick = "searchBox.OnSelectItem(6)" > < span class = "SelectionMark" >   < / span > Enumerations< / a > < a class = "SelectItem" href = "javascript:void(0)" onclick = "searchBox.OnSelectItem(7)" > < span class = "SelectionMark" >   < / span > Enumerator< / a > < a class = "SelectItem" href = "javascript:void(0)" onclick = "searchBox.OnSelectItem(8)" > < span class = "SelectionMark" >   < / span > Macros< / a > < a class = "SelectItem" href = "javascript:void(0)" onclick = "searchBox.OnSelectItem(9)" > < span class = "SelectionMark" >   < / span > Pages< / a > < / div >
<!-- iframe showing the search results (closed by default) -->
< div id = "MSearchResultsWindow" >
< iframe src = "javascript:void(0)" frameborder = "0"
name="MSearchResults" id="MSearchResults">
< / iframe >
< / div >
< div id = "nav-path" class = "navpath" >
< ul >
2013-02-05 22:39:56 +01:00
< li class = "navelem" > < a class = "el" href = "dir_e5fbe6d2783ccd4c93c7856d92d7be6e.html" > GitHub< / a > < / li > < li class = "navelem" > < a class = "el" href = "dir_397a095372f04465e811d0ee219bbf8f.html" > USB_Host_Shield_2.0< / a > < / li > < / ul >
2013-02-05 20:02:12 +01:00
< / div >
< / div > <!-- top -->
< div class = "header" >
< div class = "headertitle" >
< div class = "title" > SPP.cpp< / div > < / div >
< / div > <!-- header -->
< div class = "contents" >
< a href = "_s_p_p_8cpp.html" > Go to the documentation of this file.< / a > < div class = "fragment" > < div class = "line" > < a name = "l00001" > < / a > < span class = "lineno" > 1< / span >   < span class = "comment" > /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved.< / span > < / div >
< div class = "line" > < a name = "l00002" > < / a > < span class = "lineno" > 2< / span >   < span class = "comment" > < / span > < / div >
< div class = "line" > < a name = "l00003" > < / a > < span class = "lineno" > 3< / span >   < span class = "comment" > This software may be distributed and modified under the terms of the GNU< / span > < / div >
< div class = "line" > < a name = "l00004" > < / a > < span class = "lineno" > 4< / span >   < span class = "comment" > General Public License version 2 (GPL2) as published by the Free Software< / span > < / div >
< div class = "line" > < a name = "l00005" > < / a > < span class = "lineno" > 5< / span >   < span class = "comment" > Foundation and appearing in the file GPL2.TXT included in the packaging of< / span > < / div >
< div class = "line" > < a name = "l00006" > < / a > < span class = "lineno" > 6< / span >   < span class = "comment" > this file. Please note that GPL2 Section 2[b] requires that all works based< / span > < / div >
< div class = "line" > < a name = "l00007" > < / a > < span class = "lineno" > 7< / span >   < span class = "comment" > on this software must also be made publicly available under the terms of< / span > < / div >
< div class = "line" > < a name = "l00008" > < / a > < span class = "lineno" > 8< / span >   < span class = "comment" > the GPL2 (" Copyleft" ).< / span > < / div >
< div class = "line" > < a name = "l00009" > < / a > < span class = "lineno" > 9< / span >   < span class = "comment" > < / span > < / div >
< div class = "line" > < a name = "l00010" > < / a > < span class = "lineno" > 10< / span >   < span class = "comment" > Contact information< / span > < / div >
< div class = "line" > < a name = "l00011" > < / a > < span class = "lineno" > 11< / span >   < span class = "comment" > -------------------< / span > < / div >
< div class = "line" > < a name = "l00012" > < / a > < span class = "lineno" > 12< / span >   < span class = "comment" > < / span > < / div >
< div class = "line" > < a name = "l00013" > < / a > < span class = "lineno" > 13< / span >   < span class = "comment" > Kristian Lauszus, TKJ Electronics< / span > < / div >
< div class = "line" > < a name = "l00014" > < / a > < span class = "lineno" > 14< / span >   < span class = "comment" > Web : http://www.tkjelectronics.com< / span > < / div >
< div class = "line" > < a name = "l00015" > < / a > < span class = "lineno" > 15< / span >   < span class = "comment" > e-mail : kristianl@tkjelectronics.com< / span > < / div >
< div class = "line" > < a name = "l00016" > < / a > < span class = "lineno" > 16< / span >   < span class = "comment" > */< / span > < / div >
< div class = "line" > < a name = "l00017" > < / a > < span class = "lineno" > 17< / span >   < / div >
< div class = "line" > < a name = "l00018" > < / a > < span class = "lineno" > 18< / span >   < span class = "preprocessor" > #include " < a class = "code" href = "_s_p_p_8h.html" > SPP.h< / a > " < / span > < / div >
< div class = "line" > < a name = "l00019" > < / a > < span class = "lineno" > < a class = "code" href = "_s_p_p_8cpp.html#ad72dbcf6d0153db1b8d8a58001feed83" > 19< / a > < / span >   < span class = "preprocessor" > #define DEBUG // Uncomment to print data for debugging< / span > < / div >
< div class = "line" > < a name = "l00020" > < / a > < span class = "lineno" > 20< / span >   < span class = "preprocessor" > < / span > < span class = "comment" > //#define EXTRADEBUG // Uncomment to get even more debugging data< / span > < / div >
< div class = "line" > < a name = "l00021" > < / a > < span class = "lineno" > 21< / span >   < span class = "comment" > //#define PRINTREPORT // Uncomment to print the report sent to the Arduino< / span > < / div >
< div class = "line" > < a name = "l00022" > < / a > < span class = "lineno" > 22< / span >   < / div >
< div class = "line" > < a name = "l00023" > < / a > < span class = "lineno" > 23< / span >   < span class = "comment" > /*< / span > < / div >
< div class = "line" > < a name = "l00024" > < / a > < span class = "lineno" > 24< / span >   < span class = "comment" > * CRC (reversed crc) lookup table as calculated by the table generator in ETSI TS 101 369 V6.3.0.< / span > < / div >
< div class = "line" > < a name = "l00025" > < / a > < span class = "lineno" > 25< / span >   < span class = "comment" > */< / span > < / div >
2013-02-05 22:39:56 +01:00
< div class = "line" > < a name = "l00026" > < / a > < span class = "lineno" > < a class = "code" href = "_s_p_p_8cpp.html#a5c3da75486e8c6a65da9ecc5c9c588e1" > 26< / a > < / span >   < span class = "keyword" > const< / span > uint8_t rfcomm_crc_table[256] < a class = "code" href = "hidboot_8cpp.html#ad1eb9d7b0347c20d121c984618c442f0" > PROGMEM< / a > = { < span class = "comment" > /* reversed, 8-bit, poly=0x07 */< / span > < / div >
2013-02-05 20:02:12 +01:00
< div class = "line" > < a name = "l00027" > < / a > < span class = "lineno" > 27< / span >   0x00, 0x91, 0xE3, 0x72, 0x07, 0x96, 0xE4, 0x75, 0x0E, 0x9F, 0xED, 0x7C, 0x09, 0x98, 0xEA, 0x7B,< / div >
< div class = "line" > < a name = "l00028" > < / a > < span class = "lineno" > 28< / span >   0x1C, 0x8D, 0xFF, 0x6E, 0x1B, 0x8A, 0xF8, 0x69, 0x12, 0x83, 0xF1, 0x60, 0x15, 0x84, 0xF6, 0x67,< / div >
< div class = "line" > < a name = "l00029" > < / a > < span class = "lineno" > 29< / span >   0x38, 0xA9, 0xDB, 0x4A, 0x3F, 0xAE, 0xDC, 0x4D, 0x36, 0xA7, 0xD5, 0x44, 0x31, 0xA0, 0xD2, 0x43,< / div >
< div class = "line" > < a name = "l00030" > < / a > < span class = "lineno" > 30< / span >   0x24, 0xB5, 0xC7, 0x56, 0x23, 0xB2, 0xC0, 0x51, 0x2A, 0xBB, 0xC9, 0x58, 0x2D, 0xBC, 0xCE, 0x5F,< / div >
< div class = "line" > < a name = "l00031" > < / a > < span class = "lineno" > 31< / span >   0x70, 0xE1, 0x93, 0x02, 0x77, 0xE6, 0x94, 0x05, 0x7E, 0xEF, 0x9D, 0x0C, 0x79, 0xE8, 0x9A, 0x0B,< / div >
< div class = "line" > < a name = "l00032" > < / a > < span class = "lineno" > 32< / span >   0x6C, 0xFD, 0x8F, 0x1E, 0x6B, 0xFA, 0x88, 0x19, 0x62, 0xF3, 0x81, 0x10, 0x65, 0xF4, 0x86, 0x17,< / div >
< div class = "line" > < a name = "l00033" > < / a > < span class = "lineno" > 33< / span >   0x48, 0xD9, 0xAB, 0x3A, 0x4F, 0xDE, 0xAC, 0x3D, 0x46, 0xD7, 0xA5, 0x34, 0x41, 0xD0, 0xA2, 0x33,< / div >
< div class = "line" > < a name = "l00034" > < / a > < span class = "lineno" > 34< / span >   0x54, 0xC5, 0xB7, 0x26, 0x53, 0xC2, 0xB0, 0x21, 0x5A, 0xCB, 0xB9, 0x28, 0x5D, 0xCC, 0xBE, 0x2F,< / div >
< div class = "line" > < a name = "l00035" > < / a > < span class = "lineno" > 35< / span >   0xE0, 0x71, 0x03, 0x92, 0xE7, 0x76, 0x04, 0x95, 0xEE, 0x7F, 0x0D, 0x9C, 0xE9, 0x78, 0x0A, 0x9B,< / div >
< div class = "line" > < a name = "l00036" > < / a > < span class = "lineno" > 36< / span >   0xFC, 0x6D, 0x1F, 0x8E, 0xFB, 0x6A, 0x18, 0x89, 0xF2, 0x63, 0x11, 0x80, 0xF5, 0x64, 0x16, 0x87,< / div >
< div class = "line" > < a name = "l00037" > < / a > < span class = "lineno" > 37< / span >   0xD8, 0x49, 0x3B, 0xAA, 0xDF, 0x4E, 0x3C, 0xAD, 0xD6, 0x47, 0x35, 0xA4, 0xD1, 0x40, 0x32, 0xA3,< / div >
< div class = "line" > < a name = "l00038" > < / a > < span class = "lineno" > 38< / span >   0xC4, 0x55, 0x27, 0xB6, 0xC3, 0x52, 0x20, 0xB1, 0xCA, 0x5B, 0x29, 0xB8, 0xCD, 0x5C, 0x2E, 0xBF,< / div >
< div class = "line" > < a name = "l00039" > < / a > < span class = "lineno" > 39< / span >   0x90, 0x01, 0x73, 0xE2, 0x97, 0x06, 0x74, 0xE5, 0x9E, 0x0F, 0x7D, 0xEC, 0x99, 0x08, 0x7A, 0xEB,< / div >
< div class = "line" > < a name = "l00040" > < / a > < span class = "lineno" > 40< / span >   0x8C, 0x1D, 0x6F, 0xFE, 0x8B, 0x1A, 0x68, 0xF9, 0x82, 0x13, 0x61, 0xF0, 0x85, 0x14, 0x66, 0xF7,< / div >
< div class = "line" > < a name = "l00041" > < / a > < span class = "lineno" > 41< / span >   0xA8, 0x39, 0x4B, 0xDA, 0xAF, 0x3E, 0x4C, 0xDD, 0xA6, 0x37, 0x45, 0xD4, 0xA1, 0x30, 0x42, 0xD3,< / div >
< div class = "line" > < a name = "l00042" > < / a > < span class = "lineno" > 42< / span >   0xB4, 0x25, 0x57, 0xC6, 0xB3, 0x22, 0x50, 0xC1, 0xBA, 0x2B, 0x59, 0xC8, 0xBD, 0x2C, 0x5E, 0xCF< / div >
< div class = "line" > < a name = "l00043" > < / a > < span class = "lineno" > 43< / span >   };< / div >
< div class = "line" > < a name = "l00044" > < / a > < span class = "lineno" > 44< / span >   < / div >
< div class = "line" > < a name = "l00045" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#ae5cb4167b3ab9c891398f54729c6da81" > 45< / a > < / span >   < a class = "code" href = "class_s_p_p.html#ae5cb4167b3ab9c891398f54729c6da81" > SPP::SPP< / a > (< a class = "code" href = "class_b_t_d.html" > BTD< / a > *p, < span class = "keyword" > const< / span > < span class = "keywordtype" > char< / span > * name, < span class = "keyword" > const< / span > < span class = "keywordtype" > char< / span > * pin):< / div >
< div class = "line" > < a name = "l00046" > < / a > < span class = "lineno" > 46< / span >   pBtd(p) < span class = "comment" > // Pointer to BTD class instance - mandatory< / span > < / div >
< div class = "line" > < a name = "l00047" > < / a > < span class = "lineno" > 47< / span >   {< / div >
< div class = "line" > < a name = "l00048" > < / a > < span class = "lineno" > 48< / span >   < span class = "keywordflow" > if< / span > (pBtd)< / div >
< div class = "line" > < a name = "l00049" > < / a > < span class = "lineno" > 49< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#a4adfc7e51ad3b3c03e7c37d1af159e73" > registerServiceClass< / a > (< span class = "keyword" > this< / span > ); < span class = "comment" > // Register it as a Bluetooth service< / span > < / div >
< div class = "line" > < a name = "l00050" > < / a > < span class = "lineno" > 50< / span >   < / div >
< div class = "line" > < a name = "l00051" > < / a > < span class = "lineno" > 51< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#a0359c0c158c864c27319810cbd1534f9" > btdName< / a > = name;< / div >
< div class = "line" > < a name = "l00052" > < / a > < span class = "lineno" > 52< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#a215cb939c01ed3ff56db37841224546c" > btdPin< / a > = pin;< / div >
< div class = "line" > < a name = "l00053" > < / a > < span class = "lineno" > 53< / span >   < / div >
< div class = "line" > < a name = "l00054" > < / a > < span class = "lineno" > 54< / span >   < span class = "comment" > /* Set device cid for the SDP and RFCOMM channelse */< / span > < / div >
< div class = "line" > < a name = "l00055" > < / a > < span class = "lineno" > 55< / span >   sdp_dcid[0] = 0x50; < span class = "comment" > // 0x0050< / span > < / div >
< div class = "line" > < a name = "l00056" > < / a > < span class = "lineno" > 56< / span >   sdp_dcid[1] = 0x00;< / div >
< div class = "line" > < a name = "l00057" > < / a > < span class = "lineno" > 57< / span >   rfcomm_dcid[0] = 0x51; < span class = "comment" > // 0x0051< / span > < / div >
< div class = "line" > < a name = "l00058" > < / a > < span class = "lineno" > 58< / span >   rfcomm_dcid[1] = 0x00;< / div >
< div class = "line" > < a name = "l00059" > < / a > < span class = "lineno" > 59< / span >   < / div >
< div class = "line" > < a name = "l00060" > < / a > < span class = "lineno" > 60< / span >   < a class = "code" href = "class_s_p_p.html#ae2c661bd46cd2d74bd29c4c771cd2ef0" > Reset< / a > ();< / div >
< div class = "line" > < a name = "l00061" > < / a > < span class = "lineno" > 61< / span >   }< / div >
< div class = "line" > < a name = "l00062" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#ae2c661bd46cd2d74bd29c4c771cd2ef0" > 62< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#ae2c661bd46cd2d74bd29c4c771cd2ef0" > SPP::Reset< / a > () {< / div >
< div class = "line" > < a name = "l00063" > < / a > < span class = "lineno" > 63< / span >   < a class = "code" href = "class_s_p_p.html#ade5d4f0ab50ddcad14f75fce4450a028" > connected< / a > = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00064" > < / a > < span class = "lineno" > 64< / span >   RFCOMMConnected = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00065" > < / a > < span class = "lineno" > 65< / span >   SDPConnected = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00066" > < / a > < span class = "lineno" > 66< / span >   l2cap_sdp_state = < a class = "code" href = "_s_p_p_8h.html#a72444116eaac116983a3dec35b1944f0" > L2CAP_SDP_WAIT< / a > ;< / div >
< div class = "line" > < a name = "l00067" > < / a > < span class = "lineno" > 67< / span >   l2cap_rfcomm_state = < a class = "code" href = "_s_p_p_8h.html#a0b7cbe1aa26664847a48bd4578bc50bd" > L2CAP_RFCOMM_WAIT< / a > ;< / div >
< div class = "line" > < a name = "l00068" > < / a > < span class = "lineno" > 68< / span >   l2cap_event_flag = 0; < / div >
< div class = "line" > < a name = "l00069" > < / a > < span class = "lineno" > 69< / span >   }< / div >
< div class = "line" > < a name = "l00070" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a2b4b1f85f553c6a2fdd523e50c75c7b0" > 70< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#a2b4b1f85f553c6a2fdd523e50c75c7b0" > SPP::disconnect< / a > (){< / div >
< div class = "line" > < a name = "l00071" > < / a > < span class = "lineno" > 71< / span >   < a class = "code" href = "class_s_p_p.html#ade5d4f0ab50ddcad14f75fce4450a028" > connected< / a > = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00072" > < / a > < span class = "lineno" > 72< / span >   < span class = "comment" > // First the two L2CAP channels has to be disconencted and then the HCI connection< / span > < / div >
< div class = "line" > < a name = "l00073" > < / a > < span class = "lineno" > 73< / span >   < span class = "keywordflow" > if< / span > (RFCOMMConnected)< / div >
< div class = "line" > < a name = "l00074" > < / a > < span class = "lineno" > 74< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#ac7053ef7ac690be3afbbdd985b163f10" > l2cap_disconnection_request< / a > (hci_handle,0x0A, rfcomm_scid, rfcomm_dcid);< / div >
< div class = "line" > < a name = "l00075" > < / a > < span class = "lineno" > 75< / span >   < span class = "keywordflow" > if< / span > (RFCOMMConnected & & SDPConnected)< / div >
< div class = "line" > < a name = "l00076" > < / a > < span class = "lineno" > 76< / span >   delay(1); < span class = "comment" > // Add delay between commands< / span > < / div >
< div class = "line" > < a name = "l00077" > < / a > < span class = "lineno" > 77< / span >   < span class = "keywordflow" > if< / span > (SDPConnected)< / div >
< div class = "line" > < a name = "l00078" > < / a > < span class = "lineno" > 78< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#ac7053ef7ac690be3afbbdd985b163f10" > l2cap_disconnection_request< / a > (hci_handle,0x0B, sdp_scid, sdp_dcid);< / div >
< div class = "line" > < a name = "l00079" > < / a > < span class = "lineno" > 79< / span >   l2cap_sdp_state = < a class = "code" href = "_s_p_p_8h.html#adf2585ad5d49cf2df2595d860ad6b258" > L2CAP_DISCONNECT_RESPONSE< / a > ;< / div >
< div class = "line" > < a name = "l00080" > < / a > < span class = "lineno" > 80< / span >   }< / div >
< div class = "line" > < a name = "l00081" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#abdfe9453fb82781bec53a191c2e9fb1d" > 81< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#abdfe9453fb82781bec53a191c2e9fb1d" > SPP::ACLData< / a > (uint8_t* l2capinbuf) {< / div >
< div class = "line" > < a name = "l00082" > < / a > < span class = "lineno" > 82< / span >   < span class = "keywordflow" > if< / span > (!< a class = "code" href = "class_s_p_p.html#ade5d4f0ab50ddcad14f75fce4450a028" > connected< / a > ) {< / div >
< div class = "line" > < a name = "l00083" > < / a > < span class = "lineno" > 83< / span >   < span class = "keywordflow" > if< / span > (l2capinbuf[8] == < a class = "code" href = "_b_t_d_8h.html#ac4bae0c65fd00ed849cb226302d19c85" > L2CAP_CMD_CONNECTION_REQUEST< / a > ) {< / div >
< div class = "line" > < a name = "l00084" > < / a > < span class = "lineno" > 84< / span >   < span class = "keywordflow" > if< / span > ((l2capinbuf[12] | (l2capinbuf[13] < < 8)) == < a class = "code" href = "_b_t_d_8h.html#a25ce859d7ee2730e1d22d11c051ed60d" > SDP_PSM< / a > & & !pBtd-> < a class = "code" href = "class_b_t_d.html#af5e5b085cec1da5c83c75e80e95b3590" > sdpConnectionClaimed< / a > ) {< / div >
< div class = "line" > < a name = "l00085" > < / a > < span class = "lineno" > 85< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#af5e5b085cec1da5c83c75e80e95b3590" > sdpConnectionClaimed< / a > = < span class = "keyword" > true< / span > ;< / div >
< div class = "line" > < a name = "l00086" > < / a > < span class = "lineno" > 86< / span >   hci_handle = pBtd-> < a class = "code" href = "class_b_t_d.html#aa3bb6c692701cb33dfad1ea4d68b6f98" > hci_handle< / a > ; < span class = "comment" > // Store the HCI Handle for the connection< / span > < / div >
< div class = "line" > < a name = "l00087" > < / a > < span class = "lineno" > 87< / span >   l2cap_sdp_state = < a class = "code" href = "_s_p_p_8h.html#a72444116eaac116983a3dec35b1944f0" > L2CAP_SDP_WAIT< / a > ; < span class = "comment" > // Reset state< / span > < / div >
< div class = "line" > < a name = "l00088" > < / a > < span class = "lineno" > 88< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > ((l2capinbuf[12] | (l2capinbuf[13] < < 8)) == < a class = "code" href = "_b_t_d_8h.html#a2924020f2e7e82fe956574538e2bc3eb" > RFCOMM_PSM< / a > & & !pBtd-> < a class = "code" href = "class_b_t_d.html#a9e5a34242007b64cd6a226cfd1901e74" > rfcommConnectionClaimed< / a > ) {< / div >
< div class = "line" > < a name = "l00089" > < / a > < span class = "lineno" > 89< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#a9e5a34242007b64cd6a226cfd1901e74" > rfcommConnectionClaimed< / a > = < span class = "keyword" > true< / span > ;< / div >
< div class = "line" > < a name = "l00090" > < / a > < span class = "lineno" > 90< / span >   hci_handle = pBtd-> < a class = "code" href = "class_b_t_d.html#aa3bb6c692701cb33dfad1ea4d68b6f98" > hci_handle< / a > ; < span class = "comment" > // Store the HCI Handle for the connection< / span > < / div >
< div class = "line" > < a name = "l00091" > < / a > < span class = "lineno" > 91< / span >   l2cap_rfcomm_state = < a class = "code" href = "_s_p_p_8h.html#a0b7cbe1aa26664847a48bd4578bc50bd" > L2CAP_RFCOMM_WAIT< / a > ; < span class = "comment" > // Reset state< / span > < / div >
< div class = "line" > < a name = "l00092" > < / a > < span class = "lineno" > 92< / span >   }< / div >
< div class = "line" > < a name = "l00093" > < / a > < span class = "lineno" > 93< / span >   }< / div >
< div class = "line" > < a name = "l00094" > < / a > < span class = "lineno" > 94< / span >   }< / div >
< div class = "line" > < a name = "l00095" > < / a > < span class = "lineno" > 95< / span >   < span class = "keywordflow" > if< / span > (((l2capinbuf[0] | (l2capinbuf[1] < < 8)) == (hci_handle | 0x2000))) { < span class = "comment" > // acl_handle_ok< / span > < / div >
< div class = "line" > < a name = "l00096" > < / a > < span class = "lineno" > 96< / span >   < span class = "keywordflow" > if< / span > ((l2capinbuf[6] | (l2capinbuf[7] < < 8)) == 0x0001) { < span class = "comment" > //l2cap_control - Channel ID for ACL-U< / span > < / div >
< div class = "line" > < a name = "l00097" > < / a > < span class = "lineno" > 97< / span >   < span class = "keywordflow" > if< / span > (l2capinbuf[8] == < a class = "code" href = "_b_t_d_8h.html#a6ffcd72787c86f248192eb06a3fe18cb" > L2CAP_CMD_COMMAND_REJECT< / a > ) {< / div >
< div class = "line" > < a name = "l00098" > < / a > < span class = "lineno" > 98< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00099" > < / a > < span class = "lineno" > 99< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nL2CAP Command Rejected - Reason: " < / span > ));< / div >
< div class = "line" > < a name = "l00100" > < / a > < span class = "lineno" > 100< / span >   PrintHex< uint8_t> (l2capinbuf[13]);< / div >
< div class = "line" > < a name = "l00101" > < / a > < span class = "lineno" > 101< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " " < / span > ));< / div >
< div class = "line" > < a name = "l00102" > < / a > < span class = "lineno" > 102< / span >   PrintHex< uint8_t> (l2capinbuf[12]);< / div >
< div class = "line" > < a name = "l00103" > < / a > < span class = "lineno" > 103< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " Data: " < / span > ));< / div >
< div class = "line" > < a name = "l00104" > < / a > < span class = "lineno" > 104< / span >   PrintHex< uint8_t> (l2capinbuf[17]);< / div >
< div class = "line" > < a name = "l00105" > < / a > < span class = "lineno" > 105< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " " < / span > ));< / div >
< div class = "line" > < a name = "l00106" > < / a > < span class = "lineno" > 106< / span >   PrintHex< uint8_t> (l2capinbuf[16]);< / div >
< div class = "line" > < a name = "l00107" > < / a > < span class = "lineno" > 107< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " " < / span > ));< / div >
< div class = "line" > < a name = "l00108" > < / a > < span class = "lineno" > 108< / span >   PrintHex< uint8_t> (l2capinbuf[15]);< / div >
< div class = "line" > < a name = "l00109" > < / a > < span class = "lineno" > 109< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " " < / span > ));< / div >
< div class = "line" > < a name = "l00110" > < / a > < span class = "lineno" > 110< / span >   PrintHex< uint8_t> (l2capinbuf[14]);< / div >
< div class = "line" > < a name = "l00111" > < / a > < span class = "lineno" > 111< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00112" > < / a > < span class = "lineno" > 112< / span >   < span class = "preprocessor" > < / span > } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (l2capinbuf[8] == < a class = "code" href = "_b_t_d_8h.html#ac4bae0c65fd00ed849cb226302d19c85" > L2CAP_CMD_CONNECTION_REQUEST< / a > ) {< / div >
< div class = "line" > < a name = "l00113" > < / a > < span class = "lineno" > 113< / span >   < span class = "preprocessor" > #ifdef EXTRADEBUG< / span > < / div >
< div class = "line" > < a name = "l00114" > < / a > < span class = "lineno" > 114< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nL2CAP Connection Request - PSM: " < / span > ));< / div >
< div class = "line" > < a name = "l00115" > < / a > < span class = "lineno" > 115< / span >   PrintHex< uint8_t> (l2capinbuf[13]);< / div >
< div class = "line" > < a name = "l00116" > < / a > < span class = "lineno" > 116< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " " < / span > ));< / div >
< div class = "line" > < a name = "l00117" > < / a > < span class = "lineno" > 117< / span >   PrintHex< uint8_t> (l2capinbuf[12]);< / div >
< div class = "line" > < a name = "l00118" > < / a > < span class = "lineno" > 118< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " SCID: " < / span > ));< / div >
< div class = "line" > < a name = "l00119" > < / a > < span class = "lineno" > 119< / span >   PrintHex< uint8_t> (l2capinbuf[15]);< / div >
< div class = "line" > < a name = "l00120" > < / a > < span class = "lineno" > 120< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " " < / span > ));< / div >
< div class = "line" > < a name = "l00121" > < / a > < span class = "lineno" > 121< / span >   PrintHex< uint8_t> (l2capinbuf[14]);< / div >
< div class = "line" > < a name = "l00122" > < / a > < span class = "lineno" > 122< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " Identifier: " < / span > ));< / div >
< div class = "line" > < a name = "l00123" > < / a > < span class = "lineno" > 123< / span >   PrintHex< uint8_t> (l2capinbuf[9]);< / div >
< div class = "line" > < a name = "l00124" > < / a > < span class = "lineno" > 124< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00125" > < / a > < span class = "lineno" > 125< / span >   < span class = "preprocessor" > < / span > < span class = "keywordflow" > if< / span > ((l2capinbuf[12] | (l2capinbuf[13] < < 8)) == < a class = "code" href = "_b_t_d_8h.html#a25ce859d7ee2730e1d22d11c051ed60d" > SDP_PSM< / a > ) { < span class = "comment" > // 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< / span > < / div >
< div class = "line" > < a name = "l00126" > < / a > < span class = "lineno" > 126< / span >   identifier = l2capinbuf[9];< / div >
< div class = "line" > < a name = "l00127" > < / a > < span class = "lineno" > 127< / span >   sdp_scid[0] = l2capinbuf[14];< / div >
< div class = "line" > < a name = "l00128" > < / a > < span class = "lineno" > 128< / span >   sdp_scid[1] = l2capinbuf[15];< / div >
< div class = "line" > < a name = "l00129" > < / a > < span class = "lineno" > 129< / span >   l2cap_event_flag |= < a class = "code" href = "_s_p_p_8h.html#a0d649771ff995585c2bff030b7c1a2d3" > L2CAP_FLAG_CONNECTION_SDP_REQUEST< / a > ;< / div >
< div class = "line" > < a name = "l00130" > < / a > < span class = "lineno" > 130< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > ((l2capinbuf[12] | (l2capinbuf[13] < < 8)) == < a class = "code" href = "_b_t_d_8h.html#a2924020f2e7e82fe956574538e2bc3eb" > RFCOMM_PSM< / a > ) { < span class = "comment" > // ----- || -----< / span > < / div >
< div class = "line" > < a name = "l00131" > < / a > < span class = "lineno" > 131< / span >   identifier = l2capinbuf[9];< / div >
< div class = "line" > < a name = "l00132" > < / a > < span class = "lineno" > 132< / span >   rfcomm_scid[0] = l2capinbuf[14];< / div >
< div class = "line" > < a name = "l00133" > < / a > < span class = "lineno" > 133< / span >   rfcomm_scid[1] = l2capinbuf[15];< / div >
< div class = "line" > < a name = "l00134" > < / a > < span class = "lineno" > 134< / span >   l2cap_event_flag |= < a class = "code" href = "_s_p_p_8h.html#a61b15e54b1c5f9a28c996ae8e04ca3c0" > L2CAP_FLAG_CONNECTION_RFCOMM_REQUEST< / a > ;< / div >
< div class = "line" > < a name = "l00135" > < / a > < span class = "lineno" > 135< / span >   }< / div >
< div class = "line" > < a name = "l00136" > < / a > < span class = "lineno" > 136< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (l2capinbuf[8] == < a class = "code" href = "_b_t_d_8h.html#a8151b1fe5d940a5a7a34f43a8b8ce434" > L2CAP_CMD_CONFIG_RESPONSE< / a > ) {< / div >
< div class = "line" > < a name = "l00137" > < / a > < span class = "lineno" > 137< / span >   < span class = "keywordflow" > if< / span > ((l2capinbuf[16] | (l2capinbuf[17] < < 8)) == 0x0000) { < span class = "comment" > // Success< / span > < / div >
< div class = "line" > < a name = "l00138" > < / a > < span class = "lineno" > 138< / span >   < span class = "keywordflow" > if< / span > (l2capinbuf[12] == sdp_dcid[0] & & l2capinbuf[13] == sdp_dcid[1]) {< / div >
< div class = "line" > < a name = "l00139" > < / a > < span class = "lineno" > 139< / span >   < span class = "comment" > //Serial.print(" \r\nSDP Configuration Complete" );< / span > < / div >
< div class = "line" > < a name = "l00140" > < / a > < span class = "lineno" > 140< / span >   l2cap_event_flag |= < a class = "code" href = "_s_p_p_8h.html#a75ef214ce8a03e8d62a1b24554bc1a05" > L2CAP_FLAG_CONFIG_SDP_SUCCESS< / a > ;< / div >
< div class = "line" > < a name = "l00141" > < / a > < span class = "lineno" > 141< / span >   }< / div >
< div class = "line" > < a name = "l00142" > < / a > < span class = "lineno" > 142< / span >   < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (l2capinbuf[12] == rfcomm_dcid[0] & & l2capinbuf[13] == rfcomm_dcid[1]) {< / div >
< div class = "line" > < a name = "l00143" > < / a > < span class = "lineno" > 143< / span >   < span class = "comment" > //Serial.print(" \r\nRFCOMM Configuration Complete" );< / span > < / div >
< div class = "line" > < a name = "l00144" > < / a > < span class = "lineno" > 144< / span >   l2cap_event_flag |= < a class = "code" href = "_s_p_p_8h.html#a8af4ce4d4c42d85f0d84a514354fc570" > L2CAP_FLAG_CONFIG_RFCOMM_SUCCESS< / a > ;< / div >
< div class = "line" > < a name = "l00145" > < / a > < span class = "lineno" > 145< / span >   }< / div >
< div class = "line" > < a name = "l00146" > < / a > < span class = "lineno" > 146< / span >   }< / div >
< div class = "line" > < a name = "l00147" > < / a > < span class = "lineno" > 147< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (l2capinbuf[8] == < a class = "code" href = "_b_t_d_8h.html#a48bcd73461d736d0ef889e1fe6e36f69" > L2CAP_CMD_CONFIG_REQUEST< / a > ) {< / div >
< div class = "line" > < a name = "l00148" > < / a > < span class = "lineno" > 148< / span >   < span class = "keywordflow" > if< / span > (l2capinbuf[12] == sdp_dcid[0] & & l2capinbuf[13] == sdp_dcid[1]) {< / div >
< div class = "line" > < a name = "l00149" > < / a > < span class = "lineno" > 149< / span >   < span class = "comment" > //Serial.print(" \r\nSDP Configuration Request" );< / span > < / div >
< div class = "line" > < a name = "l00150" > < / a > < span class = "lineno" > 150< / span >   identifier = l2capinbuf[9];< / div >
< div class = "line" > < a name = "l00151" > < / a > < span class = "lineno" > 151< / span >   l2cap_event_flag |= < a class = "code" href = "_s_p_p_8h.html#a52cc6e4a2a6d151dd5d0e788b937b2e8" > L2CAP_FLAG_CONFIG_SDP_REQUEST< / a > ;< / div >
< div class = "line" > < a name = "l00152" > < / a > < span class = "lineno" > 152< / span >   }< / div >
< div class = "line" > < a name = "l00153" > < / a > < span class = "lineno" > 153< / span >   < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (l2capinbuf[12] == rfcomm_dcid[0] & & l2capinbuf[13] == rfcomm_dcid[1]) {< / div >
< div class = "line" > < a name = "l00154" > < / a > < span class = "lineno" > 154< / span >   < span class = "comment" > //Serial.print(" \r\nRFCOMM Configuration Request" );< / span > < / div >
< div class = "line" > < a name = "l00155" > < / a > < span class = "lineno" > 155< / span >   identifier = l2capinbuf[9];< / div >
< div class = "line" > < a name = "l00156" > < / a > < span class = "lineno" > 156< / span >   l2cap_event_flag |= < a class = "code" href = "_s_p_p_8h.html#abaa9eb6a1d27745243ef134ecad34bb2" > L2CAP_FLAG_CONFIG_RFCOMM_REQUEST< / a > ;< / div >
< div class = "line" > < a name = "l00157" > < / a > < span class = "lineno" > 157< / span >   }< / div >
< div class = "line" > < a name = "l00158" > < / a > < span class = "lineno" > 158< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (l2capinbuf[8] == < a class = "code" href = "_b_t_d_8h.html#a398676a2e9a2351a5a52afdddf4b660b" > L2CAP_CMD_DISCONNECT_REQUEST< / a > ) {< / div >
< div class = "line" > < a name = "l00159" > < / a > < span class = "lineno" > 159< / span >   < span class = "keywordflow" > if< / span > (l2capinbuf[12] == sdp_dcid[0] & & l2capinbuf[13] == sdp_dcid[1]) {< / div >
< div class = "line" > < a name = "l00160" > < / a > < span class = "lineno" > 160< / span >   < span class = "comment" > //Notify(PSTR(" \r\nDisconnect Request: SDP Channel" ));< / span > < / div >
< div class = "line" > < a name = "l00161" > < / a > < span class = "lineno" > 161< / span >   identifier = l2capinbuf[9];< / div >
< div class = "line" > < a name = "l00162" > < / a > < span class = "lineno" > 162< / span >   l2cap_event_flag |= < a class = "code" href = "_s_p_p_8h.html#aac25fa1de5df70a97a6ccc6267d65fea" > L2CAP_FLAG_DISCONNECT_SDP_REQUEST< / a > ;< / div >
< div class = "line" > < a name = "l00163" > < / a > < span class = "lineno" > 163< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (l2capinbuf[12] == rfcomm_dcid[0] & & l2capinbuf[13] == rfcomm_dcid[1]) {< / div >
< div class = "line" > < a name = "l00164" > < / a > < span class = "lineno" > 164< / span >   < span class = "comment" > //Notify(PSTR(" \r\nDisconnect Request: RFCOMM Channel" ));< / span > < / div >
< div class = "line" > < a name = "l00165" > < / a > < span class = "lineno" > 165< / span >   identifier = l2capinbuf[9];< / div >
< div class = "line" > < a name = "l00166" > < / a > < span class = "lineno" > 166< / span >   l2cap_event_flag |= < a class = "code" href = "_s_p_p_8h.html#a9da70c702c0b792d99f8e39713ac0ee7" > L2CAP_FLAG_DISCONNECT_RFCOMM_REQUEST< / a > ;< / div >
< div class = "line" > < a name = "l00167" > < / a > < span class = "lineno" > 167< / span >   }< / div >
< div class = "line" > < a name = "l00168" > < / a > < span class = "lineno" > 168< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (l2capinbuf[8] == < a class = "code" href = "_b_t_d_8h.html#a4c64a41200714e457b397496183dc0e4" > L2CAP_CMD_DISCONNECT_RESPONSE< / a > ) {< / div >
< div class = "line" > < a name = "l00169" > < / a > < span class = "lineno" > 169< / span >   < span class = "keywordflow" > if< / span > (l2capinbuf[12] == sdp_scid[0] & & l2capinbuf[13] == sdp_scid[1]) {< / div >
< div class = "line" > < a name = "l00170" > < / a > < span class = "lineno" > 170< / span >   < span class = "comment" > //Serial.print(" \r\nDisconnect Response: SDP Channel" );< / span > < / div >
< div class = "line" > < a name = "l00171" > < / a > < span class = "lineno" > 171< / span >   identifier = l2capinbuf[9];< / div >
< div class = "line" > < a name = "l00172" > < / a > < span class = "lineno" > 172< / span >   l2cap_event_flag |= < a class = "code" href = "_s_p_p_8h.html#ae16d9fcc820433592ba171c8b2a9e25d" > L2CAP_FLAG_DISCONNECT_RESPONSE< / a > ;< / div >
< div class = "line" > < a name = "l00173" > < / a > < span class = "lineno" > 173< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (l2capinbuf[12] == rfcomm_scid[0] & & l2capinbuf[13] == rfcomm_scid[1]) {< / div >
< div class = "line" > < a name = "l00174" > < / a > < span class = "lineno" > 174< / span >   < span class = "comment" > //Serial.print(" \r\nDisconnect Response: RFCOMM Channel" );< / span > < / div >
< div class = "line" > < a name = "l00175" > < / a > < span class = "lineno" > 175< / span >   identifier = l2capinbuf[9];< / div >
< div class = "line" > < a name = "l00176" > < / a > < span class = "lineno" > 176< / span >   l2cap_event_flag |= < a class = "code" href = "_s_p_p_8h.html#ae16d9fcc820433592ba171c8b2a9e25d" > L2CAP_FLAG_DISCONNECT_RESPONSE< / a > ;< / div >
< div class = "line" > < a name = "l00177" > < / a > < span class = "lineno" > 177< / span >   }< / div >
< div class = "line" > < a name = "l00178" > < / a > < span class = "lineno" > 178< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (l2capinbuf[8] == < a class = "code" href = "_b_t_d_8h.html#a200eb6c7c905ec74a9daf0f262af0448" > L2CAP_CMD_INFORMATION_REQUEST< / a > ) {< / div >
< div class = "line" > < a name = "l00179" > < / a > < span class = "lineno" > 179< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00180" > < / a > < span class = "lineno" > 180< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nInformation request" < / span > ));< / div >
< div class = "line" > < a name = "l00181" > < / a > < span class = "lineno" > 181< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00182" > < / a > < span class = "lineno" > 182< / span >   < span class = "preprocessor" > < / span > identifier = l2capinbuf[9];< / div >
< div class = "line" > < a name = "l00183" > < / a > < span class = "lineno" > 183< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#a91f61915c503fe7b861c88f5b3e6733c" > l2cap_information_response< / a > (hci_handle,identifier,l2capinbuf[12],l2capinbuf[13]);< / div >
< div class = "line" > < a name = "l00184" > < / a > < span class = "lineno" > 184< / span >   }< / div >
< div class = "line" > < a name = "l00185" > < / a > < span class = "lineno" > 185< / span >   < span class = "preprocessor" > #ifdef EXTRADEBUG< / span > < / div >
< div class = "line" > < a name = "l00186" > < / a > < span class = "lineno" > 186< / span >   < span class = "preprocessor" > < / span > < span class = "keywordflow" > else< / span > {< / div >
< div class = "line" > < a name = "l00187" > < / a > < span class = "lineno" > 187< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nL2CAP Unknown Signaling Command: " < / span > ));< / div >
< div class = "line" > < a name = "l00188" > < / a > < span class = "lineno" > 188< / span >   PrintHex< uint8_t> (l2capinbuf[8]); < / div >
< div class = "line" > < a name = "l00189" > < / a > < span class = "lineno" > 189< / span >   }< / div >
< div class = "line" > < a name = "l00190" > < / a > < span class = "lineno" > 190< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00191" > < / a > < span class = "lineno" > 191< / span >   < span class = "preprocessor" > < / span > } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (l2capinbuf[6] == sdp_dcid[0] & & l2capinbuf[7] == sdp_dcid[1]) { < span class = "comment" > // SDP< / span > < / div >
< div class = "line" > < a name = "l00192" > < / a > < span class = "lineno" > 192< / span >   < span class = "keywordflow" > if< / span > (l2capinbuf[8] == < a class = "code" href = "_s_p_p_8h.html#af98e9758e7c66f921d980b280a3f5b4b" > SDP_SERVICE_SEARCH_ATTRIBUTE_REQUEST_PDU< / a > ) {< / div >
< div class = "line" > < a name = "l00193" > < / a > < span class = "lineno" > 193< / span >   < span class = "comment" > /*< / span > < / div >
< div class = "line" > < a name = "l00194" > < / a > < span class = "lineno" > 194< / span >   < span class = "comment" > Serial.print(" \r\nUUID: 0x" );< / span > < / div >
< div class = "line" > < a name = "l00195" > < / a > < span class = "lineno" > 195< / span >   < span class = "comment" > Serial.print(l2capinbuf[16],HEX);< / span > < / div >
< div class = "line" > < a name = "l00196" > < / a > < span class = "lineno" > 196< / span >   < span class = "comment" > Serial.print(" " );< / span > < / div >
< div class = "line" > < a name = "l00197" > < / a > < span class = "lineno" > 197< / span >   < span class = "comment" > Serial.print(l2capinbuf[17],HEX);< / span > < / div >
< div class = "line" > < a name = "l00198" > < / a > < span class = "lineno" > 198< / span >   < span class = "comment" > */< / span > < / div >
< div class = "line" > < a name = "l00199" > < / a > < span class = "lineno" > 199< / span >   < span class = "keywordflow" > if< / span > ((l2capinbuf[16] < < 8 | l2capinbuf[17]) == < a class = "code" href = "_s_p_p_8h.html#a677a1fc4883355f7fad87551cc003c1b" > SERIALPORT_UUID< / a > ) {< / div >
< div class = "line" > < a name = "l00200" > < / a > < span class = "lineno" > 200< / span >   < span class = "keywordflow" > if< / span > (firstMessage) {< / div >
< div class = "line" > < a name = "l00201" > < / a > < span class = "lineno" > 201< / span >   serialPortResponse1(l2capinbuf[9],l2capinbuf[10]);< / div >
< div class = "line" > < a name = "l00202" > < / a > < span class = "lineno" > 202< / span >   firstMessage = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00203" > < / a > < span class = "lineno" > 203< / span >   } < span class = "keywordflow" > else< / span > {< / div >
< div class = "line" > < a name = "l00204" > < / a > < span class = "lineno" > 204< / span >   serialPortResponse2(l2capinbuf[9],l2capinbuf[10]); < span class = "comment" > // Serialport continuation state< / span > < / div >
< div class = "line" > < a name = "l00205" > < / a > < span class = "lineno" > 205< / span >   firstMessage = < span class = "keyword" > true< / span > ;< / div >
< div class = "line" > < a name = "l00206" > < / a > < span class = "lineno" > 206< / span >   }< / div >
< div class = "line" > < a name = "l00207" > < / a > < span class = "lineno" > 207< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > ((l2capinbuf[16] < < 8 | l2capinbuf[17]) == < a class = "code" href = "_s_p_p_8h.html#ac202a65fc9bc1a5d837e5d095b1bb9f2" > L2CAP_UUID< / a > ) {< / div >
< div class = "line" > < a name = "l00208" > < / a > < span class = "lineno" > 208< / span >   < span class = "keywordflow" > if< / span > (firstMessage) {< / div >
< div class = "line" > < a name = "l00209" > < / a > < span class = "lineno" > 209< / span >   l2capResponse1(l2capinbuf[9],l2capinbuf[10]);< / div >
< div class = "line" > < a name = "l00210" > < / a > < span class = "lineno" > 210< / span >   firstMessage = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00211" > < / a > < span class = "lineno" > 211< / span >   } < span class = "keywordflow" > else< / span > {< / div >
< div class = "line" > < a name = "l00212" > < / a > < span class = "lineno" > 212< / span >   l2capResponse2(l2capinbuf[9],l2capinbuf[10]); < span class = "comment" > // L2CAP continuation state< / span > < / div >
< div class = "line" > < a name = "l00213" > < / a > < span class = "lineno" > 213< / span >   firstMessage = < span class = "keyword" > true< / span > ;< / div >
< div class = "line" > < a name = "l00214" > < / a > < span class = "lineno" > 214< / span >   }< / div >
< div class = "line" > < a name = "l00215" > < / a > < span class = "lineno" > 215< / span >   } < span class = "keywordflow" > else< / span > < / div >
< div class = "line" > < a name = "l00216" > < / a > < span class = "lineno" > 216< / span >   serviceNotSupported(l2capinbuf[9],l2capinbuf[10]); < span class = "comment" > // The service is not supported< / span > < / div >
< div class = "line" > < a name = "l00217" > < / a > < span class = "lineno" > 217< / span >   }< / div >
< div class = "line" > < a name = "l00218" > < / a > < span class = "lineno" > 218< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (l2capinbuf[6] == rfcomm_dcid[0] & & l2capinbuf[7] == rfcomm_dcid[1]) { < span class = "comment" > // RFCOMM< / span > < / div >
< div class = "line" > < a name = "l00219" > < / a > < span class = "lineno" > 219< / span >   rfcommChannel = l2capinbuf[8] & 0xF8;< / div >
< div class = "line" > < a name = "l00220" > < / a > < span class = "lineno" > 220< / span >   rfcommDirection = l2capinbuf[8] & 0x04;< / div >
< div class = "line" > < a name = "l00221" > < / a > < span class = "lineno" > 221< / span >   rfcommCommandResponse = l2capinbuf[8] & 0x02;< / div >
< div class = "line" > < a name = "l00222" > < / a > < span class = "lineno" > 222< / span >   rfcommChannelType = l2capinbuf[9] & 0xEF;< / div >
< div class = "line" > < a name = "l00223" > < / a > < span class = "lineno" > 223< / span >   rfcommPfBit = l2capinbuf[9] & 0x10;< / div >
< div class = "line" > < a name = "l00224" > < / a > < span class = "lineno" > 224< / span >   < / div >
< div class = "line" > < a name = "l00225" > < / a > < span class = "lineno" > 225< / span >   < span class = "keywordflow" > if< / span > (rfcommChannel> > 3 != 0x00)< / div >
< div class = "line" > < a name = "l00226" > < / a > < span class = "lineno" > 226< / span >   rfcommChannelConnection = rfcommChannel;< / div >
< div class = "line" > < a name = "l00227" > < / a > < span class = "lineno" > 227< / span >   < / div >
< div class = "line" > < a name = "l00228" > < / a > < span class = "lineno" > 228< / span >   < span class = "preprocessor" > #ifdef EXTRADEBUG< / span > < / div >
< div class = "line" > < a name = "l00229" > < / a > < span class = "lineno" > 229< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nRFCOMM Channel: " < / span > ));< / div >
< div class = "line" > < a name = "l00230" > < / a > < span class = "lineno" > 230< / span >   Serial.print(rfcommChannel> > 3,HEX);< / div >
< div class = "line" > < a name = "l00231" > < / a > < span class = "lineno" > 231< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " Direction: " < / span > ));< / div >
< div class = "line" > < a name = "l00232" > < / a > < span class = "lineno" > 232< / span >   Serial.print(rfcommDirection> > 2,HEX);< / div >
< div class = "line" > < a name = "l00233" > < / a > < span class = "lineno" > 233< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " CommandResponse: " < / span > ));< / div >
< div class = "line" > < a name = "l00234" > < / a > < span class = "lineno" > 234< / span >   Serial.print(rfcommCommandResponse> > 1,HEX);< / div >
< div class = "line" > < a name = "l00235" > < / a > < span class = "lineno" > 235< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " ChannelType: " < / span > ));< / div >
< div class = "line" > < a name = "l00236" > < / a > < span class = "lineno" > 236< / span >   Serial.print(rfcommChannelType,HEX);< / div >
< div class = "line" > < a name = "l00237" > < / a > < span class = "lineno" > 237< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " PF_BIT: " < / span > ));< / div >
< div class = "line" > < a name = "l00238" > < / a > < span class = "lineno" > 238< / span >   Serial.print(rfcommPfBit,HEX);< / div >
< div class = "line" > < a name = "l00239" > < / a > < span class = "lineno" > 239< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00240" > < / a > < span class = "lineno" > 240< / span >   < span class = "preprocessor" > < / span > < span class = "keywordflow" > if< / span > (rfcommChannelType == < a class = "code" href = "_s_p_p_8h.html#a2c8ebc5e78dc22e7ae4e79370fada66f" > RFCOMM_DISC< / a > ) {< / div >
< div class = "line" > < a name = "l00241" > < / a > < span class = "lineno" > 241< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00242" > < / a > < span class = "lineno" > 242< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nReceived Disconnect RFCOMM Command on channel: " < / span > ));< / div >
< div class = "line" > < a name = "l00243" > < / a > < span class = "lineno" > 243< / span >   Serial.print(rfcommChannel> > 3,HEX);< / div >
< div class = "line" > < a name = "l00244" > < / a > < span class = "lineno" > 244< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00245" > < / a > < span class = "lineno" > 245< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "class_s_p_p.html#ade5d4f0ab50ddcad14f75fce4450a028" > connected< / a > = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00246" > < / a > < span class = "lineno" > 246< / span >   sendRfcomm(rfcommChannel,rfcommDirection,rfcommCommandResponse,< a class = "code" href = "_s_p_p_8h.html#a9f534220af893b5ae8c8927564db77c3" > RFCOMM_UA< / a > ,rfcommPfBit,rfcommbuf,0x00); < span class = "comment" > // UA Command< / span > < / div >
< div class = "line" > < a name = "l00247" > < / a > < span class = "lineno" > 247< / span >   }< / div >
< div class = "line" > < a name = "l00248" > < / a > < span class = "lineno" > 248< / span >   < span class = "keywordflow" > if< / span > (< a class = "code" href = "class_s_p_p.html#ade5d4f0ab50ddcad14f75fce4450a028" > connected< / a > ) {< / div >
< div class = "line" > < a name = "l00249" > < / a > < span class = "lineno" > 249< / span >   < span class = "comment" > /* Read the incoming message */< / span > < / div >
< div class = "line" > < a name = "l00250" > < / a > < span class = "lineno" > 250< / span >   < span class = "keywordflow" > if< / span > (rfcommChannelType == < a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > & & rfcommChannel == rfcommChannelConnection) {< / div >
< div class = "line" > < a name = "l00251" > < / a > < span class = "lineno" > 251< / span >   uint8_t length = l2capinbuf[10] > > 1; < span class = "comment" > // Get length< / span > < / div >
< div class = "line" > < a name = "l00252" > < / a > < span class = "lineno" > 252< / span >   uint8_t offset = l2capinbuf[4]-length-4; < span class = "comment" > // See if there is credit< / span > < / div >
< div class = "line" > < a name = "l00253" > < / a > < span class = "lineno" > 253< / span >   < span class = "keywordflow" > if< / span > (rfcommAvailable + length < = < span class = "keyword" > sizeof< / span > (rfcommDataBuffer)) { < span class = "comment" > // Don' t add data to buffer if it would be full< / span > < / div >
< div class = "line" > < a name = "l00254" > < / a > < span class = "lineno" > 254< / span >   < span class = "keywordflow" > for< / span > (uint8_t i = 0; i < length; i++)< / div >
< div class = "line" > < a name = "l00255" > < / a > < span class = "lineno" > 255< / span >   rfcommDataBuffer[rfcommAvailable+i] = l2capinbuf[11+i+offset];< / div >
< div class = "line" > < a name = "l00256" > < / a > < span class = "lineno" > 256< / span >   rfcommAvailable += length;< / div >
< div class = "line" > < a name = "l00257" > < / a > < span class = "lineno" > 257< / span >   }< / div >
< div class = "line" > < a name = "l00258" > < / a > < span class = "lineno" > 258< / span >   < span class = "preprocessor" > #ifdef EXTRADEBUG< / span > < / div >
< div class = "line" > < a name = "l00259" > < / a > < span class = "lineno" > 259< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nRFCOMM Data Available: " < / span > ));< / div >
< div class = "line" > < a name = "l00260" > < / a > < span class = "lineno" > 260< / span >   Serial.print(rfcommAvailable);< / div >
< div class = "line" > < a name = "l00261" > < / a > < span class = "lineno" > 261< / span >   < span class = "keywordflow" > if< / span > (offset) {< / div >
< div class = "line" > < a name = "l00262" > < / a > < span class = "lineno" > 262< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " - Credit: 0x" < / span > ));< / div >
< div class = "line" > < a name = "l00263" > < / a > < span class = "lineno" > 263< / span >   Serial.print(l2capinbuf[11],HEX);< / div >
< div class = "line" > < a name = "l00264" > < / a > < span class = "lineno" > 264< / span >   }< / div >
< div class = "line" > < a name = "l00265" > < / a > < span class = "lineno" > 265< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00266" > < / a > < span class = "lineno" > 266< / span >   < span class = "preprocessor" > < / span > < span class = "preprocessor" > #ifdef PRINTREPORT // Uncomment " #define PRINTREPORT" to print the report send to the Arduino via Bluetooth< / span > < / div >
< div class = "line" > < a name = "l00267" > < / a > < span class = "lineno" > 267< / span >   < span class = "preprocessor" > < / span > < span class = "keywordflow" > for< / span > (uint8_t i = 0; i < length; i++)< / div >
< div class = "line" > < a name = "l00268" > < / a > < span class = "lineno" > 268< / span >   Serial.write(l2capinbuf[i+11+offset]);< / div >
< div class = "line" > < a name = "l00269" > < / a > < span class = "lineno" > 269< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00270" > < / a > < span class = "lineno" > 270< / span >   < span class = "preprocessor" > < / span > }< / div >
< div class = "line" > < a name = "l00271" > < / a > < span class = "lineno" > 271< / span >   } < span class = "keywordflow" > else< / span > {< / div >
< div class = "line" > < a name = "l00272" > < / a > < span class = "lineno" > 272< / span >   < span class = "keywordflow" > if< / span > (rfcommChannelType == < a class = "code" href = "_s_p_p_8h.html#a5747e4c0826eb3341fe2476b5229e0d0" > RFCOMM_SABM< / a > ) { < span class = "comment" > // SABM Command - this is sent twice: once for channel 0 and then for the channel to establish< / span > < / div >
< div class = "line" > < a name = "l00273" > < / a > < span class = "lineno" > 273< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00274" > < / a > < span class = "lineno" > 274< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nReceived SABM Command" < / span > ));< / div >
< div class = "line" > < a name = "l00275" > < / a > < span class = "lineno" > 275< / span >   < span class = "preprocessor" > #endif < / span > < / div >
< div class = "line" > < a name = "l00276" > < / a > < span class = "lineno" > 276< / span >   < span class = "preprocessor" > < / span > sendRfcomm(rfcommChannel,rfcommDirection,rfcommCommandResponse,< a class = "code" href = "_s_p_p_8h.html#a9f534220af893b5ae8c8927564db77c3" > RFCOMM_UA< / a > ,rfcommPfBit,rfcommbuf,0x00); < span class = "comment" > // UA Command< / span > < / div >
< div class = "line" > < a name = "l00277" > < / a > < span class = "lineno" > 277< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (rfcommChannelType == < a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > & & l2capinbuf[11] == < a class = "code" href = "_s_p_p_8h.html#a11185ec5287f08bf49c2c68d8cd52a16" > BT_RFCOMM_PN_CMD< / a > ) { < span class = "comment" > // UIH Parameter Negotiation Command< / span > < / div >
< div class = "line" > < a name = "l00278" > < / a > < span class = "lineno" > 278< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00279" > < / a > < span class = "lineno" > 279< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nReceived UIH Parameter Negotiation Command" < / span > ));< / div >
< div class = "line" > < a name = "l00280" > < / a > < span class = "lineno" > 280< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00281" > < / a > < span class = "lineno" > 281< / span >   < span class = "preprocessor" > < / span > rfcommbuf[0] = < a class = "code" href = "_s_p_p_8h.html#a17b4a98661e30b6989cbe35ba5da4822" > BT_RFCOMM_PN_RSP< / a > ; < span class = "comment" > // UIH Parameter Negotiation Response< / span > < / div >
< div class = "line" > < a name = "l00282" > < / a > < span class = "lineno" > 282< / span >   rfcommbuf[1] = l2capinbuf[12]; < span class = "comment" > // Length and shiftet like so: length < < 1 | 1< / span > < / div >
< div class = "line" > < a name = "l00283" > < / a > < span class = "lineno" > 283< / span >   rfcommbuf[2] = l2capinbuf[13]; < span class = "comment" > // Channel: channel < < 1 | 1< / span > < / div >
< div class = "line" > < a name = "l00284" > < / a > < span class = "lineno" > 284< / span >   rfcommbuf[3] = 0xE0; < span class = "comment" > // Pre difined for Bluetooth, see 5.5.3 of TS 07.10 Adaption for RFCOMM< / span > < / div >
< div class = "line" > < a name = "l00285" > < / a > < span class = "lineno" > 285< / span >   rfcommbuf[4] = 0x00; < span class = "comment" > // Priority< / span > < / div >
< div class = "line" > < a name = "l00286" > < / a > < span class = "lineno" > 286< / span >   rfcommbuf[5] = 0x00; < span class = "comment" > // Timer< / span > < / div >
< div class = "line" > < a name = "l00287" > < / a > < span class = "lineno" > 287< / span >   rfcommbuf[6] = 0x40; < span class = "comment" > // Max Fram Size LSB - we will just set this to 64< / span > < / div >
< div class = "line" > < a name = "l00288" > < / a > < span class = "lineno" > 288< / span >   rfcommbuf[7] = 0x00; < span class = "comment" > // Max Fram Size MSB< / span > < / div >
< div class = "line" > < a name = "l00289" > < / a > < span class = "lineno" > 289< / span >   rfcommbuf[8] = 0x00; < span class = "comment" > // MaxRatransm.< / span > < / div >
< div class = "line" > < a name = "l00290" > < / a > < span class = "lineno" > 290< / span >   rfcommbuf[9] = 0x00; < span class = "comment" > // Number of Frames< / span > < / div >
< div class = "line" > < a name = "l00291" > < / a > < span class = "lineno" > 291< / span >   sendRfcomm(rfcommChannel,rfcommDirection,0,< a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > ,rfcommPfBit,rfcommbuf,0x0A);< / div >
< div class = "line" > < a name = "l00292" > < / a > < span class = "lineno" > 292< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (rfcommChannelType == < a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > & & l2capinbuf[11] == < a class = "code" href = "_s_p_p_8h.html#ad14b1def5eec64e94cc64a2dcba354ea" > BT_RFCOMM_MSC_CMD< / a > ) { < span class = "comment" > // UIH Modem Status Command< / span > < / div >
< div class = "line" > < a name = "l00293" > < / a > < span class = "lineno" > 293< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00294" > < / a > < span class = "lineno" > 294< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nSend UIH Modem Status Response" < / span > ));< / div >
< div class = "line" > < a name = "l00295" > < / a > < span class = "lineno" > 295< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00296" > < / a > < span class = "lineno" > 296< / span >   < span class = "preprocessor" > < / span > rfcommbuf[0] = < a class = "code" href = "_s_p_p_8h.html#ab68e7621ab822c3bfb9507c78d0d0550" > BT_RFCOMM_MSC_RSP< / a > ; < span class = "comment" > // UIH Modem Status Response< / span > < / div >
< div class = "line" > < a name = "l00297" > < / a > < span class = "lineno" > 297< / span >   rfcommbuf[1] = 2 < < 1 | 1; < span class = "comment" > // Length and shiftet like so: length < < 1 | 1< / span > < / div >
< div class = "line" > < a name = "l00298" > < / a > < span class = "lineno" > 298< / span >   rfcommbuf[2] = l2capinbuf[13]; < span class = "comment" > // Channel: (1 < < 0) | (1 < < 1) | (0 < < 2) | (channel < < 3)< / span > < / div >
< div class = "line" > < a name = "l00299" > < / a > < span class = "lineno" > 299< / span >   rfcommbuf[3] = l2capinbuf[14];< / div >
< div class = "line" > < a name = "l00300" > < / a > < span class = "lineno" > 300< / span >   sendRfcomm(rfcommChannel,rfcommDirection,0,< a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > ,rfcommPfBit,rfcommbuf,0x04);< / div >
< div class = "line" > < a name = "l00301" > < / a > < span class = "lineno" > 301< / span >   < / div >
< div class = "line" > < a name = "l00302" > < / a > < span class = "lineno" > 302< / span >   delay(1);< / div >
< div class = "line" > < a name = "l00303" > < / a > < span class = "lineno" > 303< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00304" > < / a > < span class = "lineno" > 304< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nSend UIH Modem Status Command" < / span > ));< / div >
< div class = "line" > < a name = "l00305" > < / a > < span class = "lineno" > 305< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00306" > < / a > < span class = "lineno" > 306< / span >   < span class = "preprocessor" > < / span > rfcommbuf[0] = < a class = "code" href = "_s_p_p_8h.html#ad14b1def5eec64e94cc64a2dcba354ea" > BT_RFCOMM_MSC_CMD< / a > ; < span class = "comment" > // UIH Modem Status Command< / span > < / div >
< div class = "line" > < a name = "l00307" > < / a > < span class = "lineno" > 307< / span >   rfcommbuf[1] = 2 < < 1 | 1; < span class = "comment" > // Length and shiftet like so: length < < 1 | 1< / span > < / div >
< div class = "line" > < a name = "l00308" > < / a > < span class = "lineno" > 308< / span >   rfcommbuf[2] = l2capinbuf[13]; < span class = "comment" > // Channel: (1 < < 0) | (1 < < 1) | (0 < < 2) | (channel < < 3)< / span > < / div >
< div class = "line" > < a name = "l00309" > < / a > < span class = "lineno" > 309< / span >   rfcommbuf[3] = 0x8D; < span class = "comment" > // Can receive frames (YES), Ready to Communicate (YES), Ready to Receive (YES), Incomig Call (NO), Data is Value (YES)< / span > < / div >
< div class = "line" > < a name = "l00310" > < / a > < span class = "lineno" > 310< / span >   < / div >
< div class = "line" > < a name = "l00311" > < / a > < span class = "lineno" > 311< / span >   sendRfcomm(rfcommChannel,rfcommDirection,0,< a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > ,rfcommPfBit,rfcommbuf,0x04);< / div >
< div class = "line" > < a name = "l00312" > < / a > < span class = "lineno" > 312< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (rfcommChannelType == < a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > & & l2capinbuf[11] == < a class = "code" href = "_s_p_p_8h.html#ab68e7621ab822c3bfb9507c78d0d0550" > BT_RFCOMM_MSC_RSP< / a > ) { < span class = "comment" > // UIH Modem Status Response< / span > < / div >
< div class = "line" > < a name = "l00313" > < / a > < span class = "lineno" > 313< / span >   < span class = "keywordflow" > if< / span > (!creditSent) {< / div >
< div class = "line" > < a name = "l00314" > < / a > < span class = "lineno" > 314< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00315" > < / a > < span class = "lineno" > 315< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nSend UIH Command with credit" < / span > ));< / div >
< div class = "line" > < a name = "l00316" > < / a > < span class = "lineno" > 316< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00317" > < / a > < span class = "lineno" > 317< / span >   < span class = "preprocessor" > < / span > sendRfcommCredit(rfcommChannelConnection,rfcommDirection,0,< a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > ,0x10,< span class = "keyword" > sizeof< / span > (rfcommDataBuffer)); < span class = "comment" > // Send credit< / span > < / div >
< div class = "line" > < a name = "l00318" > < / a > < span class = "lineno" > 318< / span >   creditSent = < span class = "keyword" > true< / span > ;< / div >
< div class = "line" > < a name = "l00319" > < / a > < span class = "lineno" > 319< / span >   timer = millis();< / div >
< div class = "line" > < a name = "l00320" > < / a > < span class = "lineno" > 320< / span >   waitForLastCommand = < span class = "keyword" > true< / span > ;< / div >
< div class = "line" > < a name = "l00321" > < / a > < span class = "lineno" > 321< / span >   }< / div >
< div class = "line" > < a name = "l00322" > < / a > < span class = "lineno" > 322< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (rfcommChannelType == < a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > & & l2capinbuf[10] == 0x01) { < span class = "comment" > // UIH Command with credit< / span > < / div >
< div class = "line" > < a name = "l00323" > < / a > < span class = "lineno" > 323< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00324" > < / a > < span class = "lineno" > 324< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nReceived UIH Command with credit" < / span > ));< / div >
< div class = "line" > < a name = "l00325" > < / a > < span class = "lineno" > 325< / span >   < span class = "preprocessor" > #endif < / span > < / div >
< div class = "line" > < a name = "l00326" > < / a > < span class = "lineno" > 326< / span >   < span class = "preprocessor" > < / span > } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (rfcommChannelType == < a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > & & l2capinbuf[11] == < a class = "code" href = "_s_p_p_8h.html#ad9b8c11f7f4f8e8d59ac77999b2ec4a3" > BT_RFCOMM_RPN_CMD< / a > ) { < span class = "comment" > // UIH Remote Port Negotiation Command< / span > < / div >
< div class = "line" > < a name = "l00327" > < / a > < span class = "lineno" > 327< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00328" > < / a > < span class = "lineno" > 328< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nReceived UIH Remote Port Negotiation Command" < / span > ));< / div >
< div class = "line" > < a name = "l00329" > < / a > < span class = "lineno" > 329< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00330" > < / a > < span class = "lineno" > 330< / span >   < span class = "preprocessor" > < / span > rfcommbuf[0] = < a class = "code" href = "_s_p_p_8h.html#a336bf1805637fdd66033c9040e606a6b" > BT_RFCOMM_RPN_RSP< / a > ; < span class = "comment" > // Command< / span > < / div >
< div class = "line" > < a name = "l00331" > < / a > < span class = "lineno" > 331< / span >   rfcommbuf[1] = l2capinbuf[12]; < span class = "comment" > // Length and shiftet like so: length < < 1 | 1< / span > < / div >
< div class = "line" > < a name = "l00332" > < / a > < span class = "lineno" > 332< / span >   rfcommbuf[2] = l2capinbuf[13]; < span class = "comment" > // Channel: channel < < 1 | 1< / span > < / div >
< div class = "line" > < a name = "l00333" > < / a > < span class = "lineno" > 333< / span >   rfcommbuf[3] = l2capinbuf[14]; < span class = "comment" > // Pre difined for Bluetooth, see 5.5.3 of TS 07.10 Adaption for RFCOMM< / span > < / div >
< div class = "line" > < a name = "l00334" > < / a > < span class = "lineno" > 334< / span >   rfcommbuf[4] = l2capinbuf[15]; < span class = "comment" > // Priority< / span > < / div >
< div class = "line" > < a name = "l00335" > < / a > < span class = "lineno" > 335< / span >   rfcommbuf[5] = l2capinbuf[16]; < span class = "comment" > // Timer< / span > < / div >
< div class = "line" > < a name = "l00336" > < / a > < span class = "lineno" > 336< / span >   rfcommbuf[6] = l2capinbuf[17]; < span class = "comment" > // Max Fram Size LSB< / span > < / div >
< div class = "line" > < a name = "l00337" > < / a > < span class = "lineno" > 337< / span >   rfcommbuf[7] = l2capinbuf[18]; < span class = "comment" > // Max Fram Size MSB< / span > < / div >
< div class = "line" > < a name = "l00338" > < / a > < span class = "lineno" > 338< / span >   rfcommbuf[8] = l2capinbuf[19]; < span class = "comment" > // MaxRatransm.< / span > < / div >
< div class = "line" > < a name = "l00339" > < / a > < span class = "lineno" > 339< / span >   rfcommbuf[9] = l2capinbuf[20]; < span class = "comment" > // Number of Frames< / span > < / div >
< div class = "line" > < a name = "l00340" > < / a > < span class = "lineno" > 340< / span >   sendRfcomm(rfcommChannel,rfcommDirection,0,< a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > ,rfcommPfBit,rfcommbuf,0x0A); < span class = "comment" > // UIH Remote Port Negotiation Response< / span > < / div >
< div class = "line" > < a name = "l00341" > < / a > < span class = "lineno" > 341< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00342" > < / a > < span class = "lineno" > 342< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nRFCOMM Connection is now established\r\n" < / span > ));< / div >
< div class = "line" > < a name = "l00343" > < / a > < span class = "lineno" > 343< / span >   < span class = "preprocessor" > #endif < / span > < / div >
< div class = "line" > < a name = "l00344" > < / a > < span class = "lineno" > 344< / span >   < span class = "preprocessor" > < / span > waitForLastCommand = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00345" > < / a > < span class = "lineno" > 345< / span >   creditSent = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00346" > < / a > < span class = "lineno" > 346< / span >   < a class = "code" href = "class_s_p_p.html#ade5d4f0ab50ddcad14f75fce4450a028" > connected< / a > = < span class = "keyword" > true< / span > ; < span class = "comment" > // The RFCOMM channel is now established< / span > < / div >
< div class = "line" > < a name = "l00347" > < / a > < span class = "lineno" > 347< / span >   }< / div >
< div class = "line" > < a name = "l00348" > < / a > < span class = "lineno" > 348< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00349" > < / a > < span class = "lineno" > 349< / span >   < span class = "preprocessor" > < / span > < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (rfcommChannelType != < a class = "code" href = "_s_p_p_8h.html#a2c8ebc5e78dc22e7ae4e79370fada66f" > RFCOMM_DISC< / a > ) {< / div >
< div class = "line" > < a name = "l00350" > < / a > < span class = "lineno" > 350< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nUnsupported RFCOMM Data - ChannelType: " < / span > ));< / div >
< div class = "line" > < a name = "l00351" > < / a > < span class = "lineno" > 351< / span >   PrintHex< uint8_t> (rfcommChannelType);< / div >
< div class = "line" > < a name = "l00352" > < / a > < span class = "lineno" > 352< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " Command: " < / span > ));< / div >
< div class = "line" > < a name = "l00353" > < / a > < span class = "lineno" > 353< / span >   PrintHex< uint8_t> (l2capinbuf[11]);< / div >
< div class = "line" > < a name = "l00354" > < / a > < span class = "lineno" > 354< / span >   }< / div >
< div class = "line" > < a name = "l00355" > < / a > < span class = "lineno" > 355< / span >   < span class = "preprocessor" > #endif < / span > < / div >
< div class = "line" > < a name = "l00356" > < / a > < span class = "lineno" > 356< / span >   < span class = "preprocessor" > < / span > }< / div >
< div class = "line" > < a name = "l00357" > < / a > < span class = "lineno" > 357< / span >   }< / div >
< div class = "line" > < a name = "l00358" > < / a > < span class = "lineno" > 358< / span >   < span class = "preprocessor" > #ifdef EXTRADEBUG< / span > < / div >
< div class = "line" > < a name = "l00359" > < / a > < span class = "lineno" > 359< / span >   < span class = "preprocessor" > < / span > < span class = "keywordflow" > else< / span > {< / div >
< div class = "line" > < a name = "l00360" > < / a > < span class = "lineno" > 360< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nUnsupported L2CAP Data - Channel ID: " < / span > ));< / div >
< div class = "line" > < a name = "l00361" > < / a > < span class = "lineno" > 361< / span >   PrintHex< uint8_t> (l2capinbuf[7]);< / div >
< div class = "line" > < a name = "l00362" > < / a > < span class = "lineno" > 362< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " " < / span > ));< / div >
< div class = "line" > < a name = "l00363" > < / a > < span class = "lineno" > 363< / span >   PrintHex< uint8_t> (l2capinbuf[6]);< / div >
< div class = "line" > < a name = "l00364" > < / a > < span class = "lineno" > 364< / span >   }< / div >
< div class = "line" > < a name = "l00365" > < / a > < span class = "lineno" > 365< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00366" > < / a > < span class = "lineno" > 366< / span >   < span class = "preprocessor" > < / span > SDP_task();< / div >
< div class = "line" > < a name = "l00367" > < / a > < span class = "lineno" > 367< / span >   RFCOMM_task();< / div >
< div class = "line" > < a name = "l00368" > < / a > < span class = "lineno" > 368< / span >   }< / div >
< div class = "line" > < a name = "l00369" > < / a > < span class = "lineno" > 369< / span >   }< / div >
< div class = "line" > < a name = "l00370" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a2de67ee7ad1be9d2f3daf7dc08dc5f90" > 370< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#a2de67ee7ad1be9d2f3daf7dc08dc5f90" > SPP::Run< / a > () {< / div >
< div class = "line" > < a name = "l00371" > < / a > < span class = "lineno" > 371< / span >   < span class = "keywordflow" > if< / span > (waitForLastCommand & & (millis() - timer) > 100) { < span class = "comment" > // We will only wait 100ms and see if the UIH Remote Port Negotiation Command is send, as some deviced don' t send it< / span > < / div >
< div class = "line" > < a name = "l00372" > < / a > < span class = "lineno" > 372< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00373" > < / a > < span class = "lineno" > 373< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nRFCOMM Connection is now established - Automatic\r\n" < / span > ));< / div >
< div class = "line" > < a name = "l00374" > < / a > < span class = "lineno" > 374< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00375" > < / a > < span class = "lineno" > 375< / span >   < span class = "preprocessor" > < / span > creditSent = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00376" > < / a > < span class = "lineno" > 376< / span >   waitForLastCommand = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00377" > < / a > < span class = "lineno" > 377< / span >   < a class = "code" href = "class_s_p_p.html#ade5d4f0ab50ddcad14f75fce4450a028" > connected< / a > = < span class = "keyword" > true< / span > ; < span class = "comment" > // The RFCOMM channel is now established< / span > < / div >
< div class = "line" > < a name = "l00378" > < / a > < span class = "lineno" > 378< / span >   } < / div >
< div class = "line" > < a name = "l00379" > < / a > < span class = "lineno" > 379< / span >   }< / div >
< div class = "line" > < a name = "l00380" > < / a > < span class = "lineno" > 380< / span >   < span class = "keywordtype" > void< / span > SPP::SDP_task() {< / div >
< div class = "line" > < a name = "l00381" > < / a > < span class = "lineno" > 381< / span >   < span class = "keywordflow" > switch< / span > (l2cap_sdp_state)< / div >
< div class = "line" > < a name = "l00382" > < / a > < span class = "lineno" > 382< / span >   {< / div >
< div class = "line" > < a name = "l00383" > < / a > < span class = "lineno" > 383< / span >   < span class = "keywordflow" > case< / span > < a class = "code" href = "_s_p_p_8h.html#a72444116eaac116983a3dec35b1944f0" > L2CAP_SDP_WAIT< / a > :< / div >
< div class = "line" > < a name = "l00384" > < / a > < span class = "lineno" > 384< / span >   < span class = "keywordflow" > if< / span > (< a class = "code" href = "_s_p_p_8h.html#a3b1cbac2f2fc44b393ff3cb96448892a" > l2cap_connection_request_sdp_flag< / a > ) {< / div >
< div class = "line" > < a name = "l00385" > < / a > < span class = "lineno" > 385< / span >   l2cap_event_flag & = ~< a class = "code" href = "_s_p_p_8h.html#a0d649771ff995585c2bff030b7c1a2d3" > L2CAP_FLAG_CONNECTION_SDP_REQUEST< / a > ; < span class = "comment" > // Clear flag< / span > < / div >
< div class = "line" > < a name = "l00386" > < / a > < span class = "lineno" > 386< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00387" > < / a > < span class = "lineno" > 387< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nSDP Incoming Connection Request" < / span > ));< / div >
< div class = "line" > < a name = "l00388" > < / a > < span class = "lineno" > 388< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00389" > < / a > < span class = "lineno" > 389< / span >   < span class = "preprocessor" > < / span > pBtd-> < a class = "code" href = "class_b_t_d.html#a7d34c62b1d561679dea5cd27356b38a7" > l2cap_connection_response< / a > (hci_handle,identifier, sdp_dcid, sdp_scid, < a class = "code" href = "_b_t_d_8h.html#a9960d0d5ae92fc92c70bbb84c2a5c0cc" > PENDING< / a > );< / div >
< div class = "line" > < a name = "l00390" > < / a > < span class = "lineno" > 390< / span >   delay(1);< / div >
< div class = "line" > < a name = "l00391" > < / a > < span class = "lineno" > 391< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#a7d34c62b1d561679dea5cd27356b38a7" > l2cap_connection_response< / a > (hci_handle,identifier, sdp_dcid, sdp_scid, < a class = "code" href = "_b_t_d_8h.html#a1be7a56cdddcdb7dedf16d4dee381e93" > SUCCESSFUL< / a > ); < / div >
< div class = "line" > < a name = "l00392" > < / a > < span class = "lineno" > 392< / span >   identifier++;< / div >
< div class = "line" > < a name = "l00393" > < / a > < span class = "lineno" > 393< / span >   delay(1);< / div >
< div class = "line" > < a name = "l00394" > < / a > < span class = "lineno" > 394< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#ab646a59311344966f139bb3b78f30233" > l2cap_config_request< / a > (hci_handle,identifier, sdp_scid); < / div >
< div class = "line" > < a name = "l00395" > < / a > < span class = "lineno" > 395< / span >   l2cap_sdp_state = < a class = "code" href = "_s_p_p_8h.html#ae100d60ef94dea996b12fc89d6a339f2" > L2CAP_SDP_REQUEST< / a > ; < / div >
< div class = "line" > < a name = "l00396" > < / a > < span class = "lineno" > 396< / span >   } < / div >
< div class = "line" > < a name = "l00397" > < / a > < span class = "lineno" > 397< / span >   < span class = "keywordflow" > break< / span > ;< / div >
< div class = "line" > < a name = "l00398" > < / a > < span class = "lineno" > 398< / span >   < span class = "keywordflow" > case< / span > < a class = "code" href = "_s_p_p_8h.html#ae100d60ef94dea996b12fc89d6a339f2" > L2CAP_SDP_REQUEST< / a > :< / div >
< div class = "line" > < a name = "l00399" > < / a > < span class = "lineno" > 399< / span >   < span class = "keywordflow" > if< / span > (< a class = "code" href = "_s_p_p_8h.html#a5f5f1cfcc3f39ee032185cac348cb068" > l2cap_config_request_sdp_flag< / a > ) {< / div >
< div class = "line" > < a name = "l00400" > < / a > < span class = "lineno" > 400< / span >   l2cap_event_flag & = ~< a class = "code" href = "_s_p_p_8h.html#a52cc6e4a2a6d151dd5d0e788b937b2e8" > L2CAP_FLAG_CONFIG_SDP_REQUEST< / a > ; < span class = "comment" > // Clear flag< / span > < / div >
< div class = "line" > < a name = "l00401" > < / a > < span class = "lineno" > 401< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00402" > < / a > < span class = "lineno" > 402< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nSDP Configuration Request" < / span > ));< / div >
< div class = "line" > < a name = "l00403" > < / a > < span class = "lineno" > 403< / span >   < span class = "preprocessor" > #endif < / span > < / div >
< div class = "line" > < a name = "l00404" > < / a > < span class = "lineno" > 404< / span >   < span class = "preprocessor" > < / span > pBtd-> < a class = "code" href = "class_b_t_d.html#a792ac4529b65235698ecf3d37982c05e" > l2cap_config_response< / a > (hci_handle,identifier, sdp_scid); < / div >
< div class = "line" > < a name = "l00405" > < / a > < span class = "lineno" > 405< / span >   l2cap_sdp_state = < a class = "code" href = "_s_p_p_8h.html#a1b8e3e654e4f55e27ca5054aef956edc" > L2CAP_SDP_SUCCESS< / a > ;< / div >
< div class = "line" > < a name = "l00406" > < / a > < span class = "lineno" > 406< / span >   }< / div >
< div class = "line" > < a name = "l00407" > < / a > < span class = "lineno" > 407< / span >   < span class = "keywordflow" > break< / span > ;< / div >
< div class = "line" > < a name = "l00408" > < / a > < span class = "lineno" > 408< / span >   < span class = "keywordflow" > case< / span > < a class = "code" href = "_s_p_p_8h.html#a1b8e3e654e4f55e27ca5054aef956edc" > L2CAP_SDP_SUCCESS< / a > :< / div >
< div class = "line" > < a name = "l00409" > < / a > < span class = "lineno" > 409< / span >   < span class = "keywordflow" > if< / span > (< a class = "code" href = "_s_p_p_8h.html#a37d324cfd5a79f623dcd0fc8fa047447" > l2cap_config_success_sdp_flag< / a > ) {< / div >
< div class = "line" > < a name = "l00410" > < / a > < span class = "lineno" > 410< / span >   l2cap_event_flag & = ~< a class = "code" href = "_s_p_p_8h.html#a75ef214ce8a03e8d62a1b24554bc1a05" > L2CAP_FLAG_CONFIG_SDP_SUCCESS< / a > ; < span class = "comment" > // Clear flag< / span > < / div >
< div class = "line" > < a name = "l00411" > < / a > < span class = "lineno" > 411< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00412" > < / a > < span class = "lineno" > 412< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nSDP Successfully Configured" < / span > ));< / div >
< div class = "line" > < a name = "l00413" > < / a > < span class = "lineno" > 413< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00414" > < / a > < span class = "lineno" > 414< / span >   < span class = "preprocessor" > < / span > firstMessage = < span class = "keyword" > true< / span > ; < span class = "comment" > // Reset bool< / span > < / div >
< div class = "line" > < a name = "l00415" > < / a > < span class = "lineno" > 415< / span >   SDPConnected = < span class = "keyword" > true< / span > ;< / div >
< div class = "line" > < a name = "l00416" > < / a > < span class = "lineno" > 416< / span >   l2cap_sdp_state = < a class = "code" href = "_s_p_p_8h.html#a25f7af87e6960e2e8ed49006b0b50f3e" > L2CAP_SDP_DONE< / a > ;< / div >
< div class = "line" > < a name = "l00417" > < / a > < span class = "lineno" > 417< / span >   }< / div >
< div class = "line" > < a name = "l00418" > < / a > < span class = "lineno" > 418< / span >   < span class = "keywordflow" > break< / span > ;< / div >
< div class = "line" > < a name = "l00419" > < / a > < span class = "lineno" > 419< / span >   < span class = "keywordflow" > case< / span > < a class = "code" href = "_s_p_p_8h.html#a25f7af87e6960e2e8ed49006b0b50f3e" > L2CAP_SDP_DONE< / a > :< / div >
< div class = "line" > < a name = "l00420" > < / a > < span class = "lineno" > 420< / span >   < span class = "keywordflow" > if< / span > (< a class = "code" href = "_s_p_p_8h.html#a05022c9cce93cccafc32337771c8704a" > l2cap_disconnect_request_sdp_flag< / a > ) {< / div >
< div class = "line" > < a name = "l00421" > < / a > < span class = "lineno" > 421< / span >   l2cap_event_flag & = ~< a class = "code" href = "_s_p_p_8h.html#aac25fa1de5df70a97a6ccc6267d65fea" > L2CAP_FLAG_DISCONNECT_SDP_REQUEST< / a > ; < span class = "comment" > // Clear flag< / span > < / div >
< div class = "line" > < a name = "l00422" > < / a > < span class = "lineno" > 422< / span >   SDPConnected = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00423" > < / a > < span class = "lineno" > 423< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00424" > < / a > < span class = "lineno" > 424< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nDisconnected SDP Channel" < / span > ));< / div >
< div class = "line" > < a name = "l00425" > < / a > < span class = "lineno" > 425< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00426" > < / a > < span class = "lineno" > 426< / span >   < span class = "preprocessor" > < / span > pBtd-> < a class = "code" href = "class_b_t_d.html#a29d176d9194e5c92fbe54791fc245407" > l2cap_disconnection_response< / a > (hci_handle,identifier,sdp_dcid,sdp_scid); < / div >
< div class = "line" > < a name = "l00427" > < / a > < span class = "lineno" > 427< / span >   l2cap_sdp_state = < a class = "code" href = "_s_p_p_8h.html#a72444116eaac116983a3dec35b1944f0" > L2CAP_SDP_WAIT< / a > ;< / div >
< div class = "line" > < a name = "l00428" > < / a > < span class = "lineno" > 428< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (< a class = "code" href = "_s_p_p_8h.html#a3b1cbac2f2fc44b393ff3cb96448892a" > l2cap_connection_request_sdp_flag< / a > )< / div >
< div class = "line" > < a name = "l00429" > < / a > < span class = "lineno" > 429< / span >   l2cap_rfcomm_state = < a class = "code" href = "_s_p_p_8h.html#a72444116eaac116983a3dec35b1944f0" > L2CAP_SDP_WAIT< / a > ;< / div >
< div class = "line" > < a name = "l00430" > < / a > < span class = "lineno" > 430< / span >   < span class = "keywordflow" > break< / span > ;< / div >
< div class = "line" > < a name = "l00431" > < / a > < span class = "lineno" > 431< / span >   < span class = "keywordflow" > case< / span > < a class = "code" href = "_s_p_p_8h.html#adf2585ad5d49cf2df2595d860ad6b258" > L2CAP_DISCONNECT_RESPONSE< / a > : < span class = "comment" > // This is for both disconnection response from the RFCOMM and SDP channel if they were connected< / span > < / div >
< div class = "line" > < a name = "l00432" > < / a > < span class = "lineno" > 432< / span >   < span class = "keywordflow" > if< / span > (< a class = "code" href = "_s_p_p_8h.html#a1412e00ebed70b8d7b41afd769252530" > l2cap_disconnect_response_flag< / a > ) {< / div >
< div class = "line" > < a name = "l00433" > < / a > < span class = "lineno" > 433< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00434" > < / a > < span class = "lineno" > 434< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nDisconnected L2CAP Connection" < / span > ));< / div >
< div class = "line" > < a name = "l00435" > < / a > < span class = "lineno" > 435< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00436" > < / a > < span class = "lineno" > 436< / span >   < span class = "preprocessor" > < / span > RFCOMMConnected = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00437" > < / a > < span class = "lineno" > 437< / span >   SDPConnected = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00438" > < / a > < span class = "lineno" > 438< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#a1bea5dd793a2f47006b4a7642efc9e56" > hci_disconnect< / a > (hci_handle);< / div >
< div class = "line" > < a name = "l00439" > < / a > < span class = "lineno" > 439< / span >   hci_handle = -1; < span class = "comment" > // Reset handle< / span > < / div >
< div class = "line" > < a name = "l00440" > < / a > < span class = "lineno" > 440< / span >   l2cap_event_flag = 0; < span class = "comment" > // Reset flags< / span > < / div >
< div class = "line" > < a name = "l00441" > < / a > < span class = "lineno" > 441< / span >   l2cap_sdp_state = < a class = "code" href = "_s_p_p_8h.html#a72444116eaac116983a3dec35b1944f0" > L2CAP_SDP_WAIT< / a > ;< / div >
< div class = "line" > < a name = "l00442" > < / a > < span class = "lineno" > 442< / span >   l2cap_rfcomm_state = < a class = "code" href = "_s_p_p_8h.html#a0b7cbe1aa26664847a48bd4578bc50bd" > L2CAP_RFCOMM_WAIT< / a > ;< / div >
< div class = "line" > < a name = "l00443" > < / a > < span class = "lineno" > 443< / span >   }< / div >
< div class = "line" > < a name = "l00444" > < / a > < span class = "lineno" > 444< / span >   < span class = "keywordflow" > break< / span > ; < / div >
< div class = "line" > < a name = "l00445" > < / a > < span class = "lineno" > 445< / span >   }< / div >
< div class = "line" > < a name = "l00446" > < / a > < span class = "lineno" > 446< / span >   }< / div >
< div class = "line" > < a name = "l00447" > < / a > < span class = "lineno" > 447< / span >   < span class = "keywordtype" > void< / span > SPP::RFCOMM_task()< / div >
< div class = "line" > < a name = "l00448" > < / a > < span class = "lineno" > 448< / span >   { < / div >
< div class = "line" > < a name = "l00449" > < / a > < span class = "lineno" > 449< / span >   < span class = "keywordflow" > switch< / span > (l2cap_rfcomm_state)< / div >
< div class = "line" > < a name = "l00450" > < / a > < span class = "lineno" > 450< / span >   {< / div >
< div class = "line" > < a name = "l00451" > < / a > < span class = "lineno" > 451< / span >   < span class = "keywordflow" > case< / span > < a class = "code" href = "_s_p_p_8h.html#a0b7cbe1aa26664847a48bd4578bc50bd" > L2CAP_RFCOMM_WAIT< / a > : < / div >
< div class = "line" > < a name = "l00452" > < / a > < span class = "lineno" > 452< / span >   < span class = "keywordflow" > if< / span > (< a class = "code" href = "_s_p_p_8h.html#a28cbb8ce9ab60e04e2e131a87e06d5f0" > l2cap_connection_request_rfcomm_flag< / a > ) {< / div >
< div class = "line" > < a name = "l00453" > < / a > < span class = "lineno" > 453< / span >   l2cap_event_flag & = ~< a class = "code" href = "_s_p_p_8h.html#a61b15e54b1c5f9a28c996ae8e04ca3c0" > L2CAP_FLAG_CONNECTION_RFCOMM_REQUEST< / a > ; < span class = "comment" > // Clear flag< / span > < / div >
< div class = "line" > < a name = "l00454" > < / a > < span class = "lineno" > 454< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00455" > < / a > < span class = "lineno" > 455< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nRFCOMM Incoming Connection Request" < / span > ));< / div >
< div class = "line" > < a name = "l00456" > < / a > < span class = "lineno" > 456< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00457" > < / a > < span class = "lineno" > 457< / span >   < span class = "preprocessor" > < / span > pBtd-> < a class = "code" href = "class_b_t_d.html#a7d34c62b1d561679dea5cd27356b38a7" > l2cap_connection_response< / a > (hci_handle,identifier, rfcomm_dcid, rfcomm_scid, < a class = "code" href = "_b_t_d_8h.html#a9960d0d5ae92fc92c70bbb84c2a5c0cc" > PENDING< / a > ); < / div >
< div class = "line" > < a name = "l00458" > < / a > < span class = "lineno" > 458< / span >   delay(1);< / div >
< div class = "line" > < a name = "l00459" > < / a > < span class = "lineno" > 459< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#a7d34c62b1d561679dea5cd27356b38a7" > l2cap_connection_response< / a > (hci_handle,identifier, rfcomm_dcid, rfcomm_scid, < a class = "code" href = "_b_t_d_8h.html#a1be7a56cdddcdb7dedf16d4dee381e93" > SUCCESSFUL< / a > ); < / div >
< div class = "line" > < a name = "l00460" > < / a > < span class = "lineno" > 460< / span >   identifier++;< / div >
< div class = "line" > < a name = "l00461" > < / a > < span class = "lineno" > 461< / span >   delay(1);< / div >
< div class = "line" > < a name = "l00462" > < / a > < span class = "lineno" > 462< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#ab646a59311344966f139bb3b78f30233" > l2cap_config_request< / a > (hci_handle,identifier, rfcomm_scid); < / div >
< div class = "line" > < a name = "l00463" > < / a > < span class = "lineno" > 463< / span >   l2cap_rfcomm_state = < a class = "code" href = "_s_p_p_8h.html#ad7f3cf22bd76c9ccd377d96b4a751fc4" > L2CAP_RFCOMM_REQUEST< / a > ; < / div >
< div class = "line" > < a name = "l00464" > < / a > < span class = "lineno" > 464< / span >   } < / div >
< div class = "line" > < a name = "l00465" > < / a > < span class = "lineno" > 465< / span >   < span class = "keywordflow" > break< / span > ; < / div >
< div class = "line" > < a name = "l00466" > < / a > < span class = "lineno" > 466< / span >   < span class = "keywordflow" > case< / span > < a class = "code" href = "_s_p_p_8h.html#ad7f3cf22bd76c9ccd377d96b4a751fc4" > L2CAP_RFCOMM_REQUEST< / a > :< / div >
< div class = "line" > < a name = "l00467" > < / a > < span class = "lineno" > 467< / span >   < span class = "keywordflow" > if< / span > (< a class = "code" href = "_s_p_p_8h.html#ae9459fccc82a24e23dc52ef0e0422273" > l2cap_config_request_rfcomm_flag< / a > ) {< / div >
< div class = "line" > < a name = "l00468" > < / a > < span class = "lineno" > 468< / span >   l2cap_event_flag & = ~< a class = "code" href = "_s_p_p_8h.html#abaa9eb6a1d27745243ef134ecad34bb2" > L2CAP_FLAG_CONFIG_RFCOMM_REQUEST< / a > ; < span class = "comment" > // Clear flag< / span > < / div >
< div class = "line" > < a name = "l00469" > < / a > < span class = "lineno" > 469< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00470" > < / a > < span class = "lineno" > 470< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nRFCOMM Configuration Request" < / span > ));< / div >
< div class = "line" > < a name = "l00471" > < / a > < span class = "lineno" > 471< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00472" > < / a > < span class = "lineno" > 472< / span >   < span class = "preprocessor" > < / span > pBtd-> < a class = "code" href = "class_b_t_d.html#a792ac4529b65235698ecf3d37982c05e" > l2cap_config_response< / a > (hci_handle,identifier, rfcomm_scid); < / div >
< div class = "line" > < a name = "l00473" > < / a > < span class = "lineno" > 473< / span >   l2cap_rfcomm_state = < a class = "code" href = "_s_p_p_8h.html#a75321d181cfa3c485bcd96918c1b353e" > L2CAP_RFCOMM_SUCCESS< / a > ;< / div >
< div class = "line" > < a name = "l00474" > < / a > < span class = "lineno" > 474< / span >   }< / div >
< div class = "line" > < a name = "l00475" > < / a > < span class = "lineno" > 475< / span >   < span class = "keywordflow" > break< / span > ;< / div >
< div class = "line" > < a name = "l00476" > < / a > < span class = "lineno" > 476< / span >   < span class = "keywordflow" > case< / span > < a class = "code" href = "_s_p_p_8h.html#a75321d181cfa3c485bcd96918c1b353e" > L2CAP_RFCOMM_SUCCESS< / a > :< / div >
< div class = "line" > < a name = "l00477" > < / a > < span class = "lineno" > 477< / span >   < span class = "keywordflow" > if< / span > (< a class = "code" href = "_s_p_p_8h.html#a1c5c7dc5782a562f1b91e835f8aebdb4" > l2cap_config_success_rfcomm_flag< / a > ) {< / div >
< div class = "line" > < a name = "l00478" > < / a > < span class = "lineno" > 478< / span >   l2cap_event_flag & = ~< a class = "code" href = "_s_p_p_8h.html#a8af4ce4d4c42d85f0d84a514354fc570" > L2CAP_FLAG_CONFIG_RFCOMM_SUCCESS< / a > ; < span class = "comment" > // Clear flag< / span > < / div >
< div class = "line" > < a name = "l00479" > < / a > < span class = "lineno" > 479< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00480" > < / a > < span class = "lineno" > 480< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nRFCOMM Successfully Configured" < / span > ));< / div >
< div class = "line" > < a name = "l00481" > < / a > < span class = "lineno" > 481< / span >   < span class = "preprocessor" > #endif < / span > < / div >
< div class = "line" > < a name = "l00482" > < / a > < span class = "lineno" > 482< / span >   < span class = "preprocessor" > < / span > rfcommAvailable = 0; < span class = "comment" > // Reset number of bytes available< / span > < / div >
< div class = "line" > < a name = "l00483" > < / a > < span class = "lineno" > 483< / span >   bytesRead = 0; < span class = "comment" > // Reset number of bytes received< / span > < / div >
< div class = "line" > < a name = "l00484" > < / a > < span class = "lineno" > 484< / span >   RFCOMMConnected = < span class = "keyword" > true< / span > ;< / div >
< div class = "line" > < a name = "l00485" > < / a > < span class = "lineno" > 485< / span >   l2cap_rfcomm_state = < a class = "code" href = "_s_p_p_8h.html#ac3b4f24642f460c347305dedbebc5e63" > L2CAP_RFCOMM_DONE< / a > ;< / div >
< div class = "line" > < a name = "l00486" > < / a > < span class = "lineno" > 486< / span >   }< / div >
< div class = "line" > < a name = "l00487" > < / a > < span class = "lineno" > 487< / span >   < span class = "keywordflow" > break< / span > ; < / div >
< div class = "line" > < a name = "l00488" > < / a > < span class = "lineno" > 488< / span >   < span class = "keywordflow" > case< / span > < a class = "code" href = "_s_p_p_8h.html#ac3b4f24642f460c347305dedbebc5e63" > L2CAP_RFCOMM_DONE< / a > :< / div >
< div class = "line" > < a name = "l00489" > < / a > < span class = "lineno" > 489< / span >   < span class = "keywordflow" > if< / span > (< a class = "code" href = "_s_p_p_8h.html#af565a91718a79907aece8a5c278aa0bc" > l2cap_disconnect_request_rfcomm_flag< / a > ) {< / div >
< div class = "line" > < a name = "l00490" > < / a > < span class = "lineno" > 490< / span >   l2cap_event_flag & = ~< a class = "code" href = "_s_p_p_8h.html#a9da70c702c0b792d99f8e39713ac0ee7" > L2CAP_FLAG_DISCONNECT_RFCOMM_REQUEST< / a > ; < span class = "comment" > // Clear flag< / span > < / div >
< div class = "line" > < a name = "l00491" > < / a > < span class = "lineno" > 491< / span >   RFCOMMConnected = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00492" > < / a > < span class = "lineno" > 492< / span >   < a class = "code" href = "class_s_p_p.html#ade5d4f0ab50ddcad14f75fce4450a028" > connected< / a > = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00493" > < / a > < span class = "lineno" > 493< / span >   < span class = "preprocessor" > #ifdef DEBUG< / span > < / div >
< div class = "line" > < a name = "l00494" > < / a > < span class = "lineno" > 494< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nDisconnected RFCOMM Channel" < / span > ));< / div >
< div class = "line" > < a name = "l00495" > < / a > < span class = "lineno" > 495< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00496" > < / a > < span class = "lineno" > 496< / span >   < span class = "preprocessor" > < / span > pBtd-> < a class = "code" href = "class_b_t_d.html#a29d176d9194e5c92fbe54791fc245407" > l2cap_disconnection_response< / a > (hci_handle,identifier,rfcomm_dcid,rfcomm_scid);< / div >
< div class = "line" > < a name = "l00497" > < / a > < span class = "lineno" > 497< / span >   l2cap_rfcomm_state = < a class = "code" href = "_s_p_p_8h.html#a0b7cbe1aa26664847a48bd4578bc50bd" > L2CAP_RFCOMM_WAIT< / a > ;< / div >
< div class = "line" > < a name = "l00498" > < / a > < span class = "lineno" > 498< / span >   } < span class = "keywordflow" > else< / span > < span class = "keywordflow" > if< / span > (< a class = "code" href = "_s_p_p_8h.html#a28cbb8ce9ab60e04e2e131a87e06d5f0" > l2cap_connection_request_rfcomm_flag< / a > )< / div >
< div class = "line" > < a name = "l00499" > < / a > < span class = "lineno" > 499< / span >   l2cap_rfcomm_state = < a class = "code" href = "_s_p_p_8h.html#a0b7cbe1aa26664847a48bd4578bc50bd" > L2CAP_RFCOMM_WAIT< / a > ;< / div >
< div class = "line" > < a name = "l00500" > < / a > < span class = "lineno" > 500< / span >   < span class = "keywordflow" > break< / span > ; < / div >
< div class = "line" > < a name = "l00501" > < / a > < span class = "lineno" > 501< / span >   }< / div >
< div class = "line" > < a name = "l00502" > < / a > < span class = "lineno" > 502< / span >   }< / div >
< div class = "line" > < a name = "l00503" > < / a > < span class = "lineno" > 503< / span >   < span class = "comment" > /************************************************************/< / span > < / div >
< div class = "line" > < a name = "l00504" > < / a > < span class = "lineno" > 504< / span >   < span class = "comment" > /* SDP Commands */< / span > < / div >
< div class = "line" > < a name = "l00505" > < / a > < span class = "lineno" > 505< / span >   < span class = "comment" > /************************************************************/< / span > < / div >
< div class = "line" > < a name = "l00506" > < / a > < span class = "lineno" > 506< / span >   < span class = "keywordtype" > void< / span > SPP::SDP_Command(uint8_t* data, uint8_t nbytes) { < span class = "comment" > // See page 223 in the Bluetooth specs< / span > < / div >
< div class = "line" > < a name = "l00507" > < / a > < span class = "lineno" > 507< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7" > L2CAP_Command< / a > (hci_handle,data,nbytes,sdp_scid[0],sdp_scid[1]);< / div >
< div class = "line" > < a name = "l00508" > < / a > < span class = "lineno" > 508< / span >   }< / div >
< div class = "line" > < a name = "l00509" > < / a > < span class = "lineno" > 509< / span >   < span class = "keywordtype" > void< / span > SPP::serviceNotSupported(uint8_t transactionIDHigh, uint8_t transactionIDLow) { < span class = "comment" > // See page 235 in the Bluetooth specs< / span > < / div >
< div class = "line" > < a name = "l00510" > < / a > < span class = "lineno" > 510< / span >   l2capoutbuf[0] = < a class = "code" href = "_s_p_p_8h.html#a42a6f00a3828a932bae1509c813b5c98" > SDP_SERVICE_SEARCH_ATTRIBUTE_RESPONSE_PDU< / a > ;< / div >
< div class = "line" > < a name = "l00511" > < / a > < span class = "lineno" > 511< / span >   l2capoutbuf[1] = transactionIDHigh;< / div >
< div class = "line" > < a name = "l00512" > < / a > < span class = "lineno" > 512< / span >   l2capoutbuf[2] = transactionIDLow;< / div >
< div class = "line" > < a name = "l00513" > < / a > < span class = "lineno" > 513< / span >   l2capoutbuf[3] = 0x00; < span class = "comment" > // Parameter Length< / span > < / div >
< div class = "line" > < a name = "l00514" > < / a > < span class = "lineno" > 514< / span >   l2capoutbuf[4] = 0x05; < span class = "comment" > // Parameter Length< / span > < / div >
< div class = "line" > < a name = "l00515" > < / a > < span class = "lineno" > 515< / span >   l2capoutbuf[5] = 0x00; < span class = "comment" > // AttributeListsByteCount< / span > < / div >
< div class = "line" > < a name = "l00516" > < / a > < span class = "lineno" > 516< / span >   l2capoutbuf[6] = 0x02; < span class = "comment" > // AttributeListsByteCount< / span > < / div >
< div class = "line" > < a name = "l00517" > < / a > < span class = "lineno" > 517< / span >   < / div >
< div class = "line" > < a name = "l00518" > < / a > < span class = "lineno" > 518< / span >   < span class = "comment" > /* Attribute ID/Value Sequence: */< / span > < / div >
< div class = "line" > < a name = "l00519" > < / a > < span class = "lineno" > 519< / span >   l2capoutbuf[7] = 0x35;< / div >
< div class = "line" > < a name = "l00520" > < / a > < span class = "lineno" > 520< / span >   l2capoutbuf[8] = 0x00;< / div >
< div class = "line" > < a name = "l00521" > < / a > < span class = "lineno" > 521< / span >   l2capoutbuf[9] = 0x00;< / div >
< div class = "line" > < a name = "l00522" > < / a > < span class = "lineno" > 522< / span >   < / div >
< div class = "line" > < a name = "l00523" > < / a > < span class = "lineno" > 523< / span >   SDP_Command(l2capoutbuf,10);< / div >
< div class = "line" > < a name = "l00524" > < / a > < span class = "lineno" > 524< / span >   }< / div >
< div class = "line" > < a name = "l00525" > < / a > < span class = "lineno" > 525< / span >   < span class = "keywordtype" > void< / span > SPP::serialPortResponse1(uint8_t transactionIDHigh, uint8_t transactionIDLow) {< / div >
< div class = "line" > < a name = "l00526" > < / a > < span class = "lineno" > 526< / span >   l2capoutbuf[0] = < a class = "code" href = "_s_p_p_8h.html#a42a6f00a3828a932bae1509c813b5c98" > SDP_SERVICE_SEARCH_ATTRIBUTE_RESPONSE_PDU< / a > ;< / div >
< div class = "line" > < a name = "l00527" > < / a > < span class = "lineno" > 527< / span >   l2capoutbuf[1] = transactionIDHigh;< / div >
< div class = "line" > < a name = "l00528" > < / a > < span class = "lineno" > 528< / span >   l2capoutbuf[2] = transactionIDLow;< / div >
< div class = "line" > < a name = "l00529" > < / a > < span class = "lineno" > 529< / span >   l2capoutbuf[3] = 0x00; < span class = "comment" > // Parameter Length< / span > < / div >
< div class = "line" > < a name = "l00530" > < / a > < span class = "lineno" > 530< / span >   l2capoutbuf[4] = 0x2B; < span class = "comment" > // Parameter Length< / span > < / div >
< div class = "line" > < a name = "l00531" > < / a > < span class = "lineno" > 531< / span >   l2capoutbuf[5] = 0x00; < span class = "comment" > // AttributeListsByteCount< / span > < / div >
< div class = "line" > < a name = "l00532" > < / a > < span class = "lineno" > 532< / span >   l2capoutbuf[6] = 0x26; < span class = "comment" > // AttributeListsByteCount< / span > < / div >
< div class = "line" > < a name = "l00533" > < / a > < span class = "lineno" > 533< / span >   < / div >
< div class = "line" > < a name = "l00534" > < / a > < span class = "lineno" > 534< / span >   < span class = "comment" > /* Attribute ID/Value Sequence: */< / span > < / div >
< div class = "line" > < a name = "l00535" > < / a > < span class = "lineno" > 535< / span >   l2capoutbuf[7] = 0x36;< / div >
< div class = "line" > < a name = "l00536" > < / a > < span class = "lineno" > 536< / span >   l2capoutbuf[8] = 0x00;< / div >
< div class = "line" > < a name = "l00537" > < / a > < span class = "lineno" > 537< / span >   l2capoutbuf[9] = 0x3C;< / div >
< div class = "line" > < a name = "l00538" > < / a > < span class = "lineno" > 538< / span >   l2capoutbuf[10] = 0x36;< / div >
< div class = "line" > < a name = "l00539" > < / a > < span class = "lineno" > 539< / span >   l2capoutbuf[11] = 0x00;< / div >
< div class = "line" > < a name = "l00540" > < / a > < span class = "lineno" > 540< / span >   < / div >
< div class = "line" > < a name = "l00541" > < / a > < span class = "lineno" > 541< / span >   l2capoutbuf[12] = 0x39;< / div >
< div class = "line" > < a name = "l00542" > < / a > < span class = "lineno" > 542< / span >   l2capoutbuf[13] = 0x09;< / div >
< div class = "line" > < a name = "l00543" > < / a > < span class = "lineno" > 543< / span >   l2capoutbuf[14] = 0x00;< / div >
< div class = "line" > < a name = "l00544" > < / a > < span class = "lineno" > 544< / span >   l2capoutbuf[15] = 0x00;< / div >
< div class = "line" > < a name = "l00545" > < / a > < span class = "lineno" > 545< / span >   l2capoutbuf[16] = 0x0A;< / div >
< div class = "line" > < a name = "l00546" > < / a > < span class = "lineno" > 546< / span >   l2capoutbuf[17] = 0x00;< / div >
< div class = "line" > < a name = "l00547" > < / a > < span class = "lineno" > 547< / span >   l2capoutbuf[18] = 0x01;< / div >
< div class = "line" > < a name = "l00548" > < / a > < span class = "lineno" > 548< / span >   l2capoutbuf[19] = 0x00;< / div >
< div class = "line" > < a name = "l00549" > < / a > < span class = "lineno" > 549< / span >   l2capoutbuf[20] = 0x06;< / div >
< div class = "line" > < a name = "l00550" > < / a > < span class = "lineno" > 550< / span >   l2capoutbuf[21] = 0x09;< / div >
< div class = "line" > < a name = "l00551" > < / a > < span class = "lineno" > 551< / span >   l2capoutbuf[22] = 0x00;< / div >
< div class = "line" > < a name = "l00552" > < / a > < span class = "lineno" > 552< / span >   l2capoutbuf[23] = 0x01;< / div >
< div class = "line" > < a name = "l00553" > < / a > < span class = "lineno" > 553< / span >   l2capoutbuf[24] = 0x35;< / div >
< div class = "line" > < a name = "l00554" > < / a > < span class = "lineno" > 554< / span >   l2capoutbuf[25] = 0x03;< / div >
< div class = "line" > < a name = "l00555" > < / a > < span class = "lineno" > 555< / span >   l2capoutbuf[26] = 0x19;< / div >
< div class = "line" > < a name = "l00556" > < / a > < span class = "lineno" > 556< / span >   l2capoutbuf[27] = 0x11;< / div >
< div class = "line" > < a name = "l00557" > < / a > < span class = "lineno" > 557< / span >   < / div >
< div class = "line" > < a name = "l00558" > < / a > < span class = "lineno" > 558< / span >   l2capoutbuf[28] = 0x01;< / div >
< div class = "line" > < a name = "l00559" > < / a > < span class = "lineno" > 559< / span >   l2capoutbuf[29] = 0x09;< / div >
< div class = "line" > < a name = "l00560" > < / a > < span class = "lineno" > 560< / span >   l2capoutbuf[30] = 0x00;< / div >
< div class = "line" > < a name = "l00561" > < / a > < span class = "lineno" > 561< / span >   l2capoutbuf[31] = 0x04;< / div >
< div class = "line" > < a name = "l00562" > < / a > < span class = "lineno" > 562< / span >   l2capoutbuf[32] = 0x35;< / div >
< div class = "line" > < a name = "l00563" > < / a > < span class = "lineno" > 563< / span >   l2capoutbuf[33] = 0x0C;< / div >
< div class = "line" > < a name = "l00564" > < / a > < span class = "lineno" > 564< / span >   l2capoutbuf[34] = 0x35;< / div >
< div class = "line" > < a name = "l00565" > < / a > < span class = "lineno" > 565< / span >   l2capoutbuf[35] = 0x03;< / div >
< div class = "line" > < a name = "l00566" > < / a > < span class = "lineno" > 566< / span >   l2capoutbuf[36] = 0x19;< / div >
< div class = "line" > < a name = "l00567" > < / a > < span class = "lineno" > 567< / span >   l2capoutbuf[37] = 0x01;< / div >
< div class = "line" > < a name = "l00568" > < / a > < span class = "lineno" > 568< / span >   l2capoutbuf[38] = 0x00;< / div >
< div class = "line" > < a name = "l00569" > < / a > < span class = "lineno" > 569< / span >   l2capoutbuf[39] = 0x35;< / div >
< div class = "line" > < a name = "l00570" > < / a > < span class = "lineno" > 570< / span >   l2capoutbuf[40] = 0x05;< / div >
< div class = "line" > < a name = "l00571" > < / a > < span class = "lineno" > 571< / span >   l2capoutbuf[41] = 0x19;< / div >
< div class = "line" > < a name = "l00572" > < / a > < span class = "lineno" > 572< / span >   l2capoutbuf[42] = 0x00;< / div >
< div class = "line" > < a name = "l00573" > < / a > < span class = "lineno" > 573< / span >   l2capoutbuf[43] = 0x03;< / div >
< div class = "line" > < a name = "l00574" > < / a > < span class = "lineno" > 574< / span >   < / div >
< div class = "line" > < a name = "l00575" > < / a > < span class = "lineno" > 575< / span >   l2capoutbuf[44] = 0x08;< / div >
< div class = "line" > < a name = "l00576" > < / a > < span class = "lineno" > 576< / span >   l2capoutbuf[45] = 0x02; < span class = "comment" > // Two extra bytes< / span > < / div >
< div class = "line" > < a name = "l00577" > < / a > < span class = "lineno" > 577< / span >   l2capoutbuf[46] = 0x00; < span class = "comment" > // 25 (0x19) more bytes to come< / span > < / div >
< div class = "line" > < a name = "l00578" > < / a > < span class = "lineno" > 578< / span >   l2capoutbuf[47] = 0x19; < / div >
< div class = "line" > < a name = "l00579" > < / a > < span class = "lineno" > 579< / span >   < / div >
< div class = "line" > < a name = "l00580" > < / a > < span class = "lineno" > 580< / span >   SDP_Command(l2capoutbuf,48); < / div >
< div class = "line" > < a name = "l00581" > < / a > < span class = "lineno" > 581< / span >   }< / div >
< div class = "line" > < a name = "l00582" > < / a > < span class = "lineno" > 582< / span >   < span class = "keywordtype" > void< / span > SPP::serialPortResponse2(uint8_t transactionIDHigh, uint8_t transactionIDLow) {< / div >
< div class = "line" > < a name = "l00583" > < / a > < span class = "lineno" > 583< / span >   l2capoutbuf[0] = < a class = "code" href = "_s_p_p_8h.html#a42a6f00a3828a932bae1509c813b5c98" > SDP_SERVICE_SEARCH_ATTRIBUTE_RESPONSE_PDU< / a > ;< / div >
< div class = "line" > < a name = "l00584" > < / a > < span class = "lineno" > 584< / span >   l2capoutbuf[1] = transactionIDHigh;< / div >
< div class = "line" > < a name = "l00585" > < / a > < span class = "lineno" > 585< / span >   l2capoutbuf[2] = transactionIDLow;< / div >
< div class = "line" > < a name = "l00586" > < / a > < span class = "lineno" > 586< / span >   l2capoutbuf[3] = 0x00; < span class = "comment" > // Parameter Length< / span > < / div >
< div class = "line" > < a name = "l00587" > < / a > < span class = "lineno" > 587< / span >   l2capoutbuf[4] = 0x1C; < span class = "comment" > // Parameter Length< / span > < / div >
< div class = "line" > < a name = "l00588" > < / a > < span class = "lineno" > 588< / span >   l2capoutbuf[5] = 0x00; < span class = "comment" > // AttributeListsByteCount< / span > < / div >
< div class = "line" > < a name = "l00589" > < / a > < span class = "lineno" > 589< / span >   l2capoutbuf[6] = 0x19; < span class = "comment" > // AttributeListsByteCount< / span > < / div >
< div class = "line" > < a name = "l00590" > < / a > < span class = "lineno" > 590< / span >   < / div >
< div class = "line" > < a name = "l00591" > < / a > < span class = "lineno" > 591< / span >   < span class = "comment" > /* Attribute ID/Value Sequence: */< / span > < / div >
< div class = "line" > < a name = "l00592" > < / a > < span class = "lineno" > 592< / span >   l2capoutbuf[7] = 0x01;< / div >
< div class = "line" > < a name = "l00593" > < / a > < span class = "lineno" > 593< / span >   l2capoutbuf[8] = 0x09;< / div >
< div class = "line" > < a name = "l00594" > < / a > < span class = "lineno" > 594< / span >   l2capoutbuf[9] = 0x00;< / div >
< div class = "line" > < a name = "l00595" > < / a > < span class = "lineno" > 595< / span >   l2capoutbuf[10] = 0x06;< / div >
< div class = "line" > < a name = "l00596" > < / a > < span class = "lineno" > 596< / span >   l2capoutbuf[11] = 0x35;< / div >
< div class = "line" > < a name = "l00597" > < / a > < span class = "lineno" > 597< / span >   < / div >
< div class = "line" > < a name = "l00598" > < / a > < span class = "lineno" > 598< / span >   l2capoutbuf[12] = 0x09;< / div >
< div class = "line" > < a name = "l00599" > < / a > < span class = "lineno" > 599< / span >   l2capoutbuf[13] = 0x09;< / div >
< div class = "line" > < a name = "l00600" > < / a > < span class = "lineno" > 600< / span >   l2capoutbuf[14] = 0x65;< / div >
< div class = "line" > < a name = "l00601" > < / a > < span class = "lineno" > 601< / span >   l2capoutbuf[15] = 0x6E;< / div >
< div class = "line" > < a name = "l00602" > < / a > < span class = "lineno" > 602< / span >   l2capoutbuf[16] = 0x09;< / div >
< div class = "line" > < a name = "l00603" > < / a > < span class = "lineno" > 603< / span >   l2capoutbuf[17] = 0x00;< / div >
< div class = "line" > < a name = "l00604" > < / a > < span class = "lineno" > 604< / span >   l2capoutbuf[18] = 0x6A;< / div >
< div class = "line" > < a name = "l00605" > < / a > < span class = "lineno" > 605< / span >   l2capoutbuf[19] = 0x09;< / div >
< div class = "line" > < a name = "l00606" > < / a > < span class = "lineno" > 606< / span >   l2capoutbuf[20] = 0x01;< / div >
< div class = "line" > < a name = "l00607" > < / a > < span class = "lineno" > 607< / span >   l2capoutbuf[21] = 0x00;< / div >
< div class = "line" > < a name = "l00608" > < / a > < span class = "lineno" > 608< / span >   l2capoutbuf[22] = 0x09;< / div >
< div class = "line" > < a name = "l00609" > < / a > < span class = "lineno" > 609< / span >   l2capoutbuf[23] = 0x01;< / div >
< div class = "line" > < a name = "l00610" > < / a > < span class = "lineno" > 610< / span >   l2capoutbuf[24] = 0x00;< / div >
< div class = "line" > < a name = "l00611" > < / a > < span class = "lineno" > 611< / span >   l2capoutbuf[25] = 0x25;< / div >
< div class = "line" > < a name = "l00612" > < / a > < span class = "lineno" > 612< / span >   < / div >
< div class = "line" > < a name = "l00613" > < / a > < span class = "lineno" > 613< / span >   l2capoutbuf[26] = 0x05; < span class = "comment" > // Name length < / span > < / div >
< div class = "line" > < a name = "l00614" > < / a > < span class = "lineno" > 614< / span >   l2capoutbuf[27] = < span class = "charliteral" > ' T' < / span > ;< / div >
< div class = "line" > < a name = "l00615" > < / a > < span class = "lineno" > 615< / span >   l2capoutbuf[28] = < span class = "charliteral" > ' K' < / span > ;< / div >
< div class = "line" > < a name = "l00616" > < / a > < span class = "lineno" > 616< / span >   l2capoutbuf[29] = < span class = "charliteral" > ' J' < / span > ;< / div >
< div class = "line" > < a name = "l00617" > < / a > < span class = "lineno" > 617< / span >   l2capoutbuf[30] = < span class = "charliteral" > ' S' < / span > ;< / div >
< div class = "line" > < a name = "l00618" > < / a > < span class = "lineno" > 618< / span >   l2capoutbuf[31] = < span class = "charliteral" > ' P' < / span > ;< / div >
< div class = "line" > < a name = "l00619" > < / a > < span class = "lineno" > 619< / span >   l2capoutbuf[32] = 0x00; < span class = "comment" > // No more data< / span > < / div >
< div class = "line" > < a name = "l00620" > < / a > < span class = "lineno" > 620< / span >   < / div >
< div class = "line" > < a name = "l00621" > < / a > < span class = "lineno" > 621< / span >   SDP_Command(l2capoutbuf,33);< / div >
< div class = "line" > < a name = "l00622" > < / a > < span class = "lineno" > 622< / span >   }< / div >
< div class = "line" > < a name = "l00623" > < / a > < span class = "lineno" > 623< / span >   < span class = "keywordtype" > void< / span > SPP::l2capResponse1(uint8_t transactionIDHigh, uint8_t transactionIDLow) {< / div >
< div class = "line" > < a name = "l00624" > < / a > < span class = "lineno" > 624< / span >   serialPortResponse1(transactionIDHigh,transactionIDLow); < span class = "comment" > // These has to send all the supported functions, since it only supports virtual serialport it just sends the message again< / span > < / div >
< div class = "line" > < a name = "l00625" > < / a > < span class = "lineno" > 625< / span >   }< / div >
< div class = "line" > < a name = "l00626" > < / a > < span class = "lineno" > 626< / span >   < span class = "keywordtype" > void< / span > SPP::l2capResponse2(uint8_t transactionIDHigh, uint8_t transactionIDLow) {< / div >
< div class = "line" > < a name = "l00627" > < / a > < span class = "lineno" > 627< / span >   serialPortResponse2(transactionIDHigh,transactionIDLow); < span class = "comment" > // Same data as serialPortResponse2 < / span > < / div >
< div class = "line" > < a name = "l00628" > < / a > < span class = "lineno" > 628< / span >   }< / div >
< div class = "line" > < a name = "l00629" > < / a > < span class = "lineno" > 629< / span >   < span class = "comment" > /************************************************************/< / span > < / div >
< div class = "line" > < a name = "l00630" > < / a > < span class = "lineno" > 630< / span >   < span class = "comment" > /* RFCOMM Commands */< / span > < / div >
< div class = "line" > < a name = "l00631" > < / a > < span class = "lineno" > 631< / span >   < span class = "comment" > /************************************************************/< / span > < / div >
< div class = "line" > < a name = "l00632" > < / a > < span class = "lineno" > 632< / span >   < span class = "keywordtype" > void< / span > SPP::RFCOMM_Command(uint8_t* data, uint8_t nbytes) {< / div >
< div class = "line" > < a name = "l00633" > < / a > < span class = "lineno" > 633< / span >   < span class = "keywordflow" > if< / span > ((millis() - printTimer) < 10)< span class = "comment" > // Check if is has been more than 10ms since last command< / span > < / div >
< div class = "line" > < a name = "l00634" > < / a > < span class = "lineno" > 634< / span >   delay((uint32_t)(10 - (millis() - printTimer))); < span class = "comment" > // There have to be a delay between commands< / span > < / div >
< div class = "line" > < a name = "l00635" > < / a > < span class = "lineno" > 635< / span >   pBtd-> < a class = "code" href = "class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7" > L2CAP_Command< / a > (hci_handle,data,nbytes,rfcomm_scid[0],rfcomm_scid[1]);< / div >
< div class = "line" > < a name = "l00636" > < / a > < span class = "lineno" > 636< / span >   printTimer = millis();< / div >
< div class = "line" > < a name = "l00637" > < / a > < span class = "lineno" > 637< / span >   }< / div >
< div class = "line" > < a name = "l00638" > < / a > < span class = "lineno" > 638< / span >   < / div >
< div class = "line" > < a name = "l00639" > < / a > < span class = "lineno" > 639< / span >   < span class = "keywordtype" > void< / span > SPP::sendRfcomm(uint8_t channel, uint8_t direction, uint8_t CR, uint8_t channelType, uint8_t pfBit, uint8_t* data, uint8_t length) {< / div >
< div class = "line" > < a name = "l00640" > < / a > < span class = "lineno" > 640< / span >   l2capoutbuf[0] = channel | direction | CR | < a class = "code" href = "_s_p_p_8h.html#af31032289d962bc2408debecc2823b8c" > extendAddress< / a > ; < span class = "comment" > // RFCOMM Address< / span > < / div >
< div class = "line" > < a name = "l00641" > < / a > < span class = "lineno" > 641< / span >   l2capoutbuf[1] = channelType | pfBit; < span class = "comment" > // RFCOMM Control< / span > < / div >
< div class = "line" > < a name = "l00642" > < / a > < span class = "lineno" > 642< / span >   l2capoutbuf[2] = length < < 1 | 0x01; < span class = "comment" > // Length and format (allways 0x01 bytes format)< / span > < / div >
< div class = "line" > < a name = "l00643" > < / a > < span class = "lineno" > 643< / span >   uint8_t i = 0;< / div >
< div class = "line" > < a name = "l00644" > < / a > < span class = "lineno" > 644< / span >   < span class = "keywordflow" > for< / span > (; i < length; i++)< / div >
< div class = "line" > < a name = "l00645" > < / a > < span class = "lineno" > 645< / span >   l2capoutbuf[i+3] = data[i];< / div >
< div class = "line" > < a name = "l00646" > < / a > < span class = "lineno" > 646< / span >   l2capoutbuf[i+3] = calcFcs(l2capoutbuf);< / div >
< div class = "line" > < a name = "l00647" > < / a > < span class = "lineno" > 647< / span >   < span class = "preprocessor" > #ifdef EXTRADEBUG< / span > < / div >
< div class = "line" > < a name = "l00648" > < / a > < span class = "lineno" > 648< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " - RFCOMM Data: " < / span > ));< / div >
< div class = "line" > < a name = "l00649" > < / a > < span class = "lineno" > 649< / span >   < span class = "keywordflow" > for< / span > (i = 0; i < length+4; i++) {< / div >
< div class = "line" > < a name = "l00650" > < / a > < span class = "lineno" > 650< / span >   Serial.print(l2capoutbuf[i],HEX);< / div >
< div class = "line" > < a name = "l00651" > < / a > < span class = "lineno" > 651< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " " < / span > ));< / div >
< div class = "line" > < a name = "l00652" > < / a > < span class = "lineno" > 652< / span >   }< / div >
< div class = "line" > < a name = "l00653" > < / a > < span class = "lineno" > 653< / span >   < span class = "preprocessor" > #endif < / span > < / div >
< div class = "line" > < a name = "l00654" > < / a > < span class = "lineno" > 654< / span >   < span class = "preprocessor" > < / span > RFCOMM_Command(l2capoutbuf,length+4);< / div >
< div class = "line" > < a name = "l00655" > < / a > < span class = "lineno" > 655< / span >   } < / div >
< div class = "line" > < a name = "l00656" > < / a > < span class = "lineno" > 656< / span >   < / div >
< div class = "line" > < a name = "l00657" > < / a > < span class = "lineno" > 657< / span >   < span class = "keywordtype" > void< / span > SPP::sendRfcommCredit(uint8_t channel, uint8_t direction, uint8_t CR, uint8_t channelType, uint8_t pfBit, uint8_t credit) {< / div >
< div class = "line" > < a name = "l00658" > < / a > < span class = "lineno" > 658< / span >   l2capoutbuf[0] = channel | direction | CR | < a class = "code" href = "_s_p_p_8h.html#af31032289d962bc2408debecc2823b8c" > extendAddress< / a > ; < span class = "comment" > // RFCOMM Address< / span > < / div >
< div class = "line" > < a name = "l00659" > < / a > < span class = "lineno" > 659< / span >   l2capoutbuf[1] = channelType | pfBit; < span class = "comment" > // RFCOMM Control< / span > < / div >
< div class = "line" > < a name = "l00660" > < / a > < span class = "lineno" > 660< / span >   l2capoutbuf[2] = 0x01; < span class = "comment" > // Length = 0< / span > < / div >
< div class = "line" > < a name = "l00661" > < / a > < span class = "lineno" > 661< / span >   l2capoutbuf[3] = credit; < span class = "comment" > // Credit< / span > < / div >
< div class = "line" > < a name = "l00662" > < / a > < span class = "lineno" > 662< / span >   l2capoutbuf[4] = calcFcs(l2capoutbuf); < / div >
< div class = "line" > < a name = "l00663" > < / a > < span class = "lineno" > 663< / span >   < span class = "preprocessor" > #ifdef EXTRADEBUG< / span > < / div >
< div class = "line" > < a name = "l00664" > < / a > < span class = "lineno" > 664< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " - RFCOMM Credit Data: " < / span > ));< / div >
< div class = "line" > < a name = "l00665" > < / a > < span class = "lineno" > 665< / span >   < span class = "keywordflow" > for< / span > (uint8_t i = 0; i < 5; i++) {< / div >
< div class = "line" > < a name = "l00666" > < / a > < span class = "lineno" > 666< / span >   Serial.print(l2capoutbuf[i],HEX);< / div >
< div class = "line" > < a name = "l00667" > < / a > < span class = "lineno" > 667< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " " < / span > ));< / div >
< div class = "line" > < a name = "l00668" > < / a > < span class = "lineno" > 668< / span >   }< / div >
< div class = "line" > < a name = "l00669" > < / a > < span class = "lineno" > 669< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00670" > < / a > < span class = "lineno" > 670< / span >   < span class = "preprocessor" > < / span > RFCOMM_Command(l2capoutbuf,5);< / div >
< div class = "line" > < a name = "l00671" > < / a > < span class = "lineno" > 671< / span >   }< / div >
< div class = "line" > < a name = "l00672" > < / a > < span class = "lineno" > 672< / span >   < / div >
< div class = "line" > < a name = "l00673" > < / a > < span class = "lineno" > 673< / span >   < span class = "comment" > /* CRC on 2 bytes */< / span > < / div >
< div class = "line" > < a name = "l00674" > < / a > < span class = "lineno" > 674< / span >   uint8_t SPP::__crc(uint8_t* data) {< / div >
< div class = "line" > < a name = "l00675" > < / a > < span class = "lineno" > 675< / span >   < span class = "keywordflow" > return< / span > (pgm_read_byte(& rfcomm_crc_table[pgm_read_byte(& rfcomm_crc_table[0xff ^ data[0]]) ^ data[1]]));< / div >
< div class = "line" > < a name = "l00676" > < / a > < span class = "lineno" > 676< / span >   }< / div >
< div class = "line" > < a name = "l00677" > < / a > < span class = "lineno" > 677< / span >   < / div >
< div class = "line" > < a name = "l00678" > < / a > < span class = "lineno" > 678< / span >   < span class = "comment" > /* Calculate FCS - we never actually check if the host sends correct FCS to the Arduino */< / span > < / div >
< div class = "line" > < a name = "l00679" > < / a > < span class = "lineno" > 679< / span >   uint8_t SPP::calcFcs(uint8_t *data) {< / div >
< div class = "line" > < a name = "l00680" > < / a > < span class = "lineno" > 680< / span >   < span class = "keywordflow" > if< / span > ((data[1] & 0xEF) == < a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > )< / div >
< div class = "line" > < a name = "l00681" > < / a > < span class = "lineno" > 681< / span >   < span class = "keywordflow" > return< / span > (0xff - __crc(data)); < span class = "comment" > // FCS on 2 bytes< / span > < / div >
< div class = "line" > < a name = "l00682" > < / a > < span class = "lineno" > 682< / span >   < span class = "keywordflow" > else< / span > < / div >
< div class = "line" > < a name = "l00683" > < / a > < span class = "lineno" > 683< / span >   < span class = "keywordflow" > return< / span > (0xff - pgm_read_byte(& rfcomm_crc_table[__crc(data) ^ data[2]])); < span class = "comment" > // FCS on 3 bytes< / span > < / div >
< div class = "line" > < a name = "l00684" > < / a > < span class = "lineno" > 684< / span >   }< / div >
< div class = "line" > < a name = "l00685" > < / a > < span class = "lineno" > 685< / span >   < / div >
< div class = "line" > < a name = "l00686" > < / a > < span class = "lineno" > 686< / span >   < span class = "comment" > /* Serial commands */< / span > < / div >
< div class = "line" > < a name = "l00687" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > 687< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > SPP::print< / a > (< span class = "keyword" > const< / span > String & str) {< / div >
< div class = "line" > < a name = "l00688" > < / a > < span class = "lineno" > 688< / span >   < span class = "keywordflow" > if< / span > (!< a class = "code" href = "class_s_p_p.html#ade5d4f0ab50ddcad14f75fce4450a028" > connected< / a > )< / div >
< div class = "line" > < a name = "l00689" > < / a > < span class = "lineno" > 689< / span >   < span class = "keywordflow" > return< / span > ;< / div >
< div class = "line" > < a name = "l00690" > < / a > < span class = "lineno" > 690< / span >   uint8_t length = str.length();< / div >
< div class = "line" > < a name = "l00691" > < / a > < span class = "lineno" > 691< / span >   < span class = "keywordflow" > if< / span > (length > (< span class = "keyword" > sizeof< / span > (l2capoutbuf)-4))< / div >
< div class = "line" > < a name = "l00692" > < / a > < span class = "lineno" > 692< / span >   length = < span class = "keyword" > sizeof< / span > (l2capoutbuf)-4;< / div >
< div class = "line" > < a name = "l00693" > < / a > < span class = "lineno" > 693< / span >   l2capoutbuf[0] = rfcommChannelConnection | 0 | 0 | < a class = "code" href = "_s_p_p_8h.html#af31032289d962bc2408debecc2823b8c" > extendAddress< / a > ;; < span class = "comment" > // RFCOMM Address< / span > < / div >
< div class = "line" > < a name = "l00694" > < / a > < span class = "lineno" > 694< / span >   l2capoutbuf[1] = < a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > ; < span class = "comment" > // RFCOMM Control< / span > < / div >
< div class = "line" > < a name = "l00695" > < / a > < span class = "lineno" > 695< / span >   l2capoutbuf[2] = length < < 1 | 1; < span class = "comment" > // Length< / span > < / div >
< div class = "line" > < a name = "l00696" > < / a > < span class = "lineno" > 696< / span >   uint8_t i = 0; < / div >
< div class = "line" > < a name = "l00697" > < / a > < span class = "lineno" > 697< / span >   < span class = "keywordflow" > for< / span > (; i < length; i++)< / div >
< div class = "line" > < a name = "l00698" > < / a > < span class = "lineno" > 698< / span >   l2capoutbuf[i+3] = str[i];< / div >
< div class = "line" > < a name = "l00699" > < / a > < span class = "lineno" > 699< / span >   l2capoutbuf[i+3] = calcFcs(l2capoutbuf);< / div >
< div class = "line" > < a name = "l00700" > < / a > < span class = "lineno" > 700< / span >   < / div >
< div class = "line" > < a name = "l00701" > < / a > < span class = "lineno" > 701< / span >   RFCOMM_Command(l2capoutbuf,length+4);< / div >
< div class = "line" > < a name = "l00702" > < / a > < span class = "lineno" > 702< / span >   }< / div >
< div class = "line" > < a name = "l00703" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a2632bccbdd58b98c483a85e5474fd053" > 703< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > SPP::print< / a > (< span class = "keyword" > const< / span > < span class = "keywordtype" > char< / span > * str) {< / div >
< div class = "line" > < a name = "l00704" > < / a > < span class = "lineno" > 704< / span >   < span class = "keywordflow" > if< / span > (!< a class = "code" href = "class_s_p_p.html#ade5d4f0ab50ddcad14f75fce4450a028" > connected< / a > )< / div >
< div class = "line" > < a name = "l00705" > < / a > < span class = "lineno" > 705< / span >   < span class = "keywordflow" > return< / span > ;< / div >
< div class = "line" > < a name = "l00706" > < / a > < span class = "lineno" > 706< / span >   uint8_t length = strlen(str);< / div >
< div class = "line" > < a name = "l00707" > < / a > < span class = "lineno" > 707< / span >   < span class = "keywordflow" > if< / span > (length > (< span class = "keyword" > sizeof< / span > (l2capoutbuf)-4))< / div >
< div class = "line" > < a name = "l00708" > < / a > < span class = "lineno" > 708< / span >   length = < span class = "keyword" > sizeof< / span > (l2capoutbuf)-4;< / div >
< div class = "line" > < a name = "l00709" > < / a > < span class = "lineno" > 709< / span >   l2capoutbuf[0] = rfcommChannelConnection | 0 | 0 | < a class = "code" href = "_s_p_p_8h.html#af31032289d962bc2408debecc2823b8c" > extendAddress< / a > ;; < span class = "comment" > // RFCOMM Address< / span > < / div >
< div class = "line" > < a name = "l00710" > < / a > < span class = "lineno" > 710< / span >   l2capoutbuf[1] = < a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > ; < span class = "comment" > // RFCOMM Control < / span > < / div >
< div class = "line" > < a name = "l00711" > < / a > < span class = "lineno" > 711< / span >   l2capoutbuf[2] = length < < 1 | 1; < span class = "comment" > // Length< / span > < / div >
< div class = "line" > < a name = "l00712" > < / a > < span class = "lineno" > 712< / span >   uint8_t i = 0;< / div >
< div class = "line" > < a name = "l00713" > < / a > < span class = "lineno" > 713< / span >   < span class = "keywordflow" > for< / span > (; i < length; i++)< / div >
< div class = "line" > < a name = "l00714" > < / a > < span class = "lineno" > 714< / span >   l2capoutbuf[i+3] = str[i]; < / div >
< div class = "line" > < a name = "l00715" > < / a > < span class = "lineno" > 715< / span >   l2capoutbuf[i+3] = calcFcs(l2capoutbuf); < / div >
< div class = "line" > < a name = "l00716" > < / a > < span class = "lineno" > 716< / span >   < / div >
< div class = "line" > < a name = "l00717" > < / a > < span class = "lineno" > 717< / span >   RFCOMM_Command(l2capoutbuf,length+4);< / div >
< div class = "line" > < a name = "l00718" > < / a > < span class = "lineno" > 718< / span >   }< / div >
< div class = "line" > < a name = "l00719" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a6bf2176a1fd3772e2c903eee680307b4" > 719< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > SPP::print< / a > (uint8_t data) {< / div >
< div class = "line" > < a name = "l00720" > < / a > < span class = "lineno" > 720< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (& data,1);< / div >
< div class = "line" > < a name = "l00721" > < / a > < span class = "lineno" > 721< / span >   }< / div >
< div class = "line" > < a name = "l00722" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a29784e177ce4ea9ee3e155d1a39cf3fa" > 722< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > SPP::print< / a > (uint8_t* array, uint8_t length) {< / div >
< div class = "line" > < a name = "l00723" > < / a > < span class = "lineno" > 723< / span >   < span class = "keywordflow" > if< / span > (!< a class = "code" href = "class_s_p_p.html#ade5d4f0ab50ddcad14f75fce4450a028" > connected< / a > )< / div >
< div class = "line" > < a name = "l00724" > < / a > < span class = "lineno" > 724< / span >   < span class = "keywordflow" > return< / span > ;< / div >
< div class = "line" > < a name = "l00725" > < / a > < span class = "lineno" > 725< / span >   < span class = "keywordflow" > if< / span > (length > (< span class = "keyword" > sizeof< / span > (l2capoutbuf)-4))< / div >
< div class = "line" > < a name = "l00726" > < / a > < span class = "lineno" > 726< / span >   length = < span class = "keyword" > sizeof< / span > (l2capoutbuf)-4;< / div >
< div class = "line" > < a name = "l00727" > < / a > < span class = "lineno" > 727< / span >   l2capoutbuf[0] = rfcommChannelConnection | 0 | 0 | < a class = "code" href = "_s_p_p_8h.html#af31032289d962bc2408debecc2823b8c" > extendAddress< / a > ;; < span class = "comment" > // RFCOMM Address< / span > < / div >
< div class = "line" > < a name = "l00728" > < / a > < span class = "lineno" > 728< / span >   l2capoutbuf[1] = < a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > ; < span class = "comment" > // RFCOMM Control< / span > < / div >
< div class = "line" > < a name = "l00729" > < / a > < span class = "lineno" > 729< / span >   l2capoutbuf[2] = length < < 1 | 1; < span class = "comment" > // Length< / span > < / div >
< div class = "line" > < a name = "l00730" > < / a > < span class = "lineno" > 730< / span >   uint8_t i = 0;< / div >
< div class = "line" > < a name = "l00731" > < / a > < span class = "lineno" > 731< / span >   < span class = "keywordflow" > for< / span > (; i < length; i++)< / div >
< div class = "line" > < a name = "l00732" > < / a > < span class = "lineno" > 732< / span >   l2capoutbuf[i+3] = array[i];< / div >
< div class = "line" > < a name = "l00733" > < / a > < span class = "lineno" > 733< / span >   l2capoutbuf[i+3] = calcFcs(l2capoutbuf);< / div >
< div class = "line" > < a name = "l00734" > < / a > < span class = "lineno" > 734< / span >   < / div >
< div class = "line" > < a name = "l00735" > < / a > < span class = "lineno" > 735< / span >   RFCOMM_Command(l2capoutbuf,length+4);< / div >
< div class = "line" > < a name = "l00736" > < / a > < span class = "lineno" > 736< / span >   }< / div >
< div class = "line" > < a name = "l00737" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#aa534ca2960b81635c9ef00baaa04b37c" > 737< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > SPP::print< / a > (< span class = "keyword" > const< / span > __FlashStringHelper *ifsh) {< / div >
2013-02-05 22:39:56 +01:00
< div class = "line" > < a name = "l00738" > < / a > < span class = "lineno" > 738< / span >   < span class = "keyword" > const< / span > < span class = "keywordtype" > char< / span > < a class = "code" href = "hidboot_8cpp.html#ad1eb9d7b0347c20d121c984618c442f0" > PROGMEM< / a > *p = (< span class = "keyword" > const< / span > < span class = "keywordtype" > char< / span > < a class = "code" href = "hidboot_8cpp.html#ad1eb9d7b0347c20d121c984618c442f0" > PROGMEM< / a > *)ifsh;< / div >
2013-02-05 20:02:12 +01:00
< div class = "line" > < a name = "l00739" > < / a > < span class = "lineno" > 739< / span >   < span class = "keywordtype" > size_t< / span > size = 0;< / div >
< div class = "line" > < a name = "l00740" > < / a > < span class = "lineno" > 740< / span >   < span class = "keywordflow" > while< / span > (1) { < span class = "comment" > // Calculate the size of the string< / span > < / div >
< div class = "line" > < a name = "l00741" > < / a > < span class = "lineno" > 741< / span >   uint8_t c = pgm_read_byte(p+size);< / div >
< div class = "line" > < a name = "l00742" > < / a > < span class = "lineno" > 742< / span >   < span class = "keywordflow" > if< / span > (c == 0)< / div >
< div class = "line" > < a name = "l00743" > < / a > < span class = "lineno" > 743< / span >   < span class = "keywordflow" > break< / span > ;< / div >
< div class = "line" > < a name = "l00744" > < / a > < span class = "lineno" > 744< / span >   size++;< / div >
< div class = "line" > < a name = "l00745" > < / a > < span class = "lineno" > 745< / span >   }< / div >
< div class = "line" > < a name = "l00746" > < / a > < span class = "lineno" > 746< / span >   uint8_t buf[size];< / div >
< div class = "line" > < a name = "l00747" > < / a > < span class = "lineno" > 747< / span >   < / div >
< div class = "line" > < a name = "l00748" > < / a > < span class = "lineno" > 748< / span >   < span class = "keywordflow" > for< / span > (uint8_t i = 0; i < size; i++)< / div >
< div class = "line" > < a name = "l00749" > < / a > < span class = "lineno" > 749< / span >   buf[i] = pgm_read_byte(p++);< / div >
< div class = "line" > < a name = "l00750" > < / a > < span class = "lineno" > 750< / span >   < / div >
< div class = "line" > < a name = "l00751" > < / a > < span class = "lineno" > 751< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (buf,size);< / div >
< div class = "line" > < a name = "l00752" > < / a > < span class = "lineno" > 752< / span >   }< / div >
< div class = "line" > < a name = "l00753" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a8b2ce856e7431905451c3f45526e1b28" > 753< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#a4afe343fc15bba50507ab9205165b8dd" > SPP::println< / a > (< span class = "keyword" > const< / span > String & str) {< / div >
< div class = "line" > < a name = "l00754" > < / a > < span class = "lineno" > 754< / span >   String output = str + < span class = "stringliteral" > " \r\n" < / span > ;< / div >
< div class = "line" > < a name = "l00755" > < / a > < span class = "lineno" > 755< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (output);< / div >
< div class = "line" > < a name = "l00756" > < / a > < span class = "lineno" > 756< / span >   }< / div >
< div class = "line" > < a name = "l00757" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a8f39d99ed5299a38f86b2c2376ddfdc4" > 757< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#a4afe343fc15bba50507ab9205165b8dd" > SPP::println< / a > (< span class = "keyword" > const< / span > < span class = "keywordtype" > char< / span > * str) {< / div >
< div class = "line" > < a name = "l00758" > < / a > < span class = "lineno" > 758< / span >   < span class = "keywordtype" > char< / span > output[strlen(str)+3];< / div >
< div class = "line" > < a name = "l00759" > < / a > < span class = "lineno" > 759< / span >   strcpy(output,str);< / div >
< div class = "line" > < a name = "l00760" > < / a > < span class = "lineno" > 760< / span >   strcat(output,< span class = "stringliteral" > " \r\n" < / span > );< / div >
< div class = "line" > < a name = "l00761" > < / a > < span class = "lineno" > 761< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (output);< / div >
< div class = "line" > < a name = "l00762" > < / a > < span class = "lineno" > 762< / span >   }< / div >
< div class = "line" > < a name = "l00763" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a627a6371ed4f9c251fe0dd4e1b867a2f" > 763< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#a4afe343fc15bba50507ab9205165b8dd" > SPP::println< / a > (uint8_t data) {< / div >
< div class = "line" > < a name = "l00764" > < / a > < span class = "lineno" > 764< / span >   uint8_t buf[3] = {data, < span class = "charliteral" > ' \r' < / span > , < span class = "charliteral" > ' \n' < / span > };< / div >
< div class = "line" > < a name = "l00765" > < / a > < span class = "lineno" > 765< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (buf,3);< / div >
< div class = "line" > < a name = "l00766" > < / a > < span class = "lineno" > 766< / span >   }< / div >
< div class = "line" > < a name = "l00767" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#aec05fbfff82d2a386a7064254833ce64" > 767< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#a4afe343fc15bba50507ab9205165b8dd" > SPP::println< / a > (uint8_t* array, uint8_t length) {< / div >
< div class = "line" > < a name = "l00768" > < / a > < span class = "lineno" > 768< / span >   uint8_t buf[length+2];< / div >
< div class = "line" > < a name = "l00769" > < / a > < span class = "lineno" > 769< / span >   memcpy(buf,array,length);< / div >
< div class = "line" > < a name = "l00770" > < / a > < span class = "lineno" > 770< / span >   buf[length] = < span class = "charliteral" > ' \r' < / span > ;< / div >
< div class = "line" > < a name = "l00771" > < / a > < span class = "lineno" > 771< / span >   buf[length+1] = < span class = "charliteral" > ' \n' < / span > ; < / div >
< div class = "line" > < a name = "l00772" > < / a > < span class = "lineno" > 772< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (buf,length+2);< / div >
< div class = "line" > < a name = "l00773" > < / a > < span class = "lineno" > 773< / span >   }< / div >
< div class = "line" > < a name = "l00774" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a53cae4e7a1a6208f348b9509dbe94d24" > 774< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#a4afe343fc15bba50507ab9205165b8dd" > SPP::println< / a > (< span class = "keyword" > const< / span > __FlashStringHelper *ifsh) {< / div >
2013-02-05 22:39:56 +01:00
< div class = "line" > < a name = "l00775" > < / a > < span class = "lineno" > 775< / span >   < span class = "keyword" > const< / span > < span class = "keywordtype" > char< / span > < a class = "code" href = "hidboot_8cpp.html#ad1eb9d7b0347c20d121c984618c442f0" > PROGMEM< / a > *p = (< span class = "keyword" > const< / span > < span class = "keywordtype" > char< / span > < a class = "code" href = "hidboot_8cpp.html#ad1eb9d7b0347c20d121c984618c442f0" > PROGMEM< / a > *)ifsh; < / div >
2013-02-05 20:02:12 +01:00
< div class = "line" > < a name = "l00776" > < / a > < span class = "lineno" > 776< / span >   < span class = "keywordtype" > size_t< / span > size = 0;< / div >
< div class = "line" > < a name = "l00777" > < / a > < span class = "lineno" > 777< / span >   < span class = "keywordflow" > while< / span > (1) { < span class = "comment" > // Calculate the size of the string< / span > < / div >
< div class = "line" > < a name = "l00778" > < / a > < span class = "lineno" > 778< / span >   uint8_t c = pgm_read_byte(p+size);< / div >
< div class = "line" > < a name = "l00779" > < / a > < span class = "lineno" > 779< / span >   < span class = "keywordflow" > if< / span > (c == 0)< / div >
< div class = "line" > < a name = "l00780" > < / a > < span class = "lineno" > 780< / span >   < span class = "keywordflow" > break< / span > ;< / div >
< div class = "line" > < a name = "l00781" > < / a > < span class = "lineno" > 781< / span >   size++;< / div >
< div class = "line" > < a name = "l00782" > < / a > < span class = "lineno" > 782< / span >   }< / div >
< div class = "line" > < a name = "l00783" > < / a > < span class = "lineno" > 783< / span >   uint8_t buf[size+2];< / div >
< div class = "line" > < a name = "l00784" > < / a > < span class = "lineno" > 784< / span >   < / div >
< div class = "line" > < a name = "l00785" > < / a > < span class = "lineno" > 785< / span >   < span class = "keywordflow" > for< / span > (uint8_t i = 0; i < size; i++)< / div >
< div class = "line" > < a name = "l00786" > < / a > < span class = "lineno" > 786< / span >   buf[i] = pgm_read_byte(p++);< / div >
< div class = "line" > < a name = "l00787" > < / a > < span class = "lineno" > 787< / span >   < / div >
< div class = "line" > < a name = "l00788" > < / a > < span class = "lineno" > 788< / span >   buf[size] = < span class = "charliteral" > ' \r' < / span > ;< / div >
< div class = "line" > < a name = "l00789" > < / a > < span class = "lineno" > 789< / span >   buf[size+1] = < span class = "charliteral" > ' \n' < / span > ;< / div >
< div class = "line" > < a name = "l00790" > < / a > < span class = "lineno" > 790< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (buf,size+2);< / div >
< div class = "line" > < a name = "l00791" > < / a > < span class = "lineno" > 791< / span >   }< / div >
< div class = "line" > < a name = "l00792" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a4afe343fc15bba50507ab9205165b8dd" > 792< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#a4afe343fc15bba50507ab9205165b8dd" > SPP::println< / a > (< span class = "keywordtype" > void< / span > ) {< / div >
< div class = "line" > < a name = "l00793" > < / a > < span class = "lineno" > 793< / span >   uint8_t buf[2] = {< span class = "charliteral" > ' \r' < / span > ,< span class = "charliteral" > ' \n' < / span > };< / div >
< div class = "line" > < a name = "l00794" > < / a > < span class = "lineno" > 794< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (buf,2);< / div >
< div class = "line" > < a name = "l00795" > < / a > < span class = "lineno" > 795< / span >   }< / div >
< div class = "line" > < a name = "l00796" > < / a > < span class = "lineno" > 796< / span >   < / div >
< div class = "line" > < a name = "l00797" > < / a > < span class = "lineno" > 797< / span >   < span class = "comment" > /* These must be used to print numbers */< / span > < / div >
< div class = "line" > < a name = "l00798" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#af31f14d7249f8a5b6eb2230a42a9d5ae" > 798< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#af31f14d7249f8a5b6eb2230a42a9d5ae" > SPP::printNumber< / a > (int32_t n) {< / div >
< div class = "line" > < a name = "l00799" > < / a > < span class = "lineno" > 799< / span >   < span class = "keywordtype" > bool< / span > negative = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00800" > < / a > < span class = "lineno" > 800< / span >   < span class = "keywordflow" > if< / span > (n < 0) {< / div >
< div class = "line" > < a name = "l00801" > < / a > < span class = "lineno" > 801< / span >   negative = < span class = "keyword" > true< / span > ;< / div >
< div class = "line" > < a name = "l00802" > < / a > < span class = "lineno" > 802< / span >   n = -n;< / div >
< div class = "line" > < a name = "l00803" > < / a > < span class = "lineno" > 803< / span >   } < / div >
< div class = "line" > < a name = "l00804" > < / a > < span class = "lineno" > 804< / span >   uint32_t temp = n;< / div >
< div class = "line" > < a name = "l00805" > < / a > < span class = "lineno" > 805< / span >   uint8_t digits = 0;< / div >
< div class = "line" > < a name = "l00806" > < / a > < span class = "lineno" > 806< / span >   < span class = "keywordflow" > while< / span > (temp) {< / div >
< div class = "line" > < a name = "l00807" > < / a > < span class = "lineno" > 807< / span >   temp /= 10;< / div >
< div class = "line" > < a name = "l00808" > < / a > < span class = "lineno" > 808< / span >   digits++;< / div >
< div class = "line" > < a name = "l00809" > < / a > < span class = "lineno" > 809< / span >   } < / div >
< div class = "line" > < a name = "l00810" > < / a > < span class = "lineno" > 810< / span >   < span class = "keywordflow" > if< / span > (digits == 0)< / div >
< div class = "line" > < a name = "l00811" > < / a > < span class = "lineno" > 811< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (< span class = "stringliteral" > " 0" < / span > );< / div >
< div class = "line" > < a name = "l00812" > < / a > < span class = "lineno" > 812< / span >   < span class = "keywordflow" > else< / span > {< / div >
< div class = "line" > < a name = "l00813" > < / a > < span class = "lineno" > 813< / span >   uint8_t buf[digits+1]; < span class = "comment" > // Add one extra in case it is negative< / span > < / div >
< div class = "line" > < a name = "l00814" > < / a > < span class = "lineno" > 814< / span >   < span class = "keywordflow" > for< / span > (uint8_t i = 1; i < digits+1; i++) {< / div >
< div class = "line" > < a name = "l00815" > < / a > < span class = "lineno" > 815< / span >   < span class = "keywordflow" > if< / span > (negative)< / div >
< div class = "line" > < a name = "l00816" > < / a > < span class = "lineno" > 816< / span >   buf[digits-i+1] = n%10 + < span class = "charliteral" > ' 0' < / span > ; < span class = "comment" > // Get number and convert to ASCII Character< / span > < / div >
< div class = "line" > < a name = "l00817" > < / a > < span class = "lineno" > 817< / span >   < span class = "keywordflow" > else< / span > < / div >
< div class = "line" > < a name = "l00818" > < / a > < span class = "lineno" > 818< / span >   buf[digits-i] = n%10 + < span class = "charliteral" > ' 0' < / span > ; < span class = "comment" > // Get number and convert to ASCII Character< / span > < / div >
< div class = "line" > < a name = "l00819" > < / a > < span class = "lineno" > 819< / span >   n /= 10;< / div >
< div class = "line" > < a name = "l00820" > < / a > < span class = "lineno" > 820< / span >   }< / div >
< div class = "line" > < a name = "l00821" > < / a > < span class = "lineno" > 821< / span >   < span class = "keywordflow" > if< / span > (negative) {< / div >
< div class = "line" > < a name = "l00822" > < / a > < span class = "lineno" > 822< / span >   buf[0] = < span class = "charliteral" > ' -' < / span > ; < / div >
< div class = "line" > < a name = "l00823" > < / a > < span class = "lineno" > 823< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (buf,digits+1);< / div >
< div class = "line" > < a name = "l00824" > < / a > < span class = "lineno" > 824< / span >   } < span class = "keywordflow" > else< / span > < / div >
< div class = "line" > < a name = "l00825" > < / a > < span class = "lineno" > 825< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (buf,digits);< / div >
< div class = "line" > < a name = "l00826" > < / a > < span class = "lineno" > 826< / span >   }< / div >
< div class = "line" > < a name = "l00827" > < / a > < span class = "lineno" > 827< / span >   }< / div >
< div class = "line" > < a name = "l00828" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#ac3a2e5fa45ba0fe17d3341998a6c4640" > 828< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#ac3a2e5fa45ba0fe17d3341998a6c4640" > SPP::printNumberln< / a > (int32_t n) {< / div >
< div class = "line" > < a name = "l00829" > < / a > < span class = "lineno" > 829< / span >   < span class = "keywordtype" > bool< / span > negative = < span class = "keyword" > false< / span > ;< / div >
< div class = "line" > < a name = "l00830" > < / a > < span class = "lineno" > 830< / span >   < span class = "keywordflow" > if< / span > (n < 0) {< / div >
< div class = "line" > < a name = "l00831" > < / a > < span class = "lineno" > 831< / span >   negative = < span class = "keyword" > true< / span > ;< / div >
< div class = "line" > < a name = "l00832" > < / a > < span class = "lineno" > 832< / span >   n = -n;< / div >
< div class = "line" > < a name = "l00833" > < / a > < span class = "lineno" > 833< / span >   }< / div >
< div class = "line" > < a name = "l00834" > < / a > < span class = "lineno" > 834< / span >   uint32_t temp = n;< / div >
< div class = "line" > < a name = "l00835" > < / a > < span class = "lineno" > 835< / span >   uint8_t digits = 0;< / div >
< div class = "line" > < a name = "l00836" > < / a > < span class = "lineno" > 836< / span >   < span class = "keywordflow" > while< / span > (temp) {< / div >
< div class = "line" > < a name = "l00837" > < / a > < span class = "lineno" > 837< / span >   temp /= 10;< / div >
< div class = "line" > < a name = "l00838" > < / a > < span class = "lineno" > 838< / span >   digits++;< / div >
< div class = "line" > < a name = "l00839" > < / a > < span class = "lineno" > 839< / span >   }< / div >
< div class = "line" > < a name = "l00840" > < / a > < span class = "lineno" > 840< / span >   < span class = "keywordflow" > if< / span > (digits == 0)< / div >
< div class = "line" > < a name = "l00841" > < / a > < span class = "lineno" > 841< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (< span class = "stringliteral" > " 0\r\n" < / span > );< / div >
< div class = "line" > < a name = "l00842" > < / a > < span class = "lineno" > 842< / span >   < span class = "keywordflow" > else< / span > {< / div >
< div class = "line" > < a name = "l00843" > < / a > < span class = "lineno" > 843< / span >   uint8_t buf[digits+3]; < span class = "comment" > // Add one extra in case it is negative< / span > < / div >
< div class = "line" > < a name = "l00844" > < / a > < span class = "lineno" > 844< / span >   < span class = "keywordflow" > for< / span > (uint8_t i = 1; i < digits+1; i++) {< / div >
< div class = "line" > < a name = "l00845" > < / a > < span class = "lineno" > 845< / span >   < span class = "keywordflow" > if< / span > (negative)< / div >
< div class = "line" > < a name = "l00846" > < / a > < span class = "lineno" > 846< / span >   buf[digits-i+1] = n%10 + < span class = "charliteral" > ' 0' < / span > ; < span class = "comment" > // Get number and convert to ASCII Character< / span > < / div >
< div class = "line" > < a name = "l00847" > < / a > < span class = "lineno" > 847< / span >   < span class = "keywordflow" > else< / span > < / div >
< div class = "line" > < a name = "l00848" > < / a > < span class = "lineno" > 848< / span >   buf[digits-i] = n%10 + < span class = "charliteral" > ' 0' < / span > ; < span class = "comment" > // Get number and convert to ASCII Character< / span > < / div >
< div class = "line" > < a name = "l00849" > < / a > < span class = "lineno" > 849< / span >   n /= 10;< / div >
< div class = "line" > < a name = "l00850" > < / a > < span class = "lineno" > 850< / span >   } < / div >
< div class = "line" > < a name = "l00851" > < / a > < span class = "lineno" > 851< / span >   < span class = "keywordflow" > if< / span > (negative) {< / div >
< div class = "line" > < a name = "l00852" > < / a > < span class = "lineno" > 852< / span >   buf[0] = < span class = "charliteral" > ' -' < / span > ;< / div >
< div class = "line" > < a name = "l00853" > < / a > < span class = "lineno" > 853< / span >   buf[digits+1] = < span class = "charliteral" > ' \r' < / span > ;< / div >
< div class = "line" > < a name = "l00854" > < / a > < span class = "lineno" > 854< / span >   buf[digits+2] = < span class = "charliteral" > ' \n' < / span > ;< / div >
< div class = "line" > < a name = "l00855" > < / a > < span class = "lineno" > 855< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (buf,digits+3);< / div >
< div class = "line" > < a name = "l00856" > < / a > < span class = "lineno" > 856< / span >   } < span class = "keywordflow" > else< / span > {< / div >
< div class = "line" > < a name = "l00857" > < / a > < span class = "lineno" > 857< / span >   buf[digits] = < span class = "charliteral" > ' \r' < / span > ;< / div >
< div class = "line" > < a name = "l00858" > < / a > < span class = "lineno" > 858< / span >   buf[digits+1] = < span class = "charliteral" > ' \n' < / span > ;< / div >
< div class = "line" > < a name = "l00859" > < / a > < span class = "lineno" > 859< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (buf,digits+2);< / div >
< div class = "line" > < a name = "l00860" > < / a > < span class = "lineno" > 860< / span >   }< / div >
< div class = "line" > < a name = "l00861" > < / a > < span class = "lineno" > 861< / span >   }< / div >
< div class = "line" > < a name = "l00862" > < / a > < span class = "lineno" > 862< / span >   }< / div >
< div class = "line" > < a name = "l00863" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#ae7938394e271e0cec64aae6f534eae69" > 863< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#af31f14d7249f8a5b6eb2230a42a9d5ae" > SPP::printNumber< / a > (< span class = "keywordtype" > double< / span > n, uint8_t digits) {< / div >
< div class = "line" > < a name = "l00864" > < / a > < span class = "lineno" > 864< / span >   < span class = "keywordtype" > char< / span > output[10];< / div >
< div class = "line" > < a name = "l00865" > < / a > < span class = "lineno" > 865< / span >   < a class = "code" href = "class_s_p_p.html#a3117df8f320d9d010b57c30255db054b" > doubleToString< / a > (n,output,digits);< / div >
< div class = "line" > < a name = "l00866" > < / a > < span class = "lineno" > 866< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (output);< / div >
< div class = "line" > < a name = "l00867" > < / a > < span class = "lineno" > 867< / span >   }< / div >
< div class = "line" > < a name = "l00868" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a2cdc30f2314dbd572b8432972469bb25" > 868< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#ac3a2e5fa45ba0fe17d3341998a6c4640" > SPP::printNumberln< / a > (< span class = "keywordtype" > double< / span > n, uint8_t digits) {< / div >
< div class = "line" > < a name = "l00869" > < / a > < span class = "lineno" > 869< / span >   < span class = "keywordtype" > char< / span > buf[10];< / div >
< div class = "line" > < a name = "l00870" > < / a > < span class = "lineno" > 870< / span >   < span class = "keywordtype" > char< / span > output[12];< / div >
< div class = "line" > < a name = "l00871" > < / a > < span class = "lineno" > 871< / span >   < a class = "code" href = "class_s_p_p.html#a3117df8f320d9d010b57c30255db054b" > doubleToString< / a > (n,buf,digits);< / div >
< div class = "line" > < a name = "l00872" > < / a > < span class = "lineno" > 872< / span >   strcpy(output,buf);< / div >
< div class = "line" > < a name = "l00873" > < / a > < span class = "lineno" > 873< / span >   strcat(output,< span class = "stringliteral" > " \r\n" < / span > );< / div >
< div class = "line" > < a name = "l00874" > < / a > < span class = "lineno" > 874< / span >   < a class = "code" href = "class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36" > print< / a > (output);< / div >
< div class = "line" > < a name = "l00875" > < / a > < span class = "lineno" > 875< / span >   }< / div >
< div class = "line" > < a name = "l00876" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a3117df8f320d9d010b57c30255db054b" > 876< / a > < / span >   < span class = "keywordtype" > void< / span > < a class = "code" href = "class_s_p_p.html#a3117df8f320d9d010b57c30255db054b" > SPP::doubleToString< / a > (< span class = "keywordtype" > double< / span > input, < span class = "keywordtype" > char< / span > * output, uint8_t digits) {< / div >
< div class = "line" > < a name = "l00877" > < / a > < span class = "lineno" > 877< / span >   < span class = "keywordtype" > char< / span > buffer[10];< / div >
< div class = "line" > < a name = "l00878" > < / a > < span class = "lineno" > 878< / span >   < span class = "keywordflow" > if< / span > (input < 0) {< / div >
< div class = "line" > < a name = "l00879" > < / a > < span class = "lineno" > 879< / span >   strcpy(output,< span class = "stringliteral" > " -" < / span > );< / div >
< div class = "line" > < a name = "l00880" > < / a > < span class = "lineno" > 880< / span >   input = -input;< / div >
< div class = "line" > < a name = "l00881" > < / a > < span class = "lineno" > 881< / span >   }< / div >
< div class = "line" > < a name = "l00882" > < / a > < span class = "lineno" > 882< / span >   < span class = "keywordflow" > else< / span > < / div >
< div class = "line" > < a name = "l00883" > < / a > < span class = "lineno" > 883< / span >   strcpy(output,< span class = "stringliteral" > " " < / span > );< / div >
< div class = "line" > < a name = "l00884" > < / a > < span class = "lineno" > 884< / span >   < / div >
< div class = "line" > < a name = "l00885" > < / a > < span class = "lineno" > 885< / span >   < span class = "comment" > // Round correctly< / span > < / div >
< div class = "line" > < a name = "l00886" > < / a > < span class = "lineno" > 886< / span >   < span class = "keywordtype" > double< / span > rounding = 0.5;< / div >
< div class = "line" > < a name = "l00887" > < / a > < span class = "lineno" > 887< / span >   < span class = "keywordflow" > for< / span > (uint8_t i=0; i< digits; i++)< / div >
< div class = "line" > < a name = "l00888" > < / a > < span class = "lineno" > 888< / span >   rounding /= 10.0;< / div >
< div class = "line" > < a name = "l00889" > < / a > < span class = "lineno" > 889< / span >   input += rounding;< / div >
< div class = "line" > < a name = "l00890" > < / a > < span class = "lineno" > 890< / span >   < / div >
< div class = "line" > < a name = "l00891" > < / a > < span class = "lineno" > 891< / span >   < span class = "keywordtype" > unsigned< / span > < span class = "keywordtype" > long< / span > intpart = (< span class = "keywordtype" > unsigned< / span > long)input;< / div >
< div class = "line" > < a name = "l00892" > < / a > < span class = "lineno" > 892< / span >   itoa(intpart,buffer,10); < span class = "comment" > // Convert to string< / span > < / div >
< div class = "line" > < a name = "l00893" > < / a > < span class = "lineno" > 893< / span >   strcat(output,buffer);< / div >
< div class = "line" > < a name = "l00894" > < / a > < span class = "lineno" > 894< / span >   strcat(output,< span class = "stringliteral" > " ." < / span > );< / div >
< div class = "line" > < a name = "l00895" > < / a > < span class = "lineno" > 895< / span >   < span class = "keywordtype" > double< / span > fractpart = (input-(double)intpart);< / div >
< div class = "line" > < a name = "l00896" > < / a > < span class = "lineno" > 896< / span >   fractpart *= pow(10,digits);< / div >
< div class = "line" > < a name = "l00897" > < / a > < span class = "lineno" > 897< / span >   < span class = "keywordflow" > for< / span > (uint8_t i=1;i< digits;i++) { < span class = "comment" > // Put zeroes in front of number< / span > < / div >
< div class = "line" > < a name = "l00898" > < / a > < span class = "lineno" > 898< / span >   < span class = "keywordflow" > if< / span > (fractpart < pow(10,digits-i)) {< / div >
< div class = "line" > < a name = "l00899" > < / a > < span class = "lineno" > 899< / span >   strcat(output,< span class = "stringliteral" > " 0" < / span > );< / div >
< div class = "line" > < a name = "l00900" > < / a > < span class = "lineno" > 900< / span >   }< / div >
< div class = "line" > < a name = "l00901" > < / a > < span class = "lineno" > 901< / span >   }< / div >
< div class = "line" > < a name = "l00902" > < / a > < span class = "lineno" > 902< / span >   itoa((< span class = "keywordtype" > unsigned< / span > < span class = "keywordtype" > long< / span > )fractpart,buffer,10); < span class = "comment" > // Convert to string< / span > < / div >
< div class = "line" > < a name = "l00903" > < / a > < span class = "lineno" > 903< / span >   strcat(output,buffer);< / div >
< div class = "line" > < a name = "l00904" > < / a > < span class = "lineno" > 904< / span >   }< / div >
< div class = "line" > < a name = "l00905" > < / a > < span class = "lineno" > 905< / span >   < / div >
< div class = "line" > < a name = "l00906" > < / a > < span class = "lineno" > < a class = "code" href = "class_s_p_p.html#a53980e0d20944454790febe5c9be66af" > 906< / a > < / span >   uint8_t < a class = "code" href = "class_s_p_p.html#a53980e0d20944454790febe5c9be66af" > SPP::read< / a > () {< / div >
< div class = "line" > < a name = "l00907" > < / a > < span class = "lineno" > 907< / span >   < span class = "keywordflow" > if< / span > (rfcommAvailable == 0) < span class = "comment" > // Don' t read if there is nothing in the buffer< / span > < / div >
< div class = "line" > < a name = "l00908" > < / a > < span class = "lineno" > 908< / span >   < span class = "keywordflow" > return< / span > 0;< / div >
< div class = "line" > < a name = "l00909" > < / a > < span class = "lineno" > 909< / span >   uint8_t output = rfcommDataBuffer[0];< / div >
< div class = "line" > < a name = "l00910" > < / a > < span class = "lineno" > 910< / span >   < span class = "keywordflow" > for< / span > (uint8_t i = 1; i < rfcommAvailable; i++)< / div >
< div class = "line" > < a name = "l00911" > < / a > < span class = "lineno" > 911< / span >   rfcommDataBuffer[i-1] = rfcommDataBuffer[i]; < span class = "comment" > // Shift the buffer one left< / span > < / div >
< div class = "line" > < a name = "l00912" > < / a > < span class = "lineno" > 912< / span >   rfcommAvailable--;< / div >
< div class = "line" > < a name = "l00913" > < / a > < span class = "lineno" > 913< / span >   bytesRead++;< / div >
< div class = "line" > < a name = "l00914" > < / a > < span class = "lineno" > 914< / span >   < span class = "keywordflow" > if< / span > (bytesRead > (< span class = "keyword" > sizeof< / span > (rfcommDataBuffer)-5)) { < span class = "comment" > // We will send the command just before it runs out of credit< / span > < / div >
< div class = "line" > < a name = "l00915" > < / a > < span class = "lineno" > 915< / span >   bytesRead = 0;< / div >
< div class = "line" > < a name = "l00916" > < / a > < span class = "lineno" > 916< / span >   sendRfcommCredit(rfcommChannelConnection,rfcommDirection,0,< a class = "code" href = "_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373" > RFCOMM_UIH< / a > ,0x10,< span class = "keyword" > sizeof< / span > (rfcommDataBuffer)); < span class = "comment" > // Send more credit< / span > < / div >
< div class = "line" > < a name = "l00917" > < / a > < span class = "lineno" > 917< / span >   < span class = "preprocessor" > #ifdef EXTRADEBUG< / span > < / div >
< div class = "line" > < a name = "l00918" > < / a > < span class = "lineno" > 918< / span >   < span class = "preprocessor" > < / span > < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " \r\nSent " < / span > ));< / div >
< div class = "line" > < a name = "l00919" > < / a > < span class = "lineno" > 919< / span >   Serial.print(< span class = "keyword" > sizeof< / span > (rfcommDataBuffer));< / div >
< div class = "line" > < a name = "l00920" > < / a > < span class = "lineno" > 920< / span >   < a class = "code" href = "message_8cpp.html#a968335d1c8fd7b45c95634e0828411be" > Notify< / a > (PSTR(< span class = "stringliteral" > " more credit" < / span > ));< / div >
< div class = "line" > < a name = "l00921" > < / a > < span class = "lineno" > 921< / span >   < span class = "preprocessor" > #endif< / span > < / div >
< div class = "line" > < a name = "l00922" > < / a > < span class = "lineno" > 922< / span >   < span class = "preprocessor" > < / span > }< / div >
< div class = "line" > < a name = "l00923" > < / a > < span class = "lineno" > 923< / span >   < span class = "keywordflow" > return< / span > output;< / div >
< div class = "line" > < a name = "l00924" > < / a > < span class = "lineno" > 924< / span >   }< / div >
< / div > <!-- fragment --> < / div > <!-- contents -->
<!-- start footer part -->
< hr class = "footer" / > < address class = "footer" > < small >
2013-02-17 01:37:13 +01:00
Generated by   < a href = "http://www.doxygen.org/index.html" >
2013-02-05 20:02:12 +01:00
< img class = "footer" src = "doxygen.png" alt = "doxygen" / >
< / a > 1.8.3.1
< / small > < / address >
< / body >
< / html >