USB_Host_Shield_2.0/_s_p_p_8cpp_source.html

1025 lines
163 KiB
HTML
Raw Normal View History

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"/>
<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" />
<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;">
<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&#160;Page</span></a></li>
<li><a href="pages.html"><span>Related&#160;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&#160;List</span></a></li>
<li><a href="globals.html"><span>File&#160;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">&#160;</span>All</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(1)"><span class="SelectionMark">&#160;</span>Classes</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(2)"><span class="SelectionMark">&#160;</span>Files</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(3)"><span class="SelectionMark">&#160;</span>Functions</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(4)"><span class="SelectionMark">&#160;</span>Variables</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(5)"><span class="SelectionMark">&#160;</span>Typedefs</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(6)"><span class="SelectionMark">&#160;</span>Enumerations</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(7)"><span class="SelectionMark">&#160;</span>Enumerator</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(8)"><span class="SelectionMark">&#160;</span>Macros</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(9)"><span class="SelectionMark">&#160;</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>
<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>&#160;<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>&#160;<span class="comment"> </span></div>
<div class="line"><a name="l00003"></a><span class="lineno"> 3</span>&#160;<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>&#160;<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>&#160;<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>&#160;<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>&#160;<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>&#160;<span class="comment"> the GPL2 (&quot;Copyleft&quot;).</span></div>
<div class="line"><a name="l00009"></a><span class="lineno"> 9</span>&#160;<span class="comment"> </span></div>
<div class="line"><a name="l00010"></a><span class="lineno"> 10</span>&#160;<span class="comment"> Contact information</span></div>
<div class="line"><a name="l00011"></a><span class="lineno"> 11</span>&#160;<span class="comment"> -------------------</span></div>
<div class="line"><a name="l00012"></a><span class="lineno"> 12</span>&#160;<span class="comment"> </span></div>
<div class="line"><a name="l00013"></a><span class="lineno"> 13</span>&#160;<span class="comment"> Kristian Lauszus, TKJ Electronics</span></div>
<div class="line"><a name="l00014"></a><span class="lineno"> 14</span>&#160;<span class="comment"> Web : http://www.tkjelectronics.com</span></div>
<div class="line"><a name="l00015"></a><span class="lineno"> 15</span>&#160;<span class="comment"> e-mail : kristianl@tkjelectronics.com</span></div>
<div class="line"><a name="l00016"></a><span class="lineno"> 16</span>&#160;<span class="comment"> */</span></div>
<div class="line"><a name="l00017"></a><span class="lineno"> 17</span>&#160;</div>
<div class="line"><a name="l00018"></a><span class="lineno"> 18</span>&#160;<span class="preprocessor">#include &quot;<a class="code" href="_s_p_p_8h.html">SPP.h</a>&quot;</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>&#160;<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>&#160;<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>&#160;<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>&#160;</div>
<div class="line"><a name="l00023"></a><span class="lineno"> 23</span>&#160;<span class="comment">/*</span></div>
<div class="line"><a name="l00024"></a><span class="lineno"> 24</span>&#160;<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>&#160;<span class="comment"> */</span></div>
<div class="line"><a name="l00026"></a><span class="lineno"><a class="code" href="_s_p_p_8cpp.html#a5c3da75486e8c6a65da9ecc5c9c588e1"> 26</a></span>&#160;<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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160; 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>&#160;};</div>
<div class="line"><a name="l00044"></a><span class="lineno"> 44</span>&#160;</div>
<div class="line"><a name="l00045"></a><span class="lineno"><a class="code" href="class_s_p_p.html#ae5cb4167b3ab9c891398f54729c6da81"> 45</a></span>&#160;<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>&#160;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>&#160;{</div>
<div class="line"><a name="l00048"></a><span class="lineno"> 48</span>&#160; <span class="keywordflow">if</span> (pBtd)</div>
<div class="line"><a name="l00049"></a><span class="lineno"> 49</span>&#160; pBtd-&gt;<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>&#160; </div>
<div class="line"><a name="l00051"></a><span class="lineno"> 51</span>&#160; pBtd-&gt;<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>&#160; pBtd-&gt;<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>&#160; </div>
<div class="line"><a name="l00054"></a><span class="lineno"> 54</span>&#160; <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>&#160; sdp_dcid[0] = 0x50; <span class="comment">// 0x0050</span></div>
<div class="line"><a name="l00056"></a><span class="lineno"> 56</span>&#160; sdp_dcid[1] = 0x00;</div>
<div class="line"><a name="l00057"></a><span class="lineno"> 57</span>&#160; rfcomm_dcid[0] = 0x51; <span class="comment">// 0x0051</span></div>
<div class="line"><a name="l00058"></a><span class="lineno"> 58</span>&#160; rfcomm_dcid[1] = 0x00;</div>
<div class="line"><a name="l00059"></a><span class="lineno"> 59</span>&#160; </div>
<div class="line"><a name="l00060"></a><span class="lineno"> 60</span>&#160; <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>&#160;}</div>
<div class="line"><a name="l00062"></a><span class="lineno"><a class="code" href="class_s_p_p.html#ae2c661bd46cd2d74bd29c4c771cd2ef0"> 62</a></span>&#160;<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>&#160; <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>&#160; RFCOMMConnected = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00065"></a><span class="lineno"> 65</span>&#160; SDPConnected = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00066"></a><span class="lineno"> 66</span>&#160; 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>&#160; 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>&#160; l2cap_event_flag = 0; </div>
<div class="line"><a name="l00069"></a><span class="lineno"> 69</span>&#160;}</div>
<div class="line"><a name="l00070"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a2b4b1f85f553c6a2fdd523e50c75c7b0"> 70</a></span>&#160;<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>&#160; <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>&#160; <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>&#160; <span class="keywordflow">if</span>(RFCOMMConnected)</div>
<div class="line"><a name="l00074"></a><span class="lineno"> 74</span>&#160; pBtd-&gt;<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>&#160; <span class="keywordflow">if</span>(RFCOMMConnected &amp;&amp; SDPConnected)</div>
<div class="line"><a name="l00076"></a><span class="lineno"> 76</span>&#160; delay(1); <span class="comment">// Add delay between commands</span></div>
<div class="line"><a name="l00077"></a><span class="lineno"> 77</span>&#160; <span class="keywordflow">if</span>(SDPConnected)</div>
<div class="line"><a name="l00078"></a><span class="lineno"> 78</span>&#160; pBtd-&gt;<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>&#160; 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>&#160;}</div>
<div class="line"><a name="l00081"></a><span class="lineno"><a class="code" href="class_s_p_p.html#abdfe9453fb82781bec53a191c2e9fb1d"> 81</a></span>&#160;<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>&#160; <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>&#160; <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>&#160; <span class="keywordflow">if</span>((l2capinbuf[12] | (l2capinbuf[13] &lt;&lt; 8)) == <a class="code" href="_b_t_d_8h.html#a25ce859d7ee2730e1d22d11c051ed60d">SDP_PSM</a> &amp;&amp; !pBtd-&gt;<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>&#160; pBtd-&gt;<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>&#160; hci_handle = pBtd-&gt;<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>&#160; 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>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span>((l2capinbuf[12] | (l2capinbuf[13] &lt;&lt; 8)) == <a class="code" href="_b_t_d_8h.html#a2924020f2e7e82fe956574538e2bc3eb">RFCOMM_PSM</a> &amp;&amp; !pBtd-&gt;<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>&#160; pBtd-&gt;<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>&#160; hci_handle = pBtd-&gt;<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>&#160; 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>&#160; }</div>
<div class="line"><a name="l00093"></a><span class="lineno"> 93</span>&#160; }</div>
<div class="line"><a name="l00094"></a><span class="lineno"> 94</span>&#160; }</div>
<div class="line"><a name="l00095"></a><span class="lineno"> 95</span>&#160; <span class="keywordflow">if</span> (((l2capinbuf[0] | (l2capinbuf[1] &lt;&lt; 8)) == (hci_handle | 0x2000))) { <span class="comment">// acl_handle_ok</span></div>
<div class="line"><a name="l00096"></a><span class="lineno"> 96</span>&#160; <span class="keywordflow">if</span> ((l2capinbuf[6] | (l2capinbuf[7] &lt;&lt; 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>&#160; <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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00099"></a><span class="lineno"> 99</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nL2CAP Command Rejected - Reason: &quot;</span>));</div>
<div class="line"><a name="l00100"></a><span class="lineno"> 100</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[13]);</div>
<div class="line"><a name="l00101"></a><span class="lineno"> 101</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>));</div>
<div class="line"><a name="l00102"></a><span class="lineno"> 102</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[12]);</div>
<div class="line"><a name="l00103"></a><span class="lineno"> 103</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; Data: &quot;</span>));</div>
<div class="line"><a name="l00104"></a><span class="lineno"> 104</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[17]);</div>
<div class="line"><a name="l00105"></a><span class="lineno"> 105</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>));</div>
<div class="line"><a name="l00106"></a><span class="lineno"> 106</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[16]);</div>
<div class="line"><a name="l00107"></a><span class="lineno"> 107</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>));</div>
<div class="line"><a name="l00108"></a><span class="lineno"> 108</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[15]);</div>
<div class="line"><a name="l00109"></a><span class="lineno"> 109</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>));</div>
<div class="line"><a name="l00110"></a><span class="lineno"> 110</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[14]);</div>
<div class="line"><a name="l00111"></a><span class="lineno"> 111</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00112"></a><span class="lineno"> 112</span>&#160;<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>&#160;<span class="preprocessor">#ifdef EXTRADEBUG</span></div>
<div class="line"><a name="l00114"></a><span class="lineno"> 114</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nL2CAP Connection Request - PSM: &quot;</span>));</div>
<div class="line"><a name="l00115"></a><span class="lineno"> 115</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[13]);</div>
<div class="line"><a name="l00116"></a><span class="lineno"> 116</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>));</div>
<div class="line"><a name="l00117"></a><span class="lineno"> 117</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[12]);</div>
<div class="line"><a name="l00118"></a><span class="lineno"> 118</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; SCID: &quot;</span>));</div>
<div class="line"><a name="l00119"></a><span class="lineno"> 119</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[15]);</div>
<div class="line"><a name="l00120"></a><span class="lineno"> 120</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>));</div>
<div class="line"><a name="l00121"></a><span class="lineno"> 121</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[14]);</div>
<div class="line"><a name="l00122"></a><span class="lineno"> 122</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; Identifier: &quot;</span>));</div>
<div class="line"><a name="l00123"></a><span class="lineno"> 123</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[9]);</div>
<div class="line"><a name="l00124"></a><span class="lineno"> 124</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00125"></a><span class="lineno"> 125</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">if</span> ((l2capinbuf[12] | (l2capinbuf[13] &lt;&lt; 8)) == <a class="code" href="_b_t_d_8h.html#a25ce859d7ee2730e1d22d11c051ed60d">SDP_PSM</a>) { <span class="comment">// It doesn&#39;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>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00127"></a><span class="lineno"> 127</span>&#160; sdp_scid[0] = l2capinbuf[14];</div>
<div class="line"><a name="l00128"></a><span class="lineno"> 128</span>&#160; sdp_scid[1] = l2capinbuf[15];</div>
<div class="line"><a name="l00129"></a><span class="lineno"> 129</span>&#160; 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>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> ((l2capinbuf[12] | (l2capinbuf[13] &lt;&lt; 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>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00132"></a><span class="lineno"> 132</span>&#160; rfcomm_scid[0] = l2capinbuf[14];</div>
<div class="line"><a name="l00133"></a><span class="lineno"> 133</span>&#160; rfcomm_scid[1] = l2capinbuf[15];</div>
<div class="line"><a name="l00134"></a><span class="lineno"> 134</span>&#160; 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>&#160; }</div>
<div class="line"><a name="l00136"></a><span class="lineno"> 136</span>&#160; } <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>&#160; <span class="keywordflow">if</span> ((l2capinbuf[16] | (l2capinbuf[17] &lt;&lt; 8)) == 0x0000) { <span class="comment">// Success</span></div>
<div class="line"><a name="l00138"></a><span class="lineno"> 138</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[12] == sdp_dcid[0] &amp;&amp; l2capinbuf[13] == sdp_dcid[1]) {</div>
<div class="line"><a name="l00139"></a><span class="lineno"> 139</span>&#160; <span class="comment">//Serial.print(&quot;\r\nSDP Configuration Complete&quot;);</span></div>
<div class="line"><a name="l00140"></a><span class="lineno"> 140</span>&#160; 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>&#160; }</div>
<div class="line"><a name="l00142"></a><span class="lineno"> 142</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[12] == rfcomm_dcid[0] &amp;&amp; l2capinbuf[13] == rfcomm_dcid[1]) {</div>
<div class="line"><a name="l00143"></a><span class="lineno"> 143</span>&#160; <span class="comment">//Serial.print(&quot;\r\nRFCOMM Configuration Complete&quot;);</span></div>
<div class="line"><a name="l00144"></a><span class="lineno"> 144</span>&#160; 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>&#160; }</div>
<div class="line"><a name="l00146"></a><span class="lineno"> 146</span>&#160; }</div>
<div class="line"><a name="l00147"></a><span class="lineno"> 147</span>&#160; } <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>&#160; <span class="keywordflow">if</span> (l2capinbuf[12] == sdp_dcid[0] &amp;&amp; l2capinbuf[13] == sdp_dcid[1]) {</div>
<div class="line"><a name="l00149"></a><span class="lineno"> 149</span>&#160; <span class="comment">//Serial.print(&quot;\r\nSDP Configuration Request&quot;);</span></div>
<div class="line"><a name="l00150"></a><span class="lineno"> 150</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00151"></a><span class="lineno"> 151</span>&#160; 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>&#160; }</div>
<div class="line"><a name="l00153"></a><span class="lineno"> 153</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[12] == rfcomm_dcid[0] &amp;&amp; l2capinbuf[13] == rfcomm_dcid[1]) {</div>
<div class="line"><a name="l00154"></a><span class="lineno"> 154</span>&#160; <span class="comment">//Serial.print(&quot;\r\nRFCOMM Configuration Request&quot;);</span></div>
<div class="line"><a name="l00155"></a><span class="lineno"> 155</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00156"></a><span class="lineno"> 156</span>&#160; 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>&#160; }</div>
<div class="line"><a name="l00158"></a><span class="lineno"> 158</span>&#160; } <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>&#160; <span class="keywordflow">if</span> (l2capinbuf[12] == sdp_dcid[0] &amp;&amp; l2capinbuf[13] == sdp_dcid[1]) {</div>
<div class="line"><a name="l00160"></a><span class="lineno"> 160</span>&#160; <span class="comment">//Notify(PSTR(&quot;\r\nDisconnect Request: SDP Channel&quot;));</span></div>
<div class="line"><a name="l00161"></a><span class="lineno"> 161</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00162"></a><span class="lineno"> 162</span>&#160; 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>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[12] == rfcomm_dcid[0] &amp;&amp; l2capinbuf[13] == rfcomm_dcid[1]) {</div>
<div class="line"><a name="l00164"></a><span class="lineno"> 164</span>&#160; <span class="comment">//Notify(PSTR(&quot;\r\nDisconnect Request: RFCOMM Channel&quot;));</span></div>
<div class="line"><a name="l00165"></a><span class="lineno"> 165</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00166"></a><span class="lineno"> 166</span>&#160; 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>&#160; }</div>
<div class="line"><a name="l00168"></a><span class="lineno"> 168</span>&#160; } <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>&#160; <span class="keywordflow">if</span> (l2capinbuf[12] == sdp_scid[0] &amp;&amp; l2capinbuf[13] == sdp_scid[1]) {</div>
<div class="line"><a name="l00170"></a><span class="lineno"> 170</span>&#160; <span class="comment">//Serial.print(&quot;\r\nDisconnect Response: SDP Channel&quot;);</span></div>
<div class="line"><a name="l00171"></a><span class="lineno"> 171</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00172"></a><span class="lineno"> 172</span>&#160; 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>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[12] == rfcomm_scid[0] &amp;&amp; l2capinbuf[13] == rfcomm_scid[1]) {</div>
<div class="line"><a name="l00174"></a><span class="lineno"> 174</span>&#160; <span class="comment">//Serial.print(&quot;\r\nDisconnect Response: RFCOMM Channel&quot;);</span></div>
<div class="line"><a name="l00175"></a><span class="lineno"> 175</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00176"></a><span class="lineno"> 176</span>&#160; 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>&#160; }</div>
<div class="line"><a name="l00178"></a><span class="lineno"> 178</span>&#160; } <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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00180"></a><span class="lineno"> 180</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nInformation request&quot;</span>));</div>
<div class="line"><a name="l00181"></a><span class="lineno"> 181</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00182"></a><span class="lineno"> 182</span>&#160;<span class="preprocessor"></span> identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00183"></a><span class="lineno"> 183</span>&#160; pBtd-&gt;<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>&#160; }</div>
<div class="line"><a name="l00185"></a><span class="lineno"> 185</span>&#160;<span class="preprocessor">#ifdef EXTRADEBUG</span></div>
<div class="line"><a name="l00186"></a><span class="lineno"> 186</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00187"></a><span class="lineno"> 187</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nL2CAP Unknown Signaling Command: &quot;</span>));</div>
<div class="line"><a name="l00188"></a><span class="lineno"> 188</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[8]); </div>
<div class="line"><a name="l00189"></a><span class="lineno"> 189</span>&#160; }</div>
<div class="line"><a name="l00190"></a><span class="lineno"> 190</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00191"></a><span class="lineno"> 191</span>&#160;<span class="preprocessor"></span> } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[6] == sdp_dcid[0] &amp;&amp; l2capinbuf[7] == sdp_dcid[1]) { <span class="comment">// SDP</span></div>
<div class="line"><a name="l00192"></a><span class="lineno"> 192</span>&#160; <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>&#160; <span class="comment">/*</span></div>
<div class="line"><a name="l00194"></a><span class="lineno"> 194</span>&#160;<span class="comment"> Serial.print(&quot;\r\nUUID: 0x&quot;);</span></div>
<div class="line"><a name="l00195"></a><span class="lineno"> 195</span>&#160;<span class="comment"> Serial.print(l2capinbuf[16],HEX);</span></div>
<div class="line"><a name="l00196"></a><span class="lineno"> 196</span>&#160;<span class="comment"> Serial.print(&quot; &quot;);</span></div>
<div class="line"><a name="l00197"></a><span class="lineno"> 197</span>&#160;<span class="comment"> Serial.print(l2capinbuf[17],HEX);</span></div>
<div class="line"><a name="l00198"></a><span class="lineno"> 198</span>&#160;<span class="comment"> */</span></div>
<div class="line"><a name="l00199"></a><span class="lineno"> 199</span>&#160; <span class="keywordflow">if</span> ((l2capinbuf[16] &lt;&lt; 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>&#160; <span class="keywordflow">if</span>(firstMessage) {</div>
<div class="line"><a name="l00201"></a><span class="lineno"> 201</span>&#160; serialPortResponse1(l2capinbuf[9],l2capinbuf[10]);</div>
<div class="line"><a name="l00202"></a><span class="lineno"> 202</span>&#160; firstMessage = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00203"></a><span class="lineno"> 203</span>&#160; } <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00204"></a><span class="lineno"> 204</span>&#160; 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>&#160; firstMessage = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00206"></a><span class="lineno"> 206</span>&#160; }</div>
<div class="line"><a name="l00207"></a><span class="lineno"> 207</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> ((l2capinbuf[16] &lt;&lt; 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>&#160; <span class="keywordflow">if</span>(firstMessage) {</div>
<div class="line"><a name="l00209"></a><span class="lineno"> 209</span>&#160; l2capResponse1(l2capinbuf[9],l2capinbuf[10]);</div>
<div class="line"><a name="l00210"></a><span class="lineno"> 210</span>&#160; firstMessage = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00211"></a><span class="lineno"> 211</span>&#160; } <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00212"></a><span class="lineno"> 212</span>&#160; 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>&#160; firstMessage = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00214"></a><span class="lineno"> 214</span>&#160; }</div>
<div class="line"><a name="l00215"></a><span class="lineno"> 215</span>&#160; } <span class="keywordflow">else</span></div>
<div class="line"><a name="l00216"></a><span class="lineno"> 216</span>&#160; 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>&#160; }</div>
<div class="line"><a name="l00218"></a><span class="lineno"> 218</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[6] == rfcomm_dcid[0] &amp;&amp; l2capinbuf[7] == rfcomm_dcid[1]) { <span class="comment">// RFCOMM</span></div>
<div class="line"><a name="l00219"></a><span class="lineno"> 219</span>&#160; rfcommChannel = l2capinbuf[8] &amp; 0xF8;</div>
<div class="line"><a name="l00220"></a><span class="lineno"> 220</span>&#160; rfcommDirection = l2capinbuf[8] &amp; 0x04;</div>
<div class="line"><a name="l00221"></a><span class="lineno"> 221</span>&#160; rfcommCommandResponse = l2capinbuf[8] &amp; 0x02;</div>
<div class="line"><a name="l00222"></a><span class="lineno"> 222</span>&#160; rfcommChannelType = l2capinbuf[9] &amp; 0xEF;</div>
<div class="line"><a name="l00223"></a><span class="lineno"> 223</span>&#160; rfcommPfBit = l2capinbuf[9] &amp; 0x10;</div>
<div class="line"><a name="l00224"></a><span class="lineno"> 224</span>&#160; </div>
<div class="line"><a name="l00225"></a><span class="lineno"> 225</span>&#160; <span class="keywordflow">if</span>(rfcommChannel&gt;&gt;3 != 0x00)</div>
<div class="line"><a name="l00226"></a><span class="lineno"> 226</span>&#160; rfcommChannelConnection = rfcommChannel;</div>
<div class="line"><a name="l00227"></a><span class="lineno"> 227</span>&#160; </div>
<div class="line"><a name="l00228"></a><span class="lineno"> 228</span>&#160;<span class="preprocessor">#ifdef EXTRADEBUG</span></div>
<div class="line"><a name="l00229"></a><span class="lineno"> 229</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nRFCOMM Channel: &quot;</span>));</div>
<div class="line"><a name="l00230"></a><span class="lineno"> 230</span>&#160; Serial.print(rfcommChannel&gt;&gt;3,HEX);</div>
<div class="line"><a name="l00231"></a><span class="lineno"> 231</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; Direction: &quot;</span>));</div>
<div class="line"><a name="l00232"></a><span class="lineno"> 232</span>&#160; Serial.print(rfcommDirection&gt;&gt;2,HEX);</div>
<div class="line"><a name="l00233"></a><span class="lineno"> 233</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; CommandResponse: &quot;</span>));</div>
<div class="line"><a name="l00234"></a><span class="lineno"> 234</span>&#160; Serial.print(rfcommCommandResponse&gt;&gt;1,HEX);</div>
<div class="line"><a name="l00235"></a><span class="lineno"> 235</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; ChannelType: &quot;</span>));</div>
<div class="line"><a name="l00236"></a><span class="lineno"> 236</span>&#160; Serial.print(rfcommChannelType,HEX);</div>
<div class="line"><a name="l00237"></a><span class="lineno"> 237</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; PF_BIT: &quot;</span>));</div>
<div class="line"><a name="l00238"></a><span class="lineno"> 238</span>&#160; Serial.print(rfcommPfBit,HEX);</div>
<div class="line"><a name="l00239"></a><span class="lineno"> 239</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00240"></a><span class="lineno"> 240</span>&#160;<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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00242"></a><span class="lineno"> 242</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nReceived Disconnect RFCOMM Command on channel: &quot;</span>));</div>
<div class="line"><a name="l00243"></a><span class="lineno"> 243</span>&#160; Serial.print(rfcommChannel&gt;&gt;3,HEX);</div>
<div class="line"><a name="l00244"></a><span class="lineno"> 244</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00245"></a><span class="lineno"> 245</span>&#160;<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>&#160; 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>&#160; }</div>
<div class="line"><a name="l00248"></a><span class="lineno"> 248</span>&#160; <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>&#160; <span class="comment">/* Read the incoming message */</span></div>
<div class="line"><a name="l00250"></a><span class="lineno"> 250</span>&#160; <span class="keywordflow">if</span>(rfcommChannelType == <a class="code" href="_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373">RFCOMM_UIH</a> &amp;&amp; rfcommChannel == rfcommChannelConnection) {</div>
<div class="line"><a name="l00251"></a><span class="lineno"> 251</span>&#160; uint8_t length = l2capinbuf[10] &gt;&gt; 1; <span class="comment">// Get length</span></div>
<div class="line"><a name="l00252"></a><span class="lineno"> 252</span>&#160; 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>&#160; <span class="keywordflow">if</span>(rfcommAvailable + length &lt;= <span class="keyword">sizeof</span>(rfcommDataBuffer)) { <span class="comment">// Don&#39;t add data to buffer if it would be full</span></div>
<div class="line"><a name="l00254"></a><span class="lineno"> 254</span>&#160; <span class="keywordflow">for</span>(uint8_t i = 0; i &lt; length; i++)</div>
<div class="line"><a name="l00255"></a><span class="lineno"> 255</span>&#160; rfcommDataBuffer[rfcommAvailable+i] = l2capinbuf[11+i+offset];</div>
<div class="line"><a name="l00256"></a><span class="lineno"> 256</span>&#160; rfcommAvailable += length;</div>
<div class="line"><a name="l00257"></a><span class="lineno"> 257</span>&#160; }</div>
<div class="line"><a name="l00258"></a><span class="lineno"> 258</span>&#160;<span class="preprocessor">#ifdef EXTRADEBUG</span></div>
<div class="line"><a name="l00259"></a><span class="lineno"> 259</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nRFCOMM Data Available: &quot;</span>));</div>
<div class="line"><a name="l00260"></a><span class="lineno"> 260</span>&#160; Serial.print(rfcommAvailable);</div>
<div class="line"><a name="l00261"></a><span class="lineno"> 261</span>&#160; <span class="keywordflow">if</span> (offset) {</div>
<div class="line"><a name="l00262"></a><span class="lineno"> 262</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; - Credit: 0x&quot;</span>));</div>
<div class="line"><a name="l00263"></a><span class="lineno"> 263</span>&#160; Serial.print(l2capinbuf[11],HEX);</div>
<div class="line"><a name="l00264"></a><span class="lineno"> 264</span>&#160; }</div>
<div class="line"><a name="l00265"></a><span class="lineno"> 265</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00266"></a><span class="lineno"> 266</span>&#160;<span class="preprocessor"></span><span class="preprocessor">#ifdef PRINTREPORT // Uncomment &quot;#define PRINTREPORT&quot; to print the report send to the Arduino via Bluetooth</span></div>
<div class="line"><a name="l00267"></a><span class="lineno"> 267</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">for</span>(uint8_t i = 0; i &lt; length; i++)</div>
<div class="line"><a name="l00268"></a><span class="lineno"> 268</span>&#160; Serial.write(l2capinbuf[i+11+offset]);</div>
<div class="line"><a name="l00269"></a><span class="lineno"> 269</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00270"></a><span class="lineno"> 270</span>&#160;<span class="preprocessor"></span> }</div>
<div class="line"><a name="l00271"></a><span class="lineno"> 271</span>&#160; } <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00272"></a><span class="lineno"> 272</span>&#160; <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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00274"></a><span class="lineno"> 274</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nReceived SABM Command&quot;</span>));</div>
<div class="line"><a name="l00275"></a><span class="lineno"> 275</span>&#160;<span class="preprocessor">#endif </span></div>
<div class="line"><a name="l00276"></a><span class="lineno"> 276</span>&#160;<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>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span>(rfcommChannelType == <a class="code" href="_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373">RFCOMM_UIH</a> &amp;&amp; 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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00279"></a><span class="lineno"> 279</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nReceived UIH Parameter Negotiation Command&quot;</span>));</div>
<div class="line"><a name="l00280"></a><span class="lineno"> 280</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00281"></a><span class="lineno"> 281</span>&#160;<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>&#160; rfcommbuf[1] = l2capinbuf[12]; <span class="comment">// Length and shiftet like so: length &lt;&lt; 1 | 1</span></div>
<div class="line"><a name="l00283"></a><span class="lineno"> 283</span>&#160; rfcommbuf[2] = l2capinbuf[13]; <span class="comment">// Channel: channel &lt;&lt; 1 | 1</span></div>
<div class="line"><a name="l00284"></a><span class="lineno"> 284</span>&#160; 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>&#160; rfcommbuf[4] = 0x00; <span class="comment">// Priority</span></div>
<div class="line"><a name="l00286"></a><span class="lineno"> 286</span>&#160; rfcommbuf[5] = 0x00; <span class="comment">// Timer</span></div>
<div class="line"><a name="l00287"></a><span class="lineno"> 287</span>&#160; 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>&#160; rfcommbuf[7] = 0x00; <span class="comment">// Max Fram Size MSB</span></div>
<div class="line"><a name="l00289"></a><span class="lineno"> 289</span>&#160; rfcommbuf[8] = 0x00; <span class="comment">// MaxRatransm.</span></div>
<div class="line"><a name="l00290"></a><span class="lineno"> 290</span>&#160; rfcommbuf[9] = 0x00; <span class="comment">// Number of Frames</span></div>
<div class="line"><a name="l00291"></a><span class="lineno"> 291</span>&#160; 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>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span>(rfcommChannelType == <a class="code" href="_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373">RFCOMM_UIH</a> &amp;&amp; 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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00294"></a><span class="lineno"> 294</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSend UIH Modem Status Response&quot;</span>));</div>
<div class="line"><a name="l00295"></a><span class="lineno"> 295</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00296"></a><span class="lineno"> 296</span>&#160;<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>&#160; rfcommbuf[1] = 2 &lt;&lt; 1 | 1; <span class="comment">// Length and shiftet like so: length &lt;&lt; 1 | 1</span></div>
<div class="line"><a name="l00298"></a><span class="lineno"> 298</span>&#160; rfcommbuf[2] = l2capinbuf[13]; <span class="comment">// Channel: (1 &lt;&lt; 0) | (1 &lt;&lt; 1) | (0 &lt;&lt; 2) | (channel &lt;&lt; 3)</span></div>
<div class="line"><a name="l00299"></a><span class="lineno"> 299</span>&#160; rfcommbuf[3] = l2capinbuf[14];</div>
<div class="line"><a name="l00300"></a><span class="lineno"> 300</span>&#160; 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>&#160; </div>
<div class="line"><a name="l00302"></a><span class="lineno"> 302</span>&#160; delay(1);</div>
<div class="line"><a name="l00303"></a><span class="lineno"> 303</span>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00304"></a><span class="lineno"> 304</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSend UIH Modem Status Command&quot;</span>));</div>
<div class="line"><a name="l00305"></a><span class="lineno"> 305</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00306"></a><span class="lineno"> 306</span>&#160;<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>&#160; rfcommbuf[1] = 2 &lt;&lt; 1 | 1; <span class="comment">// Length and shiftet like so: length &lt;&lt; 1 | 1</span></div>
<div class="line"><a name="l00308"></a><span class="lineno"> 308</span>&#160; rfcommbuf[2] = l2capinbuf[13]; <span class="comment">// Channel: (1 &lt;&lt; 0) | (1 &lt;&lt; 1) | (0 &lt;&lt; 2) | (channel &lt;&lt; 3)</span></div>
<div class="line"><a name="l00309"></a><span class="lineno"> 309</span>&#160; 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>&#160; </div>
<div class="line"><a name="l00311"></a><span class="lineno"> 311</span>&#160; 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>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span>(rfcommChannelType == <a class="code" href="_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373">RFCOMM_UIH</a> &amp;&amp; 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>&#160; <span class="keywordflow">if</span>(!creditSent) {</div>
<div class="line"><a name="l00314"></a><span class="lineno"> 314</span>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00315"></a><span class="lineno"> 315</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSend UIH Command with credit&quot;</span>));</div>
<div class="line"><a name="l00316"></a><span class="lineno"> 316</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00317"></a><span class="lineno"> 317</span>&#160;<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>&#160; creditSent = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00319"></a><span class="lineno"> 319</span>&#160; timer = millis();</div>
<div class="line"><a name="l00320"></a><span class="lineno"> 320</span>&#160; waitForLastCommand = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00321"></a><span class="lineno"> 321</span>&#160; }</div>
<div class="line"><a name="l00322"></a><span class="lineno"> 322</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span>(rfcommChannelType == <a class="code" href="_s_p_p_8h.html#ae9ffac80725386a879ba956251f64373">RFCOMM_UIH</a> &amp;&amp; l2capinbuf[10] == 0x01) { <span class="comment">// UIH Command with credit</span></div>
<div class="line"><a name="l00323"></a><span class="lineno"> 323</span>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00324"></a><span class="lineno"> 324</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nReceived UIH Command with credit&quot;</span>));</div>
<div class="line"><a name="l00325"></a><span class="lineno"> 325</span>&#160;<span class="preprocessor">#endif </span></div>
<div class="line"><a name="l00326"></a><span class="lineno"> 326</span>&#160;<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> &amp;&amp; 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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00328"></a><span class="lineno"> 328</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nReceived UIH Remote Port Negotiation Command&quot;</span>));</div>
<div class="line"><a name="l00329"></a><span class="lineno"> 329</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00330"></a><span class="lineno"> 330</span>&#160;<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>&#160; rfcommbuf[1] = l2capinbuf[12]; <span class="comment">// Length and shiftet like so: length &lt;&lt; 1 | 1</span></div>
<div class="line"><a name="l00332"></a><span class="lineno"> 332</span>&#160; rfcommbuf[2] = l2capinbuf[13]; <span class="comment">// Channel: channel &lt;&lt; 1 | 1</span></div>
<div class="line"><a name="l00333"></a><span class="lineno"> 333</span>&#160; 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>&#160; rfcommbuf[4] = l2capinbuf[15]; <span class="comment">// Priority</span></div>
<div class="line"><a name="l00335"></a><span class="lineno"> 335</span>&#160; rfcommbuf[5] = l2capinbuf[16]; <span class="comment">// Timer</span></div>
<div class="line"><a name="l00336"></a><span class="lineno"> 336</span>&#160; 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>&#160; 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>&#160; rfcommbuf[8] = l2capinbuf[19]; <span class="comment">// MaxRatransm.</span></div>
<div class="line"><a name="l00339"></a><span class="lineno"> 339</span>&#160; rfcommbuf[9] = l2capinbuf[20]; <span class="comment">// Number of Frames</span></div>
<div class="line"><a name="l00340"></a><span class="lineno"> 340</span>&#160; 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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00342"></a><span class="lineno"> 342</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nRFCOMM Connection is now established\r\n&quot;</span>));</div>
<div class="line"><a name="l00343"></a><span class="lineno"> 343</span>&#160;<span class="preprocessor">#endif </span></div>
<div class="line"><a name="l00344"></a><span class="lineno"> 344</span>&#160;<span class="preprocessor"></span> waitForLastCommand = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00345"></a><span class="lineno"> 345</span>&#160; creditSent = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00346"></a><span class="lineno"> 346</span>&#160; <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>&#160; }</div>
<div class="line"><a name="l00348"></a><span class="lineno"> 348</span>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00349"></a><span class="lineno"> 349</span>&#160;<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>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nUnsupported RFCOMM Data - ChannelType: &quot;</span>));</div>
<div class="line"><a name="l00351"></a><span class="lineno"> 351</span>&#160; PrintHex&lt;uint8_t&gt;(rfcommChannelType);</div>
<div class="line"><a name="l00352"></a><span class="lineno"> 352</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; Command: &quot;</span>));</div>
<div class="line"><a name="l00353"></a><span class="lineno"> 353</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[11]);</div>
<div class="line"><a name="l00354"></a><span class="lineno"> 354</span>&#160; }</div>
<div class="line"><a name="l00355"></a><span class="lineno"> 355</span>&#160;<span class="preprocessor">#endif </span></div>
<div class="line"><a name="l00356"></a><span class="lineno"> 356</span>&#160;<span class="preprocessor"></span> }</div>
<div class="line"><a name="l00357"></a><span class="lineno"> 357</span>&#160; }</div>
<div class="line"><a name="l00358"></a><span class="lineno"> 358</span>&#160;<span class="preprocessor">#ifdef EXTRADEBUG</span></div>
<div class="line"><a name="l00359"></a><span class="lineno"> 359</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00360"></a><span class="lineno"> 360</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nUnsupported L2CAP Data - Channel ID: &quot;</span>));</div>
<div class="line"><a name="l00361"></a><span class="lineno"> 361</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[7]);</div>
<div class="line"><a name="l00362"></a><span class="lineno"> 362</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>));</div>
<div class="line"><a name="l00363"></a><span class="lineno"> 363</span>&#160; PrintHex&lt;uint8_t&gt;(l2capinbuf[6]);</div>
<div class="line"><a name="l00364"></a><span class="lineno"> 364</span>&#160; }</div>
<div class="line"><a name="l00365"></a><span class="lineno"> 365</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00366"></a><span class="lineno"> 366</span>&#160;<span class="preprocessor"></span> SDP_task();</div>
<div class="line"><a name="l00367"></a><span class="lineno"> 367</span>&#160; RFCOMM_task();</div>
<div class="line"><a name="l00368"></a><span class="lineno"> 368</span>&#160; }</div>
<div class="line"><a name="l00369"></a><span class="lineno"> 369</span>&#160;}</div>
<div class="line"><a name="l00370"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a2de67ee7ad1be9d2f3daf7dc08dc5f90"> 370</a></span>&#160;<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>&#160; <span class="keywordflow">if</span>(waitForLastCommand &amp;&amp; (millis() - timer) &gt; 100) { <span class="comment">// We will only wait 100ms and see if the UIH Remote Port Negotiation Command is send, as some deviced don&#39;t send it</span></div>
<div class="line"><a name="l00372"></a><span class="lineno"> 372</span>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00373"></a><span class="lineno"> 373</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nRFCOMM Connection is now established - Automatic\r\n&quot;</span>));</div>
<div class="line"><a name="l00374"></a><span class="lineno"> 374</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00375"></a><span class="lineno"> 375</span>&#160;<span class="preprocessor"></span> creditSent = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00376"></a><span class="lineno"> 376</span>&#160; waitForLastCommand = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00377"></a><span class="lineno"> 377</span>&#160; <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>&#160; } </div>
<div class="line"><a name="l00379"></a><span class="lineno"> 379</span>&#160;}</div>
<div class="line"><a name="l00380"></a><span class="lineno"> 380</span>&#160;<span class="keywordtype">void</span> SPP::SDP_task() {</div>
<div class="line"><a name="l00381"></a><span class="lineno"> 381</span>&#160; <span class="keywordflow">switch</span> (l2cap_sdp_state)</div>
<div class="line"><a name="l00382"></a><span class="lineno"> 382</span>&#160; {</div>
<div class="line"><a name="l00383"></a><span class="lineno"> 383</span>&#160; <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>&#160; <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>&#160; l2cap_event_flag &amp;= ~<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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00387"></a><span class="lineno"> 387</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSDP Incoming Connection Request&quot;</span>));</div>
<div class="line"><a name="l00388"></a><span class="lineno"> 388</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00389"></a><span class="lineno"> 389</span>&#160;<span class="preprocessor"></span> pBtd-&gt;<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>&#160; delay(1);</div>
<div class="line"><a name="l00391"></a><span class="lineno"> 391</span>&#160; pBtd-&gt;<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>&#160; identifier++;</div>
<div class="line"><a name="l00393"></a><span class="lineno"> 393</span>&#160; delay(1);</div>
<div class="line"><a name="l00394"></a><span class="lineno"> 394</span>&#160; pBtd-&gt;<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>&#160; 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>&#160; } </div>
<div class="line"><a name="l00397"></a><span class="lineno"> 397</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00398"></a><span class="lineno"> 398</span>&#160; <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>&#160; <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>&#160; l2cap_event_flag &amp;= ~<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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00402"></a><span class="lineno"> 402</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSDP Configuration Request&quot;</span>));</div>
<div class="line"><a name="l00403"></a><span class="lineno"> 403</span>&#160;<span class="preprocessor">#endif </span></div>
<div class="line"><a name="l00404"></a><span class="lineno"> 404</span>&#160;<span class="preprocessor"></span> pBtd-&gt;<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>&#160; 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>&#160; }</div>
<div class="line"><a name="l00407"></a><span class="lineno"> 407</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00408"></a><span class="lineno"> 408</span>&#160; <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>&#160; <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>&#160; l2cap_event_flag &amp;= ~<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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00412"></a><span class="lineno"> 412</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSDP Successfully Configured&quot;</span>));</div>
<div class="line"><a name="l00413"></a><span class="lineno"> 413</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00414"></a><span class="lineno"> 414</span>&#160;<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>&#160; SDPConnected = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00416"></a><span class="lineno"> 416</span>&#160; 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>&#160; }</div>
<div class="line"><a name="l00418"></a><span class="lineno"> 418</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00419"></a><span class="lineno"> 419</span>&#160; <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>&#160; <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>&#160; l2cap_event_flag &amp;= ~<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>&#160; SDPConnected = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00423"></a><span class="lineno"> 423</span>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00424"></a><span class="lineno"> 424</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nDisconnected SDP Channel&quot;</span>));</div>
<div class="line"><a name="l00425"></a><span class="lineno"> 425</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00426"></a><span class="lineno"> 426</span>&#160;<span class="preprocessor"></span> pBtd-&gt;<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>&#160; 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>&#160; } <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>&#160; 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>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00431"></a><span class="lineno"> 431</span>&#160; <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>&#160; <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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00434"></a><span class="lineno"> 434</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nDisconnected L2CAP Connection&quot;</span>));</div>
<div class="line"><a name="l00435"></a><span class="lineno"> 435</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00436"></a><span class="lineno"> 436</span>&#160;<span class="preprocessor"></span> RFCOMMConnected = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00437"></a><span class="lineno"> 437</span>&#160; SDPConnected = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00438"></a><span class="lineno"> 438</span>&#160; pBtd-&gt;<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>&#160; hci_handle = -1; <span class="comment">// Reset handle</span></div>
<div class="line"><a name="l00440"></a><span class="lineno"> 440</span>&#160; l2cap_event_flag = 0; <span class="comment">// Reset flags</span></div>
<div class="line"><a name="l00441"></a><span class="lineno"> 441</span>&#160; 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>&#160; 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>&#160; }</div>
<div class="line"><a name="l00444"></a><span class="lineno"> 444</span>&#160; <span class="keywordflow">break</span>; </div>
<div class="line"><a name="l00445"></a><span class="lineno"> 445</span>&#160; }</div>
<div class="line"><a name="l00446"></a><span class="lineno"> 446</span>&#160;}</div>
<div class="line"><a name="l00447"></a><span class="lineno"> 447</span>&#160;<span class="keywordtype">void</span> SPP::RFCOMM_task()</div>
<div class="line"><a name="l00448"></a><span class="lineno"> 448</span>&#160;{ </div>
<div class="line"><a name="l00449"></a><span class="lineno"> 449</span>&#160; <span class="keywordflow">switch</span> (l2cap_rfcomm_state)</div>
<div class="line"><a name="l00450"></a><span class="lineno"> 450</span>&#160; {</div>
<div class="line"><a name="l00451"></a><span class="lineno"> 451</span>&#160; <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>&#160; <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>&#160; l2cap_event_flag &amp;= ~<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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00455"></a><span class="lineno"> 455</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nRFCOMM Incoming Connection Request&quot;</span>));</div>
<div class="line"><a name="l00456"></a><span class="lineno"> 456</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00457"></a><span class="lineno"> 457</span>&#160;<span class="preprocessor"></span> pBtd-&gt;<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>&#160; delay(1);</div>
<div class="line"><a name="l00459"></a><span class="lineno"> 459</span>&#160; pBtd-&gt;<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>&#160; identifier++;</div>
<div class="line"><a name="l00461"></a><span class="lineno"> 461</span>&#160; delay(1);</div>
<div class="line"><a name="l00462"></a><span class="lineno"> 462</span>&#160; pBtd-&gt;<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>&#160; 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>&#160; } </div>
<div class="line"><a name="l00465"></a><span class="lineno"> 465</span>&#160; <span class="keywordflow">break</span>; </div>
<div class="line"><a name="l00466"></a><span class="lineno"> 466</span>&#160; <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>&#160; <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>&#160; l2cap_event_flag &amp;= ~<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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00470"></a><span class="lineno"> 470</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nRFCOMM Configuration Request&quot;</span>));</div>
<div class="line"><a name="l00471"></a><span class="lineno"> 471</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00472"></a><span class="lineno"> 472</span>&#160;<span class="preprocessor"></span> pBtd-&gt;<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>&#160; 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>&#160; }</div>
<div class="line"><a name="l00475"></a><span class="lineno"> 475</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00476"></a><span class="lineno"> 476</span>&#160; <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>&#160; <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>&#160; l2cap_event_flag &amp;= ~<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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00480"></a><span class="lineno"> 480</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nRFCOMM Successfully Configured&quot;</span>));</div>
<div class="line"><a name="l00481"></a><span class="lineno"> 481</span>&#160;<span class="preprocessor">#endif </span></div>
<div class="line"><a name="l00482"></a><span class="lineno"> 482</span>&#160;<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>&#160; bytesRead = 0; <span class="comment">// Reset number of bytes received</span></div>
<div class="line"><a name="l00484"></a><span class="lineno"> 484</span>&#160; RFCOMMConnected = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00485"></a><span class="lineno"> 485</span>&#160; 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>&#160; }</div>
<div class="line"><a name="l00487"></a><span class="lineno"> 487</span>&#160; <span class="keywordflow">break</span>; </div>
<div class="line"><a name="l00488"></a><span class="lineno"> 488</span>&#160; <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>&#160; <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>&#160; l2cap_event_flag &amp;= ~<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>&#160; RFCOMMConnected = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00492"></a><span class="lineno"> 492</span>&#160; <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>&#160;<span class="preprocessor">#ifdef DEBUG</span></div>
<div class="line"><a name="l00494"></a><span class="lineno"> 494</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nDisconnected RFCOMM Channel&quot;</span>));</div>
<div class="line"><a name="l00495"></a><span class="lineno"> 495</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00496"></a><span class="lineno"> 496</span>&#160;<span class="preprocessor"></span> pBtd-&gt;<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>&#160; 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>&#160; } <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>&#160; 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>&#160; <span class="keywordflow">break</span>; </div>
<div class="line"><a name="l00501"></a><span class="lineno"> 501</span>&#160; }</div>
<div class="line"><a name="l00502"></a><span class="lineno"> 502</span>&#160;}</div>
<div class="line"><a name="l00503"></a><span class="lineno"> 503</span>&#160;<span class="comment">/************************************************************/</span></div>
<div class="line"><a name="l00504"></a><span class="lineno"> 504</span>&#160;<span class="comment">/* SDP Commands */</span></div>
<div class="line"><a name="l00505"></a><span class="lineno"> 505</span>&#160;<span class="comment">/************************************************************/</span></div>
<div class="line"><a name="l00506"></a><span class="lineno"> 506</span>&#160;<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>&#160; pBtd-&gt;<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>&#160;}</div>
<div class="line"><a name="l00509"></a><span class="lineno"> 509</span>&#160;<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>&#160; 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>&#160; l2capoutbuf[1] = transactionIDHigh;</div>
<div class="line"><a name="l00512"></a><span class="lineno"> 512</span>&#160; l2capoutbuf[2] = transactionIDLow;</div>
<div class="line"><a name="l00513"></a><span class="lineno"> 513</span>&#160; l2capoutbuf[3] = 0x00; <span class="comment">// Parameter Length</span></div>
<div class="line"><a name="l00514"></a><span class="lineno"> 514</span>&#160; l2capoutbuf[4] = 0x05; <span class="comment">// Parameter Length</span></div>
<div class="line"><a name="l00515"></a><span class="lineno"> 515</span>&#160; l2capoutbuf[5] = 0x00; <span class="comment">// AttributeListsByteCount</span></div>
<div class="line"><a name="l00516"></a><span class="lineno"> 516</span>&#160; l2capoutbuf[6] = 0x02; <span class="comment">// AttributeListsByteCount</span></div>
<div class="line"><a name="l00517"></a><span class="lineno"> 517</span>&#160; </div>
<div class="line"><a name="l00518"></a><span class="lineno"> 518</span>&#160; <span class="comment">/* Attribute ID/Value Sequence: */</span></div>
<div class="line"><a name="l00519"></a><span class="lineno"> 519</span>&#160; l2capoutbuf[7] = 0x35;</div>
<div class="line"><a name="l00520"></a><span class="lineno"> 520</span>&#160; l2capoutbuf[8] = 0x00;</div>
<div class="line"><a name="l00521"></a><span class="lineno"> 521</span>&#160; l2capoutbuf[9] = 0x00;</div>
<div class="line"><a name="l00522"></a><span class="lineno"> 522</span>&#160; </div>
<div class="line"><a name="l00523"></a><span class="lineno"> 523</span>&#160; SDP_Command(l2capoutbuf,10);</div>
<div class="line"><a name="l00524"></a><span class="lineno"> 524</span>&#160;}</div>
<div class="line"><a name="l00525"></a><span class="lineno"> 525</span>&#160;<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>&#160; 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>&#160; l2capoutbuf[1] = transactionIDHigh;</div>
<div class="line"><a name="l00528"></a><span class="lineno"> 528</span>&#160; l2capoutbuf[2] = transactionIDLow;</div>
<div class="line"><a name="l00529"></a><span class="lineno"> 529</span>&#160; l2capoutbuf[3] = 0x00; <span class="comment">// Parameter Length</span></div>
<div class="line"><a name="l00530"></a><span class="lineno"> 530</span>&#160; l2capoutbuf[4] = 0x2B; <span class="comment">// Parameter Length</span></div>
<div class="line"><a name="l00531"></a><span class="lineno"> 531</span>&#160; l2capoutbuf[5] = 0x00; <span class="comment">// AttributeListsByteCount</span></div>
<div class="line"><a name="l00532"></a><span class="lineno"> 532</span>&#160; l2capoutbuf[6] = 0x26; <span class="comment">// AttributeListsByteCount</span></div>
<div class="line"><a name="l00533"></a><span class="lineno"> 533</span>&#160;</div>
<div class="line"><a name="l00534"></a><span class="lineno"> 534</span>&#160; <span class="comment">/* Attribute ID/Value Sequence: */</span></div>
<div class="line"><a name="l00535"></a><span class="lineno"> 535</span>&#160; l2capoutbuf[7] = 0x36;</div>
<div class="line"><a name="l00536"></a><span class="lineno"> 536</span>&#160; l2capoutbuf[8] = 0x00;</div>
<div class="line"><a name="l00537"></a><span class="lineno"> 537</span>&#160; l2capoutbuf[9] = 0x3C;</div>
<div class="line"><a name="l00538"></a><span class="lineno"> 538</span>&#160; l2capoutbuf[10] = 0x36;</div>
<div class="line"><a name="l00539"></a><span class="lineno"> 539</span>&#160; l2capoutbuf[11] = 0x00;</div>
<div class="line"><a name="l00540"></a><span class="lineno"> 540</span>&#160; </div>
<div class="line"><a name="l00541"></a><span class="lineno"> 541</span>&#160; l2capoutbuf[12] = 0x39;</div>
<div class="line"><a name="l00542"></a><span class="lineno"> 542</span>&#160; l2capoutbuf[13] = 0x09;</div>
<div class="line"><a name="l00543"></a><span class="lineno"> 543</span>&#160; l2capoutbuf[14] = 0x00;</div>
<div class="line"><a name="l00544"></a><span class="lineno"> 544</span>&#160; l2capoutbuf[15] = 0x00;</div>
<div class="line"><a name="l00545"></a><span class="lineno"> 545</span>&#160; l2capoutbuf[16] = 0x0A;</div>
<div class="line"><a name="l00546"></a><span class="lineno"> 546</span>&#160; l2capoutbuf[17] = 0x00;</div>
<div class="line"><a name="l00547"></a><span class="lineno"> 547</span>&#160; l2capoutbuf[18] = 0x01;</div>
<div class="line"><a name="l00548"></a><span class="lineno"> 548</span>&#160; l2capoutbuf[19] = 0x00;</div>
<div class="line"><a name="l00549"></a><span class="lineno"> 549</span>&#160; l2capoutbuf[20] = 0x06;</div>
<div class="line"><a name="l00550"></a><span class="lineno"> 550</span>&#160; l2capoutbuf[21] = 0x09;</div>
<div class="line"><a name="l00551"></a><span class="lineno"> 551</span>&#160; l2capoutbuf[22] = 0x00;</div>
<div class="line"><a name="l00552"></a><span class="lineno"> 552</span>&#160; l2capoutbuf[23] = 0x01;</div>
<div class="line"><a name="l00553"></a><span class="lineno"> 553</span>&#160; l2capoutbuf[24] = 0x35;</div>
<div class="line"><a name="l00554"></a><span class="lineno"> 554</span>&#160; l2capoutbuf[25] = 0x03;</div>
<div class="line"><a name="l00555"></a><span class="lineno"> 555</span>&#160; l2capoutbuf[26] = 0x19;</div>
<div class="line"><a name="l00556"></a><span class="lineno"> 556</span>&#160; l2capoutbuf[27] = 0x11;</div>
<div class="line"><a name="l00557"></a><span class="lineno"> 557</span>&#160; </div>
<div class="line"><a name="l00558"></a><span class="lineno"> 558</span>&#160; l2capoutbuf[28] = 0x01;</div>
<div class="line"><a name="l00559"></a><span class="lineno"> 559</span>&#160; l2capoutbuf[29] = 0x09;</div>
<div class="line"><a name="l00560"></a><span class="lineno"> 560</span>&#160; l2capoutbuf[30] = 0x00;</div>
<div class="line"><a name="l00561"></a><span class="lineno"> 561</span>&#160; l2capoutbuf[31] = 0x04;</div>
<div class="line"><a name="l00562"></a><span class="lineno"> 562</span>&#160; l2capoutbuf[32] = 0x35;</div>
<div class="line"><a name="l00563"></a><span class="lineno"> 563</span>&#160; l2capoutbuf[33] = 0x0C;</div>
<div class="line"><a name="l00564"></a><span class="lineno"> 564</span>&#160; l2capoutbuf[34] = 0x35;</div>
<div class="line"><a name="l00565"></a><span class="lineno"> 565</span>&#160; l2capoutbuf[35] = 0x03;</div>
<div class="line"><a name="l00566"></a><span class="lineno"> 566</span>&#160; l2capoutbuf[36] = 0x19;</div>
<div class="line"><a name="l00567"></a><span class="lineno"> 567</span>&#160; l2capoutbuf[37] = 0x01;</div>
<div class="line"><a name="l00568"></a><span class="lineno"> 568</span>&#160; l2capoutbuf[38] = 0x00;</div>
<div class="line"><a name="l00569"></a><span class="lineno"> 569</span>&#160; l2capoutbuf[39] = 0x35;</div>
<div class="line"><a name="l00570"></a><span class="lineno"> 570</span>&#160; l2capoutbuf[40] = 0x05;</div>
<div class="line"><a name="l00571"></a><span class="lineno"> 571</span>&#160; l2capoutbuf[41] = 0x19;</div>
<div class="line"><a name="l00572"></a><span class="lineno"> 572</span>&#160; l2capoutbuf[42] = 0x00;</div>
<div class="line"><a name="l00573"></a><span class="lineno"> 573</span>&#160; l2capoutbuf[43] = 0x03;</div>
<div class="line"><a name="l00574"></a><span class="lineno"> 574</span>&#160; </div>
<div class="line"><a name="l00575"></a><span class="lineno"> 575</span>&#160; l2capoutbuf[44] = 0x08;</div>
<div class="line"><a name="l00576"></a><span class="lineno"> 576</span>&#160; l2capoutbuf[45] = 0x02; <span class="comment">// Two extra bytes</span></div>
<div class="line"><a name="l00577"></a><span class="lineno"> 577</span>&#160; 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>&#160; l2capoutbuf[47] = 0x19; </div>
<div class="line"><a name="l00579"></a><span class="lineno"> 579</span>&#160; </div>
<div class="line"><a name="l00580"></a><span class="lineno"> 580</span>&#160; SDP_Command(l2capoutbuf,48); </div>
<div class="line"><a name="l00581"></a><span class="lineno"> 581</span>&#160;}</div>
<div class="line"><a name="l00582"></a><span class="lineno"> 582</span>&#160;<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>&#160; 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>&#160; l2capoutbuf[1] = transactionIDHigh;</div>
<div class="line"><a name="l00585"></a><span class="lineno"> 585</span>&#160; l2capoutbuf[2] = transactionIDLow;</div>
<div class="line"><a name="l00586"></a><span class="lineno"> 586</span>&#160; l2capoutbuf[3] = 0x00; <span class="comment">// Parameter Length</span></div>
<div class="line"><a name="l00587"></a><span class="lineno"> 587</span>&#160; l2capoutbuf[4] = 0x1C; <span class="comment">// Parameter Length</span></div>
<div class="line"><a name="l00588"></a><span class="lineno"> 588</span>&#160; l2capoutbuf[5] = 0x00; <span class="comment">// AttributeListsByteCount</span></div>
<div class="line"><a name="l00589"></a><span class="lineno"> 589</span>&#160; l2capoutbuf[6] = 0x19; <span class="comment">// AttributeListsByteCount</span></div>
<div class="line"><a name="l00590"></a><span class="lineno"> 590</span>&#160; </div>
<div class="line"><a name="l00591"></a><span class="lineno"> 591</span>&#160; <span class="comment">/* Attribute ID/Value Sequence: */</span></div>
<div class="line"><a name="l00592"></a><span class="lineno"> 592</span>&#160; l2capoutbuf[7] = 0x01;</div>
<div class="line"><a name="l00593"></a><span class="lineno"> 593</span>&#160; l2capoutbuf[8] = 0x09;</div>
<div class="line"><a name="l00594"></a><span class="lineno"> 594</span>&#160; l2capoutbuf[9] = 0x00;</div>
<div class="line"><a name="l00595"></a><span class="lineno"> 595</span>&#160; l2capoutbuf[10] = 0x06;</div>
<div class="line"><a name="l00596"></a><span class="lineno"> 596</span>&#160; l2capoutbuf[11] = 0x35;</div>
<div class="line"><a name="l00597"></a><span class="lineno"> 597</span>&#160; </div>
<div class="line"><a name="l00598"></a><span class="lineno"> 598</span>&#160; l2capoutbuf[12] = 0x09;</div>
<div class="line"><a name="l00599"></a><span class="lineno"> 599</span>&#160; l2capoutbuf[13] = 0x09;</div>
<div class="line"><a name="l00600"></a><span class="lineno"> 600</span>&#160; l2capoutbuf[14] = 0x65;</div>
<div class="line"><a name="l00601"></a><span class="lineno"> 601</span>&#160; l2capoutbuf[15] = 0x6E;</div>
<div class="line"><a name="l00602"></a><span class="lineno"> 602</span>&#160; l2capoutbuf[16] = 0x09;</div>
<div class="line"><a name="l00603"></a><span class="lineno"> 603</span>&#160; l2capoutbuf[17] = 0x00;</div>
<div class="line"><a name="l00604"></a><span class="lineno"> 604</span>&#160; l2capoutbuf[18] = 0x6A;</div>
<div class="line"><a name="l00605"></a><span class="lineno"> 605</span>&#160; l2capoutbuf[19] = 0x09;</div>
<div class="line"><a name="l00606"></a><span class="lineno"> 606</span>&#160; l2capoutbuf[20] = 0x01;</div>
<div class="line"><a name="l00607"></a><span class="lineno"> 607</span>&#160; l2capoutbuf[21] = 0x00;</div>
<div class="line"><a name="l00608"></a><span class="lineno"> 608</span>&#160; l2capoutbuf[22] = 0x09;</div>
<div class="line"><a name="l00609"></a><span class="lineno"> 609</span>&#160; l2capoutbuf[23] = 0x01;</div>
<div class="line"><a name="l00610"></a><span class="lineno"> 610</span>&#160; l2capoutbuf[24] = 0x00;</div>
<div class="line"><a name="l00611"></a><span class="lineno"> 611</span>&#160; l2capoutbuf[25] = 0x25;</div>
<div class="line"><a name="l00612"></a><span class="lineno"> 612</span>&#160;</div>
<div class="line"><a name="l00613"></a><span class="lineno"> 613</span>&#160; l2capoutbuf[26] = 0x05; <span class="comment">// Name length </span></div>
<div class="line"><a name="l00614"></a><span class="lineno"> 614</span>&#160; l2capoutbuf[27] = <span class="charliteral">&#39;T&#39;</span>;</div>
<div class="line"><a name="l00615"></a><span class="lineno"> 615</span>&#160; l2capoutbuf[28] = <span class="charliteral">&#39;K&#39;</span>;</div>
<div class="line"><a name="l00616"></a><span class="lineno"> 616</span>&#160; l2capoutbuf[29] = <span class="charliteral">&#39;J&#39;</span>;</div>
<div class="line"><a name="l00617"></a><span class="lineno"> 617</span>&#160; l2capoutbuf[30] = <span class="charliteral">&#39;S&#39;</span>;</div>
<div class="line"><a name="l00618"></a><span class="lineno"> 618</span>&#160; l2capoutbuf[31] = <span class="charliteral">&#39;P&#39;</span>;</div>
<div class="line"><a name="l00619"></a><span class="lineno"> 619</span>&#160; l2capoutbuf[32] = 0x00; <span class="comment">// No more data</span></div>
<div class="line"><a name="l00620"></a><span class="lineno"> 620</span>&#160;</div>
<div class="line"><a name="l00621"></a><span class="lineno"> 621</span>&#160; SDP_Command(l2capoutbuf,33);</div>
<div class="line"><a name="l00622"></a><span class="lineno"> 622</span>&#160;}</div>
<div class="line"><a name="l00623"></a><span class="lineno"> 623</span>&#160;<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>&#160; 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>&#160;}</div>
<div class="line"><a name="l00626"></a><span class="lineno"> 626</span>&#160;<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>&#160; serialPortResponse2(transactionIDHigh,transactionIDLow); <span class="comment">// Same data as serialPortResponse2 </span></div>
<div class="line"><a name="l00628"></a><span class="lineno"> 628</span>&#160;}</div>
<div class="line"><a name="l00629"></a><span class="lineno"> 629</span>&#160;<span class="comment">/************************************************************/</span></div>
<div class="line"><a name="l00630"></a><span class="lineno"> 630</span>&#160;<span class="comment">/* RFCOMM Commands */</span></div>
<div class="line"><a name="l00631"></a><span class="lineno"> 631</span>&#160;<span class="comment">/************************************************************/</span></div>
<div class="line"><a name="l00632"></a><span class="lineno"> 632</span>&#160;<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>&#160; <span class="keywordflow">if</span> ((millis() - printTimer) &lt; 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>&#160; 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>&#160; pBtd-&gt;<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>&#160; printTimer = millis();</div>
<div class="line"><a name="l00637"></a><span class="lineno"> 637</span>&#160;}</div>
<div class="line"><a name="l00638"></a><span class="lineno"> 638</span>&#160;</div>
<div class="line"><a name="l00639"></a><span class="lineno"> 639</span>&#160;<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>&#160; 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>&#160; l2capoutbuf[1] = channelType | pfBit; <span class="comment">// RFCOMM Control</span></div>
<div class="line"><a name="l00642"></a><span class="lineno"> 642</span>&#160; l2capoutbuf[2] = length &lt;&lt; 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>&#160; uint8_t i = 0;</div>
<div class="line"><a name="l00644"></a><span class="lineno"> 644</span>&#160; <span class="keywordflow">for</span>(; i &lt; length; i++)</div>
<div class="line"><a name="l00645"></a><span class="lineno"> 645</span>&#160; l2capoutbuf[i+3] = data[i];</div>
<div class="line"><a name="l00646"></a><span class="lineno"> 646</span>&#160; l2capoutbuf[i+3] = calcFcs(l2capoutbuf);</div>
<div class="line"><a name="l00647"></a><span class="lineno"> 647</span>&#160;<span class="preprocessor">#ifdef EXTRADEBUG</span></div>
<div class="line"><a name="l00648"></a><span class="lineno"> 648</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; - RFCOMM Data: &quot;</span>));</div>
<div class="line"><a name="l00649"></a><span class="lineno"> 649</span>&#160; <span class="keywordflow">for</span>(i = 0; i &lt; length+4; i++) {</div>
<div class="line"><a name="l00650"></a><span class="lineno"> 650</span>&#160; Serial.print(l2capoutbuf[i],HEX);</div>
<div class="line"><a name="l00651"></a><span class="lineno"> 651</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>));</div>
<div class="line"><a name="l00652"></a><span class="lineno"> 652</span>&#160; }</div>
<div class="line"><a name="l00653"></a><span class="lineno"> 653</span>&#160;<span class="preprocessor">#endif </span></div>
<div class="line"><a name="l00654"></a><span class="lineno"> 654</span>&#160;<span class="preprocessor"></span> RFCOMM_Command(l2capoutbuf,length+4);</div>
<div class="line"><a name="l00655"></a><span class="lineno"> 655</span>&#160;} </div>
<div class="line"><a name="l00656"></a><span class="lineno"> 656</span>&#160;</div>
<div class="line"><a name="l00657"></a><span class="lineno"> 657</span>&#160;<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>&#160; 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>&#160; l2capoutbuf[1] = channelType | pfBit; <span class="comment">// RFCOMM Control</span></div>
<div class="line"><a name="l00660"></a><span class="lineno"> 660</span>&#160; l2capoutbuf[2] = 0x01; <span class="comment">// Length = 0</span></div>
<div class="line"><a name="l00661"></a><span class="lineno"> 661</span>&#160; l2capoutbuf[3] = credit; <span class="comment">// Credit</span></div>
<div class="line"><a name="l00662"></a><span class="lineno"> 662</span>&#160; l2capoutbuf[4] = calcFcs(l2capoutbuf); </div>
<div class="line"><a name="l00663"></a><span class="lineno"> 663</span>&#160;<span class="preprocessor">#ifdef EXTRADEBUG</span></div>
<div class="line"><a name="l00664"></a><span class="lineno"> 664</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; - RFCOMM Credit Data: &quot;</span>));</div>
<div class="line"><a name="l00665"></a><span class="lineno"> 665</span>&#160; <span class="keywordflow">for</span>(uint8_t i = 0; i &lt; 5; i++) {</div>
<div class="line"><a name="l00666"></a><span class="lineno"> 666</span>&#160; Serial.print(l2capoutbuf[i],HEX);</div>
<div class="line"><a name="l00667"></a><span class="lineno"> 667</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>));</div>
<div class="line"><a name="l00668"></a><span class="lineno"> 668</span>&#160; }</div>
<div class="line"><a name="l00669"></a><span class="lineno"> 669</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00670"></a><span class="lineno"> 670</span>&#160;<span class="preprocessor"></span> RFCOMM_Command(l2capoutbuf,5);</div>
<div class="line"><a name="l00671"></a><span class="lineno"> 671</span>&#160;}</div>
<div class="line"><a name="l00672"></a><span class="lineno"> 672</span>&#160;</div>
<div class="line"><a name="l00673"></a><span class="lineno"> 673</span>&#160;<span class="comment">/* CRC on 2 bytes */</span></div>
<div class="line"><a name="l00674"></a><span class="lineno"> 674</span>&#160;uint8_t SPP::__crc(uint8_t* data) {</div>
<div class="line"><a name="l00675"></a><span class="lineno"> 675</span>&#160; <span class="keywordflow">return</span>(pgm_read_byte(&amp;rfcomm_crc_table[pgm_read_byte(&amp;rfcomm_crc_table[0xff ^ data[0]]) ^ data[1]]));</div>
<div class="line"><a name="l00676"></a><span class="lineno"> 676</span>&#160;}</div>
<div class="line"><a name="l00677"></a><span class="lineno"> 677</span>&#160;</div>
<div class="line"><a name="l00678"></a><span class="lineno"> 678</span>&#160;<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>&#160;uint8_t SPP::calcFcs(uint8_t *data) {</div>
<div class="line"><a name="l00680"></a><span class="lineno"> 680</span>&#160; <span class="keywordflow">if</span>((data[1] &amp; 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>&#160; <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>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l00683"></a><span class="lineno"> 683</span>&#160; <span class="keywordflow">return</span> (0xff - pgm_read_byte(&amp;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>&#160;}</div>
<div class="line"><a name="l00685"></a><span class="lineno"> 685</span>&#160;</div>
<div class="line"><a name="l00686"></a><span class="lineno"> 686</span>&#160;<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>&#160;<span class="keywordtype">void</span> <a class="code" href="class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36">SPP::print</a>(<span class="keyword">const</span> String &amp;str) {</div>
<div class="line"><a name="l00688"></a><span class="lineno"> 688</span>&#160; <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>&#160; <span class="keywordflow">return</span>;</div>
<div class="line"><a name="l00690"></a><span class="lineno"> 690</span>&#160; uint8_t length = str.length();</div>
<div class="line"><a name="l00691"></a><span class="lineno"> 691</span>&#160; <span class="keywordflow">if</span>(length &gt; (<span class="keyword">sizeof</span>(l2capoutbuf)-4))</div>
<div class="line"><a name="l00692"></a><span class="lineno"> 692</span>&#160; length = <span class="keyword">sizeof</span>(l2capoutbuf)-4;</div>
<div class="line"><a name="l00693"></a><span class="lineno"> 693</span>&#160; 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>&#160; 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>&#160; l2capoutbuf[2] = length &lt;&lt; 1 | 1; <span class="comment">// Length</span></div>
<div class="line"><a name="l00696"></a><span class="lineno"> 696</span>&#160; uint8_t i = 0; </div>
<div class="line"><a name="l00697"></a><span class="lineno"> 697</span>&#160; <span class="keywordflow">for</span>(; i &lt; length; i++)</div>
<div class="line"><a name="l00698"></a><span class="lineno"> 698</span>&#160; l2capoutbuf[i+3] = str[i];</div>
<div class="line"><a name="l00699"></a><span class="lineno"> 699</span>&#160; l2capoutbuf[i+3] = calcFcs(l2capoutbuf);</div>
<div class="line"><a name="l00700"></a><span class="lineno"> 700</span>&#160; </div>
<div class="line"><a name="l00701"></a><span class="lineno"> 701</span>&#160; RFCOMM_Command(l2capoutbuf,length+4);</div>
<div class="line"><a name="l00702"></a><span class="lineno"> 702</span>&#160;}</div>
<div class="line"><a name="l00703"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a2632bccbdd58b98c483a85e5474fd053"> 703</a></span>&#160;<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>&#160; <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>&#160; <span class="keywordflow">return</span>;</div>
<div class="line"><a name="l00706"></a><span class="lineno"> 706</span>&#160; uint8_t length = strlen(str);</div>
<div class="line"><a name="l00707"></a><span class="lineno"> 707</span>&#160; <span class="keywordflow">if</span>(length &gt; (<span class="keyword">sizeof</span>(l2capoutbuf)-4))</div>
<div class="line"><a name="l00708"></a><span class="lineno"> 708</span>&#160; length = <span class="keyword">sizeof</span>(l2capoutbuf)-4;</div>
<div class="line"><a name="l00709"></a><span class="lineno"> 709</span>&#160; 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>&#160; 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>&#160; l2capoutbuf[2] = length &lt;&lt; 1 | 1; <span class="comment">// Length</span></div>
<div class="line"><a name="l00712"></a><span class="lineno"> 712</span>&#160; uint8_t i = 0;</div>
<div class="line"><a name="l00713"></a><span class="lineno"> 713</span>&#160; <span class="keywordflow">for</span>(; i &lt; length; i++)</div>
<div class="line"><a name="l00714"></a><span class="lineno"> 714</span>&#160; l2capoutbuf[i+3] = str[i]; </div>
<div class="line"><a name="l00715"></a><span class="lineno"> 715</span>&#160; l2capoutbuf[i+3] = calcFcs(l2capoutbuf); </div>
<div class="line"><a name="l00716"></a><span class="lineno"> 716</span>&#160; </div>
<div class="line"><a name="l00717"></a><span class="lineno"> 717</span>&#160; RFCOMM_Command(l2capoutbuf,length+4);</div>
<div class="line"><a name="l00718"></a><span class="lineno"> 718</span>&#160;}</div>
<div class="line"><a name="l00719"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a6bf2176a1fd3772e2c903eee680307b4"> 719</a></span>&#160;<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>&#160; <a class="code" href="class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36">print</a>(&amp;data,1);</div>
<div class="line"><a name="l00721"></a><span class="lineno"> 721</span>&#160;}</div>
<div class="line"><a name="l00722"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a29784e177ce4ea9ee3e155d1a39cf3fa"> 722</a></span>&#160;<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>&#160; <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>&#160; <span class="keywordflow">return</span>;</div>
<div class="line"><a name="l00725"></a><span class="lineno"> 725</span>&#160; <span class="keywordflow">if</span>(length &gt; (<span class="keyword">sizeof</span>(l2capoutbuf)-4))</div>
<div class="line"><a name="l00726"></a><span class="lineno"> 726</span>&#160; length = <span class="keyword">sizeof</span>(l2capoutbuf)-4;</div>
<div class="line"><a name="l00727"></a><span class="lineno"> 727</span>&#160; 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>&#160; 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>&#160; l2capoutbuf[2] = length &lt;&lt; 1 | 1; <span class="comment">// Length</span></div>
<div class="line"><a name="l00730"></a><span class="lineno"> 730</span>&#160; uint8_t i = 0;</div>
<div class="line"><a name="l00731"></a><span class="lineno"> 731</span>&#160; <span class="keywordflow">for</span>(; i &lt; length; i++)</div>
<div class="line"><a name="l00732"></a><span class="lineno"> 732</span>&#160; l2capoutbuf[i+3] = array[i];</div>
<div class="line"><a name="l00733"></a><span class="lineno"> 733</span>&#160; l2capoutbuf[i+3] = calcFcs(l2capoutbuf);</div>
<div class="line"><a name="l00734"></a><span class="lineno"> 734</span>&#160; </div>
<div class="line"><a name="l00735"></a><span class="lineno"> 735</span>&#160; RFCOMM_Command(l2capoutbuf,length+4);</div>
<div class="line"><a name="l00736"></a><span class="lineno"> 736</span>&#160;}</div>
<div class="line"><a name="l00737"></a><span class="lineno"><a class="code" href="class_s_p_p.html#aa534ca2960b81635c9ef00baaa04b37c"> 737</a></span>&#160;<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>
<div class="line"><a name="l00738"></a><span class="lineno"> 738</span>&#160; <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>&#160; <span class="keywordtype">size_t</span> size = 0;</div>
<div class="line"><a name="l00740"></a><span class="lineno"> 740</span>&#160; <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>&#160; uint8_t c = pgm_read_byte(p+size);</div>
<div class="line"><a name="l00742"></a><span class="lineno"> 742</span>&#160; <span class="keywordflow">if</span> (c == 0)</div>
<div class="line"><a name="l00743"></a><span class="lineno"> 743</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00744"></a><span class="lineno"> 744</span>&#160; size++;</div>
<div class="line"><a name="l00745"></a><span class="lineno"> 745</span>&#160; }</div>
<div class="line"><a name="l00746"></a><span class="lineno"> 746</span>&#160; uint8_t buf[size];</div>
<div class="line"><a name="l00747"></a><span class="lineno"> 747</span>&#160; </div>
<div class="line"><a name="l00748"></a><span class="lineno"> 748</span>&#160; <span class="keywordflow">for</span>(uint8_t i = 0; i &lt; size; i++)</div>
<div class="line"><a name="l00749"></a><span class="lineno"> 749</span>&#160; buf[i] = pgm_read_byte(p++);</div>
<div class="line"><a name="l00750"></a><span class="lineno"> 750</span>&#160; </div>
<div class="line"><a name="l00751"></a><span class="lineno"> 751</span>&#160; <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>&#160;}</div>
<div class="line"><a name="l00753"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a8b2ce856e7431905451c3f45526e1b28"> 753</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_s_p_p.html#a4afe343fc15bba50507ab9205165b8dd">SPP::println</a>(<span class="keyword">const</span> String &amp;str) {</div>
<div class="line"><a name="l00754"></a><span class="lineno"> 754</span>&#160; String output = str + <span class="stringliteral">&quot;\r\n&quot;</span>;</div>
<div class="line"><a name="l00755"></a><span class="lineno"> 755</span>&#160; <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>&#160;}</div>
<div class="line"><a name="l00757"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a8f39d99ed5299a38f86b2c2376ddfdc4"> 757</a></span>&#160;<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>&#160; <span class="keywordtype">char</span> output[strlen(str)+3];</div>
<div class="line"><a name="l00759"></a><span class="lineno"> 759</span>&#160; strcpy(output,str);</div>
<div class="line"><a name="l00760"></a><span class="lineno"> 760</span>&#160; strcat(output,<span class="stringliteral">&quot;\r\n&quot;</span>);</div>
<div class="line"><a name="l00761"></a><span class="lineno"> 761</span>&#160; <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>&#160;}</div>
<div class="line"><a name="l00763"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a627a6371ed4f9c251fe0dd4e1b867a2f"> 763</a></span>&#160;<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>&#160; uint8_t buf[3] = {data, <span class="charliteral">&#39;\r&#39;</span>, <span class="charliteral">&#39;\n&#39;</span>};</div>
<div class="line"><a name="l00765"></a><span class="lineno"> 765</span>&#160; <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>&#160;}</div>
<div class="line"><a name="l00767"></a><span class="lineno"><a class="code" href="class_s_p_p.html#aec05fbfff82d2a386a7064254833ce64"> 767</a></span>&#160;<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>&#160; uint8_t buf[length+2];</div>
<div class="line"><a name="l00769"></a><span class="lineno"> 769</span>&#160; memcpy(buf,array,length);</div>
<div class="line"><a name="l00770"></a><span class="lineno"> 770</span>&#160; buf[length] = <span class="charliteral">&#39;\r&#39;</span>;</div>
<div class="line"><a name="l00771"></a><span class="lineno"> 771</span>&#160; buf[length+1] = <span class="charliteral">&#39;\n&#39;</span>; </div>
<div class="line"><a name="l00772"></a><span class="lineno"> 772</span>&#160; <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>&#160;}</div>
<div class="line"><a name="l00774"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a53cae4e7a1a6208f348b9509dbe94d24"> 774</a></span>&#160;<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>
<div class="line"><a name="l00775"></a><span class="lineno"> 775</span>&#160; <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>&#160; <span class="keywordtype">size_t</span> size = 0;</div>
<div class="line"><a name="l00777"></a><span class="lineno"> 777</span>&#160; <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>&#160; uint8_t c = pgm_read_byte(p+size);</div>
<div class="line"><a name="l00779"></a><span class="lineno"> 779</span>&#160; <span class="keywordflow">if</span> (c == 0)</div>
<div class="line"><a name="l00780"></a><span class="lineno"> 780</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00781"></a><span class="lineno"> 781</span>&#160; size++;</div>
<div class="line"><a name="l00782"></a><span class="lineno"> 782</span>&#160; }</div>
<div class="line"><a name="l00783"></a><span class="lineno"> 783</span>&#160; uint8_t buf[size+2];</div>
<div class="line"><a name="l00784"></a><span class="lineno"> 784</span>&#160; </div>
<div class="line"><a name="l00785"></a><span class="lineno"> 785</span>&#160; <span class="keywordflow">for</span>(uint8_t i = 0; i &lt; size; i++)</div>
<div class="line"><a name="l00786"></a><span class="lineno"> 786</span>&#160; buf[i] = pgm_read_byte(p++);</div>
<div class="line"><a name="l00787"></a><span class="lineno"> 787</span>&#160; </div>
<div class="line"><a name="l00788"></a><span class="lineno"> 788</span>&#160; buf[size] = <span class="charliteral">&#39;\r&#39;</span>;</div>
<div class="line"><a name="l00789"></a><span class="lineno"> 789</span>&#160; buf[size+1] = <span class="charliteral">&#39;\n&#39;</span>;</div>
<div class="line"><a name="l00790"></a><span class="lineno"> 790</span>&#160; <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>&#160;}</div>
<div class="line"><a name="l00792"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a4afe343fc15bba50507ab9205165b8dd"> 792</a></span>&#160;<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>&#160; uint8_t buf[2] = {<span class="charliteral">&#39;\r&#39;</span>,<span class="charliteral">&#39;\n&#39;</span>};</div>
<div class="line"><a name="l00794"></a><span class="lineno"> 794</span>&#160; <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>&#160;}</div>
<div class="line"><a name="l00796"></a><span class="lineno"> 796</span>&#160;</div>
<div class="line"><a name="l00797"></a><span class="lineno"> 797</span>&#160;<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>&#160;<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>&#160; <span class="keywordtype">bool</span> negative = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00800"></a><span class="lineno"> 800</span>&#160; <span class="keywordflow">if</span>(n &lt; 0) {</div>
<div class="line"><a name="l00801"></a><span class="lineno"> 801</span>&#160; negative = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00802"></a><span class="lineno"> 802</span>&#160; n = -n;</div>
<div class="line"><a name="l00803"></a><span class="lineno"> 803</span>&#160; } </div>
<div class="line"><a name="l00804"></a><span class="lineno"> 804</span>&#160; uint32_t temp = n;</div>
<div class="line"><a name="l00805"></a><span class="lineno"> 805</span>&#160; uint8_t digits = 0;</div>
<div class="line"><a name="l00806"></a><span class="lineno"> 806</span>&#160; <span class="keywordflow">while</span> (temp) {</div>
<div class="line"><a name="l00807"></a><span class="lineno"> 807</span>&#160; temp /= 10;</div>
<div class="line"><a name="l00808"></a><span class="lineno"> 808</span>&#160; digits++;</div>
<div class="line"><a name="l00809"></a><span class="lineno"> 809</span>&#160; } </div>
<div class="line"><a name="l00810"></a><span class="lineno"> 810</span>&#160; <span class="keywordflow">if</span>(digits == 0)</div>
<div class="line"><a name="l00811"></a><span class="lineno"> 811</span>&#160; <a class="code" href="class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36">print</a>(<span class="stringliteral">&quot;0&quot;</span>);</div>
<div class="line"><a name="l00812"></a><span class="lineno"> 812</span>&#160; <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00813"></a><span class="lineno"> 813</span>&#160; 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>&#160; <span class="keywordflow">for</span>(uint8_t i = 1; i &lt; digits+1; i++) {</div>
<div class="line"><a name="l00815"></a><span class="lineno"> 815</span>&#160; <span class="keywordflow">if</span>(negative)</div>
<div class="line"><a name="l00816"></a><span class="lineno"> 816</span>&#160; buf[digits-i+1] = n%10 + <span class="charliteral">&#39;0&#39;</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>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l00818"></a><span class="lineno"> 818</span>&#160; buf[digits-i] = n%10 + <span class="charliteral">&#39;0&#39;</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>&#160; n /= 10;</div>
<div class="line"><a name="l00820"></a><span class="lineno"> 820</span>&#160; }</div>
<div class="line"><a name="l00821"></a><span class="lineno"> 821</span>&#160; <span class="keywordflow">if</span>(negative) {</div>
<div class="line"><a name="l00822"></a><span class="lineno"> 822</span>&#160; buf[0] = <span class="charliteral">&#39;-&#39;</span>; </div>
<div class="line"><a name="l00823"></a><span class="lineno"> 823</span>&#160; <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>&#160; } <span class="keywordflow">else</span></div>
<div class="line"><a name="l00825"></a><span class="lineno"> 825</span>&#160; <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>&#160; }</div>
<div class="line"><a name="l00827"></a><span class="lineno"> 827</span>&#160;}</div>
<div class="line"><a name="l00828"></a><span class="lineno"><a class="code" href="class_s_p_p.html#ac3a2e5fa45ba0fe17d3341998a6c4640"> 828</a></span>&#160;<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>&#160; <span class="keywordtype">bool</span> negative = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00830"></a><span class="lineno"> 830</span>&#160; <span class="keywordflow">if</span>(n &lt; 0) {</div>
<div class="line"><a name="l00831"></a><span class="lineno"> 831</span>&#160; negative = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00832"></a><span class="lineno"> 832</span>&#160; n = -n;</div>
<div class="line"><a name="l00833"></a><span class="lineno"> 833</span>&#160; }</div>
<div class="line"><a name="l00834"></a><span class="lineno"> 834</span>&#160; uint32_t temp = n;</div>
<div class="line"><a name="l00835"></a><span class="lineno"> 835</span>&#160; uint8_t digits = 0;</div>
<div class="line"><a name="l00836"></a><span class="lineno"> 836</span>&#160; <span class="keywordflow">while</span> (temp) {</div>
<div class="line"><a name="l00837"></a><span class="lineno"> 837</span>&#160; temp /= 10;</div>
<div class="line"><a name="l00838"></a><span class="lineno"> 838</span>&#160; digits++;</div>
<div class="line"><a name="l00839"></a><span class="lineno"> 839</span>&#160; }</div>
<div class="line"><a name="l00840"></a><span class="lineno"> 840</span>&#160; <span class="keywordflow">if</span>(digits == 0)</div>
<div class="line"><a name="l00841"></a><span class="lineno"> 841</span>&#160; <a class="code" href="class_s_p_p.html#acbea2d8894757fad6f9b903cad942b36">print</a>(<span class="stringliteral">&quot;0\r\n&quot;</span>);</div>
<div class="line"><a name="l00842"></a><span class="lineno"> 842</span>&#160; <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00843"></a><span class="lineno"> 843</span>&#160; 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>&#160; <span class="keywordflow">for</span>(uint8_t i = 1; i &lt; digits+1; i++) {</div>
<div class="line"><a name="l00845"></a><span class="lineno"> 845</span>&#160; <span class="keywordflow">if</span>(negative)</div>
<div class="line"><a name="l00846"></a><span class="lineno"> 846</span>&#160; buf[digits-i+1] = n%10 + <span class="charliteral">&#39;0&#39;</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>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l00848"></a><span class="lineno"> 848</span>&#160; buf[digits-i] = n%10 + <span class="charliteral">&#39;0&#39;</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>&#160; n /= 10;</div>
<div class="line"><a name="l00850"></a><span class="lineno"> 850</span>&#160; } </div>
<div class="line"><a name="l00851"></a><span class="lineno"> 851</span>&#160; <span class="keywordflow">if</span>(negative) {</div>
<div class="line"><a name="l00852"></a><span class="lineno"> 852</span>&#160; buf[0] = <span class="charliteral">&#39;-&#39;</span>;</div>
<div class="line"><a name="l00853"></a><span class="lineno"> 853</span>&#160; buf[digits+1] = <span class="charliteral">&#39;\r&#39;</span>;</div>
<div class="line"><a name="l00854"></a><span class="lineno"> 854</span>&#160; buf[digits+2] = <span class="charliteral">&#39;\n&#39;</span>;</div>
<div class="line"><a name="l00855"></a><span class="lineno"> 855</span>&#160; <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>&#160; } <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00857"></a><span class="lineno"> 857</span>&#160; buf[digits] = <span class="charliteral">&#39;\r&#39;</span>;</div>
<div class="line"><a name="l00858"></a><span class="lineno"> 858</span>&#160; buf[digits+1] = <span class="charliteral">&#39;\n&#39;</span>;</div>
<div class="line"><a name="l00859"></a><span class="lineno"> 859</span>&#160; <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>&#160; }</div>
<div class="line"><a name="l00861"></a><span class="lineno"> 861</span>&#160; }</div>
<div class="line"><a name="l00862"></a><span class="lineno"> 862</span>&#160;}</div>
<div class="line"><a name="l00863"></a><span class="lineno"><a class="code" href="class_s_p_p.html#ae7938394e271e0cec64aae6f534eae69"> 863</a></span>&#160;<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>&#160; <span class="keywordtype">char</span> output[10];</div>
<div class="line"><a name="l00865"></a><span class="lineno"> 865</span>&#160; <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>&#160; <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>&#160;}</div>
<div class="line"><a name="l00868"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a2cdc30f2314dbd572b8432972469bb25"> 868</a></span>&#160;<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>&#160; <span class="keywordtype">char</span> buf[10];</div>
<div class="line"><a name="l00870"></a><span class="lineno"> 870</span>&#160; <span class="keywordtype">char</span> output[12];</div>
<div class="line"><a name="l00871"></a><span class="lineno"> 871</span>&#160; <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>&#160; strcpy(output,buf);</div>
<div class="line"><a name="l00873"></a><span class="lineno"> 873</span>&#160; strcat(output,<span class="stringliteral">&quot;\r\n&quot;</span>);</div>
<div class="line"><a name="l00874"></a><span class="lineno"> 874</span>&#160; <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>&#160;}</div>
<div class="line"><a name="l00876"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a3117df8f320d9d010b57c30255db054b"> 876</a></span>&#160;<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>&#160; <span class="keywordtype">char</span> buffer[10];</div>
<div class="line"><a name="l00878"></a><span class="lineno"> 878</span>&#160; <span class="keywordflow">if</span>(input &lt; 0) {</div>
<div class="line"><a name="l00879"></a><span class="lineno"> 879</span>&#160; strcpy(output,<span class="stringliteral">&quot;-&quot;</span>);</div>
<div class="line"><a name="l00880"></a><span class="lineno"> 880</span>&#160; input = -input;</div>
<div class="line"><a name="l00881"></a><span class="lineno"> 881</span>&#160; }</div>
<div class="line"><a name="l00882"></a><span class="lineno"> 882</span>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l00883"></a><span class="lineno"> 883</span>&#160; strcpy(output,<span class="stringliteral">&quot;&quot;</span>);</div>
<div class="line"><a name="l00884"></a><span class="lineno"> 884</span>&#160; </div>
<div class="line"><a name="l00885"></a><span class="lineno"> 885</span>&#160; <span class="comment">// Round correctly</span></div>
<div class="line"><a name="l00886"></a><span class="lineno"> 886</span>&#160; <span class="keywordtype">double</span> rounding = 0.5;</div>
<div class="line"><a name="l00887"></a><span class="lineno"> 887</span>&#160; <span class="keywordflow">for</span> (uint8_t i=0; i&lt;digits; i++)</div>
<div class="line"><a name="l00888"></a><span class="lineno"> 888</span>&#160; rounding /= 10.0;</div>
<div class="line"><a name="l00889"></a><span class="lineno"> 889</span>&#160; input += rounding;</div>
<div class="line"><a name="l00890"></a><span class="lineno"> 890</span>&#160; </div>
<div class="line"><a name="l00891"></a><span class="lineno"> 891</span>&#160; <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>&#160; itoa(intpart,buffer,10); <span class="comment">// Convert to string</span></div>
<div class="line"><a name="l00893"></a><span class="lineno"> 893</span>&#160; strcat(output,buffer);</div>
<div class="line"><a name="l00894"></a><span class="lineno"> 894</span>&#160; strcat(output,<span class="stringliteral">&quot;.&quot;</span>);</div>
<div class="line"><a name="l00895"></a><span class="lineno"> 895</span>&#160; <span class="keywordtype">double</span> fractpart = (input-(double)intpart);</div>
<div class="line"><a name="l00896"></a><span class="lineno"> 896</span>&#160; fractpart *= pow(10,digits);</div>
<div class="line"><a name="l00897"></a><span class="lineno"> 897</span>&#160; <span class="keywordflow">for</span>(uint8_t i=1;i&lt;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>&#160; <span class="keywordflow">if</span>(fractpart &lt; pow(10,digits-i)) {</div>
<div class="line"><a name="l00899"></a><span class="lineno"> 899</span>&#160; strcat(output,<span class="stringliteral">&quot;0&quot;</span>);</div>
<div class="line"><a name="l00900"></a><span class="lineno"> 900</span>&#160; }</div>
<div class="line"><a name="l00901"></a><span class="lineno"> 901</span>&#160; }</div>
<div class="line"><a name="l00902"></a><span class="lineno"> 902</span>&#160; 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>&#160; strcat(output,buffer);</div>
<div class="line"><a name="l00904"></a><span class="lineno"> 904</span>&#160;}</div>
<div class="line"><a name="l00905"></a><span class="lineno"> 905</span>&#160;</div>
<div class="line"><a name="l00906"></a><span class="lineno"><a class="code" href="class_s_p_p.html#a53980e0d20944454790febe5c9be66af"> 906</a></span>&#160;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>&#160; <span class="keywordflow">if</span>(rfcommAvailable == 0) <span class="comment">// Don&#39;t read if there is nothing in the buffer</span></div>
<div class="line"><a name="l00908"></a><span class="lineno"> 908</span>&#160; <span class="keywordflow">return</span> 0;</div>
<div class="line"><a name="l00909"></a><span class="lineno"> 909</span>&#160; uint8_t output = rfcommDataBuffer[0];</div>
<div class="line"><a name="l00910"></a><span class="lineno"> 910</span>&#160; <span class="keywordflow">for</span>(uint8_t i = 1; i &lt; rfcommAvailable; i++)</div>
<div class="line"><a name="l00911"></a><span class="lineno"> 911</span>&#160; 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>&#160; rfcommAvailable--;</div>
<div class="line"><a name="l00913"></a><span class="lineno"> 913</span>&#160; bytesRead++;</div>
<div class="line"><a name="l00914"></a><span class="lineno"> 914</span>&#160; <span class="keywordflow">if</span>(bytesRead &gt; (<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>&#160; bytesRead = 0;</div>
<div class="line"><a name="l00916"></a><span class="lineno"> 916</span>&#160; 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>&#160;<span class="preprocessor">#ifdef EXTRADEBUG</span></div>
<div class="line"><a name="l00918"></a><span class="lineno"> 918</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSent &quot;</span>));</div>
<div class="line"><a name="l00919"></a><span class="lineno"> 919</span>&#160; Serial.print(<span class="keyword">sizeof</span>(rfcommDataBuffer));</div>
<div class="line"><a name="l00920"></a><span class="lineno"> 920</span>&#160; <a class="code" href="message_8cpp.html#a968335d1c8fd7b45c95634e0828411be">Notify</a>(PSTR(<span class="stringliteral">&quot; more credit&quot;</span>));</div>
<div class="line"><a name="l00921"></a><span class="lineno"> 921</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00922"></a><span class="lineno"> 922</span>&#160;<span class="preprocessor"></span> }</div>
<div class="line"><a name="l00923"></a><span class="lineno"> 923</span>&#160; <span class="keywordflow">return</span> output;</div>
<div class="line"><a name="l00924"></a><span class="lineno"> 924</span>&#160;}</div>
</div><!-- fragment --></div><!-- contents -->
<!-- start footer part -->
<hr class="footer"/><address class="footer"><small>
Generated by &#160;<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>