mirror of
https://github.com/felis/USB_Host_Shield_2.0.git
synced 2024-03-22 11:31:26 +01:00
1321 lines
229 KiB
HTML
1321 lines
229 KiB
HTML
<!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: BTD.cpp Source File</title>
|
|
<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"/>
|
|
</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
|
|
</div>
|
|
</td>
|
|
</tr>
|
|
</tbody>
|
|
</table>
|
|
</div>
|
|
<!-- end header part -->
|
|
<!-- Generated by Doxygen 1.8.3.1 -->
|
|
<script type="text/javascript">
|
|
var searchBox = new SearchBox("searchBox", "search",false,'Search');
|
|
</script>
|
|
<div id="navrow1" class="tabs">
|
|
<ul class="tablist">
|
|
<li><a href="index.html"><span>Main Page</span></a></li>
|
|
<li><a href="pages.html"><span>Related Pages</span></a></li>
|
|
<li><a href="annotated.html"><span>Classes</span></a></li>
|
|
<li class="current"><a href="files.html"><span>Files</span></a></li>
|
|
<li>
|
|
<div id="MSearchBox" class="MSearchBoxInactive">
|
|
<span class="left">
|
|
<img id="MSearchSelect" src="search/mag_sel.png"
|
|
onmouseover="return searchBox.OnSearchSelectShow()"
|
|
onmouseout="return searchBox.OnSearchSelectHide()"
|
|
alt=""/>
|
|
<input type="text" id="MSearchField" value="Search" accesskey="S"
|
|
onfocus="searchBox.OnSearchFieldFocus(true)"
|
|
onblur="searchBox.OnSearchFieldFocus(false)"
|
|
onkeyup="searchBox.OnSearchFieldChange(event)"/>
|
|
</span><span class="right">
|
|
<a id="MSearchClose" href="javascript:searchBox.CloseResultsWindow()"><img id="MSearchCloseImg" border="0" src="search/close.png" alt=""/></a>
|
|
</span>
|
|
</div>
|
|
</li>
|
|
</ul>
|
|
</div>
|
|
<div id="navrow2" class="tabs2">
|
|
<ul class="tablist">
|
|
<li><a href="files.html"><span>File List</span></a></li>
|
|
<li><a href="globals.html"><span>File Members</span></a></li>
|
|
</ul>
|
|
</div>
|
|
<!-- window showing the filter options -->
|
|
<div id="MSearchSelectWindow"
|
|
onmouseover="return searchBox.OnSearchSelectShow()"
|
|
onmouseout="return searchBox.OnSearchSelectHide()"
|
|
onkeydown="return searchBox.OnSearchSelectKey(event)">
|
|
<a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(0)"><span class="SelectionMark"> </span>All</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(1)"><span class="SelectionMark"> </span>Classes</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(2)"><span class="SelectionMark"> </span>Files</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(3)"><span class="SelectionMark"> </span>Functions</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(4)"><span class="SelectionMark"> </span>Variables</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(5)"><span class="SelectionMark"> </span>Typedefs</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(6)"><span class="SelectionMark"> </span>Enumerations</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(7)"><span class="SelectionMark"> </span>Enumerator</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(8)"><span class="SelectionMark"> </span>Macros</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(9)"><span class="SelectionMark"> </span>Pages</a></div>
|
|
|
|
<!-- iframe showing the search results (closed by default) -->
|
|
<div id="MSearchResultsWindow">
|
|
<iframe src="javascript:void(0)" frameborder="0"
|
|
name="MSearchResults" id="MSearchResults">
|
|
</iframe>
|
|
</div>
|
|
|
|
<div id="nav-path" class="navpath">
|
|
<ul>
|
|
<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>
|
|
</div>
|
|
</div><!-- top -->
|
|
<div class="header">
|
|
<div class="headertitle">
|
|
<div class="title">BTD.cpp</div> </div>
|
|
</div><!--header-->
|
|
<div class="contents">
|
|
<a href="_b_t_d_8cpp.html">Go to the documentation of this file.</a><div class="fragment"><div class="line"><a name="l00001"></a><span class="lineno"> 1</span> <span class="comment">/* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved.</span></div>
|
|
<div class="line"><a name="l00002"></a><span class="lineno"> 2</span> <span class="comment"></span></div>
|
|
<div class="line"><a name="l00003"></a><span class="lineno"> 3</span> <span class="comment"> This software may be distributed and modified under the terms of the GNU</span></div>
|
|
<div class="line"><a name="l00004"></a><span class="lineno"> 4</span> <span class="comment"> General Public License version 2 (GPL2) as published by the Free Software</span></div>
|
|
<div class="line"><a name="l00005"></a><span class="lineno"> 5</span> <span class="comment"> Foundation and appearing in the file GPL2.TXT included in the packaging of</span></div>
|
|
<div class="line"><a name="l00006"></a><span class="lineno"> 6</span> <span class="comment"> this file. Please note that GPL2 Section 2[b] requires that all works based</span></div>
|
|
<div class="line"><a name="l00007"></a><span class="lineno"> 7</span> <span class="comment"> on this software must also be made publicly available under the terms of</span></div>
|
|
<div class="line"><a name="l00008"></a><span class="lineno"> 8</span> <span class="comment"> the GPL2 ("Copyleft").</span></div>
|
|
<div class="line"><a name="l00009"></a><span class="lineno"> 9</span> <span class="comment"></span></div>
|
|
<div class="line"><a name="l00010"></a><span class="lineno"> 10</span> <span class="comment"> Contact information</span></div>
|
|
<div class="line"><a name="l00011"></a><span class="lineno"> 11</span> <span class="comment"> -------------------</span></div>
|
|
<div class="line"><a name="l00012"></a><span class="lineno"> 12</span> <span class="comment"></span></div>
|
|
<div class="line"><a name="l00013"></a><span class="lineno"> 13</span> <span class="comment"> Kristian Lauszus, TKJ Electronics</span></div>
|
|
<div class="line"><a name="l00014"></a><span class="lineno"> 14</span> <span class="comment"> Web : http://www.tkjelectronics.com</span></div>
|
|
<div class="line"><a name="l00015"></a><span class="lineno"> 15</span> <span class="comment"> e-mail : kristianl@tkjelectronics.com</span></div>
|
|
<div class="line"><a name="l00016"></a><span class="lineno"> 16</span> <span class="comment"> */</span></div>
|
|
<div class="line"><a name="l00017"></a><span class="lineno"> 17</span> </div>
|
|
<div class="line"><a name="l00018"></a><span class="lineno"> 18</span> <span class="preprocessor">#include "<a class="code" href="_b_t_d_8h.html">BTD.h</a>"</span></div>
|
|
<div class="line"><a name="l00019"></a><span class="lineno"><a class="code" href="_b_t_d_8cpp.html#ad72dbcf6d0153db1b8d8a58001feed83"> 19</a></span> <span class="preprocessor">#define DEBUG // Uncomment to print data for debugging</span></div>
|
|
<div class="line"><a name="l00020"></a><span class="lineno"> 20</span> <span class="preprocessor"></span><span class="comment">//#define EXTRADEBUG // Uncomment to get even more debugging data</span></div>
|
|
<div class="line"><a name="l00021"></a><span class="lineno"> 21</span> </div>
|
|
<div class="line"><a name="l00022"></a><span class="lineno"> 22</span> <span class="keyword">const</span> uint8_t <a class="code" href="class_b_t_d.html#a49f433ab824f259c3815e180c73bb0ad">BTD::BTD_CONTROL_PIPE</a> = 0;</div>
|
|
<div class="line"><a name="l00023"></a><span class="lineno"> 23</span> <span class="keyword">const</span> uint8_t <a class="code" href="class_b_t_d.html#a24166c9b308925eeb2f635fae43ca5ec">BTD::BTD_EVENT_PIPE</a> = 1;</div>
|
|
<div class="line"><a name="l00024"></a><span class="lineno"> 24</span> <span class="keyword">const</span> uint8_t <a class="code" href="class_b_t_d.html#a480510bd399ae74a97cd74c8474ef59c">BTD::BTD_DATAIN_PIPE</a> = 2;</div>
|
|
<div class="line"><a name="l00025"></a><span class="lineno"> 25</span> <span class="keyword">const</span> uint8_t <a class="code" href="class_b_t_d.html#a0d82870f7eef8c27c33e6f5989d7a4dd">BTD::BTD_DATAOUT_PIPE</a> = 3;</div>
|
|
<div class="line"><a name="l00026"></a><span class="lineno"> 26</span> </div>
|
|
<div class="line"><a name="l00027"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a5f07597fe15a2b917cce405fe87f2981"> 27</a></span> <a class="code" href="class_b_t_d.html#a5f07597fe15a2b917cce405fe87f2981">BTD::BTD</a>(<a class="code" href="class_u_s_b.html">USB</a> *p) :</div>
|
|
<div class="line"><a name="l00028"></a><span class="lineno"> 28</span> pUsb(p), <span class="comment">// Pointer to USB class instance - mandatory</span></div>
|
|
<div class="line"><a name="l00029"></a><span class="lineno"> 29</span> bAddress(0), <span class="comment">// Device address - mandatory</span></div>
|
|
<div class="line"><a name="l00030"></a><span class="lineno"> 30</span> bNumEP(1), <span class="comment">// If config descriptor needs to be parsed</span></div>
|
|
<div class="line"><a name="l00031"></a><span class="lineno"> 31</span> qNextPollTime(0), <span class="comment">// Reset NextPollTime</span></div>
|
|
<div class="line"><a name="l00032"></a><span class="lineno"> 32</span> bPollEnable(false) <span class="comment">// Don't start polling before dongle is connected</span></div>
|
|
<div class="line"><a name="l00033"></a><span class="lineno"> 33</span> {</div>
|
|
<div class="line"><a name="l00034"></a><span class="lineno"> 34</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < <a class="code" href="_b_t_d_8h.html#aee41c4878894db24e7ad8cd6246595cd">BTD_MAX_ENDPOINTS</a>; i++) {</div>
|
|
<div class="line"><a name="l00035"></a><span class="lineno"> 35</span>  <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[i].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a> = 0;</div>
|
|
<div class="line"><a name="l00036"></a><span class="lineno"> 36</span>  <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[i].<a class="code" href="struct_ep_info.html#aa2ca775b63736df4008e88da7dd4dddb">maxPktSize</a> = (i) ? 0 : 8;</div>
|
|
<div class="line"><a name="l00037"></a><span class="lineno"> 37</span>  <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[i].<a class="code" href="struct_ep_info.html#a1dea928517c961235eef7b0876e69f10">epAttribs</a> = 0;</div>
|
|
<div class="line"><a name="l00038"></a><span class="lineno"> 38</span>  <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[i].<a class="code" href="struct_ep_info.html#a3a5b1c017a034cd9e06e76729e727c46">bmNakPower</a> = (i) ? <a class="code" href="address_8h.html#a660e8da9c1167a8450aef91c5c03761d">USB_NAK_NOWAIT</a> : <a class="code" href="address_8h.html#a517dfa014946e2d087d197312234a1de">USB_NAK_MAX_POWER</a>;</div>
|
|
<div class="line"><a name="l00039"></a><span class="lineno"> 39</span>  }</div>
|
|
<div class="line"><a name="l00040"></a><span class="lineno"> 40</span> </div>
|
|
<div class="line"><a name="l00041"></a><span class="lineno"> 41</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>) <span class="comment">// register in USB subsystem</span></div>
|
|
<div class="line"><a name="l00042"></a><span class="lineno"> 42</span>  <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a3f66bf622590413ef2e1864f93a3e0d2">RegisterDeviceClass</a>(<span class="keyword">this</span>); <span class="comment">//set devConfig[] entry</span></div>
|
|
<div class="line"><a name="l00043"></a><span class="lineno"> 43</span> }</div>
|
|
<div class="line"><a name="l00044"></a><span class="lineno"> 44</span> </div>
|
|
<div class="line"><a name="l00045"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a48608619d8253972dd132edbb3001c5f"> 45</a></span> uint8_t <a class="code" href="class_b_t_d.html#a48608619d8253972dd132edbb3001c5f">BTD::Init</a>(uint8_t parent, uint8_t port, <span class="keywordtype">bool</span> lowspeed) {</div>
|
|
<div class="line"><a name="l00046"></a><span class="lineno"> 46</span>  uint8_t buf[<span class="keyword">sizeof</span> (<a class="code" href="struct_u_s_b___d_e_v_i_c_e___d_e_s_c_r_i_p_t_o_r.html">USB_DEVICE_DESCRIPTOR</a>)];</div>
|
|
<div class="line"><a name="l00047"></a><span class="lineno"> 47</span>  uint8_t rcode;</div>
|
|
<div class="line"><a name="l00048"></a><span class="lineno"> 48</span>  <a class="code" href="struct_usb_device.html">UsbDevice</a> *p = NULL;</div>
|
|
<div class="line"><a name="l00049"></a><span class="lineno"> 49</span>  <a class="code" href="struct_ep_info.html">EpInfo</a> *oldep_ptr = NULL;</div>
|
|
<div class="line"><a name="l00050"></a><span class="lineno"> 50</span>  uint8_t num_of_conf; <span class="comment">// number of configurations</span></div>
|
|
<div class="line"><a name="l00051"></a><span class="lineno"> 51</span>  uint16_t PID;</div>
|
|
<div class="line"><a name="l00052"></a><span class="lineno"> 52</span>  uint16_t VID;</div>
|
|
<div class="line"><a name="l00053"></a><span class="lineno"> 53</span> </div>
|
|
<div class="line"><a name="l00054"></a><span class="lineno"> 54</span>  <span class="comment">// get memory address of USB device address pool</span></div>
|
|
<div class="line"><a name="l00055"></a><span class="lineno"> 55</span>  <a class="code" href="class_address_pool.html">AddressPool</a> &addrPool = <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a66ab8f5eda239e761d5a48741ea1f9d4">GetAddressPool</a>();</div>
|
|
<div class="line"><a name="l00056"></a><span class="lineno"> 56</span> <span class="preprocessor">#ifdef EXTRADEBUG</span></div>
|
|
<div class="line"><a name="l00057"></a><span class="lineno"> 57</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nBTD Init"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00058"></a><span class="lineno"> 58</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00059"></a><span class="lineno"> 59</span> <span class="preprocessor"></span> <span class="comment">// check if address has already been assigned to an instance</span></div>
|
|
<div class="line"><a name="l00060"></a><span class="lineno"> 60</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a>) {</div>
|
|
<div class="line"><a name="l00061"></a><span class="lineno"> 61</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00062"></a><span class="lineno"> 62</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nAddress in use"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00063"></a><span class="lineno"> 63</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00064"></a><span class="lineno"> 64</span> <span class="preprocessor"></span> <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#a44416ff64fc0e3691f98addac13d4595">USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE</a>;</div>
|
|
<div class="line"><a name="l00065"></a><span class="lineno"> 65</span>  }</div>
|
|
<div class="line"><a name="l00066"></a><span class="lineno"> 66</span> </div>
|
|
<div class="line"><a name="l00067"></a><span class="lineno"> 67</span>  <span class="comment">// Get pointer to pseudo device with address 0 assigned</span></div>
|
|
<div class="line"><a name="l00068"></a><span class="lineno"> 68</span>  p = addrPool.<a class="code" href="class_address_pool.html#aa92d7e8f0f515340ae2dc1679b627056">GetUsbDevicePtr</a>(0);</div>
|
|
<div class="line"><a name="l00069"></a><span class="lineno"> 69</span> </div>
|
|
<div class="line"><a name="l00070"></a><span class="lineno"> 70</span>  <span class="keywordflow">if</span> (!p) {</div>
|
|
<div class="line"><a name="l00071"></a><span class="lineno"> 71</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00072"></a><span class="lineno"> 72</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nAddress not found"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00073"></a><span class="lineno"> 73</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00074"></a><span class="lineno"> 74</span> <span class="preprocessor"></span> <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#afe2fedb4b0ccc89a688c0b4b59691ce0">USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL</a>;</div>
|
|
<div class="line"><a name="l00075"></a><span class="lineno"> 75</span>  }</div>
|
|
<div class="line"><a name="l00076"></a><span class="lineno"> 76</span> </div>
|
|
<div class="line"><a name="l00077"></a><span class="lineno"> 77</span>  <span class="keywordflow">if</span> (!p-><a class="code" href="struct_usb_device.html#a410d39fb7758157f57794335e990ed02">epinfo</a>) {</div>
|
|
<div class="line"><a name="l00078"></a><span class="lineno"> 78</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00079"></a><span class="lineno"> 79</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nepinfo is null"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00080"></a><span class="lineno"> 80</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00081"></a><span class="lineno"> 81</span> <span class="preprocessor"></span> <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#af192c59cafe2192ad802b22e6dbc077d">USB_ERROR_EPINFO_IS_NULL</a>;</div>
|
|
<div class="line"><a name="l00082"></a><span class="lineno"> 82</span>  }</div>
|
|
<div class="line"><a name="l00083"></a><span class="lineno"> 83</span> </div>
|
|
<div class="line"><a name="l00084"></a><span class="lineno"> 84</span>  <span class="comment">// Save old pointer to EP_RECORD of address 0</span></div>
|
|
<div class="line"><a name="l00085"></a><span class="lineno"> 85</span>  oldep_ptr = p-><a class="code" href="struct_usb_device.html#a410d39fb7758157f57794335e990ed02">epinfo</a>;</div>
|
|
<div class="line"><a name="l00086"></a><span class="lineno"> 86</span> </div>
|
|
<div class="line"><a name="l00087"></a><span class="lineno"> 87</span>  <span class="comment">// Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence</span></div>
|
|
<div class="line"><a name="l00088"></a><span class="lineno"> 88</span>  p-><a class="code" href="struct_usb_device.html#a410d39fb7758157f57794335e990ed02">epinfo</a> = <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>;</div>
|
|
<div class="line"><a name="l00089"></a><span class="lineno"> 89</span> </div>
|
|
<div class="line"><a name="l00090"></a><span class="lineno"> 90</span>  p-><a class="code" href="struct_usb_device.html#a86a815577ad7883437d3ca72b32b8e8a">lowspeed</a> = lowspeed;</div>
|
|
<div class="line"><a name="l00091"></a><span class="lineno"> 91</span> </div>
|
|
<div class="line"><a name="l00092"></a><span class="lineno"> 92</span>  <span class="comment">// Get device descriptor</span></div>
|
|
<div class="line"><a name="l00093"></a><span class="lineno"> 93</span>  rcode = <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a193e63c149fad46adabd77ceb09b2b24" title="defined(USB_METHODS_INLINE)">getDevDescr</a>(0, 0, <span class="keyword">sizeof</span> (<a class="code" href="struct_u_s_b___d_e_v_i_c_e___d_e_s_c_r_i_p_t_o_r.html">USB_DEVICE_DESCRIPTOR</a>), (uint8_t*)buf); <span class="comment">// Get device descriptor - addr, ep, nbytes, data</span></div>
|
|
<div class="line"><a name="l00094"></a><span class="lineno"> 94</span> </div>
|
|
<div class="line"><a name="l00095"></a><span class="lineno"> 95</span>  <span class="comment">// Restore p->epinfo</span></div>
|
|
<div class="line"><a name="l00096"></a><span class="lineno"> 96</span>  p-><a class="code" href="struct_usb_device.html#a410d39fb7758157f57794335e990ed02">epinfo</a> = oldep_ptr;</div>
|
|
<div class="line"><a name="l00097"></a><span class="lineno"> 97</span> </div>
|
|
<div class="line"><a name="l00098"></a><span class="lineno"> 98</span>  <span class="keywordflow">if</span> (rcode)</div>
|
|
<div class="line"><a name="l00099"></a><span class="lineno"> 99</span>  <span class="keywordflow">goto</span> FailGetDevDescr;</div>
|
|
<div class="line"><a name="l00100"></a><span class="lineno"> 100</span> </div>
|
|
<div class="line"><a name="l00101"></a><span class="lineno"> 101</span>  <span class="comment">// Allocate new address according to device class</span></div>
|
|
<div class="line"><a name="l00102"></a><span class="lineno"> 102</span>  <a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a> = addrPool.<a class="code" href="class_address_pool.html#a97df4ef42e50960ce2165f4cdb53e590">AllocAddress</a>(parent, <span class="keyword">false</span>, port);</div>
|
|
<div class="line"><a name="l00103"></a><span class="lineno"> 103</span> </div>
|
|
<div class="line"><a name="l00104"></a><span class="lineno"> 104</span>  <span class="keywordflow">if</span> (!<a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a>)</div>
|
|
<div class="line"><a name="l00105"></a><span class="lineno"> 105</span>  <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#a15370eb665cdded5514e69ca58d9f39d">USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL</a>;</div>
|
|
<div class="line"><a name="l00106"></a><span class="lineno"> 106</span> </div>
|
|
<div class="line"><a name="l00107"></a><span class="lineno"> 107</span>  <span class="comment">// Extract Max Packet Size from device descriptor</span></div>
|
|
<div class="line"><a name="l00108"></a><span class="lineno"> 108</span>  <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[0].<a class="code" href="struct_ep_info.html#aa2ca775b63736df4008e88da7dd4dddb">maxPktSize</a> = (uint8_t)((<a class="code" href="struct_u_s_b___d_e_v_i_c_e___d_e_s_c_r_i_p_t_o_r.html">USB_DEVICE_DESCRIPTOR</a>*)buf)->bMaxPacketSize0;</div>
|
|
<div class="line"><a name="l00109"></a><span class="lineno"> 109</span> </div>
|
|
<div class="line"><a name="l00110"></a><span class="lineno"> 110</span>  <span class="comment">// Assign new address to the device</span></div>
|
|
<div class="line"><a name="l00111"></a><span class="lineno"> 111</span>  rcode = <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a3aea534daed66b5606fa798df7ad3c47">setAddr</a>(0, 0, <a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a>);</div>
|
|
<div class="line"><a name="l00112"></a><span class="lineno"> 112</span>  <span class="keywordflow">if</span> (rcode) {</div>
|
|
<div class="line"><a name="l00113"></a><span class="lineno"> 113</span>  p-><a class="code" href="struct_usb_device.html#a86a815577ad7883437d3ca72b32b8e8a">lowspeed</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00114"></a><span class="lineno"> 114</span>  addrPool.<a class="code" href="class_address_pool.html#a15fde13223dcb1da89305ad229763562">FreeAddress</a>(<a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a>);</div>
|
|
<div class="line"><a name="l00115"></a><span class="lineno"> 115</span>  <a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a> = 0;</div>
|
|
<div class="line"><a name="l00116"></a><span class="lineno"> 116</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00117"></a><span class="lineno"> 117</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nsetAddr: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00118"></a><span class="lineno"> 118</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00119"></a><span class="lineno"> 119</span> <span class="preprocessor"></span> PrintHex<uint8_t > (rcode, 0x80);</div>
|
|
<div class="line"><a name="l00120"></a><span class="lineno"> 120</span>  <span class="keywordflow">return</span> rcode;</div>
|
|
<div class="line"><a name="l00121"></a><span class="lineno"> 121</span>  }</div>
|
|
<div class="line"><a name="l00122"></a><span class="lineno"> 122</span> <span class="preprocessor">#ifdef EXTRADEBUG</span></div>
|
|
<div class="line"><a name="l00123"></a><span class="lineno"> 123</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nAddr: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00124"></a><span class="lineno"> 124</span>  PrintHex<uint8_t > (<a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a>, 0x80);</div>
|
|
<div class="line"><a name="l00125"></a><span class="lineno"> 125</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00126"></a><span class="lineno"> 126</span> <span class="preprocessor"></span> p-><a class="code" href="struct_usb_device.html#a86a815577ad7883437d3ca72b32b8e8a">lowspeed</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00127"></a><span class="lineno"> 127</span> </div>
|
|
<div class="line"><a name="l00128"></a><span class="lineno"> 128</span>  <span class="comment">//get pointer to assigned address record</span></div>
|
|
<div class="line"><a name="l00129"></a><span class="lineno"> 129</span>  p = addrPool.<a class="code" href="class_address_pool.html#aa92d7e8f0f515340ae2dc1679b627056">GetUsbDevicePtr</a>(bAddress);</div>
|
|
<div class="line"><a name="l00130"></a><span class="lineno"> 130</span>  <span class="keywordflow">if</span> (!p)</div>
|
|
<div class="line"><a name="l00131"></a><span class="lineno"> 131</span>  <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#afe2fedb4b0ccc89a688c0b4b59691ce0">USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL</a>;</div>
|
|
<div class="line"><a name="l00132"></a><span class="lineno"> 132</span> </div>
|
|
<div class="line"><a name="l00133"></a><span class="lineno"> 133</span>  p-><a class="code" href="struct_usb_device.html#a86a815577ad7883437d3ca72b32b8e8a">lowspeed</a> = lowspeed;</div>
|
|
<div class="line"><a name="l00134"></a><span class="lineno"> 134</span> </div>
|
|
<div class="line"><a name="l00135"></a><span class="lineno"> 135</span>  <span class="comment">// Assign epInfo to epinfo pointer - only EP0 is known</span></div>
|
|
<div class="line"><a name="l00136"></a><span class="lineno"> 136</span>  rcode = <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a6c3ba3f7e6dccb450267011ce783d7ea">setEpInfoEntry</a>(bAddress, 1, <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>);</div>
|
|
<div class="line"><a name="l00137"></a><span class="lineno"> 137</span>  <span class="keywordflow">if</span> (rcode)</div>
|
|
<div class="line"><a name="l00138"></a><span class="lineno"> 138</span>  <span class="keywordflow">goto</span> FailSetDevTblEntry;</div>
|
|
<div class="line"><a name="l00139"></a><span class="lineno"> 139</span>  VID = ((<a class="code" href="struct_u_s_b___d_e_v_i_c_e___d_e_s_c_r_i_p_t_o_r.html">USB_DEVICE_DESCRIPTOR</a>*)buf)->idVendor;</div>
|
|
<div class="line"><a name="l00140"></a><span class="lineno"> 140</span>  PID = ((<a class="code" href="struct_u_s_b___d_e_v_i_c_e___d_e_s_c_r_i_p_t_o_r.html">USB_DEVICE_DESCRIPTOR</a>*)buf)->idProduct;</div>
|
|
<div class="line"><a name="l00141"></a><span class="lineno"> 141</span> </div>
|
|
<div class="line"><a name="l00142"></a><span class="lineno"> 142</span>  <span class="keywordflow">if</span> (VID == <a class="code" href="_b_t_d_8h.html#a5bb06f989db583d290ba79642d37c514">PS3_VID</a> && (PID == <a class="code" href="_b_t_d_8h.html#a0ae276efa5e73a4da658c714e70402c0">PS3_PID</a> || PID == <a class="code" href="_b_t_d_8h.html#a54903b410722a45f8246653cd4d00632">PS3NAVIGATION_PID</a> || PID == <a class="code" href="_b_t_d_8h.html#afc242b8a1b867f79c49ad78e3a47b37f">PS3MOVE_PID</a>)) {</div>
|
|
<div class="line"><a name="l00143"></a><span class="lineno"> 143</span>  <span class="comment">/* We only need the Control endpoint, so we don't have to initialize the other endpoints of device */</span></div>
|
|
<div class="line"><a name="l00144"></a><span class="lineno"> 144</span>  rcode = <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a31e2c132ec32ffdde94dff72be87c378">setConf</a>(bAddress, <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[ <a class="code" href="class_b_t_d.html#a49f433ab824f259c3815e180c73bb0ad">BTD_CONTROL_PIPE</a> ].epAddr, 1);</div>
|
|
<div class="line"><a name="l00145"></a><span class="lineno"> 145</span>  <span class="keywordflow">if</span> (rcode)</div>
|
|
<div class="line"><a name="l00146"></a><span class="lineno"> 146</span>  <span class="keywordflow">goto</span> FailSetConfDescr;</div>
|
|
<div class="line"><a name="l00147"></a><span class="lineno"> 147</span> </div>
|
|
<div class="line"><a name="l00148"></a><span class="lineno"> 148</span>  <span class="keywordflow">if</span> (PID == <a class="code" href="_b_t_d_8h.html#a0ae276efa5e73a4da658c714e70402c0">PS3_PID</a> || PID == <a class="code" href="_b_t_d_8h.html#a54903b410722a45f8246653cd4d00632">PS3NAVIGATION_PID</a>) {</div>
|
|
<div class="line"><a name="l00149"></a><span class="lineno"> 149</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00150"></a><span class="lineno"> 150</span> <span class="preprocessor"></span> <span class="keywordflow">if</span> (PID == <a class="code" href="_b_t_d_8h.html#a0ae276efa5e73a4da658c714e70402c0">PS3_PID</a>)</div>
|
|
<div class="line"><a name="l00151"></a><span class="lineno"> 151</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nDualshock 3 Controller Connected"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00152"></a><span class="lineno"> 152</span>  <span class="keywordflow">else</span> <span class="comment">// must be a navigation controller</span></div>
|
|
<div class="line"><a name="l00153"></a><span class="lineno"> 153</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nNavigation Controller Connected"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00154"></a><span class="lineno"> 154</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00155"></a><span class="lineno"> 155</span> <span class="preprocessor"></span> <span class="comment">/* Set internal Bluetooth address */</span></div>
|
|
<div class="line"><a name="l00156"></a><span class="lineno"> 156</span>  setBdaddr(<a class="code" href="class_b_t_d.html#a1f8e9171a310e50f2c4a3c19066efe5a">my_bdaddr</a>);</div>
|
|
<div class="line"><a name="l00157"></a><span class="lineno"> 157</span>  } <span class="keywordflow">else</span> { <span class="comment">// It must be a Motion controller</span></div>
|
|
<div class="line"><a name="l00158"></a><span class="lineno"> 158</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00159"></a><span class="lineno"> 159</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nMotion Controller Connected"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00160"></a><span class="lineno"> 160</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00161"></a><span class="lineno"> 161</span> <span class="preprocessor"></span> setMoveBdaddr(<a class="code" href="class_b_t_d.html#a1f8e9171a310e50f2c4a3c19066efe5a">my_bdaddr</a>);</div>
|
|
<div class="line"><a name="l00162"></a><span class="lineno"> 162</span>  }</div>
|
|
<div class="line"><a name="l00163"></a><span class="lineno"> 163</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00164"></a><span class="lineno"> 164</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nBluetooth Address was set to: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00165"></a><span class="lineno"> 165</span>  <span class="keywordflow">for</span> (int8_t i = 5; i > 0; i--) {</div>
|
|
<div class="line"><a name="l00166"></a><span class="lineno"> 166</span>  PrintHex<uint8_t > (<a class="code" href="class_b_t_d.html#a1f8e9171a310e50f2c4a3c19066efe5a">my_bdaddr</a>[i], 0x80);</div>
|
|
<div class="line"><a name="l00167"></a><span class="lineno"> 167</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">":"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00168"></a><span class="lineno"> 168</span>  }</div>
|
|
<div class="line"><a name="l00169"></a><span class="lineno"> 169</span>  PrintHex<uint8_t > (<a class="code" href="class_b_t_d.html#a1f8e9171a310e50f2c4a3c19066efe5a">my_bdaddr</a>[0], 0x80);</div>
|
|
<div class="line"><a name="l00170"></a><span class="lineno"> 170</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00171"></a><span class="lineno"> 171</span> <span class="preprocessor"></span> rcode = <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a31e2c132ec32ffdde94dff72be87c378">setConf</a>(bAddress, <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[ <a class="code" href="class_b_t_d.html#a49f433ab824f259c3815e180c73bb0ad">BTD_CONTROL_PIPE</a> ].epAddr, 0); <span class="comment">// Reset configuration value</span></div>
|
|
<div class="line"><a name="l00172"></a><span class="lineno"> 172</span>  <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a3aea534daed66b5606fa798df7ad3c47">setAddr</a>(bAddress, 0, 0); <span class="comment">// Reset address</span></div>
|
|
<div class="line"><a name="l00173"></a><span class="lineno"> 173</span>  <a class="code" href="class_b_t_d.html#aa87c23bce56a20f2db47c6a40c8eda87">Release</a>(); <span class="comment">// Release device</span></div>
|
|
<div class="line"><a name="l00174"></a><span class="lineno"> 174</span>  <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#ae9e139d0fd29bb0b3e7afad2f76cd589">USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED</a>; <span class="comment">// return</span></div>
|
|
<div class="line"><a name="l00175"></a><span class="lineno"> 175</span>  } <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l00176"></a><span class="lineno"> 176</span>  num_of_conf = ((<a class="code" href="struct_u_s_b___d_e_v_i_c_e___d_e_s_c_r_i_p_t_o_r.html">USB_DEVICE_DESCRIPTOR</a>*)buf)->bNumConfigurations;</div>
|
|
<div class="line"><a name="l00177"></a><span class="lineno"> 177</span> </div>
|
|
<div class="line"><a name="l00178"></a><span class="lineno"> 178</span>  <span class="comment">// check if attached device is a Bluetooth dongle and fill endpoint data structure</span></div>
|
|
<div class="line"><a name="l00179"></a><span class="lineno"> 179</span>  <span class="comment">// first interface in the configuration must have Bluetooth assigned Class/Subclass/Protocol</span></div>
|
|
<div class="line"><a name="l00180"></a><span class="lineno"> 180</span>  <span class="comment">// and 3 endpoints - interrupt-IN, bulk-IN, bulk-OUT,</span></div>
|
|
<div class="line"><a name="l00181"></a><span class="lineno"> 181</span>  <span class="comment">// not necessarily in this order</span></div>
|
|
<div class="line"><a name="l00182"></a><span class="lineno"> 182</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < num_of_conf; i++) {</div>
|
|
<div class="line"><a name="l00183"></a><span class="lineno"> 183</span>  <a class="code" href="class_config_desc_parser.html">ConfigDescParser<USB_CLASS_WIRELESS_CTRL, WI_SUBCLASS_RF, WI_PROTOCOL_BT, CP_MASK_COMPARE_ALL></a> confDescrParser(<span class="keyword">this</span>);</div>
|
|
<div class="line"><a name="l00184"></a><span class="lineno"> 184</span>  rcode = <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a618eedabc161d8315be45cae0c8b6f89">getConfDescr</a>(bAddress, 0, i, &confDescrParser);</div>
|
|
<div class="line"><a name="l00185"></a><span class="lineno"> 185</span>  <span class="keywordflow">if</span> (rcode)</div>
|
|
<div class="line"><a name="l00186"></a><span class="lineno"> 186</span>  <span class="keywordflow">goto</span> FailGetConfDescr;</div>
|
|
<div class="line"><a name="l00187"></a><span class="lineno"> 187</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a893dd35932821cddda7e482a1904af66">bNumEP</a> >= <a class="code" href="_b_t_d_8h.html#aee41c4878894db24e7ad8cd6246595cd">BTD_MAX_ENDPOINTS</a>) <span class="comment">// All endpoints extracted</span></div>
|
|
<div class="line"><a name="l00188"></a><span class="lineno"> 188</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00189"></a><span class="lineno"> 189</span>  }</div>
|
|
<div class="line"><a name="l00190"></a><span class="lineno"> 190</span> </div>
|
|
<div class="line"><a name="l00191"></a><span class="lineno"> 191</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a893dd35932821cddda7e482a1904af66">bNumEP</a> < <a class="code" href="_b_t_d_8h.html#aee41c4878894db24e7ad8cd6246595cd">BTD_MAX_ENDPOINTS</a>)</div>
|
|
<div class="line"><a name="l00192"></a><span class="lineno"> 192</span>  <span class="keywordflow">goto</span> FailUnknownDevice;</div>
|
|
<div class="line"><a name="l00193"></a><span class="lineno"> 193</span> </div>
|
|
<div class="line"><a name="l00194"></a><span class="lineno"> 194</span>  <span class="comment">// Assign epInfo to epinfo pointer - this time all 3 endpoins</span></div>
|
|
<div class="line"><a name="l00195"></a><span class="lineno"> 195</span>  rcode = <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a6c3ba3f7e6dccb450267011ce783d7ea">setEpInfoEntry</a>(bAddress, <a class="code" href="class_b_t_d.html#a893dd35932821cddda7e482a1904af66">bNumEP</a>, <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>);</div>
|
|
<div class="line"><a name="l00196"></a><span class="lineno"> 196</span>  <span class="keywordflow">if</span> (rcode)</div>
|
|
<div class="line"><a name="l00197"></a><span class="lineno"> 197</span>  <span class="keywordflow">goto</span> FailSetDevTblEntry;</div>
|
|
<div class="line"><a name="l00198"></a><span class="lineno"> 198</span> </div>
|
|
<div class="line"><a name="l00199"></a><span class="lineno"> 199</span>  delay(200); <span class="comment">// Give time for address change</span></div>
|
|
<div class="line"><a name="l00200"></a><span class="lineno"> 200</span> </div>
|
|
<div class="line"><a name="l00201"></a><span class="lineno"> 201</span>  <span class="comment">// Set Configuration Value</span></div>
|
|
<div class="line"><a name="l00202"></a><span class="lineno"> 202</span>  rcode = <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a31e2c132ec32ffdde94dff72be87c378">setConf</a>(bAddress, <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[ <a class="code" href="class_b_t_d.html#a49f433ab824f259c3815e180c73bb0ad">BTD_CONTROL_PIPE</a> ].epAddr, <a class="code" href="class_b_t_d.html#a10c34527ae90e95791ac48ac7d1154a2">bConfNum</a>);</div>
|
|
<div class="line"><a name="l00203"></a><span class="lineno"> 203</span>  <span class="keywordflow">if</span> (rcode)</div>
|
|
<div class="line"><a name="l00204"></a><span class="lineno"> 204</span>  <span class="keywordflow">goto</span> FailSetConfDescr;</div>
|
|
<div class="line"><a name="l00205"></a><span class="lineno"> 205</span> </div>
|
|
<div class="line"><a name="l00206"></a><span class="lineno"> 206</span>  hci_num_reset_loops = 100; <span class="comment">// only loop 100 times before trying to send the hci reset command</span></div>
|
|
<div class="line"><a name="l00207"></a><span class="lineno"> 207</span>  hci_counter = 0;</div>
|
|
<div class="line"><a name="l00208"></a><span class="lineno"> 208</span>  hci_state = <a class="code" href="_b_t_d_8h.html#ac2b910cd6cc87c7bac09617815a1ee9a">HCI_INIT_STATE</a>;</div>
|
|
<div class="line"><a name="l00209"></a><span class="lineno"> 209</span>  <a class="code" href="class_b_t_d.html#aa7735da01865bab01b569ee836173737">watingForConnection</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00210"></a><span class="lineno"> 210</span>  bPollEnable = <span class="keyword">true</span>;</div>
|
|
<div class="line"><a name="l00211"></a><span class="lineno"> 211</span> </div>
|
|
<div class="line"><a name="l00212"></a><span class="lineno"> 212</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00213"></a><span class="lineno"> 213</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nBluetooth Dongle Initialized"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00214"></a><span class="lineno"> 214</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00215"></a><span class="lineno"> 215</span> <span class="preprocessor"></span> }</div>
|
|
<div class="line"><a name="l00216"></a><span class="lineno"> 216</span>  <span class="keywordflow">return</span> 0; <span class="comment">// Successful configuration</span></div>
|
|
<div class="line"><a name="l00217"></a><span class="lineno"> 217</span> </div>
|
|
<div class="line"><a name="l00218"></a><span class="lineno"> 218</span>  <span class="comment">/* diagnostic messages */</span></div>
|
|
<div class="line"><a name="l00219"></a><span class="lineno"> 219</span> FailGetDevDescr:</div>
|
|
<div class="line"><a name="l00220"></a><span class="lineno"> 220</span>  <a class="code" href="message_8cpp.html#ace40a5d826a882de0c5a25aece111d3f">NotifyFailGetDevDescr</a>();</div>
|
|
<div class="line"><a name="l00221"></a><span class="lineno"> 221</span>  <span class="keywordflow">goto</span> Fail;</div>
|
|
<div class="line"><a name="l00222"></a><span class="lineno"> 222</span> </div>
|
|
<div class="line"><a name="l00223"></a><span class="lineno"> 223</span> FailSetDevTblEntry:</div>
|
|
<div class="line"><a name="l00224"></a><span class="lineno"> 224</span>  <a class="code" href="message_8cpp.html#aa65008f9251787149e391f89e68b32be">NotifyFailSetDevTblEntry</a>();</div>
|
|
<div class="line"><a name="l00225"></a><span class="lineno"> 225</span>  <span class="keywordflow">goto</span> Fail;</div>
|
|
<div class="line"><a name="l00226"></a><span class="lineno"> 226</span> </div>
|
|
<div class="line"><a name="l00227"></a><span class="lineno"> 227</span> FailGetConfDescr:</div>
|
|
<div class="line"><a name="l00228"></a><span class="lineno"> 228</span>  <a class="code" href="message_8cpp.html#a8990b7c46c3f20489c3f205fa173f110">NotifyFailGetConfDescr</a>();</div>
|
|
<div class="line"><a name="l00229"></a><span class="lineno"> 229</span>  <span class="keywordflow">goto</span> Fail;</div>
|
|
<div class="line"><a name="l00230"></a><span class="lineno"> 230</span> </div>
|
|
<div class="line"><a name="l00231"></a><span class="lineno"> 231</span> FailSetConfDescr:</div>
|
|
<div class="line"><a name="l00232"></a><span class="lineno"> 232</span>  <a class="code" href="message_8cpp.html#a08b840c377ca6f8154d6924d51338d89">NotifyFailSetConfDescr</a>();</div>
|
|
<div class="line"><a name="l00233"></a><span class="lineno"> 233</span>  <span class="keywordflow">goto</span> Fail;</div>
|
|
<div class="line"><a name="l00234"></a><span class="lineno"> 234</span> </div>
|
|
<div class="line"><a name="l00235"></a><span class="lineno"> 235</span> FailUnknownDevice:</div>
|
|
<div class="line"><a name="l00236"></a><span class="lineno"> 236</span>  <a class="code" href="message_8cpp.html#a7103129ed2b7b7896461c0a3cd924eb4">NotifyFailUnknownDevice</a>(VID,PID);</div>
|
|
<div class="line"><a name="l00237"></a><span class="lineno"> 237</span>  <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a3aea534daed66b5606fa798df7ad3c47">setAddr</a>(bAddress, 0, 0); <span class="comment">// Reset address</span></div>
|
|
<div class="line"><a name="l00238"></a><span class="lineno"> 238</span>  rcode = <a class="code" href="_usb_8h.html#ae9e139d0fd29bb0b3e7afad2f76cd589">USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED</a>;</div>
|
|
<div class="line"><a name="l00239"></a><span class="lineno"> 239</span> Fail:</div>
|
|
<div class="line"><a name="l00240"></a><span class="lineno"> 240</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00241"></a><span class="lineno"> 241</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nBTD Init Failed, error code: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00242"></a><span class="lineno"> 242</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00243"></a><span class="lineno"> 243</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a5ae2cb9bf877595104f2425f50e2057f">NotifyFail</a>(rcode);</div>
|
|
<div class="line"><a name="l00244"></a><span class="lineno"> 244</span>  <a class="code" href="class_b_t_d.html#aa87c23bce56a20f2db47c6a40c8eda87">Release</a>();</div>
|
|
<div class="line"><a name="l00245"></a><span class="lineno"> 245</span>  <span class="keywordflow">return</span> rcode;</div>
|
|
<div class="line"><a name="l00246"></a><span class="lineno"> 246</span> }</div>
|
|
<div class="line"><a name="l00247"></a><span class="lineno"> 247</span> </div>
|
|
<div class="line"><a name="l00248"></a><span class="lineno"> 248</span> <span class="comment">/* Extracts interrupt-IN, bulk-IN, bulk-OUT endpoint information from config descriptor */</span></div>
|
|
<div class="line"><a name="l00249"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a23928cd0e5711a2433aec763cfa55773"> 249</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a23928cd0e5711a2433aec763cfa55773">BTD::EndpointXtract</a>(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, <span class="keyword">const</span> <a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html">USB_ENDPOINT_DESCRIPTOR</a> *pep) {</div>
|
|
<div class="line"><a name="l00250"></a><span class="lineno"> 250</span>  <span class="comment">//ErrorMessage<uint8_t>(PSTR("Conf.Val"),conf);</span></div>
|
|
<div class="line"><a name="l00251"></a><span class="lineno"> 251</span>  <span class="comment">//ErrorMessage<uint8_t>(PSTR("Iface Num"),iface);</span></div>
|
|
<div class="line"><a name="l00252"></a><span class="lineno"> 252</span>  <span class="comment">//ErrorMessage<uint8_t>(PSTR("Alt.Set"),alt);</span></div>
|
|
<div class="line"><a name="l00253"></a><span class="lineno"> 253</span> </div>
|
|
<div class="line"><a name="l00254"></a><span class="lineno"> 254</span>  <span class="keywordflow">if</span> (alt) <span class="comment">// wrong interface - by BT spec, no alt setting</span></div>
|
|
<div class="line"><a name="l00255"></a><span class="lineno"> 255</span>  <span class="keywordflow">return</span>;</div>
|
|
<div class="line"><a name="l00256"></a><span class="lineno"> 256</span> </div>
|
|
<div class="line"><a name="l00257"></a><span class="lineno"> 257</span>  <a class="code" href="class_b_t_d.html#a10c34527ae90e95791ac48ac7d1154a2">bConfNum</a> = conf;</div>
|
|
<div class="line"><a name="l00258"></a><span class="lineno"> 258</span>  uint8_t index;</div>
|
|
<div class="line"><a name="l00259"></a><span class="lineno"> 259</span> </div>
|
|
<div class="line"><a name="l00260"></a><span class="lineno"> 260</span>  <span class="keywordflow">if</span> ((pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a8ee7f1bafac335258c6e742969387f57">bmAttributes</a> & 0x03) == 3 && (pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a23fbb539d72d10a6cb12efedf7d3457c">bEndpointAddress</a> & 0x80) == 0x80) <span class="comment">// Interrupt In endpoint found</span></div>
|
|
<div class="line"><a name="l00261"></a><span class="lineno"> 261</span>  index = <a class="code" href="class_b_t_d.html#a24166c9b308925eeb2f635fae43ca5ec">BTD_EVENT_PIPE</a>;</div>
|
|
<div class="line"><a name="l00262"></a><span class="lineno"> 262</span> </div>
|
|
<div class="line"><a name="l00263"></a><span class="lineno"> 263</span>  <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l00264"></a><span class="lineno"> 264</span>  <span class="keywordflow">if</span> ((pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a8ee7f1bafac335258c6e742969387f57">bmAttributes</a> & 0x02) == 2) <span class="comment">// bulk endpoint found</span></div>
|
|
<div class="line"><a name="l00265"></a><span class="lineno"> 265</span>  index = ((pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a23fbb539d72d10a6cb12efedf7d3457c">bEndpointAddress</a> & 0x80) == 0x80) ? <a class="code" href="class_b_t_d.html#a480510bd399ae74a97cd74c8474ef59c">BTD_DATAIN_PIPE</a> : <a class="code" href="class_b_t_d.html#a0d82870f7eef8c27c33e6f5989d7a4dd">BTD_DATAOUT_PIPE</a>;</div>
|
|
<div class="line"><a name="l00266"></a><span class="lineno"> 266</span>  <span class="keywordflow">else</span></div>
|
|
<div class="line"><a name="l00267"></a><span class="lineno"> 267</span>  <span class="keywordflow">return</span>;</div>
|
|
<div class="line"><a name="l00268"></a><span class="lineno"> 268</span>  }</div>
|
|
<div class="line"><a name="l00269"></a><span class="lineno"> 269</span> </div>
|
|
<div class="line"><a name="l00270"></a><span class="lineno"> 270</span>  <span class="comment">// Fill the rest of endpoint data structure</span></div>
|
|
<div class="line"><a name="l00271"></a><span class="lineno"> 271</span>  <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[index].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a> = (pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a23fbb539d72d10a6cb12efedf7d3457c">bEndpointAddress</a> & 0x0F);</div>
|
|
<div class="line"><a name="l00272"></a><span class="lineno"> 272</span>  <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[index].<a class="code" href="struct_ep_info.html#aa2ca775b63736df4008e88da7dd4dddb">maxPktSize</a> = (uint8_t)pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#af34105fa6bd0029d9c6b73d85f7853c6">wMaxPacketSize</a>;</div>
|
|
<div class="line"><a name="l00273"></a><span class="lineno"> 273</span> #ifdef EXTRADEBUG</div>
|
|
<div class="line"><a name="l00274"></a><span class="lineno"> 274</span>  <a class="code" href="class_b_t_d.html#aa5976eead215a58553aee683d42405a0">PrintEndpointDescriptor</a>(pep);</div>
|
|
<div class="line"><a name="l00275"></a><span class="lineno"> 275</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00276"></a><span class="lineno"> 276</span> <span class="preprocessor"></span> <span class="keywordflow">if</span> (pollInterval < pep->bInterval) <span class="comment">// Set the polling interval as the largest polling interval obtained from endpoints</span></div>
|
|
<div class="line"><a name="l00277"></a><span class="lineno"> 277</span>  pollInterval = pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a95cd9669dee9cab375a7c5e62284a01b">bInterval</a>;</div>
|
|
<div class="line"><a name="l00278"></a><span class="lineno"> 278</span>  <a class="code" href="class_b_t_d.html#a893dd35932821cddda7e482a1904af66">bNumEP</a>++;</div>
|
|
<div class="line"><a name="l00279"></a><span class="lineno"> 279</span> }</div>
|
|
<div class="line"><a name="l00280"></a><span class="lineno"> 280</span> </div>
|
|
<div class="line"><a name="l00281"></a><span class="lineno"><a class="code" href="class_b_t_d.html#aa5976eead215a58553aee683d42405a0"> 281</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#aa5976eead215a58553aee683d42405a0">BTD::PrintEndpointDescriptor</a>(<span class="keyword">const</span> <a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html">USB_ENDPOINT_DESCRIPTOR</a>* ep_ptr) {</div>
|
|
<div class="line"><a name="l00282"></a><span class="lineno"> 282</span> <span class="preprocessor">#ifdef EXTRADEBUG</span></div>
|
|
<div class="line"><a name="l00283"></a><span class="lineno"> 283</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nEndpoint descriptor:"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00284"></a><span class="lineno"> 284</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nLength:\t\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00285"></a><span class="lineno"> 285</span>  PrintHex<uint8_t > (ep_ptr-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a55263a9cc9dc17abc37226ac8a471ad0">bLength</a>, 0x80);</div>
|
|
<div class="line"><a name="l00286"></a><span class="lineno"> 286</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nType:\t\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00287"></a><span class="lineno"> 287</span>  PrintHex<uint8_t > (ep_ptr-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#af39d036ab903a96b9d4d56b879555d6c">bDescriptorType</a>, 0x80);</div>
|
|
<div class="line"><a name="l00288"></a><span class="lineno"> 288</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nAddress:\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00289"></a><span class="lineno"> 289</span>  PrintHex<uint8_t > (ep_ptr-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a23fbb539d72d10a6cb12efedf7d3457c">bEndpointAddress</a>, 0x80);</div>
|
|
<div class="line"><a name="l00290"></a><span class="lineno"> 290</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nAttributes:\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00291"></a><span class="lineno"> 291</span>  PrintHex<uint8_t > (ep_ptr-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a8ee7f1bafac335258c6e742969387f57">bmAttributes</a>, 0x80);</div>
|
|
<div class="line"><a name="l00292"></a><span class="lineno"> 292</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nMaxPktSize:\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00293"></a><span class="lineno"> 293</span>  PrintHex<uint16_t > (ep_ptr-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#af34105fa6bd0029d9c6b73d85f7853c6">wMaxPacketSize</a>, 0x80);</div>
|
|
<div class="line"><a name="l00294"></a><span class="lineno"> 294</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nPoll Intrv:\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00295"></a><span class="lineno"> 295</span>  PrintHex<uint8_t > (ep_ptr-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a95cd9669dee9cab375a7c5e62284a01b">bInterval</a>, 0x80);</div>
|
|
<div class="line"><a name="l00296"></a><span class="lineno"> 296</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00297"></a><span class="lineno"> 297</span> <span class="preprocessor"></span>}</div>
|
|
<div class="line"><a name="l00298"></a><span class="lineno"> 298</span> </div>
|
|
<div class="line"><a name="l00299"></a><span class="lineno"> 299</span> <span class="comment">/* Performs a cleanup after failed Init() attempt */</span></div>
|
|
<div class="line"><a name="l00300"></a><span class="lineno"><a class="code" href="class_b_t_d.html#aa87c23bce56a20f2db47c6a40c8eda87"> 300</a></span> uint8_t <a class="code" href="class_b_t_d.html#aa87c23bce56a20f2db47c6a40c8eda87">BTD::Release</a>() {</div>
|
|
<div class="line"><a name="l00301"></a><span class="lineno"> 301</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < <a class="code" href="_b_t_d_8h.html#a2222709eed4c8af293e881ea36f599b0">BTD_NUMSERVICES</a>; i++) {</div>
|
|
<div class="line"><a name="l00302"></a><span class="lineno"> 302</span>  <span class="keywordflow">if</span> (btService[i])</div>
|
|
<div class="line"><a name="l00303"></a><span class="lineno"> 303</span>  btService[i]-><a class="code" href="class_bluetooth_service.html#a1dff7caf251f1d8a5f358b368445cb48">Reset</a>(); <span class="comment">// Reset all Bluetooth services</span></div>
|
|
<div class="line"><a name="l00304"></a><span class="lineno"> 304</span>  }</div>
|
|
<div class="line"><a name="l00305"></a><span class="lineno"> 305</span>  </div>
|
|
<div class="line"><a name="l00306"></a><span class="lineno"> 306</span>  <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a66ab8f5eda239e761d5a48741ea1f9d4">GetAddressPool</a>().<a class="code" href="class_address_pool.html#a15fde13223dcb1da89305ad229763562">FreeAddress</a>(<a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a>);</div>
|
|
<div class="line"><a name="l00307"></a><span class="lineno"> 307</span>  <a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a> = 0;</div>
|
|
<div class="line"><a name="l00308"></a><span class="lineno"> 308</span>  bPollEnable = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00309"></a><span class="lineno"> 309</span>  <a class="code" href="class_b_t_d.html#a893dd35932821cddda7e482a1904af66">bNumEP</a> = 1; <span class="comment">// must have to be reset to 1</span></div>
|
|
<div class="line"><a name="l00310"></a><span class="lineno"> 310</span>  <span class="keywordflow">return</span> 0;</div>
|
|
<div class="line"><a name="l00311"></a><span class="lineno"> 311</span> }</div>
|
|
<div class="line"><a name="l00312"></a><span class="lineno"> 312</span> </div>
|
|
<div class="line"><a name="l00313"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a76e201c5b561e3a6d0405894ba5c2e41"> 313</a></span> uint8_t <a class="code" href="class_b_t_d.html#a76e201c5b561e3a6d0405894ba5c2e41">BTD::Poll</a>() {</div>
|
|
<div class="line"><a name="l00314"></a><span class="lineno"> 314</span>  <span class="keywordflow">if</span> (!bPollEnable)</div>
|
|
<div class="line"><a name="l00315"></a><span class="lineno"> 315</span>  <span class="keywordflow">return</span> 0;</div>
|
|
<div class="line"><a name="l00316"></a><span class="lineno"> 316</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a52d6c7895f6bb01729d01ce28a2f3079">qNextPollTime</a> <= millis()) { <span class="comment">// Don't poll if shorter than polling interval</span></div>
|
|
<div class="line"><a name="l00317"></a><span class="lineno"> 317</span>  <a class="code" href="class_b_t_d.html#a52d6c7895f6bb01729d01ce28a2f3079">qNextPollTime</a> = millis() + pollInterval; <span class="comment">// Set new poll time</span></div>
|
|
<div class="line"><a name="l00318"></a><span class="lineno"> 318</span>  HCI_event_task(); <span class="comment">// poll the HCI event pipe</span></div>
|
|
<div class="line"><a name="l00319"></a><span class="lineno"> 319</span>  ACL_event_task(); <span class="comment">// start polling the ACL input pipe too, though discard data until connected</span></div>
|
|
<div class="line"><a name="l00320"></a><span class="lineno"> 320</span>  }</div>
|
|
<div class="line"><a name="l00321"></a><span class="lineno"> 321</span>  <span class="keywordflow">return</span> 0;</div>
|
|
<div class="line"><a name="l00322"></a><span class="lineno"> 322</span> }</div>
|
|
<div class="line"><a name="l00323"></a><span class="lineno"> 323</span> </div>
|
|
<div class="line"><a name="l00324"></a><span class="lineno"> 324</span> <span class="keywordtype">void</span> BTD::HCI_event_task() {</div>
|
|
<div class="line"><a name="l00325"></a><span class="lineno"> 325</span>  <span class="comment">/* check the event pipe*/</span></div>
|
|
<div class="line"><a name="l00326"></a><span class="lineno"> 326</span>  uint16_t MAX_BUFFER_SIZE = <a class="code" href="_b_t_d_8h.html#a32d591ef5742a99963130616ef146787">BULK_MAXPKTSIZE</a>; <span class="comment">// Request more than 16 bytes anyway, the inTransfer routine will take care of this</span></div>
|
|
<div class="line"><a name="l00327"></a><span class="lineno"> 327</span>  uint8_t rcode = <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#ad75d64f648b102fab2bd75e53e1324a4">inTransfer</a>(<a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a>, <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[ <a class="code" href="class_b_t_d.html#a24166c9b308925eeb2f635fae43ca5ec">BTD_EVENT_PIPE</a> ].epAddr, &MAX_BUFFER_SIZE, hcibuf); <span class="comment">// input on endpoint 1</span></div>
|
|
<div class="line"><a name="l00328"></a><span class="lineno"> 328</span>  <span class="keywordflow">if</span> (!rcode) <span class="comment">// Check for errors</span></div>
|
|
<div class="line"><a name="l00329"></a><span class="lineno"> 329</span>  {</div>
|
|
<div class="line"><a name="l00330"></a><span class="lineno"> 330</span>  <span class="keywordflow">switch</span> (hcibuf[0]) <span class="comment">//switch on event type</span></div>
|
|
<div class="line"><a name="l00331"></a><span class="lineno"> 331</span>  {</div>
|
|
<div class="line"><a name="l00332"></a><span class="lineno"> 332</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a81b71e0ba648260143529b04ae84e528">EV_COMMAND_COMPLETE</a>:</div>
|
|
<div class="line"><a name="l00333"></a><span class="lineno"> 333</span>  <span class="keywordflow">if</span> (!hcibuf[5]) { <span class="comment">// Check if command succeeded</span></div>
|
|
<div class="line"><a name="l00334"></a><span class="lineno"> 334</span>  hci_event_flag |= <a class="code" href="_b_t_d_8h.html#a14087b750ea2da7f0cef4daaa7683d01">HCI_FLAG_CMD_COMPLETE</a>; <span class="comment">// set command complete flag</span></div>
|
|
<div class="line"><a name="l00335"></a><span class="lineno"> 335</span>  <span class="keywordflow">if</span> ((hcibuf[3] == 0x01) && (hcibuf[4] == 0x10)) { <span class="comment">// parameters from read local version information</span></div>
|
|
<div class="line"><a name="l00336"></a><span class="lineno"> 336</span>  <a class="code" href="class_b_t_d.html#addaddee110af23a3195ad56f631e69ea">hci_version</a> = hcibuf[6]; <span class="comment">// Used to check if it supports 2.0+EDR - see http://www.bluetooth.org/Technical/AssignedNumbers/hci.htm</span></div>
|
|
<div class="line"><a name="l00337"></a><span class="lineno"> 337</span>  hci_event_flag |= <a class="code" href="_b_t_d_8h.html#ab3b1f616c1e885e697806f0167b73e8e">HCI_FLAG_READ_VERSION</a>;</div>
|
|
<div class="line"><a name="l00338"></a><span class="lineno"> 338</span>  } <span class="keywordflow">else</span> <span class="keywordflow">if</span> ((hcibuf[3] == 0x09) && (hcibuf[4] == 0x10)) { <span class="comment">// parameters from read local bluetooth address</span></div>
|
|
<div class="line"><a name="l00339"></a><span class="lineno"> 339</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 6; i++)</div>
|
|
<div class="line"><a name="l00340"></a><span class="lineno"> 340</span>  <a class="code" href="class_b_t_d.html#a1f8e9171a310e50f2c4a3c19066efe5a">my_bdaddr</a>[i] = hcibuf[6 + i];</div>
|
|
<div class="line"><a name="l00341"></a><span class="lineno"> 341</span>  hci_event_flag |= <a class="code" href="_b_t_d_8h.html#aabbf8a2ed694a2dc4d4e60fd389c44dd">HCI_FLAG_READ_BDADDR</a>;</div>
|
|
<div class="line"><a name="l00342"></a><span class="lineno"> 342</span>  }</div>
|
|
<div class="line"><a name="l00343"></a><span class="lineno"> 343</span>  }</div>
|
|
<div class="line"><a name="l00344"></a><span class="lineno"> 344</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00345"></a><span class="lineno"> 345</span> </div>
|
|
<div class="line"><a name="l00346"></a><span class="lineno"> 346</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a090ee10cc1a1c1c3bbb29a93c330d2d4">EV_COMMAND_STATUS</a>:</div>
|
|
<div class="line"><a name="l00347"></a><span class="lineno"> 347</span>  <span class="keywordflow">if</span> (hcibuf[2]) { <span class="comment">// show status on serial if not OK</span></div>
|
|
<div class="line"><a name="l00348"></a><span class="lineno"> 348</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00349"></a><span class="lineno"> 349</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nHCI Command Failed: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00350"></a><span class="lineno"> 350</span>  PrintHex<uint8_t > (hcibuf[2], 0x80);</div>
|
|
<div class="line"><a name="l00351"></a><span class="lineno"> 351</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">" "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00352"></a><span class="lineno"> 352</span>  PrintHex<uint8_t > (hcibuf[4], 0x80);</div>
|
|
<div class="line"><a name="l00353"></a><span class="lineno"> 353</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">" "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00354"></a><span class="lineno"> 354</span>  PrintHex<uint8_t > (hcibuf[5], 0x80);</div>
|
|
<div class="line"><a name="l00355"></a><span class="lineno"> 355</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00356"></a><span class="lineno"> 356</span> <span class="preprocessor"></span> }</div>
|
|
<div class="line"><a name="l00357"></a><span class="lineno"> 357</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00358"></a><span class="lineno"> 358</span> </div>
|
|
<div class="line"><a name="l00359"></a><span class="lineno"> 359</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a4c6ca5696adeab36258b3b0c58d804e0">EV_INQUIRY_COMPLETE</a>:</div>
|
|
<div class="line"><a name="l00360"></a><span class="lineno"> 360</span>  <span class="keywordflow">if</span> (inquiry_counter >= 5) {</div>
|
|
<div class="line"><a name="l00361"></a><span class="lineno"> 361</span>  inquiry_counter = 0;</div>
|
|
<div class="line"><a name="l00362"></a><span class="lineno"> 362</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00363"></a><span class="lineno"> 363</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nCouldn't find Wiimote"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00364"></a><span class="lineno"> 364</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00365"></a><span class="lineno"> 365</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#ac7caac80fb6f5f0e794af3644887d88e">connectToWii</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00366"></a><span class="lineno"> 366</span>  <a class="code" href="class_b_t_d.html#a0c8cc2a2dd2cda3e760b8b4c1a2d169c">pairWithWii</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00367"></a><span class="lineno"> 367</span>  hci_state = <a class="code" href="_b_t_d_8h.html#acc9b6954b4bb6c19a9d25242869d5ddf">HCI_SCANNING_STATE</a>;</div>
|
|
<div class="line"><a name="l00368"></a><span class="lineno"> 368</span>  }</div>
|
|
<div class="line"><a name="l00369"></a><span class="lineno"> 369</span>  inquiry_counter++;</div>
|
|
<div class="line"><a name="l00370"></a><span class="lineno"> 370</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00371"></a><span class="lineno"> 371</span> </div>
|
|
<div class="line"><a name="l00372"></a><span class="lineno"> 372</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a335df6d48c8cac828d62196eeaff360b">EV_INQUIRY_RESULT</a>:</div>
|
|
<div class="line"><a name="l00373"></a><span class="lineno"> 373</span>  <span class="keywordflow">if</span> (hcibuf[2]) { <span class="comment">// Check that there is more than zero responses</span></div>
|
|
<div class="line"><a name="l00374"></a><span class="lineno"> 374</span> <span class="preprocessor">#ifdef EXTRADEBUG</span></div>
|
|
<div class="line"><a name="l00375"></a><span class="lineno"> 375</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nNumber of responses: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00376"></a><span class="lineno"> 376</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(hcibuf[2], 0x80);</div>
|
|
<div class="line"><a name="l00377"></a><span class="lineno"> 377</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00378"></a><span class="lineno"> 378</span> <span class="preprocessor"></span> <span class="keywordflow">for</span> (uint8_t i = 0; i < hcibuf[2]; i++) {</div>
|
|
<div class="line"><a name="l00379"></a><span class="lineno"> 379</span>  <span class="keywordflow">if</span> ((hcibuf[4 + 8 * hcibuf[2] + 3 * i] == 0x04 && hcibuf[5 + 8 * hcibuf[2] + 3 * i] == 0x25 && hcibuf[6 + 8 * hcibuf[2] + 3 * i] == 0x00) || (hcibuf[4 + 8 * hcibuf[2] + 3 * i] == 0x08 && hcibuf[5 + 8 * hcibuf[2] + 3 * i] == 0x05 && hcibuf[6 + 8 * hcibuf[2] + 3 * i] == 0x00)) { <span class="comment">// See http://bluetooth-pentest.narod.ru/software/bluetooth_class_of_device-service_generator.html and http://wiibrew.org/wiki/Wiimote#SDP_information</span></div>
|
|
<div class="line"><a name="l00380"></a><span class="lineno"> 380</span>  <span class="keywordflow">if</span> (hcibuf[4 + 8 * hcibuf[2] + 3 * i] == 0x08) <span class="comment">// Check if it's the new Wiimote with motion plus inside that was detected</span></div>
|
|
<div class="line"><a name="l00381"></a><span class="lineno"> 381</span>  <a class="code" href="class_b_t_d.html#a3aea445b2349e99ef057db1a4ffdd9dc">motionPlusInside</a> = <span class="keyword">true</span>;</div>
|
|
<div class="line"><a name="l00382"></a><span class="lineno"> 382</span>  <span class="keywordflow">else</span></div>
|
|
<div class="line"><a name="l00383"></a><span class="lineno"> 383</span>  <a class="code" href="class_b_t_d.html#a3aea445b2349e99ef057db1a4ffdd9dc">motionPlusInside</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00384"></a><span class="lineno"> 384</span>  <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[0] = hcibuf[3 + 6 * i];</div>
|
|
<div class="line"><a name="l00385"></a><span class="lineno"> 385</span>  <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[1] = hcibuf[4 + 6 * i];</div>
|
|
<div class="line"><a name="l00386"></a><span class="lineno"> 386</span>  <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[2] = hcibuf[5 + 6 * i];</div>
|
|
<div class="line"><a name="l00387"></a><span class="lineno"> 387</span>  <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[3] = hcibuf[6 + 6 * i];</div>
|
|
<div class="line"><a name="l00388"></a><span class="lineno"> 388</span>  <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[4] = hcibuf[7 + 6 * i];</div>
|
|
<div class="line"><a name="l00389"></a><span class="lineno"> 389</span>  <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[5] = hcibuf[8 + 6 * i];</div>
|
|
<div class="line"><a name="l00390"></a><span class="lineno"> 390</span>  hci_event_flag |= <a class="code" href="_b_t_d_8h.html#aa991873698787cf45d26efaa370f34e2">HCI_FLAG_WII_FOUND</a>;</div>
|
|
<div class="line"><a name="l00391"></a><span class="lineno"> 391</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00392"></a><span class="lineno"> 392</span>  }</div>
|
|
<div class="line"><a name="l00393"></a><span class="lineno"> 393</span> <span class="preprocessor">#ifdef EXTRADEBUG</span></div>
|
|
<div class="line"><a name="l00394"></a><span class="lineno"> 394</span> <span class="preprocessor"></span> <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l00395"></a><span class="lineno"> 395</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nClass of device: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00396"></a><span class="lineno"> 396</span>  PrintHex<uint8_t > (hcibuf[6 + 8 * hcibuf[2] + 3 * i], 0x80);</div>
|
|
<div class="line"><a name="l00397"></a><span class="lineno"> 397</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">" "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00398"></a><span class="lineno"> 398</span>  PrintHex<uint8_t > (hcibuf[5 + 8 * hcibuf[2] + 3 * i], 0x80);</div>
|
|
<div class="line"><a name="l00399"></a><span class="lineno"> 399</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">" "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00400"></a><span class="lineno"> 400</span>  PrintHex<uint8_t > (hcibuf[4 + 8 * hcibuf[2] + 3 * i], 0x80);</div>
|
|
<div class="line"><a name="l00401"></a><span class="lineno"> 401</span>  }</div>
|
|
<div class="line"><a name="l00402"></a><span class="lineno"> 402</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00403"></a><span class="lineno"> 403</span> <span class="preprocessor"></span> }</div>
|
|
<div class="line"><a name="l00404"></a><span class="lineno"> 404</span>  }</div>
|
|
<div class="line"><a name="l00405"></a><span class="lineno"> 405</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00406"></a><span class="lineno"> 406</span> </div>
|
|
<div class="line"><a name="l00407"></a><span class="lineno"> 407</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#ad4bce42e1ef20447655f8916f23d07a7">EV_CONNECT_COMPLETE</a>:</div>
|
|
<div class="line"><a name="l00408"></a><span class="lineno"> 408</span>  hci_event_flag |= <a class="code" href="_b_t_d_8h.html#ad14762241e9195fc9a3b0a69ef1ab7f3">HCI_FLAG_CONNECT_EVENT</a>;</div>
|
|
<div class="line"><a name="l00409"></a><span class="lineno"> 409</span>  <span class="keywordflow">if</span> (!hcibuf[2]) { <span class="comment">// check if connected OK</span></div>
|
|
<div class="line"><a name="l00410"></a><span class="lineno"> 410</span>  <a class="code" href="class_b_t_d.html#aa3bb6c692701cb33dfad1ea4d68b6f98">hci_handle</a> = hcibuf[3] | ((hcibuf[4] & 0x0F) << 8); <span class="comment">// store the handle for the ACL connection</span></div>
|
|
<div class="line"><a name="l00411"></a><span class="lineno"> 411</span>  hci_event_flag |= <a class="code" href="_b_t_d_8h.html#aa05458d2a47122cd62cd0748c7e1e313">HCI_FLAG_CONN_COMPLETE</a>; <span class="comment">// set connection complete flag</span></div>
|
|
<div class="line"><a name="l00412"></a><span class="lineno"> 412</span>  }</div>
|
|
<div class="line"><a name="l00413"></a><span class="lineno"> 413</span> <span class="preprocessor">#ifdef EXTRADEBUG</span></div>
|
|
<div class="line"><a name="l00414"></a><span class="lineno"> 414</span> <span class="preprocessor"></span> <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l00415"></a><span class="lineno"> 415</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nConnection Failed"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00416"></a><span class="lineno"> 416</span>  hci_state = <a class="code" href="_b_t_d_8h.html#a36daee23c5d0f4276e6eb32f3fd79124">HCI_CHECK_WII_SERVICE</a>;</div>
|
|
<div class="line"><a name="l00417"></a><span class="lineno"> 417</span>  }</div>
|
|
<div class="line"><a name="l00418"></a><span class="lineno"> 418</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00419"></a><span class="lineno"> 419</span> <span class="preprocessor"></span> <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00420"></a><span class="lineno"> 420</span> </div>
|
|
<div class="line"><a name="l00421"></a><span class="lineno"> 421</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a1cf7e4d4426dcabed8976b65beee0d99">EV_DISCONNECT_COMPLETE</a>:</div>
|
|
<div class="line"><a name="l00422"></a><span class="lineno"> 422</span>  <span class="keywordflow">if</span> (!hcibuf[2]) { <span class="comment">// check if disconnected OK</span></div>
|
|
<div class="line"><a name="l00423"></a><span class="lineno"> 423</span>  hci_event_flag |= <a class="code" href="_b_t_d_8h.html#aec17e7d699b1023a0b6f675feddd7d58">HCI_FLAG_DISCONN_COMPLETE</a>; <span class="comment">// set disconnect command complete flag</span></div>
|
|
<div class="line"><a name="l00424"></a><span class="lineno"> 424</span>  hci_event_flag &= ~<a class="code" href="_b_t_d_8h.html#aa05458d2a47122cd62cd0748c7e1e313">HCI_FLAG_CONN_COMPLETE</a>; <span class="comment">// clear connection complete flag</span></div>
|
|
<div class="line"><a name="l00425"></a><span class="lineno"> 425</span>  }</div>
|
|
<div class="line"><a name="l00426"></a><span class="lineno"> 426</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00427"></a><span class="lineno"> 427</span> </div>
|
|
<div class="line"><a name="l00428"></a><span class="lineno"> 428</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a29c1744f72f3cd85865c8173eace5a36">EV_REMOTE_NAME_COMPLETE</a>:</div>
|
|
<div class="line"><a name="l00429"></a><span class="lineno"> 429</span>  <span class="keywordflow">if</span> (!hcibuf[2]) { <span class="comment">// check if reading is OK</span></div>
|
|
<div class="line"><a name="l00430"></a><span class="lineno"> 430</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < min(<span class="keyword">sizeof</span>(<a class="code" href="class_b_t_d.html#aede42d995c384c238fd49d728df01e4e">remote_name</a>),<span class="keyword">sizeof</span>(hcibuf)-9); i++)</div>
|
|
<div class="line"><a name="l00431"></a><span class="lineno"> 431</span>  <a class="code" href="class_b_t_d.html#aede42d995c384c238fd49d728df01e4e">remote_name</a>[i] = hcibuf[9 + i];</div>
|
|
<div class="line"><a name="l00432"></a><span class="lineno"> 432</span>  hci_event_flag |= <a class="code" href="_b_t_d_8h.html#a400af4b61f6e94ab821fa368d8bf2b07">HCI_FLAG_REMOTE_NAME_COMPLETE</a>;</div>
|
|
<div class="line"><a name="l00433"></a><span class="lineno"> 433</span>  }</div>
|
|
<div class="line"><a name="l00434"></a><span class="lineno"> 434</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00435"></a><span class="lineno"> 435</span> </div>
|
|
<div class="line"><a name="l00436"></a><span class="lineno"> 436</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#af6c5584636f8958689f5cd67290254e1">EV_INCOMING_CONNECT</a>:</div>
|
|
<div class="line"><a name="l00437"></a><span class="lineno"> 437</span>  <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[0] = hcibuf[2];</div>
|
|
<div class="line"><a name="l00438"></a><span class="lineno"> 438</span>  <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[1] = hcibuf[3];</div>
|
|
<div class="line"><a name="l00439"></a><span class="lineno"> 439</span>  <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[2] = hcibuf[4];</div>
|
|
<div class="line"><a name="l00440"></a><span class="lineno"> 440</span>  <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[3] = hcibuf[5];</div>
|
|
<div class="line"><a name="l00441"></a><span class="lineno"> 441</span>  <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[4] = hcibuf[6];</div>
|
|
<div class="line"><a name="l00442"></a><span class="lineno"> 442</span>  <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[5] = hcibuf[7];</div>
|
|
<div class="line"><a name="l00443"></a><span class="lineno"> 443</span> <span class="preprocessor">#ifdef EXTRADEBUG</span></div>
|
|
<div class="line"><a name="l00444"></a><span class="lineno"> 444</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nClass of device: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00445"></a><span class="lineno"> 445</span>  PrintHex<uint8_t > (hcibuf[10], 0x80);</div>
|
|
<div class="line"><a name="l00446"></a><span class="lineno"> 446</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">" "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00447"></a><span class="lineno"> 447</span>  PrintHex<uint8_t > (hcibuf[9], 0x80);</div>
|
|
<div class="line"><a name="l00448"></a><span class="lineno"> 448</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">" "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00449"></a><span class="lineno"> 449</span>  PrintHex<uint8_t > (hcibuf[8], 0x80);</div>
|
|
<div class="line"><a name="l00450"></a><span class="lineno"> 450</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00451"></a><span class="lineno"> 451</span> <span class="preprocessor"></span> hci_event_flag |= <a class="code" href="_b_t_d_8h.html#a0e8a8ce5838e265c1732795bf8822043">HCI_FLAG_INCOMING_REQUEST</a>;</div>
|
|
<div class="line"><a name="l00452"></a><span class="lineno"> 452</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00453"></a><span class="lineno"> 453</span> </div>
|
|
<div class="line"><a name="l00454"></a><span class="lineno"> 454</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a935633384e87daa14b60549134014ec4">EV_PIN_CODE_REQUEST</a>:</div>
|
|
<div class="line"><a name="l00455"></a><span class="lineno"> 455</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a0c8cc2a2dd2cda3e760b8b4c1a2d169c">pairWithWii</a>) {</div>
|
|
<div class="line"><a name="l00456"></a><span class="lineno"> 456</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00457"></a><span class="lineno"> 457</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nPairing with wiimote"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00458"></a><span class="lineno"> 458</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00459"></a><span class="lineno"> 459</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#a70047b0f624c3f0ef29f8b76b8a34938">hci_pin_code_request_reply</a>();</div>
|
|
<div class="line"><a name="l00460"></a><span class="lineno"> 460</span>  } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a215cb939c01ed3ff56db37841224546c">btdPin</a> != NULL) {</div>
|
|
<div class="line"><a name="l00461"></a><span class="lineno"> 461</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00462"></a><span class="lineno"> 462</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nBluetooth pin is set too: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00463"></a><span class="lineno"> 463</span>  <a class="code" href="message_8cpp.html#a389f3cf4766145374f70464477c3156a">NotifyStr</a>(<a class="code" href="class_b_t_d.html#a215cb939c01ed3ff56db37841224546c">btdPin</a>, 0x80);</div>
|
|
<div class="line"><a name="l00464"></a><span class="lineno"> 464</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00465"></a><span class="lineno"> 465</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#a70047b0f624c3f0ef29f8b76b8a34938">hci_pin_code_request_reply</a>();</div>
|
|
<div class="line"><a name="l00466"></a><span class="lineno"> 466</span>  } <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l00467"></a><span class="lineno"> 467</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00468"></a><span class="lineno"> 468</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nNo pin was set"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00469"></a><span class="lineno"> 469</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00470"></a><span class="lineno"> 470</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#a7114d2cb62aa413e5ecb25c45c76832b">hci_pin_code_negative_request_reply</a>();</div>
|
|
<div class="line"><a name="l00471"></a><span class="lineno"> 471</span>  }</div>
|
|
<div class="line"><a name="l00472"></a><span class="lineno"> 472</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00473"></a><span class="lineno"> 473</span> </div>
|
|
<div class="line"><a name="l00474"></a><span class="lineno"> 474</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a8c77c922bb61301760ebf5af5f1cc7f0">EV_LINK_KEY_REQUEST</a>:</div>
|
|
<div class="line"><a name="l00475"></a><span class="lineno"> 475</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00476"></a><span class="lineno"> 476</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nReceived Key Request"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00477"></a><span class="lineno"> 477</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00478"></a><span class="lineno"> 478</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#af4d28b9c1a3b9688a1871610caee2cfc">hci_link_key_request_negative_reply</a>();</div>
|
|
<div class="line"><a name="l00479"></a><span class="lineno"> 479</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00480"></a><span class="lineno"> 480</span> </div>
|
|
<div class="line"><a name="l00481"></a><span class="lineno"> 481</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a68b8f78a0e0da80434afb1e6d40eacf4">EV_AUTHENTICATION_COMPLETE</a>:</div>
|
|
<div class="line"><a name="l00482"></a><span class="lineno"> 482</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a0c8cc2a2dd2cda3e760b8b4c1a2d169c">pairWithWii</a> && !<a class="code" href="class_b_t_d.html#ac7caac80fb6f5f0e794af3644887d88e">connectToWii</a>) {</div>
|
|
<div class="line"><a name="l00483"></a><span class="lineno"> 483</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00484"></a><span class="lineno"> 484</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nPairing successful"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00485"></a><span class="lineno"> 485</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00486"></a><span class="lineno"> 486</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#ac7caac80fb6f5f0e794af3644887d88e">connectToWii</a> = <span class="keyword">true</span>; <span class="comment">// Only send the ACL data to the Wii service</span></div>
|
|
<div class="line"><a name="l00487"></a><span class="lineno"> 487</span>  }</div>
|
|
<div class="line"><a name="l00488"></a><span class="lineno"> 488</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00489"></a><span class="lineno"> 489</span>  <span class="comment">/* We will just ignore the following events */</span></div>
|
|
<div class="line"><a name="l00490"></a><span class="lineno"> 490</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a0987119cfc40f3011a2cec69686034df">EV_NUM_COMPLETE_PKT</a>:</div>
|
|
<div class="line"><a name="l00491"></a><span class="lineno"> 491</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#ac61db50de3007a22e19e660bd7e68e69">EV_ROLE_CHANGED</a>:</div>
|
|
<div class="line"><a name="l00492"></a><span class="lineno"> 492</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#ad8481acc0b144d97017f8a06d63ff47c">EV_PAGE_SCAN_REP_MODE</a>:</div>
|
|
<div class="line"><a name="l00493"></a><span class="lineno"> 493</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#acd5f65703cc34b112a1f656d9a49551b">EV_LOOPBACK_COMMAND</a>:</div>
|
|
<div class="line"><a name="l00494"></a><span class="lineno"> 494</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a6f8b4cf8546d9928a34c9c681dc5a6d5">EV_DATA_BUFFER_OVERFLOW</a>:</div>
|
|
<div class="line"><a name="l00495"></a><span class="lineno"> 495</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a3e107e9d07793ca5cfaeea8b2181d4a4">EV_CHANGE_CONNECTION_LINK</a>:</div>
|
|
<div class="line"><a name="l00496"></a><span class="lineno"> 496</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a2ad6543cdfe06cbf0924c287c08f36d7">EV_MAX_SLOTS_CHANGE</a>:</div>
|
|
<div class="line"><a name="l00497"></a><span class="lineno"> 497</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a1b58792b76e0f216df8160bf055032c3">EV_QOS_SETUP_COMPLETE</a>:</div>
|
|
<div class="line"><a name="l00498"></a><span class="lineno"> 498</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a8c662496af1164370e5fdf7149ecd842">EV_LINK_KEY_NOTIFICATION</a>:</div>
|
|
<div class="line"><a name="l00499"></a><span class="lineno"> 499</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#aa0bf5ac66c412d3415dbb753630d0e58">EV_ENCRYPTION_CHANGE</a>:</div>
|
|
<div class="line"><a name="l00500"></a><span class="lineno"> 500</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a830b2a3bcb09c4802910e8b05531d317">EV_READ_REMOTE_VERSION_INFORMATION_COMPLETE</a>:</div>
|
|
<div class="line"><a name="l00501"></a><span class="lineno"> 501</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00502"></a><span class="lineno"> 502</span> <span class="preprocessor">#ifdef EXTRADEBUG</span></div>
|
|
<div class="line"><a name="l00503"></a><span class="lineno"> 503</span> <span class="preprocessor"></span> <span class="keywordflow">default</span>:</div>
|
|
<div class="line"><a name="l00504"></a><span class="lineno"> 504</span>  <span class="keywordflow">if</span> (hcibuf[0] != 0x00) {</div>
|
|
<div class="line"><a name="l00505"></a><span class="lineno"> 505</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nUnmanaged HCI Event: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00506"></a><span class="lineno"> 506</span>  PrintHex<uint8_t > (hcibuf[0], 0x80);</div>
|
|
<div class="line"><a name="l00507"></a><span class="lineno"> 507</span>  }</div>
|
|
<div class="line"><a name="l00508"></a><span class="lineno"> 508</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00509"></a><span class="lineno"> 509</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00510"></a><span class="lineno"> 510</span> <span class="preprocessor"></span> } <span class="comment">// switch</span></div>
|
|
<div class="line"><a name="l00511"></a><span class="lineno"> 511</span>  }</div>
|
|
<div class="line"><a name="l00512"></a><span class="lineno"> 512</span> <span class="preprocessor">#ifdef EXTRADEBUG</span></div>
|
|
<div class="line"><a name="l00513"></a><span class="lineno"> 513</span> <span class="preprocessor"></span> <span class="keywordflow">else</span> <span class="keywordflow">if</span> (rcode != <a class="code" href="max3421e_8h.html#ab44a7968d08016b58d98951059c37076">hrNAK</a>) {</div>
|
|
<div class="line"><a name="l00514"></a><span class="lineno"> 514</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nHCI event error: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00515"></a><span class="lineno"> 515</span>  PrintHex<uint8_t > (rcode, 0x80);</div>
|
|
<div class="line"><a name="l00516"></a><span class="lineno"> 516</span>  }</div>
|
|
<div class="line"><a name="l00517"></a><span class="lineno"> 517</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00518"></a><span class="lineno"> 518</span> <span class="preprocessor"></span> HCI_task();</div>
|
|
<div class="line"><a name="l00519"></a><span class="lineno"> 519</span> }</div>
|
|
<div class="line"><a name="l00520"></a><span class="lineno"> 520</span> </div>
|
|
<div class="line"><a name="l00521"></a><span class="lineno"> 521</span> <span class="comment">/* Poll Bluetooth and print result */</span></div>
|
|
<div class="line"><a name="l00522"></a><span class="lineno"> 522</span> <span class="keywordtype">void</span> BTD::HCI_task() {</div>
|
|
<div class="line"><a name="l00523"></a><span class="lineno"> 523</span>  <span class="keywordflow">switch</span> (hci_state) {</div>
|
|
<div class="line"><a name="l00524"></a><span class="lineno"> 524</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#ac2b910cd6cc87c7bac09617815a1ee9a">HCI_INIT_STATE</a>:</div>
|
|
<div class="line"><a name="l00525"></a><span class="lineno"> 525</span>  hci_counter++;</div>
|
|
<div class="line"><a name="l00526"></a><span class="lineno"> 526</span>  <span class="keywordflow">if</span> (hci_counter > hci_num_reset_loops) { <span class="comment">// wait until we have looped x times to clear any old events</span></div>
|
|
<div class="line"><a name="l00527"></a><span class="lineno"> 527</span>  <a class="code" href="class_b_t_d.html#ae6f942eabd29257bc4896e5f263275b6">hci_reset</a>();</div>
|
|
<div class="line"><a name="l00528"></a><span class="lineno"> 528</span>  hci_state = <a class="code" href="_b_t_d_8h.html#af3a7567dba1a0a7ed4272324d7684440">HCI_RESET_STATE</a>;</div>
|
|
<div class="line"><a name="l00529"></a><span class="lineno"> 529</span>  hci_counter = 0;</div>
|
|
<div class="line"><a name="l00530"></a><span class="lineno"> 530</span>  }</div>
|
|
<div class="line"><a name="l00531"></a><span class="lineno"> 531</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00532"></a><span class="lineno"> 532</span> </div>
|
|
<div class="line"><a name="l00533"></a><span class="lineno"> 533</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#af3a7567dba1a0a7ed4272324d7684440">HCI_RESET_STATE</a>:</div>
|
|
<div class="line"><a name="l00534"></a><span class="lineno"> 534</span>  hci_counter++;</div>
|
|
<div class="line"><a name="l00535"></a><span class="lineno"> 535</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#a9cc765dd92016efe6eaeff535a5193c1">hci_cmd_complete</a>) {</div>
|
|
<div class="line"><a name="l00536"></a><span class="lineno"> 536</span>  hci_counter = 0;</div>
|
|
<div class="line"><a name="l00537"></a><span class="lineno"> 537</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00538"></a><span class="lineno"> 538</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nHCI Reset complete"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00539"></a><span class="lineno"> 539</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00540"></a><span class="lineno"> 540</span> <span class="preprocessor"></span> hci_state = <a class="code" href="_b_t_d_8h.html#aa4e852587db5ad51c6c5cfb8e9d4f002">HCI_CLASS_STATE</a>;</div>
|
|
<div class="line"><a name="l00541"></a><span class="lineno"> 541</span>  <a class="code" href="class_b_t_d.html#a9a17405df60591b909ff1502fb8f3141">hci_write_class_of_device</a>();</div>
|
|
<div class="line"><a name="l00542"></a><span class="lineno"> 542</span>  } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (hci_counter > hci_num_reset_loops) {</div>
|
|
<div class="line"><a name="l00543"></a><span class="lineno"> 543</span>  hci_num_reset_loops *= 10;</div>
|
|
<div class="line"><a name="l00544"></a><span class="lineno"> 544</span>  <span class="keywordflow">if</span> (hci_num_reset_loops > 2000)</div>
|
|
<div class="line"><a name="l00545"></a><span class="lineno"> 545</span>  hci_num_reset_loops = 2000;</div>
|
|
<div class="line"><a name="l00546"></a><span class="lineno"> 546</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00547"></a><span class="lineno"> 547</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nNo response to HCI Reset"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00548"></a><span class="lineno"> 548</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00549"></a><span class="lineno"> 549</span> <span class="preprocessor"></span> hci_state = <a class="code" href="_b_t_d_8h.html#ac2b910cd6cc87c7bac09617815a1ee9a">HCI_INIT_STATE</a>;</div>
|
|
<div class="line"><a name="l00550"></a><span class="lineno"> 550</span>  hci_counter = 0;</div>
|
|
<div class="line"><a name="l00551"></a><span class="lineno"> 551</span>  }</div>
|
|
<div class="line"><a name="l00552"></a><span class="lineno"> 552</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00553"></a><span class="lineno"> 553</span> </div>
|
|
<div class="line"><a name="l00554"></a><span class="lineno"> 554</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#aa4e852587db5ad51c6c5cfb8e9d4f002">HCI_CLASS_STATE</a>:</div>
|
|
<div class="line"><a name="l00555"></a><span class="lineno"> 555</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#a9cc765dd92016efe6eaeff535a5193c1">hci_cmd_complete</a>) {</div>
|
|
<div class="line"><a name="l00556"></a><span class="lineno"> 556</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00557"></a><span class="lineno"> 557</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nWrite class of device"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00558"></a><span class="lineno"> 558</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00559"></a><span class="lineno"> 559</span> <span class="preprocessor"></span> hci_state = <a class="code" href="_b_t_d_8h.html#a86fd72d2518d27c02c15af635b55fc8f">HCI_BDADDR_STATE</a>;</div>
|
|
<div class="line"><a name="l00560"></a><span class="lineno"> 560</span>  <a class="code" href="class_b_t_d.html#acb94a629477d85cebd16a9c5ecd4a8b3">hci_read_bdaddr</a>();</div>
|
|
<div class="line"><a name="l00561"></a><span class="lineno"> 561</span>  }</div>
|
|
<div class="line"><a name="l00562"></a><span class="lineno"> 562</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00563"></a><span class="lineno"> 563</span> </div>
|
|
<div class="line"><a name="l00564"></a><span class="lineno"> 564</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a86fd72d2518d27c02c15af635b55fc8f">HCI_BDADDR_STATE</a>:</div>
|
|
<div class="line"><a name="l00565"></a><span class="lineno"> 565</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#afc5a7e103eb1301c12aa35af25cc8293">hci_read_bdaddr_complete</a>) {</div>
|
|
<div class="line"><a name="l00566"></a><span class="lineno"> 566</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00567"></a><span class="lineno"> 567</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nLocal Bluetooth Address: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00568"></a><span class="lineno"> 568</span>  <span class="keywordflow">for</span> (int8_t i = 5; i > 0; i--) {</div>
|
|
<div class="line"><a name="l00569"></a><span class="lineno"> 569</span>  PrintHex<uint8_t > (<a class="code" href="class_b_t_d.html#a1f8e9171a310e50f2c4a3c19066efe5a">my_bdaddr</a>[i], 0x80);</div>
|
|
<div class="line"><a name="l00570"></a><span class="lineno"> 570</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">":"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00571"></a><span class="lineno"> 571</span>  }</div>
|
|
<div class="line"><a name="l00572"></a><span class="lineno"> 572</span>  PrintHex<uint8_t > (my_bdaddr[0], 0x80);</div>
|
|
<div class="line"><a name="l00573"></a><span class="lineno"> 573</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00574"></a><span class="lineno"> 574</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#ae2ba215b6942f4131e4c5fdef2771e22">hci_read_local_version_information</a>();</div>
|
|
<div class="line"><a name="l00575"></a><span class="lineno"> 575</span>  hci_state = <a class="code" href="_b_t_d_8h.html#a8f1d666addd0c2bba7602fbd7a692228">HCI_LOCAL_VERSION_STATE</a>;</div>
|
|
<div class="line"><a name="l00576"></a><span class="lineno"> 576</span>  }</div>
|
|
<div class="line"><a name="l00577"></a><span class="lineno"> 577</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00578"></a><span class="lineno"> 578</span> </div>
|
|
<div class="line"><a name="l00579"></a><span class="lineno"> 579</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a8f1d666addd0c2bba7602fbd7a692228">HCI_LOCAL_VERSION_STATE</a>: <span class="comment">// The local version is used by the PS3BT class</span></div>
|
|
<div class="line"><a name="l00580"></a><span class="lineno"> 580</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#ad205c180970335a666dfe5081b55ade4">hci_read_version_complete</a>) {</div>
|
|
<div class="line"><a name="l00581"></a><span class="lineno"> 581</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a0359c0c158c864c27319810cbd1534f9">btdName</a> != NULL) {</div>
|
|
<div class="line"><a name="l00582"></a><span class="lineno"> 582</span>  <a class="code" href="class_b_t_d.html#a9a6747d58951f53389922d80e25b886c">hci_set_local_name</a>(<a class="code" href="class_b_t_d.html#a0359c0c158c864c27319810cbd1534f9">btdName</a>);</div>
|
|
<div class="line"><a name="l00583"></a><span class="lineno"> 583</span>  hci_state = <a class="code" href="_b_t_d_8h.html#a1939cc2e06b3185be07a93c1ac7a10e1">HCI_SET_NAME_STATE</a>;</div>
|
|
<div class="line"><a name="l00584"></a><span class="lineno"> 584</span>  } <span class="keywordflow">else</span></div>
|
|
<div class="line"><a name="l00585"></a><span class="lineno"> 585</span>  hci_state = <a class="code" href="_b_t_d_8h.html#a36daee23c5d0f4276e6eb32f3fd79124">HCI_CHECK_WII_SERVICE</a>;</div>
|
|
<div class="line"><a name="l00586"></a><span class="lineno"> 586</span>  }</div>
|
|
<div class="line"><a name="l00587"></a><span class="lineno"> 587</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00588"></a><span class="lineno"> 588</span> </div>
|
|
<div class="line"><a name="l00589"></a><span class="lineno"> 589</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a1939cc2e06b3185be07a93c1ac7a10e1">HCI_SET_NAME_STATE</a>:</div>
|
|
<div class="line"><a name="l00590"></a><span class="lineno"> 590</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#a9cc765dd92016efe6eaeff535a5193c1">hci_cmd_complete</a>) {</div>
|
|
<div class="line"><a name="l00591"></a><span class="lineno"> 591</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00592"></a><span class="lineno"> 592</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nThe name is set to: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00593"></a><span class="lineno"> 593</span>  <a class="code" href="message_8cpp.html#a389f3cf4766145374f70464477c3156a">NotifyStr</a>(<a class="code" href="class_b_t_d.html#a0359c0c158c864c27319810cbd1534f9">btdName</a>, 0x80);</div>
|
|
<div class="line"><a name="l00594"></a><span class="lineno"> 594</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00595"></a><span class="lineno"> 595</span> <span class="preprocessor"></span> hci_state = <a class="code" href="_b_t_d_8h.html#a36daee23c5d0f4276e6eb32f3fd79124">HCI_CHECK_WII_SERVICE</a>;</div>
|
|
<div class="line"><a name="l00596"></a><span class="lineno"> 596</span>  }</div>
|
|
<div class="line"><a name="l00597"></a><span class="lineno"> 597</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00598"></a><span class="lineno"> 598</span> </div>
|
|
<div class="line"><a name="l00599"></a><span class="lineno"> 599</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a36daee23c5d0f4276e6eb32f3fd79124">HCI_CHECK_WII_SERVICE</a>:</div>
|
|
<div class="line"><a name="l00600"></a><span class="lineno"> 600</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a0c8cc2a2dd2cda3e760b8b4c1a2d169c">pairWithWii</a>) { <span class="comment">// Check if it should try to connect to a wiimote</span></div>
|
|
<div class="line"><a name="l00601"></a><span class="lineno"> 601</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00602"></a><span class="lineno"> 602</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nStarting inquiry\r\nPress 1 & 2 on the Wiimote\r\nOr press sync if you are using a Wii U Pro Controller"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00603"></a><span class="lineno"> 603</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00604"></a><span class="lineno"> 604</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#a678f2c995553ce6a9f48f9b59f2f1555">hci_inquiry</a>();</div>
|
|
<div class="line"><a name="l00605"></a><span class="lineno"> 605</span>  hci_state = <a class="code" href="_b_t_d_8h.html#a09fa39bcefd3255f8ef762034e45679e">HCI_INQUIRY_STATE</a>;</div>
|
|
<div class="line"><a name="l00606"></a><span class="lineno"> 606</span>  } <span class="keywordflow">else</span></div>
|
|
<div class="line"><a name="l00607"></a><span class="lineno"> 607</span>  hci_state = <a class="code" href="_b_t_d_8h.html#acc9b6954b4bb6c19a9d25242869d5ddf">HCI_SCANNING_STATE</a>; <span class="comment">// Don't try to connect to a Wiimote</span></div>
|
|
<div class="line"><a name="l00608"></a><span class="lineno"> 608</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00609"></a><span class="lineno"> 609</span> </div>
|
|
<div class="line"><a name="l00610"></a><span class="lineno"> 610</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a09fa39bcefd3255f8ef762034e45679e">HCI_INQUIRY_STATE</a>:</div>
|
|
<div class="line"><a name="l00611"></a><span class="lineno"> 611</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#aa12b77df715652f4735cb6620cd595a4">hci_wii_found</a>) {</div>
|
|
<div class="line"><a name="l00612"></a><span class="lineno"> 612</span>  <a class="code" href="class_b_t_d.html#a45ffbc7a40bbb763b0ece907c3dfc9ff">hci_inquiry_cancel</a>(); <span class="comment">// Stop inquiry</span></div>
|
|
<div class="line"><a name="l00613"></a><span class="lineno"> 613</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00614"></a><span class="lineno"> 614</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nWiimote found"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00615"></a><span class="lineno"> 615</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nNow just create the instance like so:"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00616"></a><span class="lineno"> 616</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nWII Wii(&Btd);"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00617"></a><span class="lineno"> 617</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nAnd then press any button on the Wiimote"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00618"></a><span class="lineno"> 618</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00619"></a><span class="lineno"> 619</span> <span class="preprocessor"></span> <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a3aea445b2349e99ef057db1a4ffdd9dc">motionPlusInside</a>) {</div>
|
|
<div class="line"><a name="l00620"></a><span class="lineno"> 620</span>  <a class="code" href="class_b_t_d.html#a8767529bd203c549348a38ac9c6682b3">hci_remote_name</a>(); <span class="comment">// We need to know the name to distinguish between a Wiimote and a Wii U Pro Controller</span></div>
|
|
<div class="line"><a name="l00621"></a><span class="lineno"> 621</span>  hci_state = <a class="code" href="_b_t_d_8h.html#a4bad48092981dffe97edb052f5ae08bd">HCI_REMOTE_NAME_STATE</a>;</div>
|
|
<div class="line"><a name="l00622"></a><span class="lineno"> 622</span>  } <span class="keywordflow">else</span></div>
|
|
<div class="line"><a name="l00623"></a><span class="lineno"> 623</span>  hci_state = <a class="code" href="_b_t_d_8h.html#a2733141c8dae8cd14f78b11b21d58ebb">HCI_CONNECT_WII_STATE</a>;</div>
|
|
<div class="line"><a name="l00624"></a><span class="lineno"> 624</span>  }</div>
|
|
<div class="line"><a name="l00625"></a><span class="lineno"> 625</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00626"></a><span class="lineno"> 626</span> </div>
|
|
<div class="line"><a name="l00627"></a><span class="lineno"> 627</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a2733141c8dae8cd14f78b11b21d58ebb">HCI_CONNECT_WII_STATE</a>:</div>
|
|
<div class="line"><a name="l00628"></a><span class="lineno"> 628</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#a9cc765dd92016efe6eaeff535a5193c1">hci_cmd_complete</a>) {</div>
|
|
<div class="line"><a name="l00629"></a><span class="lineno"> 629</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00630"></a><span class="lineno"> 630</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nConnecting to Wiimote"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00631"></a><span class="lineno"> 631</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00632"></a><span class="lineno"> 632</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#ae7066ea743f8907708db945ebef3ad76">hci_connect</a>();</div>
|
|
<div class="line"><a name="l00633"></a><span class="lineno"> 633</span>  hci_state = <a class="code" href="_b_t_d_8h.html#ad497b58476b921e620f05791fa864f04">HCI_CONNECTED_WII_STATE</a>;</div>
|
|
<div class="line"><a name="l00634"></a><span class="lineno"> 634</span>  }</div>
|
|
<div class="line"><a name="l00635"></a><span class="lineno"> 635</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00636"></a><span class="lineno"> 636</span> </div>
|
|
<div class="line"><a name="l00637"></a><span class="lineno"> 637</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#ad497b58476b921e620f05791fa864f04">HCI_CONNECTED_WII_STATE</a>:</div>
|
|
<div class="line"><a name="l00638"></a><span class="lineno"> 638</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#a11ae66a6caad9105b8e7658189dcfa7b">hci_connect_event</a>) {</div>
|
|
<div class="line"><a name="l00639"></a><span class="lineno"> 639</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#ae43eba7b19fa5c92de5344819b99ec61">hci_connect_complete</a>) {</div>
|
|
<div class="line"><a name="l00640"></a><span class="lineno"> 640</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00641"></a><span class="lineno"> 641</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nConnected to Wiimote"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00642"></a><span class="lineno"> 642</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00643"></a><span class="lineno"> 643</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#addd07c18c725a324a05792a83026d36d">hci_authentication_request</a>(); <span class="comment">// This will start the pairing with the wiimote</span></div>
|
|
<div class="line"><a name="l00644"></a><span class="lineno"> 644</span>  hci_state = <a class="code" href="_b_t_d_8h.html#acc9b6954b4bb6c19a9d25242869d5ddf">HCI_SCANNING_STATE</a>;</div>
|
|
<div class="line"><a name="l00645"></a><span class="lineno"> 645</span>  } <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l00646"></a><span class="lineno"> 646</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00647"></a><span class="lineno"> 647</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nTrying to connect one more time..."</span>), 0x80);</div>
|
|
<div class="line"><a name="l00648"></a><span class="lineno"> 648</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00649"></a><span class="lineno"> 649</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#ae7066ea743f8907708db945ebef3ad76">hci_connect</a>(); <span class="comment">// Try to connect one more time</span></div>
|
|
<div class="line"><a name="l00650"></a><span class="lineno"> 650</span>  }</div>
|
|
<div class="line"><a name="l00651"></a><span class="lineno"> 651</span>  }</div>
|
|
<div class="line"><a name="l00652"></a><span class="lineno"> 652</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00653"></a><span class="lineno"> 653</span> </div>
|
|
<div class="line"><a name="l00654"></a><span class="lineno"> 654</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#acc9b6954b4bb6c19a9d25242869d5ddf">HCI_SCANNING_STATE</a>:</div>
|
|
<div class="line"><a name="l00655"></a><span class="lineno"> 655</span>  <span class="keywordflow">if</span> (!<a class="code" href="class_b_t_d.html#ac7caac80fb6f5f0e794af3644887d88e">connectToWii</a> && !<a class="code" href="class_b_t_d.html#a0c8cc2a2dd2cda3e760b8b4c1a2d169c">pairWithWii</a>) {</div>
|
|
<div class="line"><a name="l00656"></a><span class="lineno"> 656</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00657"></a><span class="lineno"> 657</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nWait For Incoming Connection Request"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00658"></a><span class="lineno"> 658</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00659"></a><span class="lineno"> 659</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#a7dd7faaec1d3d9a1d8159cc2a4190977">hci_write_scan_enable</a>();</div>
|
|
<div class="line"><a name="l00660"></a><span class="lineno"> 660</span>  <a class="code" href="class_b_t_d.html#aa7735da01865bab01b569ee836173737">watingForConnection</a> = <span class="keyword">true</span>;</div>
|
|
<div class="line"><a name="l00661"></a><span class="lineno"> 661</span>  hci_state = <a class="code" href="_b_t_d_8h.html#a8bfcf6e1a0a044aba26d728fb0c6a17a">HCI_CONNECT_IN_STATE</a>;</div>
|
|
<div class="line"><a name="l00662"></a><span class="lineno"> 662</span>  }</div>
|
|
<div class="line"><a name="l00663"></a><span class="lineno"> 663</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00664"></a><span class="lineno"> 664</span> </div>
|
|
<div class="line"><a name="l00665"></a><span class="lineno"> 665</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a8bfcf6e1a0a044aba26d728fb0c6a17a">HCI_CONNECT_IN_STATE</a>:</div>
|
|
<div class="line"><a name="l00666"></a><span class="lineno"> 666</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#aeb3a24db49f8158f85b928385e28d83a">hci_incoming_connect_request</a>) {</div>
|
|
<div class="line"><a name="l00667"></a><span class="lineno"> 667</span>  <a class="code" href="class_b_t_d.html#aa7735da01865bab01b569ee836173737">watingForConnection</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00668"></a><span class="lineno"> 668</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00669"></a><span class="lineno"> 669</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nIncoming Connection Request"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00670"></a><span class="lineno"> 670</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00671"></a><span class="lineno"> 671</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#a8767529bd203c549348a38ac9c6682b3">hci_remote_name</a>();</div>
|
|
<div class="line"><a name="l00672"></a><span class="lineno"> 672</span>  hci_state = <a class="code" href="_b_t_d_8h.html#a4bad48092981dffe97edb052f5ae08bd">HCI_REMOTE_NAME_STATE</a>;</div>
|
|
<div class="line"><a name="l00673"></a><span class="lineno"> 673</span>  } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#ae67c9cc739a52a8f4a3c28871a07bf1b">hci_disconnect_complete</a>)</div>
|
|
<div class="line"><a name="l00674"></a><span class="lineno"> 674</span>  hci_state = <a class="code" href="_b_t_d_8h.html#a31398eae2e433d1b7b39ea3d6d07cdd0">HCI_DISCONNECT_STATE</a>;</div>
|
|
<div class="line"><a name="l00675"></a><span class="lineno"> 675</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00676"></a><span class="lineno"> 676</span> </div>
|
|
<div class="line"><a name="l00677"></a><span class="lineno"> 677</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a4bad48092981dffe97edb052f5ae08bd">HCI_REMOTE_NAME_STATE</a>:</div>
|
|
<div class="line"><a name="l00678"></a><span class="lineno"> 678</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#a8f97f22fe3bc827916b8adb724b64a7f">hci_remote_name_complete</a>) {</div>
|
|
<div class="line"><a name="l00679"></a><span class="lineno"> 679</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00680"></a><span class="lineno"> 680</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nRemote Name: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00681"></a><span class="lineno"> 681</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 30; i++) {</div>
|
|
<div class="line"><a name="l00682"></a><span class="lineno"> 682</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#aede42d995c384c238fd49d728df01e4e">remote_name</a>[i] == NULL)</div>
|
|
<div class="line"><a name="l00683"></a><span class="lineno"> 683</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00684"></a><span class="lineno"> 684</span>  <a class="code" href="message_8cpp.html#aaf22fa58f749158910b90c3ce0bf2501">Notifyc</a>(<a class="code" href="class_b_t_d.html#aede42d995c384c238fd49d728df01e4e">remote_name</a>[i], 0x80);</div>
|
|
<div class="line"><a name="l00685"></a><span class="lineno"> 685</span>  }</div>
|
|
<div class="line"><a name="l00686"></a><span class="lineno"> 686</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00687"></a><span class="lineno"> 687</span> <span class="preprocessor"></span> <span class="keywordflow">if</span> (strncmp((<span class="keyword">const</span> <span class="keywordtype">char</span>*)<a class="code" href="class_b_t_d.html#aede42d995c384c238fd49d728df01e4e">remote_name</a>, <span class="stringliteral">"Nintendo"</span>, 8) == 0) {</div>
|
|
<div class="line"><a name="l00688"></a><span class="lineno"> 688</span>  <a class="code" href="class_b_t_d.html#a4dc8f94fe85028f3d54f13dde1e5b4ee">incomingWii</a> = <span class="keyword">true</span>;</div>
|
|
<div class="line"><a name="l00689"></a><span class="lineno"> 689</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00690"></a><span class="lineno"> 690</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nWiimote is connecting"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00691"></a><span class="lineno"> 691</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00692"></a><span class="lineno"> 692</span> <span class="preprocessor"></span> <span class="keywordflow">if</span> (strncmp((<span class="keyword">const</span> <span class="keywordtype">char</span>*)<a class="code" href="class_b_t_d.html#aede42d995c384c238fd49d728df01e4e">remote_name</a>, <span class="stringliteral">"Nintendo RVL-CNT-01-TR"</span>, 22) == 0) {</div>
|
|
<div class="line"><a name="l00693"></a><span class="lineno"> 693</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00694"></a><span class="lineno"> 694</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">" with Motion Plus Inside"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00695"></a><span class="lineno"> 695</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00696"></a><span class="lineno"> 696</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#a3aea445b2349e99ef057db1a4ffdd9dc">motionPlusInside</a> = <span class="keyword">true</span>;</div>
|
|
<div class="line"><a name="l00697"></a><span class="lineno"> 697</span>  } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (strncmp((<span class="keyword">const</span> <span class="keywordtype">char</span>*)<a class="code" href="class_b_t_d.html#aede42d995c384c238fd49d728df01e4e">remote_name</a>, <span class="stringliteral">"Nintendo RVL-CNT-01-UC"</span>, 22) == 0) {</div>
|
|
<div class="line"><a name="l00698"></a><span class="lineno"> 698</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00699"></a><span class="lineno"> 699</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">" - Wii U Pro Controller"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00700"></a><span class="lineno"> 700</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00701"></a><span class="lineno"> 701</span> <span class="preprocessor"></span> <a class="code" href="class_b_t_d.html#a3aea445b2349e99ef057db1a4ffdd9dc">motionPlusInside</a> = <span class="keyword">true</span>;</div>
|
|
<div class="line"><a name="l00702"></a><span class="lineno"> 702</span>  <a class="code" href="class_b_t_d.html#a962a5714c225dcb633434f02e3657583">wiiUProController</a> = <span class="keyword">true</span>;</div>
|
|
<div class="line"><a name="l00703"></a><span class="lineno"> 703</span>  } <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l00704"></a><span class="lineno"> 704</span>  <a class="code" href="class_b_t_d.html#a3aea445b2349e99ef057db1a4ffdd9dc">motionPlusInside</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00705"></a><span class="lineno"> 705</span>  <a class="code" href="class_b_t_d.html#a962a5714c225dcb633434f02e3657583">wiiUProController</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00706"></a><span class="lineno"> 706</span>  }</div>
|
|
<div class="line"><a name="l00707"></a><span class="lineno"> 707</span>  }</div>
|
|
<div class="line"><a name="l00708"></a><span class="lineno"> 708</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a0c8cc2a2dd2cda3e760b8b4c1a2d169c">pairWithWii</a> && <a class="code" href="class_b_t_d.html#a3aea445b2349e99ef057db1a4ffdd9dc">motionPlusInside</a>)</div>
|
|
<div class="line"><a name="l00709"></a><span class="lineno"> 709</span>  hci_state = <a class="code" href="_b_t_d_8h.html#a2733141c8dae8cd14f78b11b21d58ebb">HCI_CONNECT_WII_STATE</a>;</div>
|
|
<div class="line"><a name="l00710"></a><span class="lineno"> 710</span>  <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l00711"></a><span class="lineno"> 711</span>  <a class="code" href="class_b_t_d.html#a1cb07a155c69bb1fcf45ae030b8947ec">hci_accept_connection</a>();</div>
|
|
<div class="line"><a name="l00712"></a><span class="lineno"> 712</span>  hci_state = <a class="code" href="_b_t_d_8h.html#ae0a16d1cc0142186a20379b5c68bd1e0">HCI_CONNECTED_STATE</a>;</div>
|
|
<div class="line"><a name="l00713"></a><span class="lineno"> 713</span>  }</div>
|
|
<div class="line"><a name="l00714"></a><span class="lineno"> 714</span>  }</div>
|
|
<div class="line"><a name="l00715"></a><span class="lineno"> 715</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00716"></a><span class="lineno"> 716</span> </div>
|
|
<div class="line"><a name="l00717"></a><span class="lineno"> 717</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#ae0a16d1cc0142186a20379b5c68bd1e0">HCI_CONNECTED_STATE</a>:</div>
|
|
<div class="line"><a name="l00718"></a><span class="lineno"> 718</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#ae43eba7b19fa5c92de5344819b99ec61">hci_connect_complete</a>) {</div>
|
|
<div class="line"><a name="l00719"></a><span class="lineno"> 719</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00720"></a><span class="lineno"> 720</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nConnected to Device: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00721"></a><span class="lineno"> 721</span>  <span class="keywordflow">for</span> (int8_t i = 5; i > 0; i--) {</div>
|
|
<div class="line"><a name="l00722"></a><span class="lineno"> 722</span>  PrintHex<uint8_t > (<a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[i], 0x80);</div>
|
|
<div class="line"><a name="l00723"></a><span class="lineno"> 723</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">":"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00724"></a><span class="lineno"> 724</span>  }</div>
|
|
<div class="line"><a name="l00725"></a><span class="lineno"> 725</span>  PrintHex<uint8_t > (disc_bdaddr[0], 0x80);</div>
|
|
<div class="line"><a name="l00726"></a><span class="lineno"> 726</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00727"></a><span class="lineno"> 727</span> <span class="preprocessor"></span> <span class="comment">// Clear these flags for a new connection</span></div>
|
|
<div class="line"><a name="l00728"></a><span class="lineno"> 728</span>  <a class="code" href="class_b_t_d.html#a0f1c28a03bcbe62cc7c083f97ea27594">l2capConnectionClaimed</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00729"></a><span class="lineno"> 729</span>  <a class="code" href="class_b_t_d.html#af5e5b085cec1da5c83c75e80e95b3590">sdpConnectionClaimed</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00730"></a><span class="lineno"> 730</span>  <a class="code" href="class_b_t_d.html#a9e5a34242007b64cd6a226cfd1901e74">rfcommConnectionClaimed</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00731"></a><span class="lineno"> 731</span> </div>
|
|
<div class="line"><a name="l00732"></a><span class="lineno"> 732</span>  hci_event_flag = 0;</div>
|
|
<div class="line"><a name="l00733"></a><span class="lineno"> 733</span>  hci_state = <a class="code" href="_b_t_d_8h.html#a20fc1ebfc3da8e048f6afe53330e6b8f">HCI_DONE_STATE</a>;</div>
|
|
<div class="line"><a name="l00734"></a><span class="lineno"> 734</span>  }</div>
|
|
<div class="line"><a name="l00735"></a><span class="lineno"> 735</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00736"></a><span class="lineno"> 736</span> </div>
|
|
<div class="line"><a name="l00737"></a><span class="lineno"> 737</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a20fc1ebfc3da8e048f6afe53330e6b8f">HCI_DONE_STATE</a>:</div>
|
|
<div class="line"><a name="l00738"></a><span class="lineno"> 738</span>  hci_counter++;</div>
|
|
<div class="line"><a name="l00739"></a><span class="lineno"> 739</span>  <span class="keywordflow">if</span> (hci_counter > 1000) { <span class="comment">// Wait until we have looped 1000 times to make sure that the L2CAP connection has been started</span></div>
|
|
<div class="line"><a name="l00740"></a><span class="lineno"> 740</span>  hci_counter = 0;</div>
|
|
<div class="line"><a name="l00741"></a><span class="lineno"> 741</span>  hci_state = <a class="code" href="_b_t_d_8h.html#acc9b6954b4bb6c19a9d25242869d5ddf">HCI_SCANNING_STATE</a>;</div>
|
|
<div class="line"><a name="l00742"></a><span class="lineno"> 742</span>  }</div>
|
|
<div class="line"><a name="l00743"></a><span class="lineno"> 743</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00744"></a><span class="lineno"> 744</span> </div>
|
|
<div class="line"><a name="l00745"></a><span class="lineno"> 745</span>  <span class="keywordflow">case</span> <a class="code" href="_b_t_d_8h.html#a31398eae2e433d1b7b39ea3d6d07cdd0">HCI_DISCONNECT_STATE</a>:</div>
|
|
<div class="line"><a name="l00746"></a><span class="lineno"> 746</span>  <span class="keywordflow">if</span> (<a class="code" href="_b_t_d_8h.html#ae67c9cc739a52a8f4a3c28871a07bf1b">hci_disconnect_complete</a>) {</div>
|
|
<div class="line"><a name="l00747"></a><span class="lineno"> 747</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00748"></a><span class="lineno"> 748</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nHCI Disconnected from Device"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00749"></a><span class="lineno"> 749</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00750"></a><span class="lineno"> 750</span> <span class="preprocessor"></span> hci_event_flag = 0; <span class="comment">// Clear all flags</span></div>
|
|
<div class="line"><a name="l00751"></a><span class="lineno"> 751</span> </div>
|
|
<div class="line"><a name="l00752"></a><span class="lineno"> 752</span>  <span class="comment">// Reset all buffers</span></div>
|
|
<div class="line"><a name="l00753"></a><span class="lineno"> 753</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < <a class="code" href="_b_t_d_8h.html#a32d591ef5742a99963130616ef146787">BULK_MAXPKTSIZE</a>; i++)</div>
|
|
<div class="line"><a name="l00754"></a><span class="lineno"> 754</span>  hcibuf[i] = 0;</div>
|
|
<div class="line"><a name="l00755"></a><span class="lineno"> 755</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < <a class="code" href="_b_t_d_8h.html#a32d591ef5742a99963130616ef146787">BULK_MAXPKTSIZE</a>; i++)</div>
|
|
<div class="line"><a name="l00756"></a><span class="lineno"> 756</span>  l2capinbuf[i] = 0;</div>
|
|
<div class="line"><a name="l00757"></a><span class="lineno"> 757</span> </div>
|
|
<div class="line"><a name="l00758"></a><span class="lineno"> 758</span>  hci_state = <a class="code" href="_b_t_d_8h.html#acc9b6954b4bb6c19a9d25242869d5ddf">HCI_SCANNING_STATE</a>;</div>
|
|
<div class="line"><a name="l00759"></a><span class="lineno"> 759</span>  }</div>
|
|
<div class="line"><a name="l00760"></a><span class="lineno"> 760</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00761"></a><span class="lineno"> 761</span>  <span class="keywordflow">default</span>:</div>
|
|
<div class="line"><a name="l00762"></a><span class="lineno"> 762</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00763"></a><span class="lineno"> 763</span>  }</div>
|
|
<div class="line"><a name="l00764"></a><span class="lineno"> 764</span> }</div>
|
|
<div class="line"><a name="l00765"></a><span class="lineno"> 765</span> </div>
|
|
<div class="line"><a name="l00766"></a><span class="lineno"> 766</span> <span class="keywordtype">void</span> BTD::ACL_event_task() {</div>
|
|
<div class="line"><a name="l00767"></a><span class="lineno"> 767</span>  uint16_t MAX_BUFFER_SIZE = <a class="code" href="_b_t_d_8h.html#a32d591ef5742a99963130616ef146787">BULK_MAXPKTSIZE</a>;</div>
|
|
<div class="line"><a name="l00768"></a><span class="lineno"> 768</span>  uint8_t rcode = <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#ad75d64f648b102fab2bd75e53e1324a4">inTransfer</a>(<a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a>, <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[ <a class="code" href="class_b_t_d.html#a480510bd399ae74a97cd74c8474ef59c">BTD_DATAIN_PIPE</a> ].epAddr, &MAX_BUFFER_SIZE, l2capinbuf); <span class="comment">// input on endpoint 2</span></div>
|
|
<div class="line"><a name="l00769"></a><span class="lineno"> 769</span>  <span class="keywordflow">if</span> (!rcode) { <span class="comment">// Check for errors</span></div>
|
|
<div class="line"><a name="l00770"></a><span class="lineno"> 770</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < <a class="code" href="_b_t_d_8h.html#a2222709eed4c8af293e881ea36f599b0">BTD_NUMSERVICES</a>; i++)</div>
|
|
<div class="line"><a name="l00771"></a><span class="lineno"> 771</span>  <span class="keywordflow">if</span> (btService[i])</div>
|
|
<div class="line"><a name="l00772"></a><span class="lineno"> 772</span>  btService[i]-><a class="code" href="class_bluetooth_service.html#a8dc98310fe481357eaa86c53e49af113">ACLData</a>(l2capinbuf);</div>
|
|
<div class="line"><a name="l00773"></a><span class="lineno"> 773</span>  }</div>
|
|
<div class="line"><a name="l00774"></a><span class="lineno"> 774</span> <span class="preprocessor">#ifdef EXTRADEBUG</span></div>
|
|
<div class="line"><a name="l00775"></a><span class="lineno"> 775</span> <span class="preprocessor"></span> <span class="keywordflow">else</span> <span class="keywordflow">if</span> (rcode != <a class="code" href="max3421e_8h.html#ab44a7968d08016b58d98951059c37076">hrNAK</a>) {</div>
|
|
<div class="line"><a name="l00776"></a><span class="lineno"> 776</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nACL data in error: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00777"></a><span class="lineno"> 777</span>  PrintHex<uint8_t > (rcode, 0x80);</div>
|
|
<div class="line"><a name="l00778"></a><span class="lineno"> 778</span>  }</div>
|
|
<div class="line"><a name="l00779"></a><span class="lineno"> 779</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00780"></a><span class="lineno"> 780</span> <span class="preprocessor"></span> <span class="keywordflow">for</span> (uint8_t i = 0; i < <a class="code" href="_b_t_d_8h.html#a2222709eed4c8af293e881ea36f599b0">BTD_NUMSERVICES</a>; i++)</div>
|
|
<div class="line"><a name="l00781"></a><span class="lineno"> 781</span>  <span class="keywordflow">if</span> (btService[i])</div>
|
|
<div class="line"><a name="l00782"></a><span class="lineno"> 782</span>  btService[i]-><a class="code" href="class_bluetooth_service.html#a680692ff13cb37eb81ddbb74bc9e0383">Run</a>();</div>
|
|
<div class="line"><a name="l00783"></a><span class="lineno"> 783</span> }</div>
|
|
<div class="line"><a name="l00784"></a><span class="lineno"> 784</span> </div>
|
|
<div class="line"><a name="l00785"></a><span class="lineno"> 785</span> <span class="comment">/************************************************************/</span></div>
|
|
<div class="line"><a name="l00786"></a><span class="lineno"> 786</span> <span class="comment">/* HCI Commands */</span></div>
|
|
<div class="line"><a name="l00787"></a><span class="lineno"> 787</span> </div>
|
|
<div class="line"><a name="l00788"></a><span class="lineno"> 788</span> <span class="comment">/************************************************************/</span></div>
|
|
<div class="line"><a name="l00789"></a><span class="lineno"><a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda"> 789</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">BTD::HCI_Command</a>(uint8_t* data, uint16_t nbytes) {</div>
|
|
<div class="line"><a name="l00790"></a><span class="lineno"> 790</span>  hci_event_flag &= ~<a class="code" href="_b_t_d_8h.html#a14087b750ea2da7f0cef4daaa7683d01">HCI_FLAG_CMD_COMPLETE</a>;</div>
|
|
<div class="line"><a name="l00791"></a><span class="lineno"> 791</span>  <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a636695a5c3d35cd6b9e31c54edfacd7c">ctrlReq</a>(<a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a>, <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[ <a class="code" href="class_b_t_d.html#a49f433ab824f259c3815e180c73bb0ad">BTD_CONTROL_PIPE</a> ].epAddr, <a class="code" href="_b_t_d_8h.html#ad70df063f83bf7000558b1d73aa009e5">bmREQ_HCI_OUT</a>, 0x00, 0x00, 0x00, 0x00, nbytes, nbytes, data, NULL);</div>
|
|
<div class="line"><a name="l00792"></a><span class="lineno"> 792</span> }</div>
|
|
<div class="line"><a name="l00793"></a><span class="lineno"> 793</span> </div>
|
|
<div class="line"><a name="l00794"></a><span class="lineno"><a class="code" href="class_b_t_d.html#ae6f942eabd29257bc4896e5f263275b6"> 794</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#ae6f942eabd29257bc4896e5f263275b6">BTD::hci_reset</a>() {</div>
|
|
<div class="line"><a name="l00795"></a><span class="lineno"> 795</span>  hci_event_flag = 0; <span class="comment">// Clear all the flags</span></div>
|
|
<div class="line"><a name="l00796"></a><span class="lineno"> 796</span>  hcibuf[0] = 0x03; <span class="comment">// HCI OCF = 3</span></div>
|
|
<div class="line"><a name="l00797"></a><span class="lineno"> 797</span>  hcibuf[1] = 0x03 << 2; <span class="comment">// HCI OGF = 3</span></div>
|
|
<div class="line"><a name="l00798"></a><span class="lineno"> 798</span>  hcibuf[2] = 0x00;</div>
|
|
<div class="line"><a name="l00799"></a><span class="lineno"> 799</span> </div>
|
|
<div class="line"><a name="l00800"></a><span class="lineno"> 800</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 3);</div>
|
|
<div class="line"><a name="l00801"></a><span class="lineno"> 801</span> }</div>
|
|
<div class="line"><a name="l00802"></a><span class="lineno"> 802</span> </div>
|
|
<div class="line"><a name="l00803"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a7dd7faaec1d3d9a1d8159cc2a4190977"> 803</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a7dd7faaec1d3d9a1d8159cc2a4190977">BTD::hci_write_scan_enable</a>() {</div>
|
|
<div class="line"><a name="l00804"></a><span class="lineno"> 804</span>  hci_event_flag &= ~<a class="code" href="_b_t_d_8h.html#a0e8a8ce5838e265c1732795bf8822043">HCI_FLAG_INCOMING_REQUEST</a>;</div>
|
|
<div class="line"><a name="l00805"></a><span class="lineno"> 805</span>  hcibuf[0] = 0x1A; <span class="comment">// HCI OCF = 1A</span></div>
|
|
<div class="line"><a name="l00806"></a><span class="lineno"> 806</span>  hcibuf[1] = 0x03 << 2; <span class="comment">// HCI OGF = 3</span></div>
|
|
<div class="line"><a name="l00807"></a><span class="lineno"> 807</span>  hcibuf[2] = 0x01; <span class="comment">// parameter length = 1</span></div>
|
|
<div class="line"><a name="l00808"></a><span class="lineno"> 808</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a0359c0c158c864c27319810cbd1534f9">btdName</a> != NULL)</div>
|
|
<div class="line"><a name="l00809"></a><span class="lineno"> 809</span>  hcibuf[3] = 0x03; <span class="comment">// Inquiry Scan enabled. Page Scan enabled.</span></div>
|
|
<div class="line"><a name="l00810"></a><span class="lineno"> 810</span>  <span class="keywordflow">else</span></div>
|
|
<div class="line"><a name="l00811"></a><span class="lineno"> 811</span>  hcibuf[3] = 0x02; <span class="comment">// Inquiry Scan disabled. Page Scan enabled.</span></div>
|
|
<div class="line"><a name="l00812"></a><span class="lineno"> 812</span> </div>
|
|
<div class="line"><a name="l00813"></a><span class="lineno"> 813</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 4);</div>
|
|
<div class="line"><a name="l00814"></a><span class="lineno"> 814</span> }</div>
|
|
<div class="line"><a name="l00815"></a><span class="lineno"> 815</span> </div>
|
|
<div class="line"><a name="l00816"></a><span class="lineno"><a class="code" href="class_b_t_d.html#aff59ab45d917406141ae0c9c79047f08"> 816</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#aff59ab45d917406141ae0c9c79047f08">BTD::hci_write_scan_disable</a>() {</div>
|
|
<div class="line"><a name="l00817"></a><span class="lineno"> 817</span>  hcibuf[0] = 0x1A; <span class="comment">// HCI OCF = 1A</span></div>
|
|
<div class="line"><a name="l00818"></a><span class="lineno"> 818</span>  hcibuf[1] = 0x03 << 2; <span class="comment">// HCI OGF = 3</span></div>
|
|
<div class="line"><a name="l00819"></a><span class="lineno"> 819</span>  hcibuf[2] = 0x01; <span class="comment">// parameter length = 1</span></div>
|
|
<div class="line"><a name="l00820"></a><span class="lineno"> 820</span>  hcibuf[3] = 0x00; <span class="comment">// Inquiry Scan disabled. Page Scan disabled.</span></div>
|
|
<div class="line"><a name="l00821"></a><span class="lineno"> 821</span> </div>
|
|
<div class="line"><a name="l00822"></a><span class="lineno"> 822</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 4);</div>
|
|
<div class="line"><a name="l00823"></a><span class="lineno"> 823</span> }</div>
|
|
<div class="line"><a name="l00824"></a><span class="lineno"> 824</span> </div>
|
|
<div class="line"><a name="l00825"></a><span class="lineno"><a class="code" href="class_b_t_d.html#acb94a629477d85cebd16a9c5ecd4a8b3"> 825</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#acb94a629477d85cebd16a9c5ecd4a8b3">BTD::hci_read_bdaddr</a>() {</div>
|
|
<div class="line"><a name="l00826"></a><span class="lineno"> 826</span>  hcibuf[0] = 0x09; <span class="comment">// HCI OCF = 9</span></div>
|
|
<div class="line"><a name="l00827"></a><span class="lineno"> 827</span>  hcibuf[1] = 0x04 << 2; <span class="comment">// HCI OGF = 4</span></div>
|
|
<div class="line"><a name="l00828"></a><span class="lineno"> 828</span>  hcibuf[2] = 0x00;</div>
|
|
<div class="line"><a name="l00829"></a><span class="lineno"> 829</span> </div>
|
|
<div class="line"><a name="l00830"></a><span class="lineno"> 830</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 3);</div>
|
|
<div class="line"><a name="l00831"></a><span class="lineno"> 831</span> }</div>
|
|
<div class="line"><a name="l00832"></a><span class="lineno"> 832</span> </div>
|
|
<div class="line"><a name="l00833"></a><span class="lineno"><a class="code" href="class_b_t_d.html#ae2ba215b6942f4131e4c5fdef2771e22"> 833</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#ae2ba215b6942f4131e4c5fdef2771e22">BTD::hci_read_local_version_information</a>() {</div>
|
|
<div class="line"><a name="l00834"></a><span class="lineno"> 834</span>  hcibuf[0] = 0x01; <span class="comment">// HCI OCF = 1</span></div>
|
|
<div class="line"><a name="l00835"></a><span class="lineno"> 835</span>  hcibuf[1] = 0x04 << 2; <span class="comment">// HCI OGF = 4</span></div>
|
|
<div class="line"><a name="l00836"></a><span class="lineno"> 836</span>  hcibuf[2] = 0x00;</div>
|
|
<div class="line"><a name="l00837"></a><span class="lineno"> 837</span> </div>
|
|
<div class="line"><a name="l00838"></a><span class="lineno"> 838</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 3);</div>
|
|
<div class="line"><a name="l00839"></a><span class="lineno"> 839</span> }</div>
|
|
<div class="line"><a name="l00840"></a><span class="lineno"> 840</span> </div>
|
|
<div class="line"><a name="l00841"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a1cb07a155c69bb1fcf45ae030b8947ec"> 841</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a1cb07a155c69bb1fcf45ae030b8947ec">BTD::hci_accept_connection</a>() {</div>
|
|
<div class="line"><a name="l00842"></a><span class="lineno"> 842</span>  hci_event_flag &= ~<a class="code" href="_b_t_d_8h.html#aa05458d2a47122cd62cd0748c7e1e313">HCI_FLAG_CONN_COMPLETE</a>;</div>
|
|
<div class="line"><a name="l00843"></a><span class="lineno"> 843</span>  hcibuf[0] = 0x09; <span class="comment">// HCI OCF = 9</span></div>
|
|
<div class="line"><a name="l00844"></a><span class="lineno"> 844</span>  hcibuf[1] = 0x01 << 2; <span class="comment">// HCI OGF = 1</span></div>
|
|
<div class="line"><a name="l00845"></a><span class="lineno"> 845</span>  hcibuf[2] = 0x07; <span class="comment">// parameter length 7</span></div>
|
|
<div class="line"><a name="l00846"></a><span class="lineno"> 846</span>  hcibuf[3] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[0]; <span class="comment">// 6 octet bdaddr</span></div>
|
|
<div class="line"><a name="l00847"></a><span class="lineno"> 847</span>  hcibuf[4] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[1];</div>
|
|
<div class="line"><a name="l00848"></a><span class="lineno"> 848</span>  hcibuf[5] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[2];</div>
|
|
<div class="line"><a name="l00849"></a><span class="lineno"> 849</span>  hcibuf[6] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[3];</div>
|
|
<div class="line"><a name="l00850"></a><span class="lineno"> 850</span>  hcibuf[7] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[4];</div>
|
|
<div class="line"><a name="l00851"></a><span class="lineno"> 851</span>  hcibuf[8] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[5];</div>
|
|
<div class="line"><a name="l00852"></a><span class="lineno"> 852</span>  hcibuf[9] = 0x00; <span class="comment">//switch role to master</span></div>
|
|
<div class="line"><a name="l00853"></a><span class="lineno"> 853</span> </div>
|
|
<div class="line"><a name="l00854"></a><span class="lineno"> 854</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 10);</div>
|
|
<div class="line"><a name="l00855"></a><span class="lineno"> 855</span> }</div>
|
|
<div class="line"><a name="l00856"></a><span class="lineno"> 856</span> </div>
|
|
<div class="line"><a name="l00857"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a8767529bd203c549348a38ac9c6682b3"> 857</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a8767529bd203c549348a38ac9c6682b3">BTD::hci_remote_name</a>() {</div>
|
|
<div class="line"><a name="l00858"></a><span class="lineno"> 858</span>  hci_event_flag &= ~<a class="code" href="_b_t_d_8h.html#a400af4b61f6e94ab821fa368d8bf2b07">HCI_FLAG_REMOTE_NAME_COMPLETE</a>;</div>
|
|
<div class="line"><a name="l00859"></a><span class="lineno"> 859</span>  hcibuf[0] = 0x19; <span class="comment">// HCI OCF = 19</span></div>
|
|
<div class="line"><a name="l00860"></a><span class="lineno"> 860</span>  hcibuf[1] = 0x01 << 2; <span class="comment">// HCI OGF = 1</span></div>
|
|
<div class="line"><a name="l00861"></a><span class="lineno"> 861</span>  hcibuf[2] = 0x0A; <span class="comment">// parameter length = 10</span></div>
|
|
<div class="line"><a name="l00862"></a><span class="lineno"> 862</span>  hcibuf[3] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[0]; <span class="comment">// 6 octet bdaddr</span></div>
|
|
<div class="line"><a name="l00863"></a><span class="lineno"> 863</span>  hcibuf[4] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[1];</div>
|
|
<div class="line"><a name="l00864"></a><span class="lineno"> 864</span>  hcibuf[5] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[2];</div>
|
|
<div class="line"><a name="l00865"></a><span class="lineno"> 865</span>  hcibuf[6] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[3];</div>
|
|
<div class="line"><a name="l00866"></a><span class="lineno"> 866</span>  hcibuf[7] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[4];</div>
|
|
<div class="line"><a name="l00867"></a><span class="lineno"> 867</span>  hcibuf[8] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[5];</div>
|
|
<div class="line"><a name="l00868"></a><span class="lineno"> 868</span>  hcibuf[9] = 0x01; <span class="comment">//Page Scan Repetition Mode</span></div>
|
|
<div class="line"><a name="l00869"></a><span class="lineno"> 869</span>  hcibuf[10] = 0x00; <span class="comment">//Reserved</span></div>
|
|
<div class="line"><a name="l00870"></a><span class="lineno"> 870</span>  hcibuf[11] = 0x00; <span class="comment">//Clock offset - low byte</span></div>
|
|
<div class="line"><a name="l00871"></a><span class="lineno"> 871</span>  hcibuf[12] = 0x00; <span class="comment">//Clock offset - high byte</span></div>
|
|
<div class="line"><a name="l00872"></a><span class="lineno"> 872</span> </div>
|
|
<div class="line"><a name="l00873"></a><span class="lineno"> 873</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 13);</div>
|
|
<div class="line"><a name="l00874"></a><span class="lineno"> 874</span> }</div>
|
|
<div class="line"><a name="l00875"></a><span class="lineno"> 875</span> </div>
|
|
<div class="line"><a name="l00876"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a9a6747d58951f53389922d80e25b886c"> 876</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a9a6747d58951f53389922d80e25b886c">BTD::hci_set_local_name</a>(<span class="keyword">const</span> <span class="keywordtype">char</span>* name) {</div>
|
|
<div class="line"><a name="l00877"></a><span class="lineno"> 877</span>  hcibuf[0] = 0x13; <span class="comment">// HCI OCF = 13</span></div>
|
|
<div class="line"><a name="l00878"></a><span class="lineno"> 878</span>  hcibuf[1] = 0x03 << 2; <span class="comment">// HCI OGF = 3</span></div>
|
|
<div class="line"><a name="l00879"></a><span class="lineno"> 879</span>  hcibuf[2] = strlen(name) + 1; <span class="comment">// parameter length = the length of the string + end byte</span></div>
|
|
<div class="line"><a name="l00880"></a><span class="lineno"> 880</span>  uint8_t i;</div>
|
|
<div class="line"><a name="l00881"></a><span class="lineno"> 881</span>  <span class="keywordflow">for</span> (i = 0; i < strlen(name); i++)</div>
|
|
<div class="line"><a name="l00882"></a><span class="lineno"> 882</span>  hcibuf[i + 3] = name[i];</div>
|
|
<div class="line"><a name="l00883"></a><span class="lineno"> 883</span>  hcibuf[i + 3] = 0x00; <span class="comment">// End of string</span></div>
|
|
<div class="line"><a name="l00884"></a><span class="lineno"> 884</span> </div>
|
|
<div class="line"><a name="l00885"></a><span class="lineno"> 885</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 4 + strlen(name));</div>
|
|
<div class="line"><a name="l00886"></a><span class="lineno"> 886</span> }</div>
|
|
<div class="line"><a name="l00887"></a><span class="lineno"> 887</span> </div>
|
|
<div class="line"><a name="l00888"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a678f2c995553ce6a9f48f9b59f2f1555"> 888</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a678f2c995553ce6a9f48f9b59f2f1555">BTD::hci_inquiry</a>() {</div>
|
|
<div class="line"><a name="l00889"></a><span class="lineno"> 889</span>  hci_event_flag &= ~<a class="code" href="_b_t_d_8h.html#aa991873698787cf45d26efaa370f34e2">HCI_FLAG_WII_FOUND</a>;</div>
|
|
<div class="line"><a name="l00890"></a><span class="lineno"> 890</span>  hcibuf[0] = 0x01;</div>
|
|
<div class="line"><a name="l00891"></a><span class="lineno"> 891</span>  hcibuf[1] = 0x01 << 2; <span class="comment">// HCI OGF = 1</span></div>
|
|
<div class="line"><a name="l00892"></a><span class="lineno"> 892</span>  hcibuf[2] = 0x05; <span class="comment">// Parameter Total Length = 5</span></div>
|
|
<div class="line"><a name="l00893"></a><span class="lineno"> 893</span>  hcibuf[3] = 0x33; <span class="comment">// LAP: Genera/Unlimited Inquiry Access Code (GIAC = 0x9E8B33) - see https://www.bluetooth.org/Technical/AssignedNumbers/baseband.htm</span></div>
|
|
<div class="line"><a name="l00894"></a><span class="lineno"> 894</span>  hcibuf[4] = 0x8B;</div>
|
|
<div class="line"><a name="l00895"></a><span class="lineno"> 895</span>  hcibuf[5] = 0x9E;</div>
|
|
<div class="line"><a name="l00896"></a><span class="lineno"> 896</span>  hcibuf[6] = 0x30; <span class="comment">// Inquiry time = 61.44 sec (maximum)</span></div>
|
|
<div class="line"><a name="l00897"></a><span class="lineno"> 897</span>  hcibuf[7] = 0x0A; <span class="comment">// 10 number of responses</span></div>
|
|
<div class="line"><a name="l00898"></a><span class="lineno"> 898</span> </div>
|
|
<div class="line"><a name="l00899"></a><span class="lineno"> 899</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 8);</div>
|
|
<div class="line"><a name="l00900"></a><span class="lineno"> 900</span> }</div>
|
|
<div class="line"><a name="l00901"></a><span class="lineno"> 901</span> </div>
|
|
<div class="line"><a name="l00902"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a45ffbc7a40bbb763b0ece907c3dfc9ff"> 902</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a45ffbc7a40bbb763b0ece907c3dfc9ff">BTD::hci_inquiry_cancel</a>() {</div>
|
|
<div class="line"><a name="l00903"></a><span class="lineno"> 903</span>  hcibuf[0] = 0x02;</div>
|
|
<div class="line"><a name="l00904"></a><span class="lineno"> 904</span>  hcibuf[1] = 0x01 << 2; <span class="comment">// HCI OGF = 1</span></div>
|
|
<div class="line"><a name="l00905"></a><span class="lineno"> 905</span>  hcibuf[2] = 0x00; <span class="comment">// Parameter Total Length = 0</span></div>
|
|
<div class="line"><a name="l00906"></a><span class="lineno"> 906</span> </div>
|
|
<div class="line"><a name="l00907"></a><span class="lineno"> 907</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 3);</div>
|
|
<div class="line"><a name="l00908"></a><span class="lineno"> 908</span> }</div>
|
|
<div class="line"><a name="l00909"></a><span class="lineno"> 909</span> </div>
|
|
<div class="line"><a name="l00910"></a><span class="lineno"><a class="code" href="class_b_t_d.html#ae7066ea743f8907708db945ebef3ad76"> 910</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#ae7066ea743f8907708db945ebef3ad76">BTD::hci_connect</a>() {</div>
|
|
<div class="line"><a name="l00911"></a><span class="lineno"> 911</span>  hci_event_flag &= ~(<a class="code" href="_b_t_d_8h.html#aa05458d2a47122cd62cd0748c7e1e313">HCI_FLAG_CONN_COMPLETE</a> | <a class="code" href="_b_t_d_8h.html#ad14762241e9195fc9a3b0a69ef1ab7f3">HCI_FLAG_CONNECT_EVENT</a>);</div>
|
|
<div class="line"><a name="l00912"></a><span class="lineno"> 912</span>  hcibuf[0] = 0x05;</div>
|
|
<div class="line"><a name="l00913"></a><span class="lineno"> 913</span>  hcibuf[1] = 0x01 << 2; <span class="comment">// HCI OGF = 1</span></div>
|
|
<div class="line"><a name="l00914"></a><span class="lineno"> 914</span>  hcibuf[2] = 0x0D; <span class="comment">// parameter Total Length = 13</span></div>
|
|
<div class="line"><a name="l00915"></a><span class="lineno"> 915</span>  hcibuf[3] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[0]; <span class="comment">// 6 octet bdaddr</span></div>
|
|
<div class="line"><a name="l00916"></a><span class="lineno"> 916</span>  hcibuf[4] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[1];</div>
|
|
<div class="line"><a name="l00917"></a><span class="lineno"> 917</span>  hcibuf[5] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[2];</div>
|
|
<div class="line"><a name="l00918"></a><span class="lineno"> 918</span>  hcibuf[6] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[3];</div>
|
|
<div class="line"><a name="l00919"></a><span class="lineno"> 919</span>  hcibuf[7] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[4];</div>
|
|
<div class="line"><a name="l00920"></a><span class="lineno"> 920</span>  hcibuf[8] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[5];</div>
|
|
<div class="line"><a name="l00921"></a><span class="lineno"> 921</span>  hcibuf[9] = 0x18; <span class="comment">// DM1 or DH1 may be used</span></div>
|
|
<div class="line"><a name="l00922"></a><span class="lineno"> 922</span>  hcibuf[10] = 0xCC; <span class="comment">// DM3, DH3, DM5, DH5 may be used</span></div>
|
|
<div class="line"><a name="l00923"></a><span class="lineno"> 923</span>  hcibuf[11] = 0x01; <span class="comment">// Page repetition mode R1</span></div>
|
|
<div class="line"><a name="l00924"></a><span class="lineno"> 924</span>  hcibuf[12] = 0x00; <span class="comment">// Reserved</span></div>
|
|
<div class="line"><a name="l00925"></a><span class="lineno"> 925</span>  hcibuf[13] = 0x00; <span class="comment">// Clock offset</span></div>
|
|
<div class="line"><a name="l00926"></a><span class="lineno"> 926</span>  hcibuf[14] = 0x00; <span class="comment">// Invalid clock offset</span></div>
|
|
<div class="line"><a name="l00927"></a><span class="lineno"> 927</span>  hcibuf[15] = 0x00; <span class="comment">// Do not allow role switch</span></div>
|
|
<div class="line"><a name="l00928"></a><span class="lineno"> 928</span> </div>
|
|
<div class="line"><a name="l00929"></a><span class="lineno"> 929</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 16);</div>
|
|
<div class="line"><a name="l00930"></a><span class="lineno"> 930</span> }</div>
|
|
<div class="line"><a name="l00931"></a><span class="lineno"> 931</span> </div>
|
|
<div class="line"><a name="l00932"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a70047b0f624c3f0ef29f8b76b8a34938"> 932</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a70047b0f624c3f0ef29f8b76b8a34938">BTD::hci_pin_code_request_reply</a>() {</div>
|
|
<div class="line"><a name="l00933"></a><span class="lineno"> 933</span>  hcibuf[0] = 0x0D; <span class="comment">// HCI OCF = 0D</span></div>
|
|
<div class="line"><a name="l00934"></a><span class="lineno"> 934</span>  hcibuf[1] = 0x01 << 2; <span class="comment">// HCI OGF = 1</span></div>
|
|
<div class="line"><a name="l00935"></a><span class="lineno"> 935</span>  hcibuf[2] = 0x17; <span class="comment">// parameter length 23</span></div>
|
|
<div class="line"><a name="l00936"></a><span class="lineno"> 936</span>  hcibuf[3] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[0]; <span class="comment">// 6 octet bdaddr</span></div>
|
|
<div class="line"><a name="l00937"></a><span class="lineno"> 937</span>  hcibuf[4] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[1];</div>
|
|
<div class="line"><a name="l00938"></a><span class="lineno"> 938</span>  hcibuf[5] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[2];</div>
|
|
<div class="line"><a name="l00939"></a><span class="lineno"> 939</span>  hcibuf[6] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[3];</div>
|
|
<div class="line"><a name="l00940"></a><span class="lineno"> 940</span>  hcibuf[7] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[4];</div>
|
|
<div class="line"><a name="l00941"></a><span class="lineno"> 941</span>  hcibuf[8] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[5];</div>
|
|
<div class="line"><a name="l00942"></a><span class="lineno"> 942</span>  <span class="keywordflow">if</span> (<a class="code" href="class_b_t_d.html#a0c8cc2a2dd2cda3e760b8b4c1a2d169c">pairWithWii</a>) {</div>
|
|
<div class="line"><a name="l00943"></a><span class="lineno"> 943</span>  hcibuf[9] = 6; <span class="comment">// Pin length is the length of the Bluetooth address</span></div>
|
|
<div class="line"><a name="l00944"></a><span class="lineno"> 944</span>  <span class="keywordflow">if</span>(<a class="code" href="class_b_t_d.html#a962a5714c225dcb633434f02e3657583">wiiUProController</a>) {</div>
|
|
<div class="line"><a name="l00945"></a><span class="lineno"> 945</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l00946"></a><span class="lineno"> 946</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nParing with Wii U Pro Controller"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00947"></a><span class="lineno"> 947</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00948"></a><span class="lineno"> 948</span> <span class="preprocessor"></span> <span class="keywordflow">for</span>(uint8_t i = 0; i < 6; i++)</div>
|
|
<div class="line"><a name="l00949"></a><span class="lineno"> 949</span>  hcibuf[10 + i] = <a class="code" href="class_b_t_d.html#a1f8e9171a310e50f2c4a3c19066efe5a">my_bdaddr</a>[i]; <span class="comment">// The pin is the Bluetooth dongles Bluetooth address backwards</span></div>
|
|
<div class="line"><a name="l00950"></a><span class="lineno"> 950</span>  }</div>
|
|
<div class="line"><a name="l00951"></a><span class="lineno"> 951</span>  <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l00952"></a><span class="lineno"> 952</span>  <span class="keywordflow">for</span>(uint8_t i = 0; i < 6; i++)</div>
|
|
<div class="line"><a name="l00953"></a><span class="lineno"> 953</span>  hcibuf[10 + i] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[i]; <span class="comment">// The pin is the Wiimote's Bluetooth address backwards</span></div>
|
|
<div class="line"><a name="l00954"></a><span class="lineno"> 954</span>  }</div>
|
|
<div class="line"><a name="l00955"></a><span class="lineno"> 955</span>  <span class="keywordflow">for</span> (uint8_t i = 16; i < 26; i++)</div>
|
|
<div class="line"><a name="l00956"></a><span class="lineno"> 956</span>  hcibuf[i] = 0x00; <span class="comment">// The rest should be 0</span></div>
|
|
<div class="line"><a name="l00957"></a><span class="lineno"> 957</span>  } <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l00958"></a><span class="lineno"> 958</span>  hcibuf[9] = strlen(<a class="code" href="class_b_t_d.html#a215cb939c01ed3ff56db37841224546c">btdPin</a>); <span class="comment">// Length of pin</span></div>
|
|
<div class="line"><a name="l00959"></a><span class="lineno"> 959</span>  uint8_t i;</div>
|
|
<div class="line"><a name="l00960"></a><span class="lineno"> 960</span>  <span class="keywordflow">for</span> (i = 0; i < strlen(<a class="code" href="class_b_t_d.html#a215cb939c01ed3ff56db37841224546c">btdPin</a>); i++) <span class="comment">// The maximum size of the pin is 16</span></div>
|
|
<div class="line"><a name="l00961"></a><span class="lineno"> 961</span>  hcibuf[i + 10] = <a class="code" href="class_b_t_d.html#a215cb939c01ed3ff56db37841224546c">btdPin</a>[i];</div>
|
|
<div class="line"><a name="l00962"></a><span class="lineno"> 962</span>  <span class="keywordflow">for</span> (; i < 16; i++)</div>
|
|
<div class="line"><a name="l00963"></a><span class="lineno"> 963</span>  hcibuf[i + 10] = 0x00; <span class="comment">// The rest should be 0</span></div>
|
|
<div class="line"><a name="l00964"></a><span class="lineno"> 964</span>  }</div>
|
|
<div class="line"><a name="l00965"></a><span class="lineno"> 965</span> </div>
|
|
<div class="line"><a name="l00966"></a><span class="lineno"> 966</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 26);</div>
|
|
<div class="line"><a name="l00967"></a><span class="lineno"> 967</span> }</div>
|
|
<div class="line"><a name="l00968"></a><span class="lineno"> 968</span> </div>
|
|
<div class="line"><a name="l00969"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a7114d2cb62aa413e5ecb25c45c76832b"> 969</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a7114d2cb62aa413e5ecb25c45c76832b">BTD::hci_pin_code_negative_request_reply</a>() {</div>
|
|
<div class="line"><a name="l00970"></a><span class="lineno"> 970</span>  hcibuf[0] = 0x0E; <span class="comment">// HCI OCF = 0E</span></div>
|
|
<div class="line"><a name="l00971"></a><span class="lineno"> 971</span>  hcibuf[1] = 0x01 << 2; <span class="comment">// HCI OGF = 1</span></div>
|
|
<div class="line"><a name="l00972"></a><span class="lineno"> 972</span>  hcibuf[2] = 0x06; <span class="comment">// parameter length 6</span></div>
|
|
<div class="line"><a name="l00973"></a><span class="lineno"> 973</span>  hcibuf[3] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[0]; <span class="comment">// 6 octet bdaddr</span></div>
|
|
<div class="line"><a name="l00974"></a><span class="lineno"> 974</span>  hcibuf[4] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[1];</div>
|
|
<div class="line"><a name="l00975"></a><span class="lineno"> 975</span>  hcibuf[5] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[2];</div>
|
|
<div class="line"><a name="l00976"></a><span class="lineno"> 976</span>  hcibuf[6] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[3];</div>
|
|
<div class="line"><a name="l00977"></a><span class="lineno"> 977</span>  hcibuf[7] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[4];</div>
|
|
<div class="line"><a name="l00978"></a><span class="lineno"> 978</span>  hcibuf[8] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[5];</div>
|
|
<div class="line"><a name="l00979"></a><span class="lineno"> 979</span> </div>
|
|
<div class="line"><a name="l00980"></a><span class="lineno"> 980</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 9);</div>
|
|
<div class="line"><a name="l00981"></a><span class="lineno"> 981</span> }</div>
|
|
<div class="line"><a name="l00982"></a><span class="lineno"> 982</span> </div>
|
|
<div class="line"><a name="l00983"></a><span class="lineno"><a class="code" href="class_b_t_d.html#af4d28b9c1a3b9688a1871610caee2cfc"> 983</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#af4d28b9c1a3b9688a1871610caee2cfc">BTD::hci_link_key_request_negative_reply</a>() {</div>
|
|
<div class="line"><a name="l00984"></a><span class="lineno"> 984</span>  hcibuf[0] = 0x0C; <span class="comment">// HCI OCF = 0C</span></div>
|
|
<div class="line"><a name="l00985"></a><span class="lineno"> 985</span>  hcibuf[1] = 0x01 << 2; <span class="comment">// HCI OGF = 1</span></div>
|
|
<div class="line"><a name="l00986"></a><span class="lineno"> 986</span>  hcibuf[2] = 0x06; <span class="comment">// parameter length 6</span></div>
|
|
<div class="line"><a name="l00987"></a><span class="lineno"> 987</span>  hcibuf[3] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[0]; <span class="comment">// 6 octet bdaddr</span></div>
|
|
<div class="line"><a name="l00988"></a><span class="lineno"> 988</span>  hcibuf[4] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[1];</div>
|
|
<div class="line"><a name="l00989"></a><span class="lineno"> 989</span>  hcibuf[5] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[2];</div>
|
|
<div class="line"><a name="l00990"></a><span class="lineno"> 990</span>  hcibuf[6] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[3];</div>
|
|
<div class="line"><a name="l00991"></a><span class="lineno"> 991</span>  hcibuf[7] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[4];</div>
|
|
<div class="line"><a name="l00992"></a><span class="lineno"> 992</span>  hcibuf[8] = <a class="code" href="class_b_t_d.html#ab23f95f12675d7b4505ca6807d379182">disc_bdaddr</a>[5];</div>
|
|
<div class="line"><a name="l00993"></a><span class="lineno"> 993</span> </div>
|
|
<div class="line"><a name="l00994"></a><span class="lineno"> 994</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 9);</div>
|
|
<div class="line"><a name="l00995"></a><span class="lineno"> 995</span> }</div>
|
|
<div class="line"><a name="l00996"></a><span class="lineno"> 996</span> </div>
|
|
<div class="line"><a name="l00997"></a><span class="lineno"><a class="code" href="class_b_t_d.html#addd07c18c725a324a05792a83026d36d"> 997</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#addd07c18c725a324a05792a83026d36d">BTD::hci_authentication_request</a>() {</div>
|
|
<div class="line"><a name="l00998"></a><span class="lineno"> 998</span>  hcibuf[0] = 0x11; <span class="comment">// HCI OCF = 11</span></div>
|
|
<div class="line"><a name="l00999"></a><span class="lineno"> 999</span>  hcibuf[1] = 0x01 << 2; <span class="comment">// HCI OGF = 1</span></div>
|
|
<div class="line"><a name="l01000"></a><span class="lineno"> 1000</span>  hcibuf[2] = 0x02; <span class="comment">// parameter length = 2</span></div>
|
|
<div class="line"><a name="l01001"></a><span class="lineno"> 1001</span>  hcibuf[3] = (uint8_t)(<a class="code" href="class_b_t_d.html#aa3bb6c692701cb33dfad1ea4d68b6f98">hci_handle</a> & 0xFF); <span class="comment">//connection handle - low byte</span></div>
|
|
<div class="line"><a name="l01002"></a><span class="lineno"> 1002</span>  hcibuf[4] = (uint8_t)((<a class="code" href="class_b_t_d.html#aa3bb6c692701cb33dfad1ea4d68b6f98">hci_handle</a> >> 8) & 0x0F); <span class="comment">//connection handle - high byte</span></div>
|
|
<div class="line"><a name="l01003"></a><span class="lineno"> 1003</span> </div>
|
|
<div class="line"><a name="l01004"></a><span class="lineno"> 1004</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 5);</div>
|
|
<div class="line"><a name="l01005"></a><span class="lineno"> 1005</span> }</div>
|
|
<div class="line"><a name="l01006"></a><span class="lineno"> 1006</span> </div>
|
|
<div class="line"><a name="l01007"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a1bea5dd793a2f47006b4a7642efc9e56"> 1007</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a1bea5dd793a2f47006b4a7642efc9e56">BTD::hci_disconnect</a>(uint16_t handle) { <span class="comment">// This is called by the different services</span></div>
|
|
<div class="line"><a name="l01008"></a><span class="lineno"> 1008</span>  hci_event_flag &= ~<a class="code" href="_b_t_d_8h.html#aec17e7d699b1023a0b6f675feddd7d58">HCI_FLAG_DISCONN_COMPLETE</a>;</div>
|
|
<div class="line"><a name="l01009"></a><span class="lineno"> 1009</span>  hcibuf[0] = 0x06; <span class="comment">// HCI OCF = 6</span></div>
|
|
<div class="line"><a name="l01010"></a><span class="lineno"> 1010</span>  hcibuf[1] = 0x01 << 2; <span class="comment">// HCI OGF = 1</span></div>
|
|
<div class="line"><a name="l01011"></a><span class="lineno"> 1011</span>  hcibuf[2] = 0x03; <span class="comment">// parameter length = 3</span></div>
|
|
<div class="line"><a name="l01012"></a><span class="lineno"> 1012</span>  hcibuf[3] = (uint8_t)(handle & 0xFF); <span class="comment">//connection handle - low byte</span></div>
|
|
<div class="line"><a name="l01013"></a><span class="lineno"> 1013</span>  hcibuf[4] = (uint8_t)((handle >> 8) & 0x0F); <span class="comment">//connection handle - high byte</span></div>
|
|
<div class="line"><a name="l01014"></a><span class="lineno"> 1014</span>  hcibuf[5] = 0x13; <span class="comment">// reason</span></div>
|
|
<div class="line"><a name="l01015"></a><span class="lineno"> 1015</span> </div>
|
|
<div class="line"><a name="l01016"></a><span class="lineno"> 1016</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 6);</div>
|
|
<div class="line"><a name="l01017"></a><span class="lineno"> 1017</span> }</div>
|
|
<div class="line"><a name="l01018"></a><span class="lineno"> 1018</span> </div>
|
|
<div class="line"><a name="l01019"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a9a17405df60591b909ff1502fb8f3141"> 1019</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a9a17405df60591b909ff1502fb8f3141">BTD::hci_write_class_of_device</a>() { <span class="comment">// See http://bluetooth-pentest.narod.ru/software/bluetooth_class_of_device-service_generator.html</span></div>
|
|
<div class="line"><a name="l01020"></a><span class="lineno"> 1020</span>  hcibuf[0] = 0x24; <span class="comment">// HCI OCF = 3</span></div>
|
|
<div class="line"><a name="l01021"></a><span class="lineno"> 1021</span>  hcibuf[1] = 0x03 << 2; <span class="comment">// HCI OGF = 3</span></div>
|
|
<div class="line"><a name="l01022"></a><span class="lineno"> 1022</span>  hcibuf[2] = 0x03; <span class="comment">// parameter length = 3</span></div>
|
|
<div class="line"><a name="l01023"></a><span class="lineno"> 1023</span>  hcibuf[3] = 0x04; <span class="comment">// Robot</span></div>
|
|
<div class="line"><a name="l01024"></a><span class="lineno"> 1024</span>  hcibuf[4] = 0x08; <span class="comment">// Toy</span></div>
|
|
<div class="line"><a name="l01025"></a><span class="lineno"> 1025</span>  hcibuf[5] = 0x00;</div>
|
|
<div class="line"><a name="l01026"></a><span class="lineno"> 1026</span> </div>
|
|
<div class="line"><a name="l01027"></a><span class="lineno"> 1027</span>  <a class="code" href="class_b_t_d.html#af11ad71d20783d46fe42dd405d10dfda">HCI_Command</a>(hcibuf, 6);</div>
|
|
<div class="line"><a name="l01028"></a><span class="lineno"> 1028</span> }</div>
|
|
<div class="line"><a name="l01029"></a><span class="lineno"> 1029</span> <span class="comment">/*******************************************************************</span></div>
|
|
<div class="line"><a name="l01030"></a><span class="lineno"> 1030</span> <span class="comment"> * *</span></div>
|
|
<div class="line"><a name="l01031"></a><span class="lineno"> 1031</span> <span class="comment"> * HCI ACL Data Packet *</span></div>
|
|
<div class="line"><a name="l01032"></a><span class="lineno"> 1032</span> <span class="comment"> * *</span></div>
|
|
<div class="line"><a name="l01033"></a><span class="lineno"> 1033</span> <span class="comment"> * buf[0] buf[1] buf[2] buf[3]</span></div>
|
|
<div class="line"><a name="l01034"></a><span class="lineno"> 1034</span> <span class="comment"> * 0 4 8 11 12 16 24 31 MSB</span></div>
|
|
<div class="line"><a name="l01035"></a><span class="lineno"> 1035</span> <span class="comment"> * .-+-+-+-+-+-+-+-|-+-+-+-|-+-|-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-.</span></div>
|
|
<div class="line"><a name="l01036"></a><span class="lineno"> 1036</span> <span class="comment"> * | HCI Handle |PB |BC | Data Total Length | HCI ACL Data Packet</span></div>
|
|
<div class="line"><a name="l01037"></a><span class="lineno"> 1037</span> <span class="comment"> * .-+-+-+-+-+-+-+-|-+-+-+-|-+-|-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-.</span></div>
|
|
<div class="line"><a name="l01038"></a><span class="lineno"> 1038</span> <span class="comment"> *</span></div>
|
|
<div class="line"><a name="l01039"></a><span class="lineno"> 1039</span> <span class="comment"> * buf[4] buf[5] buf[6] buf[7]</span></div>
|
|
<div class="line"><a name="l01040"></a><span class="lineno"> 1040</span> <span class="comment"> * 0 8 16 31 MSB</span></div>
|
|
<div class="line"><a name="l01041"></a><span class="lineno"> 1041</span> <span class="comment"> * .-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-.</span></div>
|
|
<div class="line"><a name="l01042"></a><span class="lineno"> 1042</span> <span class="comment"> * | Length | Channel ID | Basic L2CAP header</span></div>
|
|
<div class="line"><a name="l01043"></a><span class="lineno"> 1043</span> <span class="comment"> * .-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-.</span></div>
|
|
<div class="line"><a name="l01044"></a><span class="lineno"> 1044</span> <span class="comment"> *</span></div>
|
|
<div class="line"><a name="l01045"></a><span class="lineno"> 1045</span> <span class="comment"> * buf[8] buf[9] buf[10] buf[11]</span></div>
|
|
<div class="line"><a name="l01046"></a><span class="lineno"> 1046</span> <span class="comment"> * 0 8 16 31 MSB</span></div>
|
|
<div class="line"><a name="l01047"></a><span class="lineno"> 1047</span> <span class="comment"> * .-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-.</span></div>
|
|
<div class="line"><a name="l01048"></a><span class="lineno"> 1048</span> <span class="comment"> * | Code | Identifier | Length | Control frame (C-frame)</span></div>
|
|
<div class="line"><a name="l01049"></a><span class="lineno"> 1049</span> <span class="comment"> * .-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-. (signaling packet format)</span></div>
|
|
<div class="line"><a name="l01050"></a><span class="lineno"> 1050</span> <span class="comment"> */</span></div>
|
|
<div class="line"><a name="l01051"></a><span class="lineno"> 1051</span> <span class="comment">/************************************************************/</span></div>
|
|
<div class="line"><a name="l01052"></a><span class="lineno"> 1052</span> <span class="comment">/* L2CAP Commands */</span></div>
|
|
<div class="line"><a name="l01053"></a><span class="lineno"> 1053</span> </div>
|
|
<div class="line"><a name="l01054"></a><span class="lineno"> 1054</span> <span class="comment">/************************************************************/</span></div>
|
|
<div class="line"><a name="l01055"></a><span class="lineno"><a class="code" href="class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7"> 1055</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7">BTD::L2CAP_Command</a>(uint16_t handle, uint8_t* data, uint8_t nbytes, uint8_t channelLow, uint8_t channelHigh) {</div>
|
|
<div class="line"><a name="l01056"></a><span class="lineno"> 1056</span>  uint8_t buf[8 + nbytes];</div>
|
|
<div class="line"><a name="l01057"></a><span class="lineno"> 1057</span>  buf[0] = (uint8_t)(handle & 0xff); <span class="comment">// HCI handle with PB,BC flag</span></div>
|
|
<div class="line"><a name="l01058"></a><span class="lineno"> 1058</span>  buf[1] = (uint8_t)(((handle >> 8) & 0x0f) | 0x20);</div>
|
|
<div class="line"><a name="l01059"></a><span class="lineno"> 1059</span>  buf[2] = (uint8_t)((4 + nbytes) & 0xff); <span class="comment">// HCI ACL total data length</span></div>
|
|
<div class="line"><a name="l01060"></a><span class="lineno"> 1060</span>  buf[3] = (uint8_t)((4 + nbytes) >> 8);</div>
|
|
<div class="line"><a name="l01061"></a><span class="lineno"> 1061</span>  buf[4] = (uint8_t)(nbytes & 0xff); <span class="comment">// L2CAP header: Length</span></div>
|
|
<div class="line"><a name="l01062"></a><span class="lineno"> 1062</span>  buf[5] = (uint8_t)(nbytes >> 8);</div>
|
|
<div class="line"><a name="l01063"></a><span class="lineno"> 1063</span>  buf[6] = channelLow;</div>
|
|
<div class="line"><a name="l01064"></a><span class="lineno"> 1064</span>  buf[7] = channelHigh;</div>
|
|
<div class="line"><a name="l01065"></a><span class="lineno"> 1065</span> </div>
|
|
<div class="line"><a name="l01066"></a><span class="lineno"> 1066</span>  <span class="keywordflow">for</span> (uint16_t i = 0; i < nbytes; i++) <span class="comment">// L2CAP C-frame</span></div>
|
|
<div class="line"><a name="l01067"></a><span class="lineno"> 1067</span>  buf[8 + i] = data[i];</div>
|
|
<div class="line"><a name="l01068"></a><span class="lineno"> 1068</span> </div>
|
|
<div class="line"><a name="l01069"></a><span class="lineno"> 1069</span>  uint8_t rcode = <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#affbc018973a588995457d535b0ac7ee7">outTransfer</a>(<a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a>, <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[ <a class="code" href="class_b_t_d.html#a0d82870f7eef8c27c33e6f5989d7a4dd">BTD_DATAOUT_PIPE</a> ].epAddr, (8 + nbytes), buf);</div>
|
|
<div class="line"><a name="l01070"></a><span class="lineno"> 1070</span>  <span class="keywordflow">if</span> (rcode) {</div>
|
|
<div class="line"><a name="l01071"></a><span class="lineno"> 1071</span>  delay(100); <span class="comment">// This small delay prevents it from overflowing if it fails</span></div>
|
|
<div class="line"><a name="l01072"></a><span class="lineno"> 1072</span> <span class="preprocessor">#ifdef DEBUG</span></div>
|
|
<div class="line"><a name="l01073"></a><span class="lineno"> 1073</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">"\r\nError sending L2CAP message: 0x"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01074"></a><span class="lineno"> 1074</span>  PrintHex<uint8_t > (rcode, 0x80);</div>
|
|
<div class="line"><a name="l01075"></a><span class="lineno"> 1075</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">" - Channel ID: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l01076"></a><span class="lineno"> 1076</span>  PrintHex<uint8_t > (channelHigh, 0x80);</div>
|
|
<div class="line"><a name="l01077"></a><span class="lineno"> 1077</span>  <a class="code" href="message_8cpp.html#a1e8693828152de8408add858dc461dea">Notify</a>(PSTR(<span class="stringliteral">" "</span>), 0x80);</div>
|
|
<div class="line"><a name="l01078"></a><span class="lineno"> 1078</span>  PrintHex<uint8_t > (channelLow, 0x80);</div>
|
|
<div class="line"><a name="l01079"></a><span class="lineno"> 1079</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l01080"></a><span class="lineno"> 1080</span> <span class="preprocessor"></span> }</div>
|
|
<div class="line"><a name="l01081"></a><span class="lineno"> 1081</span> }</div>
|
|
<div class="line"><a name="l01082"></a><span class="lineno"> 1082</span> </div>
|
|
<div class="line"><a name="l01083"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a55cf412a2053972a353b1ab964ca9d3e"> 1083</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a55cf412a2053972a353b1ab964ca9d3e">BTD::l2cap_connection_request</a>(uint16_t handle, uint8_t rxid, uint8_t* scid, uint16_t psm) {</div>
|
|
<div class="line"><a name="l01084"></a><span class="lineno"> 1084</span>  l2capoutbuf[0] = <a class="code" href="_b_t_d_8h.html#ac4bae0c65fd00ed849cb226302d19c85">L2CAP_CMD_CONNECTION_REQUEST</a>; <span class="comment">// Code</span></div>
|
|
<div class="line"><a name="l01085"></a><span class="lineno"> 1085</span>  l2capoutbuf[1] = rxid; <span class="comment">// Identifier</span></div>
|
|
<div class="line"><a name="l01086"></a><span class="lineno"> 1086</span>  l2capoutbuf[2] = 0x04; <span class="comment">// Length</span></div>
|
|
<div class="line"><a name="l01087"></a><span class="lineno"> 1087</span>  l2capoutbuf[3] = 0x00;</div>
|
|
<div class="line"><a name="l01088"></a><span class="lineno"> 1088</span>  l2capoutbuf[4] = (uint8_t)(psm & 0xff); <span class="comment">// PSM</span></div>
|
|
<div class="line"><a name="l01089"></a><span class="lineno"> 1089</span>  l2capoutbuf[5] = (uint8_t)(psm >> 8);</div>
|
|
<div class="line"><a name="l01090"></a><span class="lineno"> 1090</span>  l2capoutbuf[6] = scid[0]; <span class="comment">// Source CID</span></div>
|
|
<div class="line"><a name="l01091"></a><span class="lineno"> 1091</span>  l2capoutbuf[7] = scid[1];</div>
|
|
<div class="line"><a name="l01092"></a><span class="lineno"> 1092</span> </div>
|
|
<div class="line"><a name="l01093"></a><span class="lineno"> 1093</span>  <a class="code" href="class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7">L2CAP_Command</a>(handle, l2capoutbuf, 8);</div>
|
|
<div class="line"><a name="l01094"></a><span class="lineno"> 1094</span> }</div>
|
|
<div class="line"><a name="l01095"></a><span class="lineno"> 1095</span> </div>
|
|
<div class="line"><a name="l01096"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a7d34c62b1d561679dea5cd27356b38a7"> 1096</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a7d34c62b1d561679dea5cd27356b38a7">BTD::l2cap_connection_response</a>(uint16_t handle, uint8_t rxid, uint8_t* dcid, uint8_t* scid, uint8_t result) {</div>
|
|
<div class="line"><a name="l01097"></a><span class="lineno"> 1097</span>  l2capoutbuf[0] = <a class="code" href="_b_t_d_8h.html#aef7b306479de265d725dbe5816a8227b">L2CAP_CMD_CONNECTION_RESPONSE</a>; <span class="comment">// Code</span></div>
|
|
<div class="line"><a name="l01098"></a><span class="lineno"> 1098</span>  l2capoutbuf[1] = rxid; <span class="comment">// Identifier</span></div>
|
|
<div class="line"><a name="l01099"></a><span class="lineno"> 1099</span>  l2capoutbuf[2] = 0x08; <span class="comment">// Length</span></div>
|
|
<div class="line"><a name="l01100"></a><span class="lineno"> 1100</span>  l2capoutbuf[3] = 0x00;</div>
|
|
<div class="line"><a name="l01101"></a><span class="lineno"> 1101</span>  l2capoutbuf[4] = dcid[0]; <span class="comment">// Destination CID</span></div>
|
|
<div class="line"><a name="l01102"></a><span class="lineno"> 1102</span>  l2capoutbuf[5] = dcid[1];</div>
|
|
<div class="line"><a name="l01103"></a><span class="lineno"> 1103</span>  l2capoutbuf[6] = scid[0]; <span class="comment">// Source CID</span></div>
|
|
<div class="line"><a name="l01104"></a><span class="lineno"> 1104</span>  l2capoutbuf[7] = scid[1];</div>
|
|
<div class="line"><a name="l01105"></a><span class="lineno"> 1105</span>  l2capoutbuf[8] = result; <span class="comment">// Result: Pending or Success</span></div>
|
|
<div class="line"><a name="l01106"></a><span class="lineno"> 1106</span>  l2capoutbuf[9] = 0x00;</div>
|
|
<div class="line"><a name="l01107"></a><span class="lineno"> 1107</span>  l2capoutbuf[10] = 0x00; <span class="comment">// No further information</span></div>
|
|
<div class="line"><a name="l01108"></a><span class="lineno"> 1108</span>  l2capoutbuf[11] = 0x00;</div>
|
|
<div class="line"><a name="l01109"></a><span class="lineno"> 1109</span> </div>
|
|
<div class="line"><a name="l01110"></a><span class="lineno"> 1110</span>  <a class="code" href="class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7">L2CAP_Command</a>(handle, l2capoutbuf, 12);</div>
|
|
<div class="line"><a name="l01111"></a><span class="lineno"> 1111</span> }</div>
|
|
<div class="line"><a name="l01112"></a><span class="lineno"> 1112</span> </div>
|
|
<div class="line"><a name="l01113"></a><span class="lineno"><a class="code" href="class_b_t_d.html#ab646a59311344966f139bb3b78f30233"> 1113</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#ab646a59311344966f139bb3b78f30233">BTD::l2cap_config_request</a>(uint16_t handle, uint8_t rxid, uint8_t* dcid) {</div>
|
|
<div class="line"><a name="l01114"></a><span class="lineno"> 1114</span>  l2capoutbuf[0] = <a class="code" href="_b_t_d_8h.html#a48bcd73461d736d0ef889e1fe6e36f69">L2CAP_CMD_CONFIG_REQUEST</a>; <span class="comment">// Code</span></div>
|
|
<div class="line"><a name="l01115"></a><span class="lineno"> 1115</span>  l2capoutbuf[1] = rxid; <span class="comment">// Identifier</span></div>
|
|
<div class="line"><a name="l01116"></a><span class="lineno"> 1116</span>  l2capoutbuf[2] = 0x08; <span class="comment">// Length</span></div>
|
|
<div class="line"><a name="l01117"></a><span class="lineno"> 1117</span>  l2capoutbuf[3] = 0x00;</div>
|
|
<div class="line"><a name="l01118"></a><span class="lineno"> 1118</span>  l2capoutbuf[4] = dcid[0]; <span class="comment">// Destination CID</span></div>
|
|
<div class="line"><a name="l01119"></a><span class="lineno"> 1119</span>  l2capoutbuf[5] = dcid[1];</div>
|
|
<div class="line"><a name="l01120"></a><span class="lineno"> 1120</span>  l2capoutbuf[6] = 0x00; <span class="comment">// Flags</span></div>
|
|
<div class="line"><a name="l01121"></a><span class="lineno"> 1121</span>  l2capoutbuf[7] = 0x00;</div>
|
|
<div class="line"><a name="l01122"></a><span class="lineno"> 1122</span>  l2capoutbuf[8] = 0x01; <span class="comment">// Config Opt: type = MTU (Maximum Transmission Unit) - Hint</span></div>
|
|
<div class="line"><a name="l01123"></a><span class="lineno"> 1123</span>  l2capoutbuf[9] = 0x02; <span class="comment">// Config Opt: length</span></div>
|
|
<div class="line"><a name="l01124"></a><span class="lineno"> 1124</span>  l2capoutbuf[10] = 0xFF; <span class="comment">// MTU</span></div>
|
|
<div class="line"><a name="l01125"></a><span class="lineno"> 1125</span>  l2capoutbuf[11] = 0xFF;</div>
|
|
<div class="line"><a name="l01126"></a><span class="lineno"> 1126</span> </div>
|
|
<div class="line"><a name="l01127"></a><span class="lineno"> 1127</span>  <a class="code" href="class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7">L2CAP_Command</a>(handle, l2capoutbuf, 12);</div>
|
|
<div class="line"><a name="l01128"></a><span class="lineno"> 1128</span> }</div>
|
|
<div class="line"><a name="l01129"></a><span class="lineno"> 1129</span> </div>
|
|
<div class="line"><a name="l01130"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a792ac4529b65235698ecf3d37982c05e"> 1130</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a792ac4529b65235698ecf3d37982c05e">BTD::l2cap_config_response</a>(uint16_t handle, uint8_t rxid, uint8_t* scid) {</div>
|
|
<div class="line"><a name="l01131"></a><span class="lineno"> 1131</span>  l2capoutbuf[0] = <a class="code" href="_b_t_d_8h.html#a8151b1fe5d940a5a7a34f43a8b8ce434">L2CAP_CMD_CONFIG_RESPONSE</a>; <span class="comment">// Code</span></div>
|
|
<div class="line"><a name="l01132"></a><span class="lineno"> 1132</span>  l2capoutbuf[1] = rxid; <span class="comment">// Identifier</span></div>
|
|
<div class="line"><a name="l01133"></a><span class="lineno"> 1133</span>  l2capoutbuf[2] = 0x0A; <span class="comment">// Length</span></div>
|
|
<div class="line"><a name="l01134"></a><span class="lineno"> 1134</span>  l2capoutbuf[3] = 0x00;</div>
|
|
<div class="line"><a name="l01135"></a><span class="lineno"> 1135</span>  l2capoutbuf[4] = scid[0]; <span class="comment">// Source CID</span></div>
|
|
<div class="line"><a name="l01136"></a><span class="lineno"> 1136</span>  l2capoutbuf[5] = scid[1];</div>
|
|
<div class="line"><a name="l01137"></a><span class="lineno"> 1137</span>  l2capoutbuf[6] = 0x00; <span class="comment">// Flag</span></div>
|
|
<div class="line"><a name="l01138"></a><span class="lineno"> 1138</span>  l2capoutbuf[7] = 0x00;</div>
|
|
<div class="line"><a name="l01139"></a><span class="lineno"> 1139</span>  l2capoutbuf[8] = 0x00; <span class="comment">// Result</span></div>
|
|
<div class="line"><a name="l01140"></a><span class="lineno"> 1140</span>  l2capoutbuf[9] = 0x00;</div>
|
|
<div class="line"><a name="l01141"></a><span class="lineno"> 1141</span>  l2capoutbuf[10] = 0x01; <span class="comment">// Config</span></div>
|
|
<div class="line"><a name="l01142"></a><span class="lineno"> 1142</span>  l2capoutbuf[11] = 0x02;</div>
|
|
<div class="line"><a name="l01143"></a><span class="lineno"> 1143</span>  l2capoutbuf[12] = 0xA0;</div>
|
|
<div class="line"><a name="l01144"></a><span class="lineno"> 1144</span>  l2capoutbuf[13] = 0x02;</div>
|
|
<div class="line"><a name="l01145"></a><span class="lineno"> 1145</span> </div>
|
|
<div class="line"><a name="l01146"></a><span class="lineno"> 1146</span>  <a class="code" href="class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7">L2CAP_Command</a>(handle, l2capoutbuf, 14);</div>
|
|
<div class="line"><a name="l01147"></a><span class="lineno"> 1147</span> }</div>
|
|
<div class="line"><a name="l01148"></a><span class="lineno"> 1148</span> </div>
|
|
<div class="line"><a name="l01149"></a><span class="lineno"><a class="code" href="class_b_t_d.html#ac7053ef7ac690be3afbbdd985b163f10"> 1149</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#ac7053ef7ac690be3afbbdd985b163f10">BTD::l2cap_disconnection_request</a>(uint16_t handle, uint8_t rxid, uint8_t* dcid, uint8_t* scid) {</div>
|
|
<div class="line"><a name="l01150"></a><span class="lineno"> 1150</span>  l2capoutbuf[0] = <a class="code" href="_b_t_d_8h.html#a398676a2e9a2351a5a52afdddf4b660b">L2CAP_CMD_DISCONNECT_REQUEST</a>; <span class="comment">// Code</span></div>
|
|
<div class="line"><a name="l01151"></a><span class="lineno"> 1151</span>  l2capoutbuf[1] = rxid; <span class="comment">// Identifier</span></div>
|
|
<div class="line"><a name="l01152"></a><span class="lineno"> 1152</span>  l2capoutbuf[2] = 0x04; <span class="comment">// Length</span></div>
|
|
<div class="line"><a name="l01153"></a><span class="lineno"> 1153</span>  l2capoutbuf[3] = 0x00;</div>
|
|
<div class="line"><a name="l01154"></a><span class="lineno"> 1154</span>  l2capoutbuf[4] = dcid[0];</div>
|
|
<div class="line"><a name="l01155"></a><span class="lineno"> 1155</span>  l2capoutbuf[5] = dcid[1];</div>
|
|
<div class="line"><a name="l01156"></a><span class="lineno"> 1156</span>  l2capoutbuf[6] = scid[0];</div>
|
|
<div class="line"><a name="l01157"></a><span class="lineno"> 1157</span>  l2capoutbuf[7] = scid[1];</div>
|
|
<div class="line"><a name="l01158"></a><span class="lineno"> 1158</span> </div>
|
|
<div class="line"><a name="l01159"></a><span class="lineno"> 1159</span>  <a class="code" href="class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7">L2CAP_Command</a>(handle, l2capoutbuf, 8);</div>
|
|
<div class="line"><a name="l01160"></a><span class="lineno"> 1160</span> }</div>
|
|
<div class="line"><a name="l01161"></a><span class="lineno"> 1161</span> </div>
|
|
<div class="line"><a name="l01162"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a29d176d9194e5c92fbe54791fc245407"> 1162</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a29d176d9194e5c92fbe54791fc245407">BTD::l2cap_disconnection_response</a>(uint16_t handle, uint8_t rxid, uint8_t* dcid, uint8_t* scid) {</div>
|
|
<div class="line"><a name="l01163"></a><span class="lineno"> 1163</span>  l2capoutbuf[0] = <a class="code" href="_b_t_d_8h.html#a4c64a41200714e457b397496183dc0e4">L2CAP_CMD_DISCONNECT_RESPONSE</a>; <span class="comment">// Code</span></div>
|
|
<div class="line"><a name="l01164"></a><span class="lineno"> 1164</span>  l2capoutbuf[1] = rxid; <span class="comment">// Identifier</span></div>
|
|
<div class="line"><a name="l01165"></a><span class="lineno"> 1165</span>  l2capoutbuf[2] = 0x04; <span class="comment">// Length</span></div>
|
|
<div class="line"><a name="l01166"></a><span class="lineno"> 1166</span>  l2capoutbuf[3] = 0x00;</div>
|
|
<div class="line"><a name="l01167"></a><span class="lineno"> 1167</span>  l2capoutbuf[4] = dcid[0];</div>
|
|
<div class="line"><a name="l01168"></a><span class="lineno"> 1168</span>  l2capoutbuf[5] = dcid[1];</div>
|
|
<div class="line"><a name="l01169"></a><span class="lineno"> 1169</span>  l2capoutbuf[6] = scid[0];</div>
|
|
<div class="line"><a name="l01170"></a><span class="lineno"> 1170</span>  l2capoutbuf[7] = scid[1];</div>
|
|
<div class="line"><a name="l01171"></a><span class="lineno"> 1171</span> </div>
|
|
<div class="line"><a name="l01172"></a><span class="lineno"> 1172</span>  <a class="code" href="class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7">L2CAP_Command</a>(handle, l2capoutbuf, 8);</div>
|
|
<div class="line"><a name="l01173"></a><span class="lineno"> 1173</span> }</div>
|
|
<div class="line"><a name="l01174"></a><span class="lineno"> 1174</span> </div>
|
|
<div class="line"><a name="l01175"></a><span class="lineno"><a class="code" href="class_b_t_d.html#a91f61915c503fe7b861c88f5b3e6733c"> 1175</a></span> <span class="keywordtype">void</span> <a class="code" href="class_b_t_d.html#a91f61915c503fe7b861c88f5b3e6733c">BTD::l2cap_information_response</a>(uint16_t handle, uint8_t rxid, uint8_t infoTypeLow, uint8_t infoTypeHigh) {</div>
|
|
<div class="line"><a name="l01176"></a><span class="lineno"> 1176</span>  l2capoutbuf[0] = <a class="code" href="_b_t_d_8h.html#af32d4c53927d596a8727ff232310dec1">L2CAP_CMD_INFORMATION_RESPONSE</a>; <span class="comment">// Code</span></div>
|
|
<div class="line"><a name="l01177"></a><span class="lineno"> 1177</span>  l2capoutbuf[1] = rxid; <span class="comment">// Identifier</span></div>
|
|
<div class="line"><a name="l01178"></a><span class="lineno"> 1178</span>  l2capoutbuf[2] = 0x08; <span class="comment">// Length</span></div>
|
|
<div class="line"><a name="l01179"></a><span class="lineno"> 1179</span>  l2capoutbuf[3] = 0x00;</div>
|
|
<div class="line"><a name="l01180"></a><span class="lineno"> 1180</span>  l2capoutbuf[4] = infoTypeLow;</div>
|
|
<div class="line"><a name="l01181"></a><span class="lineno"> 1181</span>  l2capoutbuf[5] = infoTypeHigh;</div>
|
|
<div class="line"><a name="l01182"></a><span class="lineno"> 1182</span>  l2capoutbuf[6] = 0x00; <span class="comment">// Result = success</span></div>
|
|
<div class="line"><a name="l01183"></a><span class="lineno"> 1183</span>  l2capoutbuf[7] = 0x00; <span class="comment">// Result = success</span></div>
|
|
<div class="line"><a name="l01184"></a><span class="lineno"> 1184</span>  l2capoutbuf[8] = 0x00;</div>
|
|
<div class="line"><a name="l01185"></a><span class="lineno"> 1185</span>  l2capoutbuf[9] = 0x00;</div>
|
|
<div class="line"><a name="l01186"></a><span class="lineno"> 1186</span>  l2capoutbuf[10] = 0x00;</div>
|
|
<div class="line"><a name="l01187"></a><span class="lineno"> 1187</span>  l2capoutbuf[11] = 0x00;</div>
|
|
<div class="line"><a name="l01188"></a><span class="lineno"> 1188</span> </div>
|
|
<div class="line"><a name="l01189"></a><span class="lineno"> 1189</span>  <a class="code" href="class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7">L2CAP_Command</a>(handle, l2capoutbuf, 12);</div>
|
|
<div class="line"><a name="l01190"></a><span class="lineno"> 1190</span> }</div>
|
|
<div class="line"><a name="l01191"></a><span class="lineno"> 1191</span> </div>
|
|
<div class="line"><a name="l01192"></a><span class="lineno"> 1192</span> <span class="comment">/* PS3 Commands - only set Bluetooth address is implemented in this library */</span></div>
|
|
<div class="line"><a name="l01193"></a><span class="lineno"> 1193</span> <span class="keywordtype">void</span> BTD::setBdaddr(uint8_t* bdaddr) {</div>
|
|
<div class="line"><a name="l01194"></a><span class="lineno"> 1194</span>  <span class="comment">/* Set the internal Bluetooth address */</span></div>
|
|
<div class="line"><a name="l01195"></a><span class="lineno"> 1195</span>  uint8_t buf[8];</div>
|
|
<div class="line"><a name="l01196"></a><span class="lineno"> 1196</span>  buf[0] = 0x01;</div>
|
|
<div class="line"><a name="l01197"></a><span class="lineno"> 1197</span>  buf[1] = 0x00;</div>
|
|
<div class="line"><a name="l01198"></a><span class="lineno"> 1198</span> </div>
|
|
<div class="line"><a name="l01199"></a><span class="lineno"> 1199</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 6; i++)</div>
|
|
<div class="line"><a name="l01200"></a><span class="lineno"> 1200</span>  buf[i + 2] = bdaddr[5 - i]; <span class="comment">// Copy into buffer, has to be written reversed</span></div>
|
|
<div class="line"><a name="l01201"></a><span class="lineno"> 1201</span> </div>
|
|
<div class="line"><a name="l01202"></a><span class="lineno"> 1202</span>  <span class="comment">// bmRequest = Host to device (0x00) | Class (0x20) | Interface (0x01) = 0x21, bRequest = Set Report (0x09), Report ID (0xF5), Report Type (Feature 0x03), interface (0x00), datalength, datalength, data)</span></div>
|
|
<div class="line"><a name="l01203"></a><span class="lineno"> 1203</span>  <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a636695a5c3d35cd6b9e31c54edfacd7c">ctrlReq</a>(<a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a>, <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[<a class="code" href="class_b_t_d.html#a49f433ab824f259c3815e180c73bb0ad">BTD_CONTROL_PIPE</a>].epAddr, <a class="code" href="_b_t_d_8h.html#a5bd4ea095da29635414952894bd527f5">bmREQ_HID_OUT</a>, <a class="code" href="_b_t_d_8h.html#aee05d40a014750b24a7e9967f6f389f4">HID_REQUEST_SET_REPORT</a>, 0xF5, 0x03, 0x00, 8, 8, buf, NULL);</div>
|
|
<div class="line"><a name="l01204"></a><span class="lineno"> 1204</span> }</div>
|
|
<div class="line"><a name="l01205"></a><span class="lineno"> 1205</span> </div>
|
|
<div class="line"><a name="l01206"></a><span class="lineno"> 1206</span> <span class="keywordtype">void</span> BTD::setMoveBdaddr(uint8_t* bdaddr) {</div>
|
|
<div class="line"><a name="l01207"></a><span class="lineno"> 1207</span>  <span class="comment">/* Set the internal Bluetooth address */</span></div>
|
|
<div class="line"><a name="l01208"></a><span class="lineno"> 1208</span>  uint8_t buf[11];</div>
|
|
<div class="line"><a name="l01209"></a><span class="lineno"> 1209</span>  buf[0] = 0x05;</div>
|
|
<div class="line"><a name="l01210"></a><span class="lineno"> 1210</span>  buf[7] = 0x10;</div>
|
|
<div class="line"><a name="l01211"></a><span class="lineno"> 1211</span>  buf[8] = 0x01;</div>
|
|
<div class="line"><a name="l01212"></a><span class="lineno"> 1212</span>  buf[9] = 0x02;</div>
|
|
<div class="line"><a name="l01213"></a><span class="lineno"> 1213</span>  buf[10] = 0x12;</div>
|
|
<div class="line"><a name="l01214"></a><span class="lineno"> 1214</span> </div>
|
|
<div class="line"><a name="l01215"></a><span class="lineno"> 1215</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 6; i++)</div>
|
|
<div class="line"><a name="l01216"></a><span class="lineno"> 1216</span>  buf[i + 1] = bdaddr[i];</div>
|
|
<div class="line"><a name="l01217"></a><span class="lineno"> 1217</span> </div>
|
|
<div class="line"><a name="l01218"></a><span class="lineno"> 1218</span>  <span class="comment">// bmRequest = Host to device (0x00) | Class (0x20) | Interface (0x01) = 0x21, bRequest = Set Report (0x09), Report ID (0x05), Report Type (Feature 0x03), interface (0x00), datalength, datalength, data)</span></div>
|
|
<div class="line"><a name="l01219"></a><span class="lineno"> 1219</span>  <a class="code" href="class_b_t_d.html#a4bcd1d622a6455ee3d0cccc4408700a1">pUsb</a>-><a class="code" href="class_u_s_b.html#a636695a5c3d35cd6b9e31c54edfacd7c">ctrlReq</a>(<a class="code" href="class_b_t_d.html#a58f78a9a28db81858dcc34a32a2ec82c">bAddress</a>, <a class="code" href="class_b_t_d.html#a91d92fee94e5a4cbca472bb3fd883e3e">epInfo</a>[<a class="code" href="class_b_t_d.html#a49f433ab824f259c3815e180c73bb0ad">BTD_CONTROL_PIPE</a>].epAddr, <a class="code" href="_b_t_d_8h.html#a5bd4ea095da29635414952894bd527f5">bmREQ_HID_OUT</a>, <a class="code" href="_b_t_d_8h.html#aee05d40a014750b24a7e9967f6f389f4">HID_REQUEST_SET_REPORT</a>, 0x05, 0x03, 0x00, 11, 11, buf, NULL);</div>
|
|
<div class="line"><a name="l01220"></a><span class="lineno"> 1220</span> }</div>
|
|
</div><!-- fragment --></div><!-- contents -->
|
|
<!-- start footer part -->
|
|
<hr class="footer"/><address class="footer"><small>
|
|
Generated by  <a href="http://www.doxygen.org/index.html">
|
|
<img class="footer" src="doxygen.png" alt="doxygen"/>
|
|
</a> 1.8.3.1
|
|
</small></address>
|
|
</body>
|
|
</html>
|