USB_Host_Shield_2.0/_wii_8cpp_source.html

1278 lines
228 KiB
HTML
Raw Normal View History

2013-02-05 20:02:12 +01:00
<!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "http://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd">
<html xmlns="http://www.w3.org/1999/xhtml">
<head>
<meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/>
<meta http-equiv="X-UA-Compatible" content="IE=9"/>
2013-06-17 20:33:24 +02:00
<meta name="generator" content="Doxygen 1.8.4"/>
<title>USB Host Shield 2.0: Wii.cpp Source File</title>
2013-02-05 20:02:12 +01:00
<link href="tabs.css" rel="stylesheet" type="text/css"/>
<script type="text/javascript" src="jquery.js"></script>
<script type="text/javascript" src="dynsections.js"></script>
<link href="search/search.css" rel="stylesheet" type="text/css"/>
<script type="text/javascript" src="search/search.js"></script>
<script type="text/javascript">
$(document).ready(function() { searchBox.OnSelectItem(0); });
</script>
<link href="doxygen.css" rel="stylesheet" type="text/css" />
<link href="imageStyle.css" rel="stylesheet" type="text/css"/>
2013-02-05 20:02:12 +01:00
</head>
<body>
<div id="top"><!-- do not remove this div, it is closed by doxygen! -->
<div id="titlearea">
<table cellspacing="0" cellpadding="0">
<tbody>
<tr style="height: 56px;">
<td style="padding-left: 0.5em;">
<div id="projectname">USB Host Shield 2.0
2013-02-05 20:02:12 +01:00
</div>
</td>
</tr>
</tbody>
</table>
</div>
<!-- end header part -->
2013-06-17 20:33:24 +02:00
<!-- Generated by Doxygen 1.8.4 -->
2013-02-05 20:02:12 +01:00
<script type="text/javascript">
var searchBox = new SearchBox("searchBox", "search",false,'Search');
</script>
<div id="navrow1" class="tabs">
<ul class="tablist">
<li><a href="index.html"><span>Main&#160;Page</span></a></li>
<li><a href="pages.html"><span>Related&#160;Pages</span></a></li>
<li><a href="annotated.html"><span>Classes</span></a></li>
<li class="current"><a href="files.html"><span>Files</span></a></li>
<li>
<div id="MSearchBox" class="MSearchBoxInactive">
<span class="left">
<img id="MSearchSelect" src="search/mag_sel.png"
onmouseover="return searchBox.OnSearchSelectShow()"
onmouseout="return searchBox.OnSearchSelectHide()"
alt=""/>
<input type="text" id="MSearchField" value="Search" accesskey="S"
onfocus="searchBox.OnSearchFieldFocus(true)"
onblur="searchBox.OnSearchFieldFocus(false)"
onkeyup="searchBox.OnSearchFieldChange(event)"/>
</span><span class="right">
<a id="MSearchClose" href="javascript:searchBox.CloseResultsWindow()"><img id="MSearchCloseImg" border="0" src="search/close.png" alt=""/></a>
</span>
</div>
</li>
</ul>
</div>
<div id="navrow2" class="tabs2">
<ul class="tablist">
<li><a href="files.html"><span>File&#160;List</span></a></li>
<li><a href="globals.html"><span>File&#160;Members</span></a></li>
</ul>
</div>
<!-- window showing the filter options -->
<div id="MSearchSelectWindow"
onmouseover="return searchBox.OnSearchSelectShow()"
onmouseout="return searchBox.OnSearchSelectHide()"
onkeydown="return searchBox.OnSearchSelectKey(event)">
<a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(0)"><span class="SelectionMark">&#160;</span>All</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(1)"><span class="SelectionMark">&#160;</span>Classes</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(2)"><span class="SelectionMark">&#160;</span>Files</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(3)"><span class="SelectionMark">&#160;</span>Functions</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(4)"><span class="SelectionMark">&#160;</span>Variables</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(5)"><span class="SelectionMark">&#160;</span>Typedefs</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(6)"><span class="SelectionMark">&#160;</span>Enumerations</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(7)"><span class="SelectionMark">&#160;</span>Enumerator</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(8)"><span class="SelectionMark">&#160;</span>Macros</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(9)"><span class="SelectionMark">&#160;</span>Pages</a></div>
<!-- iframe showing the search results (closed by default) -->
<div id="MSearchResultsWindow">
<iframe src="javascript:void(0)" frameborder="0"
name="MSearchResults" id="MSearchResults">
</iframe>
</div>
<div id="nav-path" class="navpath">
<ul>
<li class="navelem"><a class="el" href="dir_e5fbe6d2783ccd4c93c7856d92d7be6e.html">GitHub</a></li><li class="navelem"><a class="el" href="dir_397a095372f04465e811d0ee219bbf8f.html">USB_Host_Shield_2.0</a></li> </ul>
2013-02-05 20:02:12 +01:00
</div>
</div><!-- top -->
<div class="header">
<div class="headertitle">
<div class="title">Wii.cpp</div> </div>
</div><!--header-->
<div class="contents">
<a href="_wii_8cpp.html">Go to the documentation of this file.</a><div class="fragment"><div class="line"><a name="l00001"></a><span class="lineno"> 1</span>&#160;<span class="comment">/* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved.</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00002"></a><span class="lineno"> 2</span>&#160;<span class="comment"></span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00003"></a><span class="lineno"> 3</span>&#160;<span class="comment"> This software may be distributed and modified under the terms of the GNU</span></div>
<div class="line"><a name="l00004"></a><span class="lineno"> 4</span>&#160;<span class="comment"> General Public License version 2 (GPL2) as published by the Free Software</span></div>
<div class="line"><a name="l00005"></a><span class="lineno"> 5</span>&#160;<span class="comment"> Foundation and appearing in the file GPL2.TXT included in the packaging of</span></div>
<div class="line"><a name="l00006"></a><span class="lineno"> 6</span>&#160;<span class="comment"> this file. Please note that GPL2 Section 2[b] requires that all works based</span></div>
<div class="line"><a name="l00007"></a><span class="lineno"> 7</span>&#160;<span class="comment"> on this software must also be made publicly available under the terms of</span></div>
<div class="line"><a name="l00008"></a><span class="lineno"> 8</span>&#160;<span class="comment"> the GPL2 (&quot;Copyleft&quot;).</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00009"></a><span class="lineno"> 9</span>&#160;<span class="comment"></span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00010"></a><span class="lineno"> 10</span>&#160;<span class="comment"> Contact information</span></div>
<div class="line"><a name="l00011"></a><span class="lineno"> 11</span>&#160;<span class="comment"> -------------------</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00012"></a><span class="lineno"> 12</span>&#160;<span class="comment"></span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00013"></a><span class="lineno"> 13</span>&#160;<span class="comment"> Kristian Lauszus, TKJ Electronics</span></div>
<div class="line"><a name="l00014"></a><span class="lineno"> 14</span>&#160;<span class="comment"> Web : http://www.tkjelectronics.com</span></div>
<div class="line"><a name="l00015"></a><span class="lineno"> 15</span>&#160;<span class="comment"> e-mail : kristianl@tkjelectronics.com</span></div>
<div class="line"><a name="l00016"></a><span class="lineno"> 16</span>&#160;<span class="comment"></span></div>
<div class="line"><a name="l00017"></a><span class="lineno"> 17</span>&#160;<span class="comment"> IR camera support added by:</span></div>
<div class="line"><a name="l00018"></a><span class="lineno"> 18</span>&#160;<span class="comment"> Allan Glover</span></div>
<div class="line"><a name="l00019"></a><span class="lineno"> 19</span>&#160;<span class="comment"> adglover9.81@gmail.com</span></div>
<div class="line"><a name="l00020"></a><span class="lineno"> 20</span>&#160;<span class="comment"> */</span></div>
<div class="line"><a name="l00021"></a><span class="lineno"> 21</span>&#160;</div>
<div class="line"><a name="l00022"></a><span class="lineno"> 22</span>&#160;<span class="preprocessor">#include &quot;<a class="code" href="_wii_8h.html">Wii.h</a>&quot;</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00023"></a><span class="lineno"> 23</span>&#160;<span class="comment">// To enable serial debugging uncomment &quot;#define DEBUG_USB_HOST&quot; in message.h</span></div>
<div class="line"><a name="l00024"></a><span class="lineno"> 24</span>&#160;<span class="comment">//#define EXTRADEBUG // Uncomment to get even more debugging data</span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00025"></a><span class="lineno"> 25</span>&#160;<span class="comment">//#define PRINTREPORT // Uncomment to print the report send by the Wii controllers</span></div>
<div class="line"><a name="l00026"></a><span class="lineno"> 26</span>&#160;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00027"></a><span class="lineno"><a class="code" href="_wii_8cpp.html#af83672eccf0c7a02847ce75bc5c55a1a"> 27</a></span>&#160;<span class="keyword">const</span> uint8_t <a class="code" href="_p_s3_enums_8h.html#af83672eccf0c7a02847ce75bc5c55a1a">LEDS</a>[] PROGMEM = {</div>
<div class="line"><a name="l00028"></a><span class="lineno"> 28</span>&#160; 0x10, <span class="comment">// LED1</span></div>
<div class="line"><a name="l00029"></a><span class="lineno"> 29</span>&#160; 0x20, <span class="comment">// LED2</span></div>
<div class="line"><a name="l00030"></a><span class="lineno"> 30</span>&#160; 0x40, <span class="comment">// LED3</span></div>
<div class="line"><a name="l00031"></a><span class="lineno"> 31</span>&#160; 0x80, <span class="comment">// LED4</span></div>
<div class="line"><a name="l00032"></a><span class="lineno"> 32</span>&#160;</div>
<div class="line"><a name="l00033"></a><span class="lineno"> 33</span>&#160; 0x90, <span class="comment">// LED5</span></div>
<div class="line"><a name="l00034"></a><span class="lineno"> 34</span>&#160; 0xA0, <span class="comment">// LED6</span></div>
<div class="line"><a name="l00035"></a><span class="lineno"> 35</span>&#160; 0xC0, <span class="comment">// LED7</span></div>
<div class="line"><a name="l00036"></a><span class="lineno"> 36</span>&#160; 0xD0, <span class="comment">// LED8</span></div>
<div class="line"><a name="l00037"></a><span class="lineno"> 37</span>&#160; 0xE0, <span class="comment">// LED9</span></div>
<div class="line"><a name="l00038"></a><span class="lineno"> 38</span>&#160; 0xF0 <span class="comment">// LED10</span></div>
<div class="line"><a name="l00039"></a><span class="lineno"> 39</span>&#160;};</div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00040"></a><span class="lineno"> 40</span>&#160;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00041"></a><span class="lineno"><a class="code" href="_wii_8cpp.html#af3392eea150ac9151bef45148f0d7895"> 41</a></span>&#160;<span class="keyword">const</span> uint32_t <a class="code" href="_p_s3_enums_8h.html#af3392eea150ac9151bef45148f0d7895">BUTTONS</a>[] PROGMEM = {</div>
<div class="line"><a name="l00042"></a><span class="lineno"> 42</span>&#160; 0x00008, <span class="comment">// UP</span></div>
<div class="line"><a name="l00043"></a><span class="lineno"> 43</span>&#160; 0x00002, <span class="comment">// RIGHT</span></div>
<div class="line"><a name="l00044"></a><span class="lineno"> 44</span>&#160; 0x00004, <span class="comment">// DOWN</span></div>
<div class="line"><a name="l00045"></a><span class="lineno"> 45</span>&#160; 0x00001, <span class="comment">// LEFT</span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00046"></a><span class="lineno"> 46</span>&#160;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00047"></a><span class="lineno"> 47</span>&#160; 0, <span class="comment">// Skip</span></div>
<div class="line"><a name="l00048"></a><span class="lineno"> 48</span>&#160; 0x00010, <span class="comment">// PLUS</span></div>
<div class="line"><a name="l00049"></a><span class="lineno"> 49</span>&#160; 0x00100, <span class="comment">// TWO</span></div>
<div class="line"><a name="l00050"></a><span class="lineno"> 50</span>&#160; 0x00200, <span class="comment">// ONE</span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00051"></a><span class="lineno"> 51</span>&#160;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00052"></a><span class="lineno"> 52</span>&#160; 0x01000, <span class="comment">// MINUS</span></div>
<div class="line"><a name="l00053"></a><span class="lineno"> 53</span>&#160; 0x08000, <span class="comment">// HOME</span></div>
<div class="line"><a name="l00054"></a><span class="lineno"> 54</span>&#160; 0x10000, <span class="comment">// Z</span></div>
<div class="line"><a name="l00055"></a><span class="lineno"> 55</span>&#160; 0x20000, <span class="comment">// C</span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00056"></a><span class="lineno"> 56</span>&#160;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00057"></a><span class="lineno"> 57</span>&#160; 0x00400, <span class="comment">// B</span></div>
<div class="line"><a name="l00058"></a><span class="lineno"> 58</span>&#160; 0x00800 <span class="comment">// A</span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00059"></a><span class="lineno"> 59</span>&#160;};</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00060"></a><span class="lineno"><a class="code" href="_wii_8cpp.html#a6571a59427c954eefde75bb40f02443e"> 60</a></span>&#160;<span class="keyword">const</span> uint32_t <a class="code" href="_wii_8cpp.html#a6571a59427c954eefde75bb40f02443e">PROCONTROLLERBUTTONS</a>[] PROGMEM = {</div>
<div class="line"><a name="l00061"></a><span class="lineno"> 61</span>&#160; 0x00100, <span class="comment">// UP</span></div>
<div class="line"><a name="l00062"></a><span class="lineno"> 62</span>&#160; 0x00080, <span class="comment">// RIGHT</span></div>
<div class="line"><a name="l00063"></a><span class="lineno"> 63</span>&#160; 0x00040, <span class="comment">// DOWN</span></div>
<div class="line"><a name="l00064"></a><span class="lineno"> 64</span>&#160; 0x00200, <span class="comment">// LEFT</span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00065"></a><span class="lineno"> 65</span>&#160;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00066"></a><span class="lineno"> 66</span>&#160; 0, <span class="comment">// Skip</span></div>
<div class="line"><a name="l00067"></a><span class="lineno"> 67</span>&#160; 0x00004, <span class="comment">// PLUS</span></div>
<div class="line"><a name="l00068"></a><span class="lineno"> 68</span>&#160; 0x20000, <span class="comment">// L3</span></div>
<div class="line"><a name="l00069"></a><span class="lineno"> 69</span>&#160; 0x10000, <span class="comment">// R3</span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00070"></a><span class="lineno"> 70</span>&#160;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00071"></a><span class="lineno"> 71</span>&#160; 0x00010, <span class="comment">// MINUS</span></div>
<div class="line"><a name="l00072"></a><span class="lineno"> 72</span>&#160; 0x00008, <span class="comment">// HOME</span></div>
<div class="line"><a name="l00073"></a><span class="lineno"> 73</span>&#160; 0, 0, <span class="comment">// Skip</span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00074"></a><span class="lineno"> 74</span>&#160;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00075"></a><span class="lineno"> 75</span>&#160; 0x04000, <span class="comment">// B</span></div>
<div class="line"><a name="l00076"></a><span class="lineno"> 76</span>&#160; 0x01000, <span class="comment">// A</span></div>
<div class="line"><a name="l00077"></a><span class="lineno"> 77</span>&#160; 0x00800, <span class="comment">// X</span></div>
<div class="line"><a name="l00078"></a><span class="lineno"> 78</span>&#160; 0x02000, <span class="comment">// Y</span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00079"></a><span class="lineno"> 79</span>&#160;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00080"></a><span class="lineno"> 80</span>&#160; 0x00020, <span class="comment">// L</span></div>
<div class="line"><a name="l00081"></a><span class="lineno"> 81</span>&#160; 0x00002, <span class="comment">// R</span></div>
<div class="line"><a name="l00082"></a><span class="lineno"> 82</span>&#160; 0x08000, <span class="comment">// ZL</span></div>
<div class="line"><a name="l00083"></a><span class="lineno"> 83</span>&#160; 0x00400 <span class="comment">// ZR</span></div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00084"></a><span class="lineno"> 84</span>&#160;};</div>
<div class="line"><a name="l00085"></a><span class="lineno"> 85</span>&#160;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00086"></a><span class="lineno"><a class="code" href="class_w_i_i.html#a6597cb0e240a8ccb4ebdb236daef712e"> 86</a></span>&#160;<a class="code" href="class_w_i_i.html#a6597cb0e240a8ccb4ebdb236daef712e">WII::WII</a>(<a class="code" href="class_b_t_d.html">BTD</a> *p, <span class="keywordtype">bool</span> pair) :</div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00087"></a><span class="lineno"> 87</span>&#160;pBtd(p) <span class="comment">// pointer to USB class instance - mandatory</span></div>
<div class="line"><a name="l00088"></a><span class="lineno"> 88</span>&#160;{</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00089"></a><span class="lineno"> 89</span>&#160; <span class="keywordflow">if</span> (pBtd)</div>
<div class="line"><a name="l00090"></a><span class="lineno"> 90</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a4adfc7e51ad3b3c03e7c37d1af159e73">registerServiceClass</a>(<span class="keyword">this</span>); <span class="comment">// Register it as a Bluetooth service</span></div>
<div class="line"><a name="l00091"></a><span class="lineno"> 91</span>&#160;</div>
<div class="line"><a name="l00092"></a><span class="lineno"> 92</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a0c8cc2a2dd2cda3e760b8b4c1a2d169c">pairWithWii</a> = <a class="code" href="class_w_i_i.html#a39c3101b26cc549d5258018b3d05c608">pair</a>;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00093"></a><span class="lineno"> 93</span>&#160;</div>
<div class="line"><a name="l00094"></a><span class="lineno"> 94</span>&#160; HIDBuffer[0] = 0xA2; <span class="comment">// HID BT DATA_request (0xA0) | Report Type (Output 0x02)</span></div>
<div class="line"><a name="l00095"></a><span class="lineno"> 95</span>&#160;</div>
<div class="line"><a name="l00096"></a><span class="lineno"> 96</span>&#160; <span class="comment">/* Set device cid for the control and intterrupt channelse - LSB */</span></div>
<div class="line"><a name="l00097"></a><span class="lineno"> 97</span>&#160; control_dcid[0] = 0x60; <span class="comment">//0x0060</span></div>
<div class="line"><a name="l00098"></a><span class="lineno"> 98</span>&#160; control_dcid[1] = 0x00;</div>
<div class="line"><a name="l00099"></a><span class="lineno"> 99</span>&#160; interrupt_dcid[0] = 0x61; <span class="comment">//0x0061</span></div>
<div class="line"><a name="l00100"></a><span class="lineno"> 100</span>&#160; interrupt_dcid[1] = 0x00;</div>
<div class="line"><a name="l00101"></a><span class="lineno"> 101</span>&#160;</div>
<div class="line"><a name="l00102"></a><span class="lineno"> 102</span>&#160; <a class="code" href="class_w_i_i.html#a769ee2f9a0088da097438bc3cc677f7c">Reset</a>();</div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00103"></a><span class="lineno"> 103</span>&#160;}</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00104"></a><span class="lineno"> 104</span>&#160;</div>
<div class="line"><a name="l00105"></a><span class="lineno"><a class="code" href="class_w_i_i.html#a769ee2f9a0088da097438bc3cc677f7c"> 105</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#a769ee2f9a0088da097438bc3cc677f7c">WII::Reset</a>() {</div>
<div class="line"><a name="l00106"></a><span class="lineno"> 106</span>&#160; <a class="code" href="class_w_i_i.html#ae25a8ea1b0713801e0209e795b4596fa">wiimoteConnected</a> = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00107"></a><span class="lineno"> 107</span>&#160; <a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a> = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00108"></a><span class="lineno"> 108</span>&#160; <a class="code" href="class_w_i_i.html#a72bd4fad2e524276712a154b8cc2a16c">motionPlusConnected</a> = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00109"></a><span class="lineno"> 109</span>&#160; activateNunchuck = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00110"></a><span class="lineno"> 110</span>&#160; motionValuesReset = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00111"></a><span class="lineno"> 111</span>&#160; activeConnection = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00112"></a><span class="lineno"> 112</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a3aea445b2349e99ef057db1a4ffdd9dc">motionPlusInside</a> = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00113"></a><span class="lineno"> 113</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a962a5714c225dcb633434f02e3657583">wiiUProController</a> = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00114"></a><span class="lineno"> 114</span>&#160; <a class="code" href="class_w_i_i.html#a461f5b7a5f2bc874e107fc776c284b16">wiiUProControllerConnected</a> = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00115"></a><span class="lineno"> 115</span>&#160; l2cap_event_flag = 0; <span class="comment">// Reset flags</span></div>
<div class="line"><a name="l00116"></a><span class="lineno"> 116</span>&#160; l2cap_state = <a class="code" href="_p_s3_b_t_8h.html#a15cc1db556ad9a4ec6144ca8a42f8919">L2CAP_WAIT</a>;</div>
<div class="line"><a name="l00117"></a><span class="lineno"> 117</span>&#160;}</div>
<div class="line"><a name="l00118"></a><span class="lineno"> 118</span>&#160;</div>
<div class="line"><a name="l00119"></a><span class="lineno"><a class="code" href="class_w_i_i.html#aabe4780f258dada1c0564a4ac7607370"> 119</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#aabe4780f258dada1c0564a4ac7607370">WII::disconnect</a>() { <span class="comment">// Use this void to disconnect any of the controllers</span></div>
<div class="line"><a name="l00120"></a><span class="lineno"> 120</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a72bd4fad2e524276712a154b8cc2a16c">motionPlusConnected</a> &amp;&amp; !pBtd-&gt;<a class="code" href="class_b_t_d.html#a3aea445b2349e99ef057db1a4ffdd9dc">motionPlusInside</a>) { <span class="comment">// Disable the Motion Plus extension</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00121"></a><span class="lineno"> 121</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00122"></a><span class="lineno"> 122</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nDeactivating Motion Plus&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00123"></a><span class="lineno"> 123</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00124"></a><span class="lineno"> 124</span>&#160;<span class="preprocessor"></span> initExtension1(); <span class="comment">// This will disable the Motion Plus extension</span></div>
<div class="line"><a name="l00125"></a><span class="lineno"> 125</span>&#160; }</div>
<div class="line"><a name="l00126"></a><span class="lineno"> 126</span>&#160; <span class="comment">//First the HID interrupt channel has to be disconencted, then the HID control channel and finally the HCI connection</span></div>
<div class="line"><a name="l00127"></a><span class="lineno"> 127</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#ac7053ef7ac690be3afbbdd985b163f10">l2cap_disconnection_request</a>(hci_handle, 0x0A, interrupt_scid, interrupt_dcid);</div>
<div class="line"><a name="l00128"></a><span class="lineno"> 128</span>&#160; <a class="code" href="class_w_i_i.html#a769ee2f9a0088da097438bc3cc677f7c">Reset</a>();</div>
<div class="line"><a name="l00129"></a><span class="lineno"> 129</span>&#160; l2cap_state = <a class="code" href="_p_s3_b_t_8h.html#ab569b2085ad29f41d1da9c0ed352bd65">L2CAP_INTERRUPT_DISCONNECT</a>;</div>
<div class="line"><a name="l00130"></a><span class="lineno"> 130</span>&#160;}</div>
<div class="line"><a name="l00131"></a><span class="lineno"> 131</span>&#160;</div>
<div class="line"><a name="l00132"></a><span class="lineno"><a class="code" href="class_w_i_i.html#a81e1eb4d9ef9999a84e71d764d54dff7"> 132</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#a81e1eb4d9ef9999a84e71d764d54dff7">WII::ACLData</a>(uint8_t* l2capinbuf) {</div>
<div class="line"><a name="l00133"></a><span class="lineno"> 133</span>&#160; <span class="keywordflow">if</span> (!pBtd-&gt;<a class="code" href="class_b_t_d.html#a0f1c28a03bcbe62cc7c083f97ea27594">l2capConnectionClaimed</a> &amp;&amp; pBtd-&gt;<a class="code" href="class_b_t_d.html#a4dc8f94fe85028f3d54f13dde1e5b4ee">incomingWii</a> &amp;&amp; !<a class="code" href="class_w_i_i.html#ae25a8ea1b0713801e0209e795b4596fa">wiimoteConnected</a> &amp;&amp; !activeConnection) {</div>
<div class="line"><a name="l00134"></a><span class="lineno"> 134</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[8] == <a class="code" href="_b_t_d_8h.html#ac4bae0c65fd00ed849cb226302d19c85">L2CAP_CMD_CONNECTION_REQUEST</a>) {</div>
<div class="line"><a name="l00135"></a><span class="lineno"> 135</span>&#160; <span class="keywordflow">if</span> ((l2capinbuf[12] | (l2capinbuf[13] &lt;&lt; 8)) == <a class="code" href="_b_t_d_8h.html#a1465673868452307bcdab8e201430c27">HID_CTRL_PSM</a>) {</div>
<div class="line"><a name="l00136"></a><span class="lineno"> 136</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a4dc8f94fe85028f3d54f13dde1e5b4ee">incomingWii</a> = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00137"></a><span class="lineno"> 137</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a0f1c28a03bcbe62cc7c083f97ea27594">l2capConnectionClaimed</a> = <span class="keyword">true</span>; <span class="comment">// Claim that the incoming connection belongs to this service</span></div>
<div class="line"><a name="l00138"></a><span class="lineno"> 138</span>&#160; activeConnection = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00139"></a><span class="lineno"> 139</span>&#160; hci_handle = pBtd-&gt;<a class="code" href="class_b_t_d.html#aa3bb6c692701cb33dfad1ea4d68b6f98">hci_handle</a>; <span class="comment">// Store the HCI Handle for the connection</span></div>
<div class="line"><a name="l00140"></a><span class="lineno"> 140</span>&#160; l2cap_state = <a class="code" href="_p_s3_b_t_8h.html#a15cc1db556ad9a4ec6144ca8a42f8919">L2CAP_WAIT</a>;</div>
<div class="line"><a name="l00141"></a><span class="lineno"> 141</span>&#160; }</div>
<div class="line"><a name="l00142"></a><span class="lineno"> 142</span>&#160; }</div>
<div class="line"><a name="l00143"></a><span class="lineno"> 143</span>&#160; }</div>
<div class="line"><a name="l00144"></a><span class="lineno"> 144</span>&#160; <span class="keywordflow">if</span> ((l2capinbuf[0] | (l2capinbuf[1] &lt;&lt; 8)) == (hci_handle | 0x2000)) { <span class="comment">// acl_handle_ok or it&#39;s a new connection</span></div>
<div class="line"><a name="l00145"></a><span class="lineno"> 145</span>&#160; <span class="keywordflow">if</span> ((l2capinbuf[6] | (l2capinbuf[7] &lt;&lt; 8)) == 0x0001) { <span class="comment">//l2cap_control - Channel ID for ACL-U</span></div>
<div class="line"><a name="l00146"></a><span class="lineno"> 146</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[8] == <a class="code" href="_b_t_d_8h.html#a6ffcd72787c86f248192eb06a3fe18cb">L2CAP_CMD_COMMAND_REJECT</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00147"></a><span class="lineno"> 147</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00148"></a><span class="lineno"> 148</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nL2CAP Command Rejected - Reason: &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00149"></a><span class="lineno"> 149</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[13], 0x80);</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00150"></a><span class="lineno"> 150</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00151"></a><span class="lineno"> 151</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[12], 0x80);</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00152"></a><span class="lineno"> 152</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00153"></a><span class="lineno"> 153</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[17], 0x80);</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00154"></a><span class="lineno"> 154</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00155"></a><span class="lineno"> 155</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[16], 0x80);</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00156"></a><span class="lineno"> 156</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00157"></a><span class="lineno"> 157</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[15], 0x80);</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00158"></a><span class="lineno"> 158</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00159"></a><span class="lineno"> 159</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[14], 0x80);</div>
<div class="line"><a name="l00160"></a><span class="lineno"> 160</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00161"></a><span class="lineno"> 161</span>&#160;<span class="preprocessor"></span> } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[8] == <a class="code" href="_b_t_d_8h.html#aef7b306479de265d725dbe5816a8227b">L2CAP_CMD_CONNECTION_RESPONSE</a>) {</div>
<div class="line"><a name="l00162"></a><span class="lineno"> 162</span>&#160; <span class="keywordflow">if</span> (((l2capinbuf[16] | (l2capinbuf[17] &lt;&lt; 8)) == 0x0000) &amp;&amp; ((l2capinbuf[18] | (l2capinbuf[19] &lt;&lt; 8)) == <a class="code" href="_b_t_d_8h.html#a1be7a56cdddcdb7dedf16d4dee381e93">SUCCESSFUL</a>)) { <span class="comment">// Success</span></div>
<div class="line"><a name="l00163"></a><span class="lineno"> 163</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[14] == control_dcid[0] &amp;&amp; l2capinbuf[15] == control_dcid[1]) { <span class="comment">// Success</span></div>
<div class="line"><a name="l00164"></a><span class="lineno"> 164</span>&#160; <span class="comment">//Notify(PSTR(&quot;\r\nHID Control Connection Complete&quot;), 0x80);</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00165"></a><span class="lineno"> 165</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00166"></a><span class="lineno"> 166</span>&#160; control_scid[0] = l2capinbuf[12];</div>
<div class="line"><a name="l00167"></a><span class="lineno"> 167</span>&#160; control_scid[1] = l2capinbuf[13];</div>
<div class="line"><a name="l00168"></a><span class="lineno"> 168</span>&#160; l2cap_event_flag |= <a class="code" href="_wii_8h.html#a2e5a9c283f0912833f3e0418d3feadd7">L2CAP_FLAG_CONTROL_CONNECTED</a>;</div>
<div class="line"><a name="l00169"></a><span class="lineno"> 169</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[14] == interrupt_dcid[0] &amp;&amp; l2capinbuf[15] == interrupt_dcid[1]) {</div>
<div class="line"><a name="l00170"></a><span class="lineno"> 170</span>&#160; <span class="comment">//Notify(PSTR(&quot;\r\nHID Interrupt Connection Complete&quot;), 0x80);</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00171"></a><span class="lineno"> 171</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00172"></a><span class="lineno"> 172</span>&#160; interrupt_scid[0] = l2capinbuf[12];</div>
<div class="line"><a name="l00173"></a><span class="lineno"> 173</span>&#160; interrupt_scid[1] = l2capinbuf[13];</div>
<div class="line"><a name="l00174"></a><span class="lineno"> 174</span>&#160; l2cap_event_flag |= <a class="code" href="_wii_8h.html#aad823543553cc7500ac49d7479eb858f">L2CAP_FLAG_INTERRUPT_CONNECTED</a>;</div>
<div class="line"><a name="l00175"></a><span class="lineno"> 175</span>&#160; }</div>
<div class="line"><a name="l00176"></a><span class="lineno"> 176</span>&#160; }</div>
<div class="line"><a name="l00177"></a><span class="lineno"> 177</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[8] == <a class="code" href="_b_t_d_8h.html#ac4bae0c65fd00ed849cb226302d19c85">L2CAP_CMD_CONNECTION_REQUEST</a>) {</div>
<div class="line"><a name="l00178"></a><span class="lineno"> 178</span>&#160;<span class="preprocessor">#ifdef EXTRADEBUG</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00179"></a><span class="lineno"> 179</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nL2CAP Connection Request - PSM: &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00180"></a><span class="lineno"> 180</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[13], 0x80);</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00181"></a><span class="lineno"> 181</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00182"></a><span class="lineno"> 182</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[12], 0x80);</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00183"></a><span class="lineno"> 183</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot; SCID: &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00184"></a><span class="lineno"> 184</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[15], 0x80);</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00185"></a><span class="lineno"> 185</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00186"></a><span class="lineno"> 186</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[14], 0x80);</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00187"></a><span class="lineno"> 187</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot; Identifier: &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00188"></a><span class="lineno"> 188</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[9], 0x80);</div>
<div class="line"><a name="l00189"></a><span class="lineno"> 189</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00190"></a><span class="lineno"> 190</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">if</span> ((l2capinbuf[12] | (l2capinbuf[13] &lt;&lt; 8)) == <a class="code" href="_b_t_d_8h.html#a1465673868452307bcdab8e201430c27">HID_CTRL_PSM</a>) {</div>
<div class="line"><a name="l00191"></a><span class="lineno"> 191</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00192"></a><span class="lineno"> 192</span>&#160; control_scid[0] = l2capinbuf[14];</div>
<div class="line"><a name="l00193"></a><span class="lineno"> 193</span>&#160; control_scid[1] = l2capinbuf[15];</div>
<div class="line"><a name="l00194"></a><span class="lineno"> 194</span>&#160; l2cap_event_flag |= <a class="code" href="_p_s3_b_t_8h.html#a969a1ee84797f3ee5006c41f67373f96">L2CAP_FLAG_CONNECTION_CONTROL_REQUEST</a>;</div>
<div class="line"><a name="l00195"></a><span class="lineno"> 195</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> ((l2capinbuf[12] | (l2capinbuf[13] &lt;&lt; 8)) == <a class="code" href="_b_t_d_8h.html#a4c5ac96db74d61d4a5a5d945a400e7da">HID_INTR_PSM</a>) {</div>
<div class="line"><a name="l00196"></a><span class="lineno"> 196</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00197"></a><span class="lineno"> 197</span>&#160; interrupt_scid[0] = l2capinbuf[14];</div>
<div class="line"><a name="l00198"></a><span class="lineno"> 198</span>&#160; interrupt_scid[1] = l2capinbuf[15];</div>
<div class="line"><a name="l00199"></a><span class="lineno"> 199</span>&#160; l2cap_event_flag |= <a class="code" href="_p_s3_b_t_8h.html#a015f3b25bd7a2908c84b973dec453f45">L2CAP_FLAG_CONNECTION_INTERRUPT_REQUEST</a>;</div>
<div class="line"><a name="l00200"></a><span class="lineno"> 200</span>&#160; }</div>
<div class="line"><a name="l00201"></a><span class="lineno"> 201</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[8] == <a class="code" href="_b_t_d_8h.html#a8151b1fe5d940a5a7a34f43a8b8ce434">L2CAP_CMD_CONFIG_RESPONSE</a>) {</div>
<div class="line"><a name="l00202"></a><span class="lineno"> 202</span>&#160; <span class="keywordflow">if</span> ((l2capinbuf[16] | (l2capinbuf[17] &lt;&lt; 8)) == 0x0000) { <span class="comment">// Success</span></div>
<div class="line"><a name="l00203"></a><span class="lineno"> 203</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[12] == control_dcid[0] &amp;&amp; l2capinbuf[13] == control_dcid[1]) {</div>
<div class="line"><a name="l00204"></a><span class="lineno"> 204</span>&#160; <span class="comment">//Notify(PSTR(&quot;\r\nHID Control Configuration Complete&quot;), 0x80);</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00205"></a><span class="lineno"> 205</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00206"></a><span class="lineno"> 206</span>&#160; l2cap_event_flag |= <a class="code" href="_p_s3_b_t_8h.html#a0c444d5d06ec604820d426556c2f38d7">L2CAP_FLAG_CONFIG_CONTROL_SUCCESS</a>;</div>
<div class="line"><a name="l00207"></a><span class="lineno"> 207</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[12] == interrupt_dcid[0] &amp;&amp; l2capinbuf[13] == interrupt_dcid[1]) {</div>
<div class="line"><a name="l00208"></a><span class="lineno"> 208</span>&#160; <span class="comment">//Notify(PSTR(&quot;\r\nHID Interrupt Configuration Complete&quot;), 0x80);</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00209"></a><span class="lineno"> 209</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00210"></a><span class="lineno"> 210</span>&#160; l2cap_event_flag |= <a class="code" href="_p_s3_b_t_8h.html#a2b3cdcd3124251a40ce825da0d8dcb6f">L2CAP_FLAG_CONFIG_INTERRUPT_SUCCESS</a>;</div>
<div class="line"><a name="l00211"></a><span class="lineno"> 211</span>&#160; }</div>
<div class="line"><a name="l00212"></a><span class="lineno"> 212</span>&#160; }</div>
<div class="line"><a name="l00213"></a><span class="lineno"> 213</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[8] == <a class="code" href="_b_t_d_8h.html#a48bcd73461d736d0ef889e1fe6e36f69">L2CAP_CMD_CONFIG_REQUEST</a>) {</div>
<div class="line"><a name="l00214"></a><span class="lineno"> 214</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[12] == control_dcid[0] &amp;&amp; l2capinbuf[13] == control_dcid[1]) {</div>
<div class="line"><a name="l00215"></a><span class="lineno"> 215</span>&#160; <span class="comment">//Notify(PSTR(&quot;\r\nHID Control Configuration Request&quot;), 0x80);</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00216"></a><span class="lineno"> 216</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a792ac4529b65235698ecf3d37982c05e">l2cap_config_response</a>(hci_handle, l2capinbuf[9], control_scid);</div>
<div class="line"><a name="l00217"></a><span class="lineno"> 217</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[12] == interrupt_dcid[0] &amp;&amp; l2capinbuf[13] == interrupt_dcid[1]) {</div>
<div class="line"><a name="l00218"></a><span class="lineno"> 218</span>&#160; <span class="comment">//Notify(PSTR(&quot;\r\nHID Interrupt Configuration Request&quot;), 0x80);</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00219"></a><span class="lineno"> 219</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a792ac4529b65235698ecf3d37982c05e">l2cap_config_response</a>(hci_handle, l2capinbuf[9], interrupt_scid);</div>
<div class="line"><a name="l00220"></a><span class="lineno"> 220</span>&#160; }</div>
<div class="line"><a name="l00221"></a><span class="lineno"> 221</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[8] == <a class="code" href="_b_t_d_8h.html#a398676a2e9a2351a5a52afdddf4b660b">L2CAP_CMD_DISCONNECT_REQUEST</a>) {</div>
<div class="line"><a name="l00222"></a><span class="lineno"> 222</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[12] == control_dcid[0] &amp;&amp; l2capinbuf[13] == control_dcid[1]) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00223"></a><span class="lineno"> 223</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00224"></a><span class="lineno"> 224</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nDisconnect Request: Control Channel&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00225"></a><span class="lineno"> 225</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00226"></a><span class="lineno"> 226</span>&#160;<span class="preprocessor"></span> identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00227"></a><span class="lineno"> 227</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a29d176d9194e5c92fbe54791fc245407">l2cap_disconnection_response</a>(hci_handle, identifier, control_dcid, control_scid);</div>
<div class="line"><a name="l00228"></a><span class="lineno"> 228</span>&#160; <a class="code" href="class_w_i_i.html#a769ee2f9a0088da097438bc3cc677f7c">Reset</a>();</div>
<div class="line"><a name="l00229"></a><span class="lineno"> 229</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[12] == interrupt_dcid[0] &amp;&amp; l2capinbuf[13] == interrupt_dcid[1]) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00230"></a><span class="lineno"> 230</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00231"></a><span class="lineno"> 231</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nDisconnect Request: Interrupt Channel&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00232"></a><span class="lineno"> 232</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00233"></a><span class="lineno"> 233</span>&#160;<span class="preprocessor"></span> identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00234"></a><span class="lineno"> 234</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a29d176d9194e5c92fbe54791fc245407">l2cap_disconnection_response</a>(hci_handle, identifier, interrupt_dcid, interrupt_scid);</div>
<div class="line"><a name="l00235"></a><span class="lineno"> 235</span>&#160; <a class="code" href="class_w_i_i.html#a769ee2f9a0088da097438bc3cc677f7c">Reset</a>();</div>
<div class="line"><a name="l00236"></a><span class="lineno"> 236</span>&#160; }</div>
<div class="line"><a name="l00237"></a><span class="lineno"> 237</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[8] == <a class="code" href="_b_t_d_8h.html#a4c64a41200714e457b397496183dc0e4">L2CAP_CMD_DISCONNECT_RESPONSE</a>) {</div>
<div class="line"><a name="l00238"></a><span class="lineno"> 238</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[12] == control_scid[0] &amp;&amp; l2capinbuf[13] == control_scid[1]) {</div>
<div class="line"><a name="l00239"></a><span class="lineno"> 239</span>&#160; <span class="comment">//Notify(PSTR(&quot;\r\nDisconnect Response: Control Channel&quot;), 0x80);</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00240"></a><span class="lineno"> 240</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00241"></a><span class="lineno"> 241</span>&#160; l2cap_event_flag |= <a class="code" href="_p_s3_b_t_8h.html#a27057737ae0b2246442511c01eeed192">L2CAP_FLAG_DISCONNECT_CONTROL_RESPONSE</a>;</div>
<div class="line"><a name="l00242"></a><span class="lineno"> 242</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[12] == interrupt_scid[0] &amp;&amp; l2capinbuf[13] == interrupt_scid[1]) {</div>
<div class="line"><a name="l00243"></a><span class="lineno"> 243</span>&#160; <span class="comment">//Notify(PSTR(&quot;\r\nDisconnect Response: Interrupt Channel&quot;), 0x80);</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00244"></a><span class="lineno"> 244</span>&#160; identifier = l2capinbuf[9];</div>
<div class="line"><a name="l00245"></a><span class="lineno"> 245</span>&#160; l2cap_event_flag |= <a class="code" href="_p_s3_b_t_8h.html#acc096a05301f3cbdece4ad372cc149c3">L2CAP_FLAG_DISCONNECT_INTERRUPT_RESPONSE</a>;</div>
<div class="line"><a name="l00246"></a><span class="lineno"> 246</span>&#160; }</div>
<div class="line"><a name="l00247"></a><span class="lineno"> 247</span>&#160; }</div>
<div class="line"><a name="l00248"></a><span class="lineno"> 248</span>&#160;<span class="preprocessor">#ifdef EXTRADEBUG</span></div>
<div class="line"><a name="l00249"></a><span class="lineno"> 249</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00250"></a><span class="lineno"> 250</span>&#160; identifier = l2capinbuf[9];</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00251"></a><span class="lineno"> 251</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nL2CAP Unknown Signaling Command: &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00252"></a><span class="lineno"> 252</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[8], 0x80);</div>
<div class="line"><a name="l00253"></a><span class="lineno"> 253</span>&#160; }</div>
<div class="line"><a name="l00254"></a><span class="lineno"> 254</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00255"></a><span class="lineno"> 255</span>&#160;<span class="preprocessor"></span> } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[6] == interrupt_dcid[0] &amp;&amp; l2capinbuf[7] == interrupt_dcid[1]) { <span class="comment">// l2cap_interrupt</span></div>
<div class="line"><a name="l00256"></a><span class="lineno"> 256</span>&#160; <span class="comment">//Notify(PSTR(&quot;\r\nL2CAP Interrupt&quot;), 0x80);</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00257"></a><span class="lineno"> 257</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#ae25a8ea1b0713801e0209e795b4596fa">wiimoteConnected</a>) {</div>
<div class="line"><a name="l00258"></a><span class="lineno"> 258</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[8] == 0xA1) { <span class="comment">// HID_THDR_DATA_INPUT</span></div>
<div class="line"><a name="l00259"></a><span class="lineno"> 259</span>&#160; <span class="keywordflow">if</span> ((l2capinbuf[9] &gt;= 0x20 &amp;&amp; l2capinbuf[9] &lt;= 0x22) || (l2capinbuf[9] &gt;= 0x30 &amp;&amp; l2capinbuf[9] &lt;= 0x37) || l2capinbuf[9] == 0x3e || l2capinbuf[9] == 0x3f) { <span class="comment">// These reports include the buttons</span></div>
<div class="line"><a name="l00260"></a><span class="lineno"> 260</span>&#160; <span class="keywordflow">if</span> ((l2capinbuf[9] &gt;= 0x20 &amp;&amp; l2capinbuf[9] &lt;= 0x22) || l2capinbuf[9] == 0x31 || l2capinbuf[9] == 0x33) <span class="comment">// These reports have no extensions bytes</span></div>
<div class="line"><a name="l00261"></a><span class="lineno"> 261</span>&#160; ButtonState = (uint32_t)((l2capinbuf[10] &amp; 0x1F) | ((uint16_t)(l2capinbuf[11] &amp; 0x9F) &lt;&lt; 8));</div>
<div class="line"><a name="l00262"></a><span class="lineno"> 262</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a461f5b7a5f2bc874e107fc776c284b16">wiiUProControllerConnected</a>)</div>
<div class="line"><a name="l00263"></a><span class="lineno"> 263</span>&#160; ButtonState = (uint32_t)(((~l2capinbuf[23]) &amp; 0xFE) | ((uint16_t)(~l2capinbuf[24]) &lt;&lt; 8) | ((uint32_t)((~l2capinbuf[25]) &amp; 0x03) &lt;&lt; 16));</div>
<div class="line"><a name="l00264"></a><span class="lineno"> 264</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a72bd4fad2e524276712a154b8cc2a16c">motionPlusConnected</a>) {</div>
<div class="line"><a name="l00265"></a><span class="lineno"> 265</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[20] &amp; 0x02) <span class="comment">// Only update the wiimote buttons, since the extension bytes are from the Motion Plus</span></div>
<div class="line"><a name="l00266"></a><span class="lineno"> 266</span>&#160; ButtonState = (uint32_t)((l2capinbuf[10] &amp; 0x1F) | ((uint16_t)(l2capinbuf[11] &amp; 0x9F) &lt;&lt; 8) | ((uint32_t)(ButtonState &amp; 0xFFFF0000)));</div>
<div class="line"><a name="l00267"></a><span class="lineno"> 267</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a>) <span class="comment">// Update if it&#39;s a report from the Nunchuck</span></div>
<div class="line"><a name="l00268"></a><span class="lineno"> 268</span>&#160; ButtonState = (uint32_t)((l2capinbuf[10] &amp; 0x1F) | ((uint16_t)(l2capinbuf[11] &amp; 0x9F) &lt;&lt; 8) | ((uint32_t)((~l2capinbuf[20]) &amp; 0x0C) &lt;&lt; 14));</div>
<div class="line"><a name="l00269"></a><span class="lineno"> 269</span>&#160; <span class="comment">//else if(classicControllerConnected) // Update if it&#39;s a report from the Classic Controller</span></div>
<div class="line"><a name="l00270"></a><span class="lineno"> 270</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a>) <span class="comment">// The Nunchuck is directly connected</span></div>
<div class="line"><a name="l00271"></a><span class="lineno"> 271</span>&#160; ButtonState = (uint32_t)((l2capinbuf[10] &amp; 0x1F) | ((uint16_t)(l2capinbuf[11] &amp; 0x9F) &lt;&lt; 8) | ((uint32_t)((~l2capinbuf[20]) &amp; 0x03) &lt;&lt; 16));</div>
<div class="line"><a name="l00272"></a><span class="lineno"> 272</span>&#160; <span class="comment">//else if(classicControllerConnected) // The Classic Controller is directly connected</span></div>
<div class="line"><a name="l00273"></a><span class="lineno"> 273</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (!unknownExtensionConnected)</div>
<div class="line"><a name="l00274"></a><span class="lineno"> 274</span>&#160; ButtonState = (uint32_t)((l2capinbuf[10] &amp; 0x1F) | ((uint16_t)(l2capinbuf[11] &amp; 0x9F) &lt;&lt; 8));</div>
<div class="line"><a name="l00275"></a><span class="lineno"> 275</span>&#160;<span class="preprocessor">#ifdef PRINTREPORT</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00276"></a><span class="lineno"> 276</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;ButtonState: &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00277"></a><span class="lineno"> 277</span>&#160; PrintHex&lt;uint32_t &gt; (ButtonState, 0x80);</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00278"></a><span class="lineno"> 278</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\n&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00279"></a><span class="lineno"> 279</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00280"></a><span class="lineno"> 280</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">if</span> (ButtonState != OldButtonState) {</div>
<div class="line"><a name="l00281"></a><span class="lineno"> 281</span>&#160; ButtonClickState = ButtonState &amp; ~OldButtonState; <span class="comment">// Update click state variable</span></div>
<div class="line"><a name="l00282"></a><span class="lineno"> 282</span>&#160; OldButtonState = ButtonState;</div>
<div class="line"><a name="l00283"></a><span class="lineno"> 283</span>&#160; }</div>
<div class="line"><a name="l00284"></a><span class="lineno"> 284</span>&#160; }</div>
<div class="line"><a name="l00285"></a><span class="lineno"> 285</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[9] == 0x31 || l2capinbuf[9] == 0x33 || l2capinbuf[9] == 0x35 || l2capinbuf[9] == 0x37) { <span class="comment">// Read the accelerometer</span></div>
<div class="line"><a name="l00286"></a><span class="lineno"> 286</span>&#160; <a class="code" href="class_w_i_i.html#a48bcc2e5c6253d0554d70357625ff3fb">accX</a> = ((l2capinbuf[12] &lt;&lt; 2) | (l2capinbuf[10] &amp; 0x60 &gt;&gt; 5)) - 500;</div>
<div class="line"><a name="l00287"></a><span class="lineno"> 287</span>&#160; <a class="code" href="class_w_i_i.html#a07bef4e4acd42d680ac676b0e6315b2a">accY</a> = ((l2capinbuf[13] &lt;&lt; 2) | (l2capinbuf[11] &amp; 0x20 &gt;&gt; 4)) - 500;</div>
<div class="line"><a name="l00288"></a><span class="lineno"> 288</span>&#160; <a class="code" href="class_w_i_i.html#a7323e1f8b76f3f11f91cdb9601759cc4">accZ</a> = ((l2capinbuf[14] &lt;&lt; 2) | (l2capinbuf[11] &amp; 0x40 &gt;&gt; 5)) - 500;</div>
<div class="line"><a name="l00289"></a><span class="lineno"> 289</span>&#160; <a class="code" href="class_w_i_i.html#a1421306c25a76c0fa24f7ee4b10b757b">wiimotePitch</a> = (atan2(<a class="code" href="class_w_i_i.html#a07bef4e4acd42d680ac676b0e6315b2a">accY</a>, <a class="code" href="class_w_i_i.html#a7323e1f8b76f3f11f91cdb9601759cc4">accZ</a>) + PI) * RAD_TO_DEG;</div>
<div class="line"><a name="l00290"></a><span class="lineno"> 290</span>&#160; <a class="code" href="class_w_i_i.html#ab22594da86218dccf86806b13d6a7a70">wiimoteRoll</a> = (atan2(<a class="code" href="class_w_i_i.html#a48bcc2e5c6253d0554d70357625ff3fb">accX</a>, <a class="code" href="class_w_i_i.html#a7323e1f8b76f3f11f91cdb9601759cc4">accZ</a>) + PI) * RAD_TO_DEG;</div>
<div class="line"><a name="l00291"></a><span class="lineno"> 291</span>&#160; }</div>
<div class="line"><a name="l00292"></a><span class="lineno"> 292</span>&#160; <span class="keywordflow">switch</span> (l2capinbuf[9]) {</div>
<div class="line"><a name="l00293"></a><span class="lineno"> 293</span>&#160; <span class="keywordflow">case</span> 0x20: <span class="comment">// Status Information - (a1) 20 BB BB LF 00 00 VV</span></div>
<div class="line"><a name="l00294"></a><span class="lineno"> 294</span>&#160; wiiState = l2capinbuf[12]; <span class="comment">// (0x01: Battery is nearly empty), (0x02: An Extension Controller is connected), (0x04: Speaker enabled), (0x08: IR enabled), (0x10: LED1, 0x20: LED2, 0x40: LED3, 0x80: LED4)</span></div>
<div class="line"><a name="l00295"></a><span class="lineno"> 295</span>&#160; batteryLevel = l2capinbuf[15]; <span class="comment">// Update battery level</span></div>
<div class="line"><a name="l00296"></a><span class="lineno"> 296</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[12] &amp; 0x01) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00297"></a><span class="lineno"> 297</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00298"></a><span class="lineno"> 298</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nWARNING: Battery is nearly empty&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00299"></a><span class="lineno"> 299</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00300"></a><span class="lineno"> 300</span>&#160;<span class="preprocessor"></span> }</div>
<div class="line"><a name="l00301"></a><span class="lineno"> 301</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[12] &amp; 0x02) { <span class="comment">// Check if a extension is connected</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00302"></a><span class="lineno"> 302</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00303"></a><span class="lineno"> 303</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">if</span> (!unknownExtensionConnected)</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00304"></a><span class="lineno"> 304</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nExtension connected&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00305"></a><span class="lineno"> 305</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00306"></a><span class="lineno"> 306</span>&#160;<span class="preprocessor"></span> unknownExtensionConnected = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00307"></a><span class="lineno"> 307</span>&#160;<span class="preprocessor">#ifdef WIICAMERA</span></div>
<div class="line"><a name="l00308"></a><span class="lineno"> 308</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">if</span> (!<a class="code" href="class_w_i_i.html#a0a444d7e348026e062751cf723877e8f">isIRCameraEnabled</a>()) <span class="comment">// Don&#39;t activate the Motion Plus if we are trying to initialize the IR camera</span></div>
<div class="line"><a name="l00309"></a><span class="lineno"> 309</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00310"></a><span class="lineno"> 310</span>&#160;<span class="preprocessor"></span> setReportMode(<span class="keyword">false</span>, 0x35); <span class="comment">// Also read the extension</span></div>
<div class="line"><a name="l00311"></a><span class="lineno"> 311</span>&#160; } <span class="keywordflow">else</span> {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00312"></a><span class="lineno"> 312</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00313"></a><span class="lineno"> 313</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nExtension disconnected&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00314"></a><span class="lineno"> 314</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00315"></a><span class="lineno"> 315</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a72bd4fad2e524276712a154b8cc2a16c">motionPlusConnected</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00316"></a><span class="lineno"> 316</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00317"></a><span class="lineno"> 317</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot; - from Motion Plus&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00318"></a><span class="lineno"> 318</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00319"></a><span class="lineno"> 319</span>&#160;<span class="preprocessor"></span> l2cap_event_flag &amp;= ~<a class="code" href="_wii_8h.html#ae0ff99c8862a05df8877329982e1ef61">WII_FLAG_NUNCHUCK_CONNECTED</a>;</div>
<div class="line"><a name="l00320"></a><span class="lineno"> 320</span>&#160; <span class="keywordflow">if</span> (!activateNunchuck) <span class="comment">// If it&#39;s already trying to initialize the Nunchuck don&#39;t set it to false</span></div>
<div class="line"><a name="l00321"></a><span class="lineno"> 321</span>&#160; <a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a> = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00322"></a><span class="lineno"> 322</span>&#160; <span class="comment">//else if(classicControllerConnected)</span></div>
<div class="line"><a name="l00323"></a><span class="lineno"> 323</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00324"></a><span class="lineno"> 324</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00325"></a><span class="lineno"> 325</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot; - Nunchuck&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00326"></a><span class="lineno"> 326</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00327"></a><span class="lineno"> 327</span>&#160;<span class="preprocessor"></span> <a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a> = <span class="keyword">false</span>; <span class="comment">// It must be the Nunchuck controller then</span></div>
<div class="line"><a name="l00328"></a><span class="lineno"> 328</span>&#160; l2cap_event_flag &amp;= ~<a class="code" href="_wii_8h.html#ae0ff99c8862a05df8877329982e1ef61">WII_FLAG_NUNCHUCK_CONNECTED</a>;</div>
<div class="line"><a name="l00329"></a><span class="lineno"> 329</span>&#160; <a class="code" href="class_w_i_i.html#a5d3b4a33ebc2ca9ebb154e10a05dbdd4">setLedStatus</a>();</div>
<div class="line"><a name="l00330"></a><span class="lineno"> 330</span>&#160; setReportMode(<span class="keyword">false</span>, 0x31); <span class="comment">// If there is no extension connected we will read the button and accelerometer</span></div>
<div class="line"><a name="l00331"></a><span class="lineno"> 331</span>&#160; } <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00332"></a><span class="lineno"> 332</span>&#160; setReportMode(<span class="keyword">false</span>, 0x31); <span class="comment">// If there is no extension connected we will read the button and accelerometer</span></div>
<div class="line"><a name="l00333"></a><span class="lineno"> 333</span>&#160; }</div>
<div class="line"><a name="l00334"></a><span class="lineno"> 334</span>&#160; }</div>
<div class="line"><a name="l00335"></a><span class="lineno"> 335</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00336"></a><span class="lineno"> 336</span>&#160; <span class="keywordflow">case</span> 0x21: <span class="comment">// Read Memory Data</span></div>
<div class="line"><a name="l00337"></a><span class="lineno"> 337</span>&#160; <span class="keywordflow">if</span> ((l2capinbuf[12] &amp; 0x0F) == 0) { <span class="comment">// No error</span></div>
<div class="line"><a name="l00338"></a><span class="lineno"> 338</span>&#160; <span class="comment">// See: http://wiibrew.org/wiki/Wiimote/Extension_Controllers</span></div>
<div class="line"><a name="l00339"></a><span class="lineno"> 339</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[16] == 0x00 &amp;&amp; l2capinbuf[17] == 0xA4 &amp;&amp; l2capinbuf[18] == 0x20 &amp;&amp; l2capinbuf[19] == 0x00 &amp;&amp; l2capinbuf[20] == 0x00) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00340"></a><span class="lineno"> 340</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00341"></a><span class="lineno"> 341</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nNunchuck connected&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00342"></a><span class="lineno"> 342</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00343"></a><span class="lineno"> 343</span>&#160;<span class="preprocessor"></span> l2cap_event_flag |= <a class="code" href="_wii_8h.html#ae0ff99c8862a05df8877329982e1ef61">WII_FLAG_NUNCHUCK_CONNECTED</a>;</div>
<div class="line"><a name="l00344"></a><span class="lineno"> 344</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[16] == 0x00 &amp;&amp; (l2capinbuf[17] == 0xA6 || l2capinbuf[17] == 0xA4) &amp;&amp; l2capinbuf[18] == 0x20 &amp;&amp; l2capinbuf[19] == 0x00 &amp;&amp; l2capinbuf[20] == 0x05) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00345"></a><span class="lineno"> 345</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00346"></a><span class="lineno"> 346</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nMotion Plus connected&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00347"></a><span class="lineno"> 347</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00348"></a><span class="lineno"> 348</span>&#160;<span class="preprocessor"></span> l2cap_event_flag |= <a class="code" href="_wii_8h.html#a34631633d4557244dc8eda52e8505acd">WII_FLAG_MOTION_PLUS_CONNECTED</a>;</div>
<div class="line"><a name="l00349"></a><span class="lineno"> 349</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[16] == 0x00 &amp;&amp; l2capinbuf[17] == 0xA4 &amp;&amp; l2capinbuf[18] == 0x20 &amp;&amp; l2capinbuf[19] == 0x04 &amp;&amp; l2capinbuf[20] == 0x05) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00350"></a><span class="lineno"> 350</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00351"></a><span class="lineno"> 351</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nMotion Plus activated in normal mode&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00352"></a><span class="lineno"> 352</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00353"></a><span class="lineno"> 353</span>&#160;<span class="preprocessor"></span> <a class="code" href="class_w_i_i.html#a72bd4fad2e524276712a154b8cc2a16c">motionPlusConnected</a> = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00354"></a><span class="lineno"> 354</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[16] == 0x00 &amp;&amp; l2capinbuf[17] == 0xA4 &amp;&amp; l2capinbuf[18] == 0x20 &amp;&amp; l2capinbuf[19] == 0x05 &amp;&amp; l2capinbuf[20] == 0x05) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00355"></a><span class="lineno"> 355</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00356"></a><span class="lineno"> 356</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nMotion Plus activated in Nunchuck pass-through mode&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00357"></a><span class="lineno"> 357</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00358"></a><span class="lineno"> 358</span>&#160;<span class="preprocessor"></span> activateNunchuck = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00359"></a><span class="lineno"> 359</span>&#160; <a class="code" href="class_w_i_i.html#a72bd4fad2e524276712a154b8cc2a16c">motionPlusConnected</a> = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00360"></a><span class="lineno"> 360</span>&#160; <a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a> = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00361"></a><span class="lineno"> 361</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[16] == 0x00 &amp;&amp; l2capinbuf[17] == 0xA6 &amp;&amp; l2capinbuf[18] == 0x20 &amp;&amp; (l2capinbuf[19] == 0x00 || l2capinbuf[19] == 0x04 || l2capinbuf[19] == 0x05 || l2capinbuf[19] == 0x07) &amp;&amp; l2capinbuf[20] == 0x05) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00362"></a><span class="lineno"> 362</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00363"></a><span class="lineno"> 363</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nInactive Wii Motion Plus&quot;</span>), 0x80);</div>
<div class="line"><a name="l00364"></a><span class="lineno"> 364</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nPlease unplug the Motion Plus, disconnect the Wiimote and then replug the Motion Plus Extension&quot;</span>), 0x80);</div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00365"></a><span class="lineno"> 365</span>&#160;<span class="preprocessor">#endif</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00366"></a><span class="lineno"> 366</span>&#160;<span class="preprocessor"></span> stateCounter = 300; <span class="comment">// Skip the rest in &quot;L2CAP_CHECK_MOTION_PLUS_STATE&quot;</span></div>
<div class="line"><a name="l00367"></a><span class="lineno"> 367</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (l2capinbuf[16] == 0x00 &amp;&amp; l2capinbuf[17] == 0xA4 &amp;&amp; l2capinbuf[18] == 0x20 &amp;&amp; l2capinbuf[19] == 0x01 &amp;&amp; l2capinbuf[20] == 0x20) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00368"></a><span class="lineno"> 368</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00369"></a><span class="lineno"> 369</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nWii U Pro Controller connected&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00370"></a><span class="lineno"> 370</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00371"></a><span class="lineno"> 371</span>&#160;<span class="preprocessor"></span> <a class="code" href="class_w_i_i.html#a461f5b7a5f2bc874e107fc776c284b16">wiiUProControllerConnected</a> = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00372"></a><span class="lineno"> 372</span>&#160; }</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00373"></a><span class="lineno"> 373</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00374"></a><span class="lineno"> 374</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">else</span> {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00375"></a><span class="lineno"> 375</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nUnknown Device: &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00376"></a><span class="lineno"> 376</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[13], 0x80);</div>
<div class="line"><a name="l00377"></a><span class="lineno"> 377</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[14], 0x80);</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00378"></a><span class="lineno"> 378</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nData: &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00379"></a><span class="lineno"> 379</span>&#160; <span class="keywordflow">for</span> (uint8_t i = 0; i &lt; ((l2capinbuf[12] &gt;&gt; 4) + 1); i++) { <span class="comment">// bit 4-7 is the length-1</span></div>
<div class="line"><a name="l00380"></a><span class="lineno"> 380</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[15 + i], 0x80);</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00381"></a><span class="lineno"> 381</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot; &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00382"></a><span class="lineno"> 382</span>&#160; }</div>
<div class="line"><a name="l00383"></a><span class="lineno"> 383</span>&#160; }</div>
<div class="line"><a name="l00384"></a><span class="lineno"> 384</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00385"></a><span class="lineno"> 385</span>&#160;<span class="preprocessor"></span> }</div>
<div class="line"><a name="l00386"></a><span class="lineno"> 386</span>&#160;<span class="preprocessor">#ifdef EXTRADEBUG</span></div>
<div class="line"><a name="l00387"></a><span class="lineno"> 387</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">else</span> {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00388"></a><span class="lineno"> 388</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nReport Error: &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00389"></a><span class="lineno"> 389</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[13], 0x80);</div>
<div class="line"><a name="l00390"></a><span class="lineno"> 390</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[14], 0x80);</div>
<div class="line"><a name="l00391"></a><span class="lineno"> 391</span>&#160; }</div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00392"></a><span class="lineno"> 392</span>&#160;<span class="preprocessor">#endif</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00393"></a><span class="lineno"> 393</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00394"></a><span class="lineno"> 394</span>&#160; <span class="keywordflow">case</span> 0x22: <span class="comment">// Acknowledge output report, return function result</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00395"></a><span class="lineno"> 395</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00396"></a><span class="lineno"> 396</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">if</span> (l2capinbuf[13] != 0x00) { <span class="comment">// Check if there is an error</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00397"></a><span class="lineno"> 397</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nCommand failed: &quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00398"></a><span class="lineno"> 398</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[12], 0x80);</div>
<div class="line"><a name="l00399"></a><span class="lineno"> 399</span>&#160; }</div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00400"></a><span class="lineno"> 400</span>&#160;<span class="preprocessor">#endif</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00401"></a><span class="lineno"> 401</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00402"></a><span class="lineno"> 402</span>&#160; <span class="keywordflow">case</span> 0x30: <span class="comment">// Core buttons - (a1) 30 BB BB</span></div>
<div class="line"><a name="l00403"></a><span class="lineno"> 403</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00404"></a><span class="lineno"> 404</span>&#160; <span class="keywordflow">case</span> 0x31: <span class="comment">// Core Buttons and Accelerometer - (a1) 31 BB BB AA AA AA</span></div>
<div class="line"><a name="l00405"></a><span class="lineno"> 405</span>&#160; pitch = <a class="code" href="class_w_i_i.html#a1421306c25a76c0fa24f7ee4b10b757b">wiimotePitch</a>; <span class="comment">// The pitch is just equal to the angle calculated from the wiimote as there is no Motion Plus connected</span></div>
<div class="line"><a name="l00406"></a><span class="lineno"> 406</span>&#160; roll = <a class="code" href="class_w_i_i.html#ab22594da86218dccf86806b13d6a7a70">wiimoteRoll</a>;</div>
<div class="line"><a name="l00407"></a><span class="lineno"> 407</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00408"></a><span class="lineno"> 408</span>&#160; <span class="keywordflow">case</span> 0x32: <span class="comment">// Core Buttons with 8 Extension bytes - (a1) 32 BB BB EE EE EE EE EE EE EE EE</span></div>
<div class="line"><a name="l00409"></a><span class="lineno"> 409</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00410"></a><span class="lineno"> 410</span>&#160; <span class="keywordflow">case</span> 0x33: <span class="comment">// Core Buttons with Accelerometer and 12 IR bytes - (a1) 33 BB BB AA AA AA II II II II II II II II II II II II</span></div>
<div class="line"><a name="l00411"></a><span class="lineno"> 411</span>&#160; pitch = <a class="code" href="class_w_i_i.html#a1421306c25a76c0fa24f7ee4b10b757b">wiimotePitch</a>; <span class="comment">// The pitch is just equal to the angle calculated from the wiimote as there is no Motion Plus data available</span></div>
<div class="line"><a name="l00412"></a><span class="lineno"> 412</span>&#160; roll = <a class="code" href="class_w_i_i.html#ab22594da86218dccf86806b13d6a7a70">wiimoteRoll</a>;</div>
<div class="line"><a name="l00413"></a><span class="lineno"> 413</span>&#160;<span class="preprocessor">#ifdef WIICAMERA</span></div>
<div class="line"><a name="l00414"></a><span class="lineno"> 414</span>&#160;<span class="preprocessor"></span> <span class="comment">// Read the IR data</span></div>
<div class="line"><a name="l00415"></a><span class="lineno"> 415</span>&#160; IR_object_x1 = (l2capinbuf[15] | ((uint16_t)(l2capinbuf[17] &amp; 0x30) &lt;&lt; 4)); <span class="comment">// x position</span></div>
<div class="line"><a name="l00416"></a><span class="lineno"> 416</span>&#160; IR_object_y1 = (l2capinbuf[16] | ((uint16_t)(l2capinbuf[17] &amp; 0xC0) &lt;&lt; 2)); <span class="comment">// y position</span></div>
<div class="line"><a name="l00417"></a><span class="lineno"> 417</span>&#160; IR_object_s1 = (l2capinbuf[17] &amp; 0x0F); <span class="comment">// size value, 0-15</span></div>
<div class="line"><a name="l00418"></a><span class="lineno"> 418</span>&#160;</div>
<div class="line"><a name="l00419"></a><span class="lineno"> 419</span>&#160; IR_object_x2 = (l2capinbuf[18] | ((uint16_t)(l2capinbuf[20] &amp; 0x30) &lt;&lt; 4));</div>
<div class="line"><a name="l00420"></a><span class="lineno"> 420</span>&#160; IR_object_y2 = (l2capinbuf[19] | ((uint16_t)(l2capinbuf[20] &amp; 0xC0) &lt;&lt; 2));</div>
<div class="line"><a name="l00421"></a><span class="lineno"> 421</span>&#160; IR_object_s2 = (l2capinbuf[20] &amp; 0x0F);</div>
<div class="line"><a name="l00422"></a><span class="lineno"> 422</span>&#160;</div>
<div class="line"><a name="l00423"></a><span class="lineno"> 423</span>&#160; IR_object_x3 = (l2capinbuf[21] | ((uint16_t)(l2capinbuf[23] &amp; 0x30) &lt;&lt; 4));</div>
<div class="line"><a name="l00424"></a><span class="lineno"> 424</span>&#160; IR_object_y3 = (l2capinbuf[22] | ((uint16_t)(l2capinbuf[23] &amp; 0xC0) &lt;&lt; 2));</div>
<div class="line"><a name="l00425"></a><span class="lineno"> 425</span>&#160; IR_object_s3 = (l2capinbuf[23] &amp; 0x0F);</div>
<div class="line"><a name="l00426"></a><span class="lineno"> 426</span>&#160;</div>
<div class="line"><a name="l00427"></a><span class="lineno"> 427</span>&#160; IR_object_x4 = (l2capinbuf[24] | ((uint16_t)(l2capinbuf[26] &amp; 0x30) &lt;&lt; 4));</div>
<div class="line"><a name="l00428"></a><span class="lineno"> 428</span>&#160; IR_object_y4 = (l2capinbuf[25] | ((uint16_t)(l2capinbuf[26] &amp; 0xC0) &lt;&lt; 2));</div>
<div class="line"><a name="l00429"></a><span class="lineno"> 429</span>&#160; IR_object_s4 = (l2capinbuf[26] &amp; 0x0F);</div>
<div class="line"><a name="l00430"></a><span class="lineno"> 430</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00431"></a><span class="lineno"> 431</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00432"></a><span class="lineno"> 432</span>&#160; <span class="keywordflow">case</span> 0x34: <span class="comment">// Core Buttons with 19 Extension bytes - (a1) 34 BB BB EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE</span></div>
<div class="line"><a name="l00433"></a><span class="lineno"> 433</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00434"></a><span class="lineno"> 434</span>&#160; <span class="comment">/* 0x3e and 0x3f both give unknown report types when report mode is 0x3e or 0x3f with mode number 0x05 */</span></div>
<div class="line"><a name="l00435"></a><span class="lineno"> 435</span>&#160; <span class="keywordflow">case</span> 0x3E: <span class="comment">// Core Buttons with Accelerometer and 32 IR bytes</span></div>
<div class="line"><a name="l00436"></a><span class="lineno"> 436</span>&#160; <span class="comment">// (a1) 31 BB BB AA AA AA II II II II II II II II II II II II II II II II II II II II II II II II II II II II II II II II</span></div>
<div class="line"><a name="l00437"></a><span class="lineno"> 437</span>&#160; <span class="comment">// corresponds to output report mode 0x3e</span></div>
<div class="line"><a name="l00438"></a><span class="lineno"> 438</span>&#160;</div>
<div class="line"><a name="l00439"></a><span class="lineno"> 439</span>&#160; <span class="comment">/**** for reading in full mode: DOES NOT WORK YET ****/</span></div>
<div class="line"><a name="l00440"></a><span class="lineno"> 440</span>&#160; <span class="comment">/* When it works it will also have intensity and bounding box data */</span></div>
<div class="line"><a name="l00441"></a><span class="lineno"> 441</span>&#160; <span class="comment">/*</span></div>
<div class="line"><a name="l00442"></a><span class="lineno"> 442</span>&#160;<span class="comment"> IR_object_x1 = (l2capinbuf[13] | ((uint16_t)(l2capinbuf[15] &amp; 0x30) &lt;&lt; 4));</span></div>
<div class="line"><a name="l00443"></a><span class="lineno"> 443</span>&#160;<span class="comment"> IR_object_y1 = (l2capinbuf[14] | ((uint16_t)(l2capinbuf[15] &amp; 0xC0) &lt;&lt; 2));</span></div>
<div class="line"><a name="l00444"></a><span class="lineno"> 444</span>&#160;<span class="comment"> IR_object_s1 = (l2capinbuf[15] &amp; 0x0F);</span></div>
<div class="line"><a name="l00445"></a><span class="lineno"> 445</span>&#160;<span class="comment"> */</span></div>
<div class="line"><a name="l00446"></a><span class="lineno"> 446</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00447"></a><span class="lineno"> 447</span>&#160; <span class="keywordflow">case</span> 0x3F:</div>
<div class="line"><a name="l00448"></a><span class="lineno"> 448</span>&#160; <span class="comment">/*</span></div>
<div class="line"><a name="l00449"></a><span class="lineno"> 449</span>&#160;<span class="comment"> IR_object_x1 = (l2capinbuf[13] | ((uint16_t)(l2capinbuf[15] &amp; 0x30) &lt;&lt; 4));</span></div>
<div class="line"><a name="l00450"></a><span class="lineno"> 450</span>&#160;<span class="comment"> IR_object_y1 = (l2capinbuf[14] | ((uint16_t)(l2capinbuf[15] &amp; 0xC0) &lt;&lt; 2));</span></div>
<div class="line"><a name="l00451"></a><span class="lineno"> 451</span>&#160;<span class="comment"> IR_object_s1 = (l2capinbuf[15] &amp; 0x0F);</span></div>
<div class="line"><a name="l00452"></a><span class="lineno"> 452</span>&#160;<span class="comment"> */</span></div>
<div class="line"><a name="l00453"></a><span class="lineno"> 453</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00454"></a><span class="lineno"> 454</span>&#160; <span class="keywordflow">case</span> 0x35: <span class="comment">// Core Buttons and Accelerometer with 16 Extension Bytes</span></div>
<div class="line"><a name="l00455"></a><span class="lineno"> 455</span>&#160; <span class="comment">// (a1) 35 BB BB AA AA AA EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE</span></div>
<div class="line"><a name="l00456"></a><span class="lineno"> 456</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a72bd4fad2e524276712a154b8cc2a16c">motionPlusConnected</a>) {</div>
<div class="line"><a name="l00457"></a><span class="lineno"> 457</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[20] &amp; 0x02) { <span class="comment">// Check if it&#39;s a report from the Motion controller or the extension</span></div>
<div class="line"><a name="l00458"></a><span class="lineno"> 458</span>&#160; <span class="keywordflow">if</span> (motionValuesReset) { <span class="comment">// We will only use the values when the gyro value has been set</span></div>
<div class="line"><a name="l00459"></a><span class="lineno"> 459</span>&#160; <a class="code" href="class_w_i_i.html#ab813b65548e827f41a5192fcc34056ea">gyroYawRaw</a> = ((l2capinbuf[15] | ((l2capinbuf[18] &amp; 0xFC) &lt;&lt; 6)) - <a class="code" href="class_w_i_i.html#ad4f0d2456c56414f9b8013b85a1ee7d2">gyroYawZero</a>);</div>
<div class="line"><a name="l00460"></a><span class="lineno"> 460</span>&#160; <a class="code" href="class_w_i_i.html#a0784c779ebeae2d459996c35a54ee3b8">gyroRollRaw</a> = ((l2capinbuf[16] | ((l2capinbuf[19] &amp; 0xFC) &lt;&lt; 6)) - <a class="code" href="class_w_i_i.html#a10d91cd5d73bc655be776b44d27004c9">gyroRollZero</a>);</div>
<div class="line"><a name="l00461"></a><span class="lineno"> 461</span>&#160; <a class="code" href="class_w_i_i.html#a749ea9dd39ba9a5320c5b24ce93bc544">gyroPitchRaw</a> = ((l2capinbuf[17] | ((l2capinbuf[20] &amp; 0xFC) &lt;&lt; 6)) - <a class="code" href="class_w_i_i.html#abbc31ecd4495d70258cfa095e34cb3c3">gyroPitchZero</a>);</div>
<div class="line"><a name="l00462"></a><span class="lineno"> 462</span>&#160;</div>
<div class="line"><a name="l00463"></a><span class="lineno"> 463</span>&#160; <a class="code" href="class_w_i_i.html#ad5df436cc5d073f26bf3ea5c60d788d6">yawGyroSpeed</a> = (double)<a class="code" href="class_w_i_i.html#ab813b65548e827f41a5192fcc34056ea">gyroYawRaw</a> / ((<span class="keywordtype">double</span>)<a class="code" href="class_w_i_i.html#ad4f0d2456c56414f9b8013b85a1ee7d2">gyroYawZero</a> / <a class="code" href="class_w_i_i.html#a0694969a30092b9b1dcb26120c7cff73">yawGyroScale</a>);</div>
<div class="line"><a name="l00464"></a><span class="lineno"> 464</span>&#160; <a class="code" href="class_w_i_i.html#a3fb552c6ad486e23434dcb347a2a4b84">rollGyroSpeed</a> = -(double)<a class="code" href="class_w_i_i.html#a0784c779ebeae2d459996c35a54ee3b8">gyroRollRaw</a> / ((<span class="keywordtype">double</span>)<a class="code" href="class_w_i_i.html#a10d91cd5d73bc655be776b44d27004c9">gyroRollZero</a> / <a class="code" href="class_w_i_i.html#a6c0971ae4c9ab752888a5871020c8331">rollGyroScale</a>); <span class="comment">// We invert these values so they will fit the acc values</span></div>
<div class="line"><a name="l00465"></a><span class="lineno"> 465</span>&#160; <a class="code" href="class_w_i_i.html#acfb290a86aa9a65dd4ae84d02e3c6ded">pitchGyroSpeed</a> = (double)<a class="code" href="class_w_i_i.html#a749ea9dd39ba9a5320c5b24ce93bc544">gyroPitchRaw</a> / ((<span class="keywordtype">double</span>)<a class="code" href="class_w_i_i.html#abbc31ecd4495d70258cfa095e34cb3c3">gyroPitchZero</a> / <a class="code" href="class_w_i_i.html#aea6ce6f3222df3e547e9957673c7a07a">pitchGyroScale</a>);</div>
<div class="line"><a name="l00466"></a><span class="lineno"> 466</span>&#160;</div>
<div class="line"><a name="l00467"></a><span class="lineno"> 467</span>&#160; <span class="comment">/* The onboard gyro has two ranges for slow and fast mode */</span></div>
<div class="line"><a name="l00468"></a><span class="lineno"> 468</span>&#160; <span class="keywordflow">if</span> (!(l2capinbuf[18] &amp; 0x02)) <span class="comment">// Check if fast more is used</span></div>
<div class="line"><a name="l00469"></a><span class="lineno"> 469</span>&#160; <a class="code" href="class_w_i_i.html#ad5df436cc5d073f26bf3ea5c60d788d6">yawGyroSpeed</a> *= 4.545;</div>
<div class="line"><a name="l00470"></a><span class="lineno"> 470</span>&#160; <span class="keywordflow">if</span> (!(l2capinbuf[18] &amp; 0x01)) <span class="comment">// Check if fast more is used</span></div>
<div class="line"><a name="l00471"></a><span class="lineno"> 471</span>&#160; <a class="code" href="class_w_i_i.html#acfb290a86aa9a65dd4ae84d02e3c6ded">pitchGyroSpeed</a> *= 4.545;</div>
<div class="line"><a name="l00472"></a><span class="lineno"> 472</span>&#160; <span class="keywordflow">if</span> (!(l2capinbuf[19] &amp; 0x02)) <span class="comment">// Check if fast more is used</span></div>
<div class="line"><a name="l00473"></a><span class="lineno"> 473</span>&#160; <a class="code" href="class_w_i_i.html#a3fb552c6ad486e23434dcb347a2a4b84">rollGyroSpeed</a> *= 4.545;</div>
<div class="line"><a name="l00474"></a><span class="lineno"> 474</span>&#160;</div>
<div class="line"><a name="l00475"></a><span class="lineno"> 475</span>&#160; pitch = (0.93 * (pitch + (<a class="code" href="class_w_i_i.html#acfb290a86aa9a65dd4ae84d02e3c6ded">pitchGyroSpeed</a> * (double)(micros() - timer) / 1000000)))+(0.07 * <a class="code" href="class_w_i_i.html#a1421306c25a76c0fa24f7ee4b10b757b">wiimotePitch</a>); <span class="comment">// Use a complimentary filter to calculate the angle</span></div>
<div class="line"><a name="l00476"></a><span class="lineno"> 476</span>&#160; roll = (0.93 * (roll + (<a class="code" href="class_w_i_i.html#a3fb552c6ad486e23434dcb347a2a4b84">rollGyroSpeed</a> * (double)(micros() - timer) / 1000000)))+(0.07 * <a class="code" href="class_w_i_i.html#ab22594da86218dccf86806b13d6a7a70">wiimoteRoll</a>);</div>
<div class="line"><a name="l00477"></a><span class="lineno"> 477</span>&#160;</div>
<div class="line"><a name="l00478"></a><span class="lineno"> 478</span>&#160; <a class="code" href="class_w_i_i.html#a988db5b35cfc3c543f93f49587a50e62">gyroYaw</a> += (<a class="code" href="class_w_i_i.html#ad5df436cc5d073f26bf3ea5c60d788d6">yawGyroSpeed</a> * ((double)(micros() - timer) / 1000000));</div>
<div class="line"><a name="l00479"></a><span class="lineno"> 479</span>&#160; <a class="code" href="class_w_i_i.html#a2a0e4745bff7cfec644bcebe984c2bc8">gyroRoll</a> += (<a class="code" href="class_w_i_i.html#a3fb552c6ad486e23434dcb347a2a4b84">rollGyroSpeed</a> * ((double)(micros() - timer) / 1000000));</div>
<div class="line"><a name="l00480"></a><span class="lineno"> 480</span>&#160; <a class="code" href="class_w_i_i.html#af61f57d34b81f2a878f0126a074e3af4">gyroPitch</a> += (<a class="code" href="class_w_i_i.html#acfb290a86aa9a65dd4ae84d02e3c6ded">pitchGyroSpeed</a> * ((double)(micros() - timer) / 1000000));</div>
<div class="line"><a name="l00481"></a><span class="lineno"> 481</span>&#160; timer = micros();</div>
<div class="line"><a name="l00482"></a><span class="lineno"> 482</span>&#160; <span class="comment">/*</span></div>
<div class="line"><a name="l00483"></a><span class="lineno"> 483</span>&#160;<span class="comment"> // Uncomment these lines to tune the gyro scale variabels</span></div>
<div class="line"><a name="l00484"></a><span class="lineno"> 484</span>&#160;<span class="comment"> Notify(PSTR(&quot;\r\ngyroYaw: &quot;), 0x80);</span></div>
<div class="line"><a name="l00485"></a><span class="lineno"> 485</span>&#160;<span class="comment"> Notify(gyroYaw, 0x80);</span></div>
<div class="line"><a name="l00486"></a><span class="lineno"> 486</span>&#160;<span class="comment"> Notify(PSTR(&quot;\tgyroRoll: &quot;), 0x80);</span></div>
<div class="line"><a name="l00487"></a><span class="lineno"> 487</span>&#160;<span class="comment"> Notify(gyroRoll, 0x80);</span></div>
<div class="line"><a name="l00488"></a><span class="lineno"> 488</span>&#160;<span class="comment"> Notify(PSTR(&quot;\tgyroPitch: &quot;), 0x80);</span></div>
<div class="line"><a name="l00489"></a><span class="lineno"> 489</span>&#160;<span class="comment"> Notify(gyroPitch, 0x80);</span></div>
<div class="line"><a name="l00490"></a><span class="lineno"> 490</span>&#160;<span class="comment"> */</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00491"></a><span class="lineno"> 491</span>&#160; <span class="comment">/*</span></div>
<div class="line"><a name="l00492"></a><span class="lineno"> 492</span>&#160;<span class="comment"> Notify(PSTR(&quot;\twiimoteRoll: &quot;), 0x80);</span></div>
<div class="line"><a name="l00493"></a><span class="lineno"> 493</span>&#160;<span class="comment"> Notify(wiimoteRoll, 0x80);</span></div>
<div class="line"><a name="l00494"></a><span class="lineno"> 494</span>&#160;<span class="comment"> Notify(PSTR(&quot;\twiimotePitch: &quot;), 0x80);</span></div>
<div class="line"><a name="l00495"></a><span class="lineno"> 495</span>&#160;<span class="comment"> Notify(wiimotePitch, 0x80);</span></div>
<div class="line"><a name="l00496"></a><span class="lineno"> 496</span>&#160;<span class="comment"> */</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00497"></a><span class="lineno"> 497</span>&#160; } <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00498"></a><span class="lineno"> 498</span>&#160; <span class="keywordflow">if</span> ((micros() - timer) &gt; 1000000) { <span class="comment">// Loop for 1 sec before resetting the values</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00499"></a><span class="lineno"> 499</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00500"></a><span class="lineno"> 500</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nThe gyro values has been reset&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00501"></a><span class="lineno"> 501</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00502"></a><span class="lineno"> 502</span>&#160;<span class="preprocessor"></span> <a class="code" href="class_w_i_i.html#ad4f0d2456c56414f9b8013b85a1ee7d2">gyroYawZero</a> = (l2capinbuf[15] | ((l2capinbuf[18] &amp; 0xFC) &lt;&lt; 6));</div>
<div class="line"><a name="l00503"></a><span class="lineno"> 503</span>&#160; <a class="code" href="class_w_i_i.html#a10d91cd5d73bc655be776b44d27004c9">gyroRollZero</a> = (l2capinbuf[16] | ((l2capinbuf[19] &amp; 0xFC) &lt;&lt; 6));</div>
<div class="line"><a name="l00504"></a><span class="lineno"> 504</span>&#160; <a class="code" href="class_w_i_i.html#abbc31ecd4495d70258cfa095e34cb3c3">gyroPitchZero</a> = (l2capinbuf[17] | ((l2capinbuf[20] &amp; 0xFC) &lt;&lt; 6));</div>
<div class="line"><a name="l00505"></a><span class="lineno"> 505</span>&#160;</div>
<div class="line"><a name="l00506"></a><span class="lineno"> 506</span>&#160; <a class="code" href="class_w_i_i.html#a6c0971ae4c9ab752888a5871020c8331">rollGyroScale</a> = 500; <span class="comment">// You might need to adjust these</span></div>
<div class="line"><a name="l00507"></a><span class="lineno"> 507</span>&#160; <a class="code" href="class_w_i_i.html#aea6ce6f3222df3e547e9957673c7a07a">pitchGyroScale</a> = 400;</div>
<div class="line"><a name="l00508"></a><span class="lineno"> 508</span>&#160; <a class="code" href="class_w_i_i.html#a0694969a30092b9b1dcb26120c7cff73">yawGyroScale</a> = 415;</div>
<div class="line"><a name="l00509"></a><span class="lineno"> 509</span>&#160;</div>
<div class="line"><a name="l00510"></a><span class="lineno"> 510</span>&#160; <a class="code" href="class_w_i_i.html#a988db5b35cfc3c543f93f49587a50e62">gyroYaw</a> = 0;</div>
<div class="line"><a name="l00511"></a><span class="lineno"> 511</span>&#160; <a class="code" href="class_w_i_i.html#a2a0e4745bff7cfec644bcebe984c2bc8">gyroRoll</a> = 0;</div>
<div class="line"><a name="l00512"></a><span class="lineno"> 512</span>&#160; <a class="code" href="class_w_i_i.html#af61f57d34b81f2a878f0126a074e3af4">gyroPitch</a> = 0;</div>
<div class="line"><a name="l00513"></a><span class="lineno"> 513</span>&#160;</div>
<div class="line"><a name="l00514"></a><span class="lineno"> 514</span>&#160; motionValuesReset = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00515"></a><span class="lineno"> 515</span>&#160; timer = micros();</div>
<div class="line"><a name="l00516"></a><span class="lineno"> 516</span>&#160; }</div>
<div class="line"><a name="l00517"></a><span class="lineno"> 517</span>&#160; }</div>
<div class="line"><a name="l00518"></a><span class="lineno"> 518</span>&#160; } <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00519"></a><span class="lineno"> 519</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a>) {</div>
<div class="line"><a name="l00520"></a><span class="lineno"> 520</span>&#160; hatValues[<a class="code" href="_wii_8h.html#a3edd2b2fd262b698309012868fad0be7aed1a7a35bf1b9c1003fbe3dd4a61a06d">HatX</a>] = l2capinbuf[15];</div>
<div class="line"><a name="l00521"></a><span class="lineno"> 521</span>&#160; hatValues[<a class="code" href="_wii_8h.html#a3edd2b2fd262b698309012868fad0be7ae2ac743b5ba1752933e09f1dac48d97b">HatY</a>] = l2capinbuf[16];</div>
<div class="line"><a name="l00522"></a><span class="lineno"> 522</span>&#160; <a class="code" href="class_w_i_i.html#a48bcc2e5c6253d0554d70357625ff3fb">accX</a> = ((l2capinbuf[17] &lt;&lt; 2) | (l2capinbuf[20] &amp; 0x10 &gt;&gt; 3)) - 416;</div>
<div class="line"><a name="l00523"></a><span class="lineno"> 523</span>&#160; <a class="code" href="class_w_i_i.html#a07bef4e4acd42d680ac676b0e6315b2a">accY</a> = ((l2capinbuf[18] &lt;&lt; 2) | (l2capinbuf[20] &amp; 0x20 &gt;&gt; 4)) - 416;</div>
<div class="line"><a name="l00524"></a><span class="lineno"> 524</span>&#160; <a class="code" href="class_w_i_i.html#a7323e1f8b76f3f11f91cdb9601759cc4">accZ</a> = (((l2capinbuf[19] &amp; 0xFE) &lt;&lt; 2) | (l2capinbuf[20] &amp; 0xC0 &gt;&gt; 5)) - 416;</div>
<div class="line"><a name="l00525"></a><span class="lineno"> 525</span>&#160; <a class="code" href="class_w_i_i.html#a2b5a934a1be4d7c5e788d3742dd09cbf">nunchuckPitch</a> = (atan2(<a class="code" href="class_w_i_i.html#a07bef4e4acd42d680ac676b0e6315b2a">accY</a>, <a class="code" href="class_w_i_i.html#a7323e1f8b76f3f11f91cdb9601759cc4">accZ</a>) + PI) * RAD_TO_DEG;</div>
<div class="line"><a name="l00526"></a><span class="lineno"> 526</span>&#160; <a class="code" href="class_w_i_i.html#ad6c01ce2e1f7bac2c8982ecfb3f53f71">nunchuckRoll</a> = (atan2(<a class="code" href="class_w_i_i.html#a48bcc2e5c6253d0554d70357625ff3fb">accX</a>, <a class="code" href="class_w_i_i.html#a7323e1f8b76f3f11f91cdb9601759cc4">accZ</a>) + PI) * RAD_TO_DEG;</div>
<div class="line"><a name="l00527"></a><span class="lineno"> 527</span>&#160; }</div>
<div class="line"><a name="l00528"></a><span class="lineno"> 528</span>&#160; <span class="comment">//else if(classicControllerConnected) { }</span></div>
<div class="line"><a name="l00529"></a><span class="lineno"> 529</span>&#160; }</div>
<div class="line"><a name="l00530"></a><span class="lineno"> 530</span>&#160; <span class="keywordflow">if</span> (l2capinbuf[19] &amp; 0x01) {</div>
<div class="line"><a name="l00531"></a><span class="lineno"> 531</span>&#160; <span class="keywordflow">if</span> (!extensionConnected) {</div>
<div class="line"><a name="l00532"></a><span class="lineno"> 532</span>&#160; extensionConnected = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00533"></a><span class="lineno"> 533</span>&#160; unknownExtensionConnected = <span class="keyword">true</span>;</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00534"></a><span class="lineno"> 534</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00535"></a><span class="lineno"> 535</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nExtension connected to Motion Plus&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00536"></a><span class="lineno"> 536</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00537"></a><span class="lineno"> 537</span>&#160;<span class="preprocessor"></span> }</div>
<div class="line"><a name="l00538"></a><span class="lineno"> 538</span>&#160; } <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l00539"></a><span class="lineno"> 539</span>&#160; <span class="keywordflow">if</span> (extensionConnected &amp;&amp; !unknownExtensionConnected) {</div>
<div class="line"><a name="l00540"></a><span class="lineno"> 540</span>&#160; extensionConnected = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00541"></a><span class="lineno"> 541</span>&#160; unknownExtensionConnected = <span class="keyword">true</span>;</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00542"></a><span class="lineno"> 542</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00543"></a><span class="lineno"> 543</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nExtension disconnected from Motion Plus&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00544"></a><span class="lineno"> 544</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00545"></a><span class="lineno"> 545</span>&#160;<span class="preprocessor"></span> <a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a> = <span class="keyword">false</span>; <span class="comment">// There is no extension connected to the Motion Plus if this report is sent</span></div>
<div class="line"><a name="l00546"></a><span class="lineno"> 546</span>&#160; }</div>
<div class="line"><a name="l00547"></a><span class="lineno"> 547</span>&#160; }</div>
<div class="line"><a name="l00548"></a><span class="lineno"> 548</span>&#160;</div>
<div class="line"><a name="l00549"></a><span class="lineno"> 549</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a>) {</div>
<div class="line"><a name="l00550"></a><span class="lineno"> 550</span>&#160; hatValues[<a class="code" href="_wii_8h.html#a3edd2b2fd262b698309012868fad0be7aed1a7a35bf1b9c1003fbe3dd4a61a06d">HatX</a>] = l2capinbuf[15];</div>
<div class="line"><a name="l00551"></a><span class="lineno"> 551</span>&#160; hatValues[<a class="code" href="_wii_8h.html#a3edd2b2fd262b698309012868fad0be7ae2ac743b5ba1752933e09f1dac48d97b">HatY</a>] = l2capinbuf[16];</div>
<div class="line"><a name="l00552"></a><span class="lineno"> 552</span>&#160; <a class="code" href="class_w_i_i.html#a48bcc2e5c6253d0554d70357625ff3fb">accX</a> = ((l2capinbuf[17] &lt;&lt; 2) | (l2capinbuf[20] &amp; 0x0C &gt;&gt; 2)) - 416;</div>
<div class="line"><a name="l00553"></a><span class="lineno"> 553</span>&#160; <a class="code" href="class_w_i_i.html#a07bef4e4acd42d680ac676b0e6315b2a">accY</a> = ((l2capinbuf[18] &lt;&lt; 2) | (l2capinbuf[20] &amp; 0x30 &gt;&gt; 4)) - 416;</div>
<div class="line"><a name="l00554"></a><span class="lineno"> 554</span>&#160; <a class="code" href="class_w_i_i.html#a7323e1f8b76f3f11f91cdb9601759cc4">accZ</a> = ((l2capinbuf[19] &lt;&lt; 2) | (l2capinbuf[20] &amp; 0xC0 &gt;&gt; 6)) - 416;</div>
<div class="line"><a name="l00555"></a><span class="lineno"> 555</span>&#160; <a class="code" href="class_w_i_i.html#a2b5a934a1be4d7c5e788d3742dd09cbf">nunchuckPitch</a> = (atan2(<a class="code" href="class_w_i_i.html#a07bef4e4acd42d680ac676b0e6315b2a">accY</a>, <a class="code" href="class_w_i_i.html#a7323e1f8b76f3f11f91cdb9601759cc4">accZ</a>) + PI) * RAD_TO_DEG;</div>
<div class="line"><a name="l00556"></a><span class="lineno"> 556</span>&#160; <a class="code" href="class_w_i_i.html#ad6c01ce2e1f7bac2c8982ecfb3f53f71">nunchuckRoll</a> = (atan2(<a class="code" href="class_w_i_i.html#a48bcc2e5c6253d0554d70357625ff3fb">accX</a>, <a class="code" href="class_w_i_i.html#a7323e1f8b76f3f11f91cdb9601759cc4">accZ</a>) + PI) * RAD_TO_DEG;</div>
<div class="line"><a name="l00557"></a><span class="lineno"> 557</span>&#160;</div>
<div class="line"><a name="l00558"></a><span class="lineno"> 558</span>&#160; pitch = <a class="code" href="class_w_i_i.html#a1421306c25a76c0fa24f7ee4b10b757b">wiimotePitch</a>; <span class="comment">// The pitch is just equal to the angle calculated from the wiimote as there is no Motion Plus connected</span></div>
<div class="line"><a name="l00559"></a><span class="lineno"> 559</span>&#160; roll = <a class="code" href="class_w_i_i.html#ab22594da86218dccf86806b13d6a7a70">wiimoteRoll</a>;</div>
<div class="line"><a name="l00560"></a><span class="lineno"> 560</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a461f5b7a5f2bc874e107fc776c284b16">wiiUProControllerConnected</a>) {</div>
<div class="line"><a name="l00561"></a><span class="lineno"> 561</span>&#160; hatValues[<a class="code" href="controller_enums_8h.html#aaaabdefc068fd57ec2bef2b62ea4ba92a383cb8895dd296b7f69ce845ed16b0ca">LeftHatX</a>] = (l2capinbuf[15] | l2capinbuf[16] &lt;&lt; 8);</div>
<div class="line"><a name="l00562"></a><span class="lineno"> 562</span>&#160; hatValues[<a class="code" href="controller_enums_8h.html#aaaabdefc068fd57ec2bef2b62ea4ba92aaeb027a0ae5bbc6ba25e1c78a6486c7b">RightHatX</a>] = (l2capinbuf[17] | l2capinbuf[18] &lt;&lt; 8);</div>
<div class="line"><a name="l00563"></a><span class="lineno"> 563</span>&#160; hatValues[<a class="code" href="controller_enums_8h.html#aaaabdefc068fd57ec2bef2b62ea4ba92af3f3925efa9762c4e9e71ac7da7a94a3">LeftHatY</a>] = (l2capinbuf[19] | l2capinbuf[20] &lt;&lt; 8);</div>
<div class="line"><a name="l00564"></a><span class="lineno"> 564</span>&#160; hatValues[<a class="code" href="controller_enums_8h.html#aaaabdefc068fd57ec2bef2b62ea4ba92a7f1fb2db5381286691f4dec179ed5d5a">RightHatY</a>] = (l2capinbuf[21] | l2capinbuf[22] &lt;&lt; 8);</div>
<div class="line"><a name="l00565"></a><span class="lineno"> 565</span>&#160; }</div>
<div class="line"><a name="l00566"></a><span class="lineno"> 566</span>&#160; <span class="keywordflow">break</span>;</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00567"></a><span class="lineno"> 567</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00568"></a><span class="lineno"> 568</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">default</span>:</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00569"></a><span class="lineno"> 569</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nUnknown Report type: &quot;</span>), 0x80);</div>
<div class="line"><a name="l00570"></a><span class="lineno"> 570</span>&#160; PrintHex&lt;uint8_t &gt; (l2capinbuf[9], 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00571"></a><span class="lineno"> 571</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00572"></a><span class="lineno"> 572</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00573"></a><span class="lineno"> 573</span>&#160;<span class="preprocessor"></span> }</div>
<div class="line"><a name="l00574"></a><span class="lineno"> 574</span>&#160; }</div>
<div class="line"><a name="l00575"></a><span class="lineno"> 575</span>&#160; }</div>
<div class="line"><a name="l00576"></a><span class="lineno"> 576</span>&#160; }</div>
<div class="line"><a name="l00577"></a><span class="lineno"> 577</span>&#160; L2CAP_task();</div>
<div class="line"><a name="l00578"></a><span class="lineno"> 578</span>&#160; }</div>
<div class="line"><a name="l00579"></a><span class="lineno"> 579</span>&#160;}</div>
<div class="line"><a name="l00580"></a><span class="lineno"> 580</span>&#160;</div>
<div class="line"><a name="l00581"></a><span class="lineno"> 581</span>&#160;<span class="keywordtype">void</span> WII::L2CAP_task() {</div>
<div class="line"><a name="l00582"></a><span class="lineno"> 582</span>&#160; <span class="keywordflow">switch</span> (l2cap_state) {</div>
<div class="line"><a name="l00583"></a><span class="lineno"> 583</span>&#160; <span class="comment">/* These states are used if the Wiimote is the host */</span></div>
<div class="line"><a name="l00584"></a><span class="lineno"> 584</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_p_s3_b_t_8h.html#abac08b5b24a1cd2b12517cd9aa6c616b">L2CAP_CONTROL_SUCCESS</a>:</div>
<div class="line"><a name="l00585"></a><span class="lineno"> 585</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="_p_s3_b_t_8h.html#a39a58b19fb4ef26cf503ed57a43570a4">l2cap_config_success_control_flag</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00586"></a><span class="lineno"> 586</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00587"></a><span class="lineno"> 587</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nHID Control Successfully Configured&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00588"></a><span class="lineno"> 588</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00589"></a><span class="lineno"> 589</span>&#160;<span class="preprocessor"></span> l2cap_state = <a class="code" href="_p_s3_b_t_8h.html#ac7aa7fd7a8a34a6c9e420e3cb114737b">L2CAP_INTERRUPT_SETUP</a>;</div>
<div class="line"><a name="l00590"></a><span class="lineno"> 590</span>&#160; }</div>
<div class="line"><a name="l00591"></a><span class="lineno"> 591</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00592"></a><span class="lineno"> 592</span>&#160;</div>
<div class="line"><a name="l00593"></a><span class="lineno"> 593</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_p_s3_b_t_8h.html#ac7aa7fd7a8a34a6c9e420e3cb114737b">L2CAP_INTERRUPT_SETUP</a>:</div>
<div class="line"><a name="l00594"></a><span class="lineno"> 594</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="_p_s3_b_t_8h.html#a9fa7bceb44bbdff3229fd431627b9868">l2cap_connection_request_interrupt_flag</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00595"></a><span class="lineno"> 595</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00596"></a><span class="lineno"> 596</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nHID Interrupt Incoming Connection Request&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00597"></a><span class="lineno"> 597</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00598"></a><span class="lineno"> 598</span>&#160;<span class="preprocessor"></span> pBtd-&gt;<a class="code" href="class_b_t_d.html#a7d34c62b1d561679dea5cd27356b38a7">l2cap_connection_response</a>(hci_handle, identifier, interrupt_dcid, interrupt_scid, <a class="code" href="_b_t_d_8h.html#a9960d0d5ae92fc92c70bbb84c2a5c0cc">PENDING</a>);</div>
<div class="line"><a name="l00599"></a><span class="lineno"> 599</span>&#160; delay(1);</div>
<div class="line"><a name="l00600"></a><span class="lineno"> 600</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a7d34c62b1d561679dea5cd27356b38a7">l2cap_connection_response</a>(hci_handle, identifier, interrupt_dcid, interrupt_scid, <a class="code" href="_b_t_d_8h.html#a1be7a56cdddcdb7dedf16d4dee381e93">SUCCESSFUL</a>);</div>
<div class="line"><a name="l00601"></a><span class="lineno"> 601</span>&#160; identifier++;</div>
<div class="line"><a name="l00602"></a><span class="lineno"> 602</span>&#160; delay(1);</div>
<div class="line"><a name="l00603"></a><span class="lineno"> 603</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#ab646a59311344966f139bb3b78f30233">l2cap_config_request</a>(hci_handle, identifier, interrupt_scid);</div>
<div class="line"><a name="l00604"></a><span class="lineno"> 604</span>&#160;</div>
<div class="line"><a name="l00605"></a><span class="lineno"> 605</span>&#160; l2cap_state = <a class="code" href="_wii_8h.html#a73e3a81d9a8850075fd10933acc5a035">L2CAP_INTERRUPT_CONFIG_REQUEST</a>;</div>
<div class="line"><a name="l00606"></a><span class="lineno"> 606</span>&#160; }</div>
<div class="line"><a name="l00607"></a><span class="lineno"> 607</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00608"></a><span class="lineno"> 608</span>&#160;</div>
<div class="line"><a name="l00609"></a><span class="lineno"> 609</span>&#160; <span class="comment">/* These states are used if the Arduino is the host */</span></div>
<div class="line"><a name="l00610"></a><span class="lineno"> 610</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_wii_8h.html#a68bcdd68c269cd7970d5271a00bbe5fe">L2CAP_CONTROL_CONNECT_REQUEST</a>:</div>
<div class="line"><a name="l00611"></a><span class="lineno"> 611</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="_wii_8h.html#acaec1ddc53593c80dc625c1f361e3a24">l2cap_connected_control_flag</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00612"></a><span class="lineno"> 612</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00613"></a><span class="lineno"> 613</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSend HID Control Config Request&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00614"></a><span class="lineno"> 614</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00615"></a><span class="lineno"> 615</span>&#160;<span class="preprocessor"></span> identifier++;</div>
<div class="line"><a name="l00616"></a><span class="lineno"> 616</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#ab646a59311344966f139bb3b78f30233">l2cap_config_request</a>(hci_handle, identifier, control_scid);</div>
<div class="line"><a name="l00617"></a><span class="lineno"> 617</span>&#160; l2cap_state = <a class="code" href="_wii_8h.html#aaaf733ee2c84bd8df4d24f2ae1f3b378">L2CAP_CONTROL_CONFIG_REQUEST</a>;</div>
<div class="line"><a name="l00618"></a><span class="lineno"> 618</span>&#160; }</div>
<div class="line"><a name="l00619"></a><span class="lineno"> 619</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00620"></a><span class="lineno"> 620</span>&#160;</div>
<div class="line"><a name="l00621"></a><span class="lineno"> 621</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_wii_8h.html#aaaf733ee2c84bd8df4d24f2ae1f3b378">L2CAP_CONTROL_CONFIG_REQUEST</a>:</div>
<div class="line"><a name="l00622"></a><span class="lineno"> 622</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="_p_s3_b_t_8h.html#a39a58b19fb4ef26cf503ed57a43570a4">l2cap_config_success_control_flag</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00623"></a><span class="lineno"> 623</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00624"></a><span class="lineno"> 624</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSend HID Interrupt Connection Request&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00625"></a><span class="lineno"> 625</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00626"></a><span class="lineno"> 626</span>&#160;<span class="preprocessor"></span> identifier++;</div>
<div class="line"><a name="l00627"></a><span class="lineno"> 627</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a55cf412a2053972a353b1ab964ca9d3e">l2cap_connection_request</a>(hci_handle, identifier, interrupt_dcid, <a class="code" href="_b_t_d_8h.html#a4c5ac96db74d61d4a5a5d945a400e7da">HID_INTR_PSM</a>);</div>
<div class="line"><a name="l00628"></a><span class="lineno"> 628</span>&#160; l2cap_state = <a class="code" href="_wii_8h.html#af0b913a7e9e54b1f6ab95d82bd36f954">L2CAP_INTERRUPT_CONNECT_REQUEST</a>;</div>
<div class="line"><a name="l00629"></a><span class="lineno"> 629</span>&#160; }</div>
<div class="line"><a name="l00630"></a><span class="lineno"> 630</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00631"></a><span class="lineno"> 631</span>&#160;</div>
<div class="line"><a name="l00632"></a><span class="lineno"> 632</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_wii_8h.html#af0b913a7e9e54b1f6ab95d82bd36f954">L2CAP_INTERRUPT_CONNECT_REQUEST</a>:</div>
<div class="line"><a name="l00633"></a><span class="lineno"> 633</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="_wii_8h.html#ac72a2b645fafc5bdbd85c1f59cc937cc">l2cap_connected_interrupt_flag</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00634"></a><span class="lineno"> 634</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00635"></a><span class="lineno"> 635</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSend HID Interrupt Config Request&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00636"></a><span class="lineno"> 636</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00637"></a><span class="lineno"> 637</span>&#160;<span class="preprocessor"></span> identifier++;</div>
<div class="line"><a name="l00638"></a><span class="lineno"> 638</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#ab646a59311344966f139bb3b78f30233">l2cap_config_request</a>(hci_handle, identifier, interrupt_scid);</div>
<div class="line"><a name="l00639"></a><span class="lineno"> 639</span>&#160; l2cap_state = <a class="code" href="_wii_8h.html#a73e3a81d9a8850075fd10933acc5a035">L2CAP_INTERRUPT_CONFIG_REQUEST</a>;</div>
<div class="line"><a name="l00640"></a><span class="lineno"> 640</span>&#160; }</div>
<div class="line"><a name="l00641"></a><span class="lineno"> 641</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00642"></a><span class="lineno"> 642</span>&#160;</div>
<div class="line"><a name="l00643"></a><span class="lineno"> 643</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_wii_8h.html#a73e3a81d9a8850075fd10933acc5a035">L2CAP_INTERRUPT_CONFIG_REQUEST</a>:</div>
<div class="line"><a name="l00644"></a><span class="lineno"> 644</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="_p_s3_b_t_8h.html#a9b3e87e1f460bc011e69f5e53e79c104">l2cap_config_success_interrupt_flag</a>) { <span class="comment">// Now the HID channels is established</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00645"></a><span class="lineno"> 645</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00646"></a><span class="lineno"> 646</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nHID Channels Established&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00647"></a><span class="lineno"> 647</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00648"></a><span class="lineno"> 648</span>&#160;<span class="preprocessor"></span> pBtd-&gt;<a class="code" href="class_b_t_d.html#ac7caac80fb6f5f0e794af3644887d88e">connectToWii</a> = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00649"></a><span class="lineno"> 649</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a0c8cc2a2dd2cda3e760b8b4c1a2d169c">pairWithWii</a> = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00650"></a><span class="lineno"> 650</span>&#160; <a class="code" href="class_w_i_i.html#ae25a8ea1b0713801e0209e795b4596fa">wiimoteConnected</a> = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00651"></a><span class="lineno"> 651</span>&#160; stateCounter = 0;</div>
<div class="line"><a name="l00652"></a><span class="lineno"> 652</span>&#160; l2cap_state = <a class="code" href="_wii_8h.html#a44edf5415459cba3cc378992fef7560b">L2CAP_CHECK_MOTION_PLUS_STATE</a>;</div>
<div class="line"><a name="l00653"></a><span class="lineno"> 653</span>&#160; }</div>
<div class="line"><a name="l00654"></a><span class="lineno"> 654</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00655"></a><span class="lineno"> 655</span>&#160;</div>
<div class="line"><a name="l00656"></a><span class="lineno"> 656</span>&#160; <span class="comment">/* The next states are in run() */</span></div>
<div class="line"><a name="l00657"></a><span class="lineno"> 657</span>&#160;</div>
<div class="line"><a name="l00658"></a><span class="lineno"> 658</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_p_s3_b_t_8h.html#ab569b2085ad29f41d1da9c0ed352bd65">L2CAP_INTERRUPT_DISCONNECT</a>:</div>
<div class="line"><a name="l00659"></a><span class="lineno"> 659</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="_p_s3_b_t_8h.html#a667178a4486c4dee88e052b3562362cd">l2cap_disconnect_response_interrupt_flag</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00660"></a><span class="lineno"> 660</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00661"></a><span class="lineno"> 661</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nDisconnected Interrupt Channel&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00662"></a><span class="lineno"> 662</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00663"></a><span class="lineno"> 663</span>&#160;<span class="preprocessor"></span> identifier++;</div>
<div class="line"><a name="l00664"></a><span class="lineno"> 664</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#ac7053ef7ac690be3afbbdd985b163f10">l2cap_disconnection_request</a>(hci_handle, identifier, control_scid, control_dcid);</div>
<div class="line"><a name="l00665"></a><span class="lineno"> 665</span>&#160; l2cap_state = <a class="code" href="_p_s3_b_t_8h.html#a9b5140e7ca5941e5535c575255ffc1cc">L2CAP_CONTROL_DISCONNECT</a>;</div>
<div class="line"><a name="l00666"></a><span class="lineno"> 666</span>&#160; }</div>
<div class="line"><a name="l00667"></a><span class="lineno"> 667</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00668"></a><span class="lineno"> 668</span>&#160;</div>
<div class="line"><a name="l00669"></a><span class="lineno"> 669</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_p_s3_b_t_8h.html#a9b5140e7ca5941e5535c575255ffc1cc">L2CAP_CONTROL_DISCONNECT</a>:</div>
<div class="line"><a name="l00670"></a><span class="lineno"> 670</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="_p_s3_b_t_8h.html#a7f0cab74308e812106252c53b18c0391">l2cap_disconnect_response_control_flag</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00671"></a><span class="lineno"> 671</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00672"></a><span class="lineno"> 672</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nDisconnected Control Channel&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00673"></a><span class="lineno"> 673</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00674"></a><span class="lineno"> 674</span>&#160;<span class="preprocessor"></span> pBtd-&gt;<a class="code" href="class_b_t_d.html#a1bea5dd793a2f47006b4a7642efc9e56">hci_disconnect</a>(hci_handle);</div>
<div class="line"><a name="l00675"></a><span class="lineno"> 675</span>&#160; hci_handle = -1; <span class="comment">// Reset handle</span></div>
<div class="line"><a name="l00676"></a><span class="lineno"> 676</span>&#160; l2cap_event_flag = 0; <span class="comment">// Reset flags</span></div>
<div class="line"><a name="l00677"></a><span class="lineno"> 677</span>&#160; l2cap_state = <a class="code" href="_p_s3_b_t_8h.html#a15cc1db556ad9a4ec6144ca8a42f8919">L2CAP_WAIT</a>;</div>
<div class="line"><a name="l00678"></a><span class="lineno"> 678</span>&#160; }</div>
<div class="line"><a name="l00679"></a><span class="lineno"> 679</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00680"></a><span class="lineno"> 680</span>&#160; }</div>
<div class="line"><a name="l00681"></a><span class="lineno"> 681</span>&#160;}</div>
<div class="line"><a name="l00682"></a><span class="lineno"> 682</span>&#160;</div>
<div class="line"><a name="l00683"></a><span class="lineno"><a class="code" href="class_w_i_i.html#ac5cd06f3e9aa2a0d9b9691f00c047e72"> 683</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#ac5cd06f3e9aa2a0d9b9691f00c047e72">WII::Run</a>() {</div>
<div class="line"><a name="l00684"></a><span class="lineno"> 684</span>&#160; <span class="keywordflow">switch</span> (l2cap_state) {</div>
<div class="line"><a name="l00685"></a><span class="lineno"> 685</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_p_s3_b_t_8h.html#a15cc1db556ad9a4ec6144ca8a42f8919">L2CAP_WAIT</a>:</div>
<div class="line"><a name="l00686"></a><span class="lineno"> 686</span>&#160; <span class="keywordflow">if</span> (pBtd-&gt;<a class="code" href="class_b_t_d.html#ac7caac80fb6f5f0e794af3644887d88e">connectToWii</a> &amp;&amp; !pBtd-&gt;<a class="code" href="class_b_t_d.html#a0f1c28a03bcbe62cc7c083f97ea27594">l2capConnectionClaimed</a> &amp;&amp; !<a class="code" href="class_w_i_i.html#ae25a8ea1b0713801e0209e795b4596fa">wiimoteConnected</a> &amp;&amp; !activeConnection) {</div>
<div class="line"><a name="l00687"></a><span class="lineno"> 687</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a0f1c28a03bcbe62cc7c083f97ea27594">l2capConnectionClaimed</a> = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00688"></a><span class="lineno"> 688</span>&#160; activeConnection = <span class="keyword">true</span>;</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00689"></a><span class="lineno"> 689</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00690"></a><span class="lineno"> 690</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSend HID Control Connection Request&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00691"></a><span class="lineno"> 691</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00692"></a><span class="lineno"> 692</span>&#160;<span class="preprocessor"></span> hci_handle = pBtd-&gt;<a class="code" href="class_b_t_d.html#aa3bb6c692701cb33dfad1ea4d68b6f98">hci_handle</a>; <span class="comment">// Store the HCI Handle for the connection</span></div>
<div class="line"><a name="l00693"></a><span class="lineno"> 693</span>&#160; l2cap_event_flag = 0; <span class="comment">// Reset flags</span></div>
<div class="line"><a name="l00694"></a><span class="lineno"> 694</span>&#160; identifier = 0;</div>
<div class="line"><a name="l00695"></a><span class="lineno"> 695</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a55cf412a2053972a353b1ab964ca9d3e">l2cap_connection_request</a>(hci_handle, identifier, control_dcid, <a class="code" href="_b_t_d_8h.html#a1465673868452307bcdab8e201430c27">HID_CTRL_PSM</a>);</div>
<div class="line"><a name="l00696"></a><span class="lineno"> 696</span>&#160; l2cap_state = <a class="code" href="_wii_8h.html#a68bcdd68c269cd7970d5271a00bbe5fe">L2CAP_CONTROL_CONNECT_REQUEST</a>;</div>
<div class="line"><a name="l00697"></a><span class="lineno"> 697</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (<a class="code" href="_p_s3_b_t_8h.html#a728c7d92dd341dcc1b8f4bf95bb4826d">l2cap_connection_request_control_flag</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00698"></a><span class="lineno"> 698</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00699"></a><span class="lineno"> 699</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nHID Control Incoming Connection Request&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00700"></a><span class="lineno"> 700</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00701"></a><span class="lineno"> 701</span>&#160;<span class="preprocessor"></span> pBtd-&gt;<a class="code" href="class_b_t_d.html#a7d34c62b1d561679dea5cd27356b38a7">l2cap_connection_response</a>(hci_handle, identifier, control_dcid, control_scid, <a class="code" href="_b_t_d_8h.html#a9960d0d5ae92fc92c70bbb84c2a5c0cc">PENDING</a>);</div>
<div class="line"><a name="l00702"></a><span class="lineno"> 702</span>&#160; delay(1);</div>
<div class="line"><a name="l00703"></a><span class="lineno"> 703</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#a7d34c62b1d561679dea5cd27356b38a7">l2cap_connection_response</a>(hci_handle, identifier, control_dcid, control_scid, <a class="code" href="_b_t_d_8h.html#a1be7a56cdddcdb7dedf16d4dee381e93">SUCCESSFUL</a>);</div>
<div class="line"><a name="l00704"></a><span class="lineno"> 704</span>&#160; identifier++;</div>
<div class="line"><a name="l00705"></a><span class="lineno"> 705</span>&#160; delay(1);</div>
<div class="line"><a name="l00706"></a><span class="lineno"> 706</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#ab646a59311344966f139bb3b78f30233">l2cap_config_request</a>(hci_handle, identifier, control_scid);</div>
<div class="line"><a name="l00707"></a><span class="lineno"> 707</span>&#160; l2cap_state = <a class="code" href="_p_s3_b_t_8h.html#abac08b5b24a1cd2b12517cd9aa6c616b">L2CAP_CONTROL_SUCCESS</a>;</div>
<div class="line"><a name="l00708"></a><span class="lineno"> 708</span>&#160; }</div>
<div class="line"><a name="l00709"></a><span class="lineno"> 709</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00710"></a><span class="lineno"> 710</span>&#160;</div>
<div class="line"><a name="l00711"></a><span class="lineno"> 711</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_wii_8h.html#a44edf5415459cba3cc378992fef7560b">L2CAP_CHECK_MOTION_PLUS_STATE</a>:</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00712"></a><span class="lineno"> 712</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00713"></a><span class="lineno"> 713</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">if</span> (stateCounter == 0) <span class="comment">// Only print onnce</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00714"></a><span class="lineno"> 714</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nChecking if a Motion Plus is connected&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00715"></a><span class="lineno"> 715</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00716"></a><span class="lineno"> 716</span>&#160;<span class="preprocessor"></span> stateCounter++;</div>
<div class="line"><a name="l00717"></a><span class="lineno"> 717</span>&#160; <span class="keywordflow">if</span> (stateCounter % 200 == 0)</div>
<div class="line"><a name="l00718"></a><span class="lineno"> 718</span>&#160; checkMotionPresent(); <span class="comment">// Check if there is a motion plus connected</span></div>
<div class="line"><a name="l00719"></a><span class="lineno"> 719</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="_wii_8h.html#a3d4b4f06162f96e91d97650f5c2e60f7">motion_plus_connected_flag</a>) {</div>
<div class="line"><a name="l00720"></a><span class="lineno"> 720</span>&#160; stateCounter = 0;</div>
<div class="line"><a name="l00721"></a><span class="lineno"> 721</span>&#160; l2cap_state = <a class="code" href="_wii_8h.html#a291cf8ab9832ac643cdbeaa5f0b84ed1">L2CAP_INIT_MOTION_PLUS_STATE</a>;</div>
<div class="line"><a name="l00722"></a><span class="lineno"> 722</span>&#160; timer = micros();</div>
<div class="line"><a name="l00723"></a><span class="lineno"> 723</span>&#160;</div>
<div class="line"><a name="l00724"></a><span class="lineno"> 724</span>&#160; <span class="keywordflow">if</span> (unknownExtensionConnected) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00725"></a><span class="lineno"> 725</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00726"></a><span class="lineno"> 726</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nA extension is also connected&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00727"></a><span class="lineno"> 727</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00728"></a><span class="lineno"> 728</span>&#160;<span class="preprocessor"></span> activateNunchuck = <span class="keyword">true</span>; <span class="comment">// For we will just set this to true as this the only extension supported so far</span></div>
<div class="line"><a name="l00729"></a><span class="lineno"> 729</span>&#160; }</div>
<div class="line"><a name="l00730"></a><span class="lineno"> 730</span>&#160;</div>
<div class="line"><a name="l00731"></a><span class="lineno"> 731</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 601) { <span class="comment">// We will try three times to check for the motion plus</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00732"></a><span class="lineno"> 732</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00733"></a><span class="lineno"> 733</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nNo Motion Plus was detected&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00734"></a><span class="lineno"> 734</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00735"></a><span class="lineno"> 735</span>&#160;<span class="preprocessor"></span> stateCounter = 0;</div>
<div class="line"><a name="l00736"></a><span class="lineno"> 736</span>&#160; l2cap_state = <a class="code" href="_wii_8h.html#ab84d043703110a74ba9b8d7afa30c5de">L2CAP_CHECK_EXTENSION_STATE</a>;</div>
<div class="line"><a name="l00737"></a><span class="lineno"> 737</span>&#160; }</div>
<div class="line"><a name="l00738"></a><span class="lineno"> 738</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00739"></a><span class="lineno"> 739</span>&#160;</div>
<div class="line"><a name="l00740"></a><span class="lineno"> 740</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_wii_8h.html#ab84d043703110a74ba9b8d7afa30c5de">L2CAP_CHECK_EXTENSION_STATE</a>: <span class="comment">// This is used to check if there is anything plugged in to the extension port</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00741"></a><span class="lineno"> 741</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00742"></a><span class="lineno"> 742</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">if</span> (stateCounter == 0) <span class="comment">// Only print onnce</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00743"></a><span class="lineno"> 743</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nChecking if there is any extension connected&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00744"></a><span class="lineno"> 744</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00745"></a><span class="lineno"> 745</span>&#160;<span class="preprocessor"></span> stateCounter++; <span class="comment">// We use this counter as there has to be a short delay between the commands</span></div>
<div class="line"><a name="l00746"></a><span class="lineno"> 746</span>&#160; <span class="keywordflow">if</span> (stateCounter == 1)</div>
<div class="line"><a name="l00747"></a><span class="lineno"> 747</span>&#160; <a class="code" href="class_w_i_i.html#acf275afab058a712ab84fac6c38f8f54">statusRequest</a>(); <span class="comment">// See if a new device has connected</span></div>
<div class="line"><a name="l00748"></a><span class="lineno"> 748</span>&#160; <span class="keywordflow">if</span> (stateCounter == 100) {</div>
<div class="line"><a name="l00749"></a><span class="lineno"> 749</span>&#160; <span class="keywordflow">if</span> (unknownExtensionConnected) <span class="comment">// Check if there is a extension is connected to the port</span></div>
<div class="line"><a name="l00750"></a><span class="lineno"> 750</span>&#160; initExtension1();</div>
<div class="line"><a name="l00751"></a><span class="lineno"> 751</span>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l00752"></a><span class="lineno"> 752</span>&#160; stateCounter = 399;</div>
<div class="line"><a name="l00753"></a><span class="lineno"> 753</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 200)</div>
<div class="line"><a name="l00754"></a><span class="lineno"> 754</span>&#160; initExtension2();</div>
<div class="line"><a name="l00755"></a><span class="lineno"> 755</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 300) {</div>
<div class="line"><a name="l00756"></a><span class="lineno"> 756</span>&#160; readExtensionType();</div>
<div class="line"><a name="l00757"></a><span class="lineno"> 757</span>&#160; unknownExtensionConnected = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00758"></a><span class="lineno"> 758</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 400) {</div>
<div class="line"><a name="l00759"></a><span class="lineno"> 759</span>&#160; stateCounter = 0;</div>
<div class="line"><a name="l00760"></a><span class="lineno"> 760</span>&#160; l2cap_state = <a class="code" href="_wii_8h.html#a11f7dbb22bf86e28848abc165e22c2de">L2CAP_LED_STATE</a>;</div>
<div class="line"><a name="l00761"></a><span class="lineno"> 761</span>&#160; }</div>
<div class="line"><a name="l00762"></a><span class="lineno"> 762</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00763"></a><span class="lineno"> 763</span>&#160;</div>
<div class="line"><a name="l00764"></a><span class="lineno"> 764</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_wii_8h.html#a291cf8ab9832ac643cdbeaa5f0b84ed1">L2CAP_INIT_MOTION_PLUS_STATE</a>:</div>
<div class="line"><a name="l00765"></a><span class="lineno"> 765</span>&#160; stateCounter++;</div>
<div class="line"><a name="l00766"></a><span class="lineno"> 766</span>&#160; <span class="keywordflow">if</span> (stateCounter == 1)</div>
<div class="line"><a name="l00767"></a><span class="lineno"> 767</span>&#160; initMotionPlus();</div>
<div class="line"><a name="l00768"></a><span class="lineno"> 768</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 100)</div>
<div class="line"><a name="l00769"></a><span class="lineno"> 769</span>&#160; activateMotionPlus();</div>
<div class="line"><a name="l00770"></a><span class="lineno"> 770</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 200)</div>
<div class="line"><a name="l00771"></a><span class="lineno"> 771</span>&#160; readExtensionType(); <span class="comment">// Check if it has been activated</span></div>
<div class="line"><a name="l00772"></a><span class="lineno"> 772</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 300) {</div>
<div class="line"><a name="l00773"></a><span class="lineno"> 773</span>&#160; stateCounter = 0;</div>
<div class="line"><a name="l00774"></a><span class="lineno"> 774</span>&#160; unknownExtensionConnected = <span class="keyword">false</span>; <span class="comment">// The motion plus will send a status report when it&#39;s activated, we will set this to false so it doesn&#39;t reinitialize the Motion Plus</span></div>
<div class="line"><a name="l00775"></a><span class="lineno"> 775</span>&#160; l2cap_state = <a class="code" href="_wii_8h.html#a11f7dbb22bf86e28848abc165e22c2de">L2CAP_LED_STATE</a>;</div>
<div class="line"><a name="l00776"></a><span class="lineno"> 776</span>&#160; }</div>
<div class="line"><a name="l00777"></a><span class="lineno"> 777</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00778"></a><span class="lineno"> 778</span>&#160;</div>
<div class="line"><a name="l00779"></a><span class="lineno"> 779</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_wii_8h.html#a11f7dbb22bf86e28848abc165e22c2de">L2CAP_LED_STATE</a>:</div>
<div class="line"><a name="l00780"></a><span class="lineno"> 780</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="_wii_8h.html#a7ae9154397104e4df34302ed0884bbfb">nunchuck_connected_flag</a>)</div>
<div class="line"><a name="l00781"></a><span class="lineno"> 781</span>&#160; <a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a> = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00782"></a><span class="lineno"> 782</span>&#160; <a class="code" href="class_w_i_i.html#a5d3b4a33ebc2ca9ebb154e10a05dbdd4">setLedStatus</a>();</div>
<div class="line"><a name="l00783"></a><span class="lineno"> 783</span>&#160; l2cap_state = <a class="code" href="_p_s3_b_t_8h.html#ae4da52ca67e1f8b977199b24e8f3a400">L2CAP_DONE</a>;</div>
<div class="line"><a name="l00784"></a><span class="lineno"> 784</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00785"></a><span class="lineno"> 785</span>&#160;</div>
<div class="line"><a name="l00786"></a><span class="lineno"> 786</span>&#160; <span class="keywordflow">case</span> <a class="code" href="_p_s3_b_t_8h.html#ae4da52ca67e1f8b977199b24e8f3a400">L2CAP_DONE</a>:</div>
<div class="line"><a name="l00787"></a><span class="lineno"> 787</span>&#160; <span class="keywordflow">if</span> (unknownExtensionConnected) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00788"></a><span class="lineno"> 788</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00789"></a><span class="lineno"> 789</span>&#160;<span class="preprocessor"></span> <span class="keywordflow">if</span> (stateCounter == 0) <span class="comment">// Only print once</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00790"></a><span class="lineno"> 790</span>&#160; <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nChecking extension port&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00791"></a><span class="lineno"> 791</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00792"></a><span class="lineno"> 792</span>&#160;<span class="preprocessor"></span> stateCounter++; <span class="comment">// We will use this counter as there has to be a short delay between the commands</span></div>
<div class="line"><a name="l00793"></a><span class="lineno"> 793</span>&#160; <span class="keywordflow">if</span> (stateCounter == 50)</div>
<div class="line"><a name="l00794"></a><span class="lineno"> 794</span>&#160; <a class="code" href="class_w_i_i.html#acf275afab058a712ab84fac6c38f8f54">statusRequest</a>();</div>
<div class="line"><a name="l00795"></a><span class="lineno"> 795</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 100)</div>
<div class="line"><a name="l00796"></a><span class="lineno"> 796</span>&#160; initExtension1();</div>
<div class="line"><a name="l00797"></a><span class="lineno"> 797</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 150)</div>
<div class="line"><a name="l00798"></a><span class="lineno"> 798</span>&#160; <span class="keywordflow">if</span> ((extensionConnected &amp;&amp; <a class="code" href="class_w_i_i.html#a72bd4fad2e524276712a154b8cc2a16c">motionPlusConnected</a>) || (unknownExtensionConnected &amp;&amp; !<a class="code" href="class_w_i_i.html#a72bd4fad2e524276712a154b8cc2a16c">motionPlusConnected</a>))</div>
<div class="line"><a name="l00799"></a><span class="lineno"> 799</span>&#160; initExtension2();</div>
<div class="line"><a name="l00800"></a><span class="lineno"> 800</span>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l00801"></a><span class="lineno"> 801</span>&#160; stateCounter = 299; <span class="comment">// There is no extension connected</span></div>
<div class="line"><a name="l00802"></a><span class="lineno"> 802</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 200)</div>
<div class="line"><a name="l00803"></a><span class="lineno"> 803</span>&#160; readExtensionType();</div>
<div class="line"><a name="l00804"></a><span class="lineno"> 804</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 250) {</div>
<div class="line"><a name="l00805"></a><span class="lineno"> 805</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="_wii_8h.html#a7ae9154397104e4df34302ed0884bbfb">nunchuck_connected_flag</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00806"></a><span class="lineno"> 806</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00807"></a><span class="lineno"> 807</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nNunchuck was reconnected&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00808"></a><span class="lineno"> 808</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00809"></a><span class="lineno"> 809</span>&#160;<span class="preprocessor"></span> activateNunchuck = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00810"></a><span class="lineno"> 810</span>&#160; <a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a> = <span class="keyword">true</span>;</div>
<div class="line"><a name="l00811"></a><span class="lineno"> 811</span>&#160; }</div>
<div class="line"><a name="l00812"></a><span class="lineno"> 812</span>&#160; <span class="keywordflow">if</span> (!<a class="code" href="class_w_i_i.html#a72bd4fad2e524276712a154b8cc2a16c">motionPlusConnected</a>)</div>
<div class="line"><a name="l00813"></a><span class="lineno"> 813</span>&#160; stateCounter = 449;</div>
<div class="line"><a name="l00814"></a><span class="lineno"> 814</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 300) {</div>
<div class="line"><a name="l00815"></a><span class="lineno"> 815</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a72bd4fad2e524276712a154b8cc2a16c">motionPlusConnected</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00816"></a><span class="lineno"> 816</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00817"></a><span class="lineno"> 817</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nReactivating the Motion Plus&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00818"></a><span class="lineno"> 818</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00819"></a><span class="lineno"> 819</span>&#160;<span class="preprocessor"></span> initMotionPlus();</div>
<div class="line"><a name="l00820"></a><span class="lineno"> 820</span>&#160; } <span class="keywordflow">else</span></div>
<div class="line"><a name="l00821"></a><span class="lineno"> 821</span>&#160; stateCounter = 449;</div>
<div class="line"><a name="l00822"></a><span class="lineno"> 822</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 350)</div>
<div class="line"><a name="l00823"></a><span class="lineno"> 823</span>&#160; activateMotionPlus();</div>
<div class="line"><a name="l00824"></a><span class="lineno"> 824</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 400)</div>
<div class="line"><a name="l00825"></a><span class="lineno"> 825</span>&#160; readExtensionType(); <span class="comment">// Check if it has been activated</span></div>
<div class="line"><a name="l00826"></a><span class="lineno"> 826</span>&#160; <span class="keywordflow">else</span> <span class="keywordflow">if</span> (stateCounter == 450) {</div>
<div class="line"><a name="l00827"></a><span class="lineno"> 827</span>&#160; <span class="comment">//setLedStatus();</span></div>
<div class="line"><a name="l00828"></a><span class="lineno"> 828</span>&#160; stateCounter = 0;</div>
<div class="line"><a name="l00829"></a><span class="lineno"> 829</span>&#160; unknownExtensionConnected = <span class="keyword">false</span>;</div>
<div class="line"><a name="l00830"></a><span class="lineno"> 830</span>&#160; }</div>
<div class="line"><a name="l00831"></a><span class="lineno"> 831</span>&#160; } <span class="keywordflow">else</span></div>
<div class="line"><a name="l00832"></a><span class="lineno"> 832</span>&#160; stateCounter = 0;</div>
<div class="line"><a name="l00833"></a><span class="lineno"> 833</span>&#160; <span class="keywordflow">break</span>;</div>
<div class="line"><a name="l00834"></a><span class="lineno"> 834</span>&#160; }</div>
<div class="line"><a name="l00835"></a><span class="lineno"> 835</span>&#160;}</div>
<div class="line"><a name="l00836"></a><span class="lineno"> 836</span>&#160;</div>
<div class="line"><a name="l00837"></a><span class="lineno"> 837</span>&#160;<span class="comment">/************************************************************/</span></div>
<div class="line"><a name="l00838"></a><span class="lineno"> 838</span>&#160;<span class="comment">/* HID Commands */</span></div>
<div class="line"><a name="l00839"></a><span class="lineno"> 839</span>&#160;</div>
<div class="line"><a name="l00840"></a><span class="lineno"> 840</span>&#160;<span class="comment">/************************************************************/</span></div>
<div class="line"><a name="l00841"></a><span class="lineno"> 841</span>&#160;<span class="keywordtype">void</span> WII::HID_Command(uint8_t* data, uint8_t nbytes) {</div>
<div class="line"><a name="l00842"></a><span class="lineno"> 842</span>&#160; <span class="keywordflow">if</span> (pBtd-&gt;<a class="code" href="class_b_t_d.html#a3aea445b2349e99ef057db1a4ffdd9dc">motionPlusInside</a>)</div>
<div class="line"><a name="l00843"></a><span class="lineno"> 843</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7">L2CAP_Command</a>(hci_handle, data, nbytes, interrupt_scid[0], interrupt_scid[1]); <span class="comment">// It&#39;s the new wiimote with the Motion Plus Inside</span></div>
<div class="line"><a name="l00844"></a><span class="lineno"> 844</span>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l00845"></a><span class="lineno"> 845</span>&#160; pBtd-&gt;<a class="code" href="class_b_t_d.html#aad7d8ef46e60b48ff4aaabefb0b290e7">L2CAP_Command</a>(hci_handle, data, nbytes, control_scid[0], control_scid[1]);</div>
<div class="line"><a name="l00846"></a><span class="lineno"> 846</span>&#160;}</div>
<div class="line"><a name="l00847"></a><span class="lineno"> 847</span>&#160;</div>
<div class="line"><a name="l00848"></a><span class="lineno"><a class="code" href="class_w_i_i.html#a6e97bfcfb134b63d7190ba1bc326e1d3"> 848</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#a6e97bfcfb134b63d7190ba1bc326e1d3">WII::setAllOff</a>() {</div>
<div class="line"><a name="l00849"></a><span class="lineno"> 849</span>&#160; HIDBuffer[1] = 0x11;</div>
<div class="line"><a name="l00850"></a><span class="lineno"> 850</span>&#160; HIDBuffer[2] = 0x00;</div>
<div class="line"><a name="l00851"></a><span class="lineno"> 851</span>&#160; HID_Command(HIDBuffer, 3);</div>
<div class="line"><a name="l00852"></a><span class="lineno"> 852</span>&#160;}</div>
<div class="line"><a name="l00853"></a><span class="lineno"> 853</span>&#160;</div>
<div class="line"><a name="l00854"></a><span class="lineno"><a class="code" href="class_w_i_i.html#a2c5c32841b020b248f757cb793acb936"> 854</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#a2c5c32841b020b248f757cb793acb936">WII::setRumbleOff</a>() {</div>
<div class="line"><a name="l00855"></a><span class="lineno"> 855</span>&#160; HIDBuffer[1] = 0x11;</div>
<div class="line"><a name="l00856"></a><span class="lineno"> 856</span>&#160; HIDBuffer[2] &amp;= ~0x01; <span class="comment">// Bit 0 control the rumble</span></div>
<div class="line"><a name="l00857"></a><span class="lineno"> 857</span>&#160; HID_Command(HIDBuffer, 3);</div>
<div class="line"><a name="l00858"></a><span class="lineno"> 858</span>&#160;}</div>
<div class="line"><a name="l00859"></a><span class="lineno"> 859</span>&#160;</div>
<div class="line"><a name="l00860"></a><span class="lineno"><a class="code" href="class_w_i_i.html#a0d9c869bd3677c4488a586c38558a137"> 860</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#a0d9c869bd3677c4488a586c38558a137">WII::setRumbleOn</a>() {</div>
<div class="line"><a name="l00861"></a><span class="lineno"> 861</span>&#160; HIDBuffer[1] = 0x11;</div>
<div class="line"><a name="l00862"></a><span class="lineno"> 862</span>&#160; HIDBuffer[2] |= 0x01; <span class="comment">// Bit 0 control the rumble</span></div>
<div class="line"><a name="l00863"></a><span class="lineno"> 863</span>&#160; HID_Command(HIDBuffer, 3);</div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l00864"></a><span class="lineno"> 864</span>&#160;}</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00865"></a><span class="lineno"> 865</span>&#160;</div>
<div class="line"><a name="l00866"></a><span class="lineno"><a class="code" href="class_w_i_i.html#a841396b533cccccb05db37d35f6fef9c"> 866</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#a841396b533cccccb05db37d35f6fef9c">WII::setRumbleToggle</a>() {</div>
<div class="line"><a name="l00867"></a><span class="lineno"> 867</span>&#160; HIDBuffer[1] = 0x11;</div>
<div class="line"><a name="l00868"></a><span class="lineno"> 868</span>&#160; HIDBuffer[2] ^= 0x01; <span class="comment">// Bit 0 control the rumble</span></div>
<div class="line"><a name="l00869"></a><span class="lineno"> 869</span>&#160; HID_Command(HIDBuffer, 3);</div>
<div class="line"><a name="l00870"></a><span class="lineno"> 870</span>&#160;}</div>
<div class="line"><a name="l00871"></a><span class="lineno"> 871</span>&#160;</div>
<div class="line"><a name="l00872"></a><span class="lineno"><a class="code" href="class_w_i_i.html#ae7e07f929fba8f0ff061a1405baa2b58"> 872</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#ae7e07f929fba8f0ff061a1405baa2b58">WII::setLedRaw</a>(uint8_t value) {</div>
<div class="line"><a name="l00873"></a><span class="lineno"> 873</span>&#160; HIDBuffer[1] = 0x11;</div>
<div class="line"><a name="l00874"></a><span class="lineno"> 874</span>&#160; HIDBuffer[2] = value | (HIDBuffer[2] &amp; 0x01); <span class="comment">// Keep the rumble bit</span></div>
<div class="line"><a name="l00875"></a><span class="lineno"> 875</span>&#160; HID_Command(HIDBuffer, 3);</div>
<div class="line"><a name="l00876"></a><span class="lineno"> 876</span>&#160;}</div>
<div class="line"><a name="l00877"></a><span class="lineno"><a class="code" href="class_w_i_i.html#a7efe7577ba30c218f6fbd3804a53d242"> 877</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#a7efe7577ba30c218f6fbd3804a53d242">WII::setLedOff</a>(<a class="code" href="controller_enums_8h.html#aadcb6002d2b42fdfe01490f730ab00a6">LED</a> a) {</div>
<div class="line"><a name="l00878"></a><span class="lineno"> 878</span>&#160; HIDBuffer[1] = 0x11;</div>
<div class="line"><a name="l00879"></a><span class="lineno"> 879</span>&#160; HIDBuffer[2] &amp;= ~(pgm_read_byte(&amp;<a class="code" href="_p_s3_enums_8h.html#af83672eccf0c7a02847ce75bc5c55a1a">LEDS</a>[(uint8_t)a]));</div>
<div class="line"><a name="l00880"></a><span class="lineno"> 880</span>&#160; HID_Command(HIDBuffer, 3);</div>
<div class="line"><a name="l00881"></a><span class="lineno"> 881</span>&#160;}</div>
<div class="line"><a name="l00882"></a><span class="lineno"> 882</span>&#160;</div>
<div class="line"><a name="l00883"></a><span class="lineno"><a class="code" href="class_w_i_i.html#a3a7b9dd571c5a8597bfb194000bd517c"> 883</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#a3a7b9dd571c5a8597bfb194000bd517c">WII::setLedOn</a>(<a class="code" href="controller_enums_8h.html#aadcb6002d2b42fdfe01490f730ab00a6">LED</a> a) {</div>
<div class="line"><a name="l00884"></a><span class="lineno"> 884</span>&#160; HIDBuffer[1] = 0x11;</div>
<div class="line"><a name="l00885"></a><span class="lineno"> 885</span>&#160; HIDBuffer[2] |= pgm_read_byte(&amp;<a class="code" href="_p_s3_enums_8h.html#af83672eccf0c7a02847ce75bc5c55a1a">LEDS</a>[(uint8_t)a]);</div>
<div class="line"><a name="l00886"></a><span class="lineno"> 886</span>&#160; HID_Command(HIDBuffer, 3);</div>
<div class="line"><a name="l00887"></a><span class="lineno"> 887</span>&#160;}</div>
<div class="line"><a name="l00888"></a><span class="lineno"> 888</span>&#160;</div>
<div class="line"><a name="l00889"></a><span class="lineno"><a class="code" href="class_w_i_i.html#af7755e2b2a161a550c99de2ca1018ce3"> 889</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#af7755e2b2a161a550c99de2ca1018ce3">WII::setLedToggle</a>(<a class="code" href="controller_enums_8h.html#aadcb6002d2b42fdfe01490f730ab00a6">LED</a> a) {</div>
<div class="line"><a name="l00890"></a><span class="lineno"> 890</span>&#160; HIDBuffer[1] = 0x11;</div>
<div class="line"><a name="l00891"></a><span class="lineno"> 891</span>&#160; HIDBuffer[2] ^= pgm_read_byte(&amp;<a class="code" href="_p_s3_enums_8h.html#af83672eccf0c7a02847ce75bc5c55a1a">LEDS</a>[(uint8_t)a]);</div>
<div class="line"><a name="l00892"></a><span class="lineno"> 892</span>&#160; HID_Command(HIDBuffer, 3);</div>
<div class="line"><a name="l00893"></a><span class="lineno"> 893</span>&#160;}</div>
<div class="line"><a name="l00894"></a><span class="lineno"> 894</span>&#160;</div>
<div class="line"><a name="l00895"></a><span class="lineno"><a class="code" href="class_w_i_i.html#a5d3b4a33ebc2ca9ebb154e10a05dbdd4"> 895</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#a5d3b4a33ebc2ca9ebb154e10a05dbdd4">WII::setLedStatus</a>() {</div>
<div class="line"><a name="l00896"></a><span class="lineno"> 896</span>&#160; HIDBuffer[1] = 0x11;</div>
<div class="line"><a name="l00897"></a><span class="lineno"> 897</span>&#160; HIDBuffer[2] = (HIDBuffer[2] &amp; 0x01); <span class="comment">// Keep the rumble bit</span></div>
<div class="line"><a name="l00898"></a><span class="lineno"> 898</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#ae25a8ea1b0713801e0209e795b4596fa">wiimoteConnected</a>)</div>
<div class="line"><a name="l00899"></a><span class="lineno"> 899</span>&#160; HIDBuffer[2] |= 0x10; <span class="comment">// If it&#39;s connected LED1 will light up</span></div>
<div class="line"><a name="l00900"></a><span class="lineno"> 900</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a72bd4fad2e524276712a154b8cc2a16c">motionPlusConnected</a>)</div>
<div class="line"><a name="l00901"></a><span class="lineno"> 901</span>&#160; HIDBuffer[2] |= 0x20; <span class="comment">// If it&#39;s connected LED2 will light up</span></div>
<div class="line"><a name="l00902"></a><span class="lineno"> 902</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a>)</div>
<div class="line"><a name="l00903"></a><span class="lineno"> 903</span>&#160; HIDBuffer[2] |= 0x40; <span class="comment">// If it&#39;s connected LED3 will light up</span></div>
<div class="line"><a name="l00904"></a><span class="lineno"> 904</span>&#160;</div>
<div class="line"><a name="l00905"></a><span class="lineno"> 905</span>&#160; HID_Command(HIDBuffer, 3);</div>
<div class="line"><a name="l00906"></a><span class="lineno"> 906</span>&#160;}</div>
<div class="line"><a name="l00907"></a><span class="lineno"> 907</span>&#160;</div>
<div class="line"><a name="l00908"></a><span class="lineno"> 908</span>&#160;<span class="keywordtype">void</span> WII::setReportMode(<span class="keywordtype">bool</span> continuous, uint8_t mode) {</div>
<div class="line"><a name="l00909"></a><span class="lineno"> 909</span>&#160; uint8_t cmd_buf[4];</div>
<div class="line"><a name="l00910"></a><span class="lineno"> 910</span>&#160; cmd_buf[0] = 0xA2; <span class="comment">// HID BT DATA_request (0xA0) | Report Type (Output 0x02)</span></div>
<div class="line"><a name="l00911"></a><span class="lineno"> 911</span>&#160; cmd_buf[1] = 0x12;</div>
<div class="line"><a name="l00912"></a><span class="lineno"> 912</span>&#160; <span class="keywordflow">if</span> (continuous)</div>
<div class="line"><a name="l00913"></a><span class="lineno"> 913</span>&#160; cmd_buf[2] = 0x04 | (HIDBuffer[2] &amp; 0x01); <span class="comment">// Keep the rumble bit</span></div>
<div class="line"><a name="l00914"></a><span class="lineno"> 914</span>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l00915"></a><span class="lineno"> 915</span>&#160; cmd_buf[2] = 0x00 | (HIDBuffer[2] &amp; 0x01); <span class="comment">// Keep the rumble bit</span></div>
<div class="line"><a name="l00916"></a><span class="lineno"> 916</span>&#160; cmd_buf[3] = mode;</div>
<div class="line"><a name="l00917"></a><span class="lineno"> 917</span>&#160; HID_Command(cmd_buf, 4);</div>
<div class="line"><a name="l00918"></a><span class="lineno"> 918</span>&#160;}</div>
<div class="line"><a name="l00919"></a><span class="lineno"> 919</span>&#160;</div>
<div class="line"><a name="l00920"></a><span class="lineno"><a class="code" href="class_w_i_i.html#acf275afab058a712ab84fac6c38f8f54"> 920</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#acf275afab058a712ab84fac6c38f8f54">WII::statusRequest</a>() {</div>
<div class="line"><a name="l00921"></a><span class="lineno"> 921</span>&#160; uint8_t cmd_buf[3];</div>
<div class="line"><a name="l00922"></a><span class="lineno"> 922</span>&#160; cmd_buf[0] = 0xA2; <span class="comment">// HID BT DATA_request (0xA0) | Report Type (Output 0x02)</span></div>
<div class="line"><a name="l00923"></a><span class="lineno"> 923</span>&#160; cmd_buf[1] = 0x15;</div>
<div class="line"><a name="l00924"></a><span class="lineno"> 924</span>&#160; cmd_buf[2] = (HIDBuffer[2] &amp; 0x01); <span class="comment">// Keep the rumble bit</span></div>
<div class="line"><a name="l00925"></a><span class="lineno"> 925</span>&#160; HID_Command(cmd_buf, 3);</div>
<div class="line"><a name="l00926"></a><span class="lineno"> 926</span>&#160;}</div>
<div class="line"><a name="l00927"></a><span class="lineno"> 927</span>&#160;</div>
<div class="line"><a name="l00928"></a><span class="lineno"> 928</span>&#160;<span class="comment">/************************************************************/</span></div>
<div class="line"><a name="l00929"></a><span class="lineno"> 929</span>&#160;<span class="comment">/* Memmory Commands */</span></div>
<div class="line"><a name="l00930"></a><span class="lineno"> 930</span>&#160;</div>
<div class="line"><a name="l00931"></a><span class="lineno"> 931</span>&#160;<span class="comment">/************************************************************/</span></div>
<div class="line"><a name="l00932"></a><span class="lineno"> 932</span>&#160;<span class="keywordtype">void</span> WII::writeData(uint32_t offset, uint8_t size, uint8_t* data) {</div>
<div class="line"><a name="l00933"></a><span class="lineno"> 933</span>&#160; uint8_t cmd_buf[23];</div>
<div class="line"><a name="l00934"></a><span class="lineno"> 934</span>&#160; cmd_buf[0] = 0xA2; <span class="comment">// HID BT DATA_request (0xA0) | Report Type (Output 0x02)</span></div>
<div class="line"><a name="l00935"></a><span class="lineno"> 935</span>&#160; cmd_buf[1] = 0x16; <span class="comment">// Write data</span></div>
<div class="line"><a name="l00936"></a><span class="lineno"> 936</span>&#160; cmd_buf[2] = 0x04 | (HIDBuffer[2] &amp; 0x01); <span class="comment">// Write to memory, clear bit 2 to write to EEPROM</span></div>
<div class="line"><a name="l00937"></a><span class="lineno"> 937</span>&#160; cmd_buf[3] = (uint8_t)((offset &amp; 0xFF0000) &gt;&gt; 16);</div>
<div class="line"><a name="l00938"></a><span class="lineno"> 938</span>&#160; cmd_buf[4] = (uint8_t)((offset &amp; 0xFF00) &gt;&gt; 8);</div>
<div class="line"><a name="l00939"></a><span class="lineno"> 939</span>&#160; cmd_buf[5] = (uint8_t)(offset &amp; 0xFF);</div>
<div class="line"><a name="l00940"></a><span class="lineno"> 940</span>&#160; cmd_buf[6] = size;</div>
<div class="line"><a name="l00941"></a><span class="lineno"> 941</span>&#160; uint8_t i = 0;</div>
<div class="line"><a name="l00942"></a><span class="lineno"> 942</span>&#160; <span class="keywordflow">for</span> (; i &lt; size; i++)</div>
<div class="line"><a name="l00943"></a><span class="lineno"> 943</span>&#160; cmd_buf[7 + i] = data[i];</div>
<div class="line"><a name="l00944"></a><span class="lineno"> 944</span>&#160; <span class="keywordflow">for</span> (; i &lt; 16; i++) <span class="comment">// Set the rest to zero</span></div>
<div class="line"><a name="l00945"></a><span class="lineno"> 945</span>&#160; cmd_buf[7 + i] = 0x00;</div>
<div class="line"><a name="l00946"></a><span class="lineno"> 946</span>&#160; HID_Command(cmd_buf, 23);</div>
<div class="line"><a name="l00947"></a><span class="lineno"> 947</span>&#160;}</div>
<div class="line"><a name="l00948"></a><span class="lineno"> 948</span>&#160;</div>
<div class="line"><a name="l00949"></a><span class="lineno"> 949</span>&#160;<span class="keywordtype">void</span> WII::initExtension1() {</div>
<div class="line"><a name="l00950"></a><span class="lineno"> 950</span>&#160; uint8_t buf[1];</div>
<div class="line"><a name="l00951"></a><span class="lineno"> 951</span>&#160; buf[0] = 0x55;</div>
<div class="line"><a name="l00952"></a><span class="lineno"> 952</span>&#160; writeData(0xA400F0, 1, buf);</div>
<div class="line"><a name="l00953"></a><span class="lineno"> 953</span>&#160;}</div>
<div class="line"><a name="l00954"></a><span class="lineno"> 954</span>&#160;</div>
<div class="line"><a name="l00955"></a><span class="lineno"> 955</span>&#160;<span class="keywordtype">void</span> WII::initExtension2() {</div>
<div class="line"><a name="l00956"></a><span class="lineno"> 956</span>&#160; uint8_t buf[1];</div>
<div class="line"><a name="l00957"></a><span class="lineno"> 957</span>&#160; buf[0] = 0x00;</div>
<div class="line"><a name="l00958"></a><span class="lineno"> 958</span>&#160; writeData(0xA400FB, 1, buf);</div>
<div class="line"><a name="l00959"></a><span class="lineno"> 959</span>&#160;}</div>
<div class="line"><a name="l00960"></a><span class="lineno"> 960</span>&#160;</div>
<div class="line"><a name="l00961"></a><span class="lineno"> 961</span>&#160;<span class="keywordtype">void</span> WII::initMotionPlus() {</div>
<div class="line"><a name="l00962"></a><span class="lineno"> 962</span>&#160; uint8_t buf[1];</div>
<div class="line"><a name="l00963"></a><span class="lineno"> 963</span>&#160; buf[0] = 0x55;</div>
<div class="line"><a name="l00964"></a><span class="lineno"> 964</span>&#160; writeData(0xA600F0, 1, buf);</div>
<div class="line"><a name="l00965"></a><span class="lineno"> 965</span>&#160;}</div>
<div class="line"><a name="l00966"></a><span class="lineno"> 966</span>&#160;</div>
<div class="line"><a name="l00967"></a><span class="lineno"> 967</span>&#160;<span class="keywordtype">void</span> WII::activateMotionPlus() {</div>
<div class="line"><a name="l00968"></a><span class="lineno"> 968</span>&#160; uint8_t buf[1];</div>
<div class="line"><a name="l00969"></a><span class="lineno"> 969</span>&#160; <span class="keywordflow">if</span> (pBtd-&gt;<a class="code" href="class_b_t_d.html#a962a5714c225dcb633434f02e3657583">wiiUProController</a>) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00970"></a><span class="lineno"> 970</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00971"></a><span class="lineno"> 971</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nActivating Wii U Pro Controller&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00972"></a><span class="lineno"> 972</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00973"></a><span class="lineno"> 973</span>&#160;<span class="preprocessor"></span> buf[0] = 0x00; <span class="comment">// It seems like you can send anything but 0x04, 0x05, and 0x07</span></div>
<div class="line"><a name="l00974"></a><span class="lineno"> 974</span>&#160; } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (activateNunchuck) {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00975"></a><span class="lineno"> 975</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00976"></a><span class="lineno"> 976</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nActivating Motion Plus in pass-through mode&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00977"></a><span class="lineno"> 977</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00978"></a><span class="lineno"> 978</span>&#160;<span class="preprocessor"></span> buf[0] = 0x05; <span class="comment">// Activate nunchuck pass-through mode</span></div>
<div class="line"><a name="l00979"></a><span class="lineno"> 979</span>&#160; } <span class="comment">//else if(classicControllerConnected &amp;&amp; extensionConnected)</span></div>
<div class="line"><a name="l00980"></a><span class="lineno"> 980</span>&#160; <span class="comment">//buf[0] = 0x07;</span></div>
<div class="line"><a name="l00981"></a><span class="lineno"> 981</span>&#160; <span class="keywordflow">else</span> {</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l00982"></a><span class="lineno"> 982</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l00983"></a><span class="lineno"> 983</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nActivating Motion Plus in normal mode&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l00984"></a><span class="lineno"> 984</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l00985"></a><span class="lineno"> 985</span>&#160;<span class="preprocessor"></span> buf[0] = 0x04; <span class="comment">// Don&#39;t use any extension</span></div>
<div class="line"><a name="l00986"></a><span class="lineno"> 986</span>&#160; }</div>
<div class="line"><a name="l00987"></a><span class="lineno"> 987</span>&#160; writeData(0xA600FE, 1, buf);</div>
<div class="line"><a name="l00988"></a><span class="lineno"> 988</span>&#160;}</div>
<div class="line"><a name="l00989"></a><span class="lineno"> 989</span>&#160;</div>
<div class="line"><a name="l00990"></a><span class="lineno"> 990</span>&#160;<span class="keywordtype">void</span> WII::readData(uint32_t offset, uint16_t size, <span class="keywordtype">bool</span> EEPROM) {</div>
<div class="line"><a name="l00991"></a><span class="lineno"> 991</span>&#160; uint8_t cmd_buf[8];</div>
<div class="line"><a name="l00992"></a><span class="lineno"> 992</span>&#160; cmd_buf[0] = 0xA2; <span class="comment">// HID BT DATA_request (0xA0) | Report Type (Output 0x02)</span></div>
<div class="line"><a name="l00993"></a><span class="lineno"> 993</span>&#160; cmd_buf[1] = 0x17; <span class="comment">// Read data</span></div>
<div class="line"><a name="l00994"></a><span class="lineno"> 994</span>&#160; <span class="keywordflow">if</span> (EEPROM)</div>
<div class="line"><a name="l00995"></a><span class="lineno"> 995</span>&#160; cmd_buf[2] = 0x00 | (HIDBuffer[2] &amp; 0x01); <span class="comment">// Read from EEPROM</span></div>
<div class="line"><a name="l00996"></a><span class="lineno"> 996</span>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l00997"></a><span class="lineno"> 997</span>&#160; cmd_buf[2] = 0x04 | (HIDBuffer[2] &amp; 0x01); <span class="comment">// Read from memory</span></div>
<div class="line"><a name="l00998"></a><span class="lineno"> 998</span>&#160; cmd_buf[3] = (uint8_t)((offset &amp; 0xFF0000) &gt;&gt; 16);</div>
<div class="line"><a name="l00999"></a><span class="lineno"> 999</span>&#160; cmd_buf[4] = (uint8_t)((offset &amp; 0xFF00) &gt;&gt; 8);</div>
<div class="line"><a name="l01000"></a><span class="lineno"> 1000</span>&#160; cmd_buf[5] = (uint8_t)(offset &amp; 0xFF);</div>
<div class="line"><a name="l01001"></a><span class="lineno"> 1001</span>&#160; cmd_buf[6] = (uint8_t)((size &amp; 0xFF00) &gt;&gt; 8);</div>
<div class="line"><a name="l01002"></a><span class="lineno"> 1002</span>&#160; cmd_buf[7] = (uint8_t)(size &amp; 0xFF);</div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l01003"></a><span class="lineno"> 1003</span>&#160;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l01004"></a><span class="lineno"> 1004</span>&#160; HID_Command(cmd_buf, 8);</div>
<div class="line"><a name="l01005"></a><span class="lineno"> 1005</span>&#160;}</div>
<div class="line"><a name="l01006"></a><span class="lineno"> 1006</span>&#160;</div>
<div class="line"><a name="l01007"></a><span class="lineno"> 1007</span>&#160;<span class="keywordtype">void</span> WII::readExtensionType() {</div>
<div class="line"><a name="l01008"></a><span class="lineno"> 1008</span>&#160; readData(0xA400FA, 6, <span class="keyword">false</span>);</div>
<div class="line"><a name="l01009"></a><span class="lineno"> 1009</span>&#160;}</div>
<div class="line"><a name="l01010"></a><span class="lineno"> 1010</span>&#160;</div>
<div class="line"><a name="l01011"></a><span class="lineno"> 1011</span>&#160;<span class="keywordtype">void</span> WII::readCalData() {</div>
<div class="line"><a name="l01012"></a><span class="lineno"> 1012</span>&#160; readData(0x0016, 8, <span class="keyword">true</span>);</div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l01013"></a><span class="lineno"> 1013</span>&#160;}</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l01014"></a><span class="lineno"> 1014</span>&#160;</div>
<div class="line"><a name="l01015"></a><span class="lineno"> 1015</span>&#160;<span class="keywordtype">void</span> WII::checkMotionPresent() {</div>
<div class="line"><a name="l01016"></a><span class="lineno"> 1016</span>&#160; readData(0xA600FA, 6, <span class="keyword">false</span>);</div>
<div class="line"><a name="l01017"></a><span class="lineno"> 1017</span>&#160;}</div>
<div class="line"><a name="l01018"></a><span class="lineno"> 1018</span>&#160;</div>
<div class="line"><a name="l01019"></a><span class="lineno"> 1019</span>&#160;<span class="comment">/************************************************************/</span></div>
<div class="line"><a name="l01020"></a><span class="lineno"> 1020</span>&#160;<span class="comment">/* WII Commands */</span></div>
<div class="line"><a name="l01021"></a><span class="lineno"> 1021</span>&#160;</div>
<div class="line"><a name="l01022"></a><span class="lineno"> 1022</span>&#160;<span class="comment">/************************************************************/</span></div>
<div class="line"><a name="l01023"></a><span class="lineno"> 1023</span>&#160;</div>
<div class="line"><a name="l01024"></a><span class="lineno"><a class="code" href="class_w_i_i.html#acf4b3ef0a4fa0cf71133a22213361288"> 1024</a></span>&#160;<span class="keywordtype">bool</span> <a class="code" href="class_w_i_i.html#acf4b3ef0a4fa0cf71133a22213361288">WII::getButtonPress</a>(<a class="code" href="controller_enums_8h.html#a03bfec859eac87be20f8952c1eb89de0">Button</a> b) { <span class="comment">// Return true when a button is pressed</span></div>
<div class="line"><a name="l01025"></a><span class="lineno"> 1025</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a461f5b7a5f2bc874e107fc776c284b16">wiiUProControllerConnected</a>)</div>
<div class="line"><a name="l01026"></a><span class="lineno"> 1026</span>&#160; <span class="keywordflow">return</span> (ButtonState &amp; pgm_read_dword(&amp;<a class="code" href="_wii_8cpp.html#a6571a59427c954eefde75bb40f02443e">PROCONTROLLERBUTTONS</a>[(uint8_t)b]));</div>
<div class="line"><a name="l01027"></a><span class="lineno"> 1027</span>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l01028"></a><span class="lineno"> 1028</span>&#160; <span class="keywordflow">return</span> (ButtonState &amp; pgm_read_dword(&amp;<a class="code" href="_p_s3_enums_8h.html#af3392eea150ac9151bef45148f0d7895">BUTTONS</a>[(uint8_t)b]));</div>
<div class="line"><a name="l01029"></a><span class="lineno"> 1029</span>&#160;}</div>
<div class="line"><a name="l01030"></a><span class="lineno"> 1030</span>&#160;</div>
<div class="line"><a name="l01031"></a><span class="lineno"><a class="code" href="class_w_i_i.html#adbf9ccb1725dc432e07ca19468713116"> 1031</a></span>&#160;<span class="keywordtype">bool</span> <a class="code" href="class_w_i_i.html#adbf9ccb1725dc432e07ca19468713116">WII::getButtonClick</a>(<a class="code" href="controller_enums_8h.html#a03bfec859eac87be20f8952c1eb89de0">Button</a> b) { <span class="comment">// Only return true when a button is clicked</span></div>
<div class="line"><a name="l01032"></a><span class="lineno"> 1032</span>&#160; uint32_t button;</div>
<div class="line"><a name="l01033"></a><span class="lineno"> 1033</span>&#160; <span class="keywordflow">if</span> (<a class="code" href="class_w_i_i.html#a461f5b7a5f2bc874e107fc776c284b16">wiiUProControllerConnected</a>)</div>
<div class="line"><a name="l01034"></a><span class="lineno"> 1034</span>&#160; button = pgm_read_dword(&amp;<a class="code" href="_wii_8cpp.html#a6571a59427c954eefde75bb40f02443e">PROCONTROLLERBUTTONS</a>[(uint8_t)b]);</div>
<div class="line"><a name="l01035"></a><span class="lineno"> 1035</span>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l01036"></a><span class="lineno"> 1036</span>&#160; button = pgm_read_dword(&amp;<a class="code" href="_p_s3_enums_8h.html#af3392eea150ac9151bef45148f0d7895">BUTTONS</a>[(uint8_t)b]);</div>
<div class="line"><a name="l01037"></a><span class="lineno"> 1037</span>&#160; <span class="keywordtype">bool</span> click = (ButtonClickState &amp; button);</div>
<div class="line"><a name="l01038"></a><span class="lineno"> 1038</span>&#160; ButtonClickState &amp;= ~button; <span class="comment">// clear &quot;click&quot; event</span></div>
<div class="line"><a name="l01039"></a><span class="lineno"> 1039</span>&#160; <span class="keywordflow">return</span> click;</div>
<div class="line"><a name="l01040"></a><span class="lineno"> 1040</span>&#160;}</div>
<div class="line"><a name="l01041"></a><span class="lineno"> 1041</span>&#160;</div>
<div class="line"><a name="l01042"></a><span class="lineno"><a class="code" href="class_w_i_i.html#ab16e907132354be9848fd91a6a5171db"> 1042</a></span>&#160;uint8_t <a class="code" href="class_w_i_i.html#ab16e907132354be9848fd91a6a5171db">WII::getAnalogHat</a>(<a class="code" href="_wii_8h.html#a3edd2b2fd262b698309012868fad0be7">Hat</a> a) {</div>
<div class="line"><a name="l01043"></a><span class="lineno"> 1043</span>&#160; <span class="keywordflow">if</span> (!<a class="code" href="class_w_i_i.html#a7cb4cec343c65fd350e6b05043d7f1a8">nunchuckConnected</a>)</div>
<div class="line"><a name="l01044"></a><span class="lineno"> 1044</span>&#160; <span class="keywordflow">return</span> 127; <span class="comment">// Return center position</span></div>
<div class="line"><a name="l01045"></a><span class="lineno"> 1045</span>&#160; <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l01046"></a><span class="lineno"> 1046</span>&#160; uint8_t output = hatValues[(uint8_t)a];</div>
<div class="line"><a name="l01047"></a><span class="lineno"> 1047</span>&#160; <span class="keywordflow">if</span> (output == 0xFF || output == 0x00) <span class="comment">// The joystick will only read 255 or 0 when the cable is unplugged or initializing, so we will just return the center position</span></div>
<div class="line"><a name="l01048"></a><span class="lineno"> 1048</span>&#160; <span class="keywordflow">return</span> 127;</div>
<div class="line"><a name="l01049"></a><span class="lineno"> 1049</span>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l01050"></a><span class="lineno"> 1050</span>&#160; <span class="keywordflow">return</span> output;</div>
<div class="line"><a name="l01051"></a><span class="lineno"> 1051</span>&#160; }</div>
<div class="line"><a name="l01052"></a><span class="lineno"> 1052</span>&#160;}</div>
<div class="line"><a name="l01053"></a><span class="lineno"> 1053</span>&#160;</div>
<div class="line"><a name="l01054"></a><span class="lineno"><a class="code" href="class_w_i_i.html#ab684ac791f235aed4d5ccf485081c075"> 1054</a></span>&#160;uint16_t <a class="code" href="class_w_i_i.html#ab16e907132354be9848fd91a6a5171db">WII::getAnalogHat</a>(<a class="code" href="controller_enums_8h.html#aaaabdefc068fd57ec2bef2b62ea4ba92">AnalogHat</a> a) {</div>
<div class="line"><a name="l01055"></a><span class="lineno"> 1055</span>&#160; <span class="keywordflow">if</span> (!<a class="code" href="class_w_i_i.html#a461f5b7a5f2bc874e107fc776c284b16">wiiUProControllerConnected</a>)</div>
<div class="line"><a name="l01056"></a><span class="lineno"> 1056</span>&#160; <span class="keywordflow">return</span> 2000;</div>
<div class="line"><a name="l01057"></a><span class="lineno"> 1057</span>&#160; <span class="keywordflow">else</span> {</div>
<div class="line"><a name="l01058"></a><span class="lineno"> 1058</span>&#160; uint16_t output = hatValues[(uint8_t)a];</div>
<div class="line"><a name="l01059"></a><span class="lineno"> 1059</span>&#160; <span class="keywordflow">if</span> (output == 0x00) <span class="comment">// The joystick will only read 0 when it is first initializing, so we will just return the center position</span></div>
<div class="line"><a name="l01060"></a><span class="lineno"> 1060</span>&#160; <span class="keywordflow">return</span> 2000;</div>
<div class="line"><a name="l01061"></a><span class="lineno"> 1061</span>&#160; <span class="keywordflow">else</span></div>
<div class="line"><a name="l01062"></a><span class="lineno"> 1062</span>&#160; <span class="keywordflow">return</span> output;</div>
<div class="line"><a name="l01063"></a><span class="lineno"> 1063</span>&#160; }</div>
<div class="line"><a name="l01064"></a><span class="lineno"> 1064</span>&#160;}</div>
<div class="line"><a name="l01065"></a><span class="lineno"> 1065</span>&#160;<span class="comment">/************************************************************/</span></div>
<div class="line"><a name="l01066"></a><span class="lineno"> 1066</span>&#160;<span class="comment">/* The following functions are for the IR camera */</span></div>
<div class="line"><a name="l01067"></a><span class="lineno"> 1067</span>&#160;<span class="comment">/************************************************************/</span></div>
<div class="line"><a name="l01068"></a><span class="lineno"> 1068</span>&#160;</div>
<div class="line"><a name="l01069"></a><span class="lineno"> 1069</span>&#160;<span class="preprocessor">#ifdef WIICAMERA</span></div>
<div class="line"><a name="l01070"></a><span class="lineno"> 1070</span>&#160;<span class="preprocessor"></span></div>
<div class="line"><a name="l01071"></a><span class="lineno"><a class="code" href="class_w_i_i.html#a3505abbc01c71d134ce301dfb7c0c5b5"> 1071</a></span>&#160;<span class="keywordtype">void</span> <a class="code" href="class_w_i_i.html#a3505abbc01c71d134ce301dfb7c0c5b5">WII::IRinitialize</a>() { <span class="comment">// Turns on and initialises the IR camera</span></div>
<div class="line"><a name="l01072"></a><span class="lineno"> 1072</span>&#160;</div>
<div class="line"><a name="l01073"></a><span class="lineno"> 1073</span>&#160; enableIRCamera1();</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l01074"></a><span class="lineno"> 1074</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l01075"></a><span class="lineno"> 1075</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nEnable IR Camera1 Complete&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l01076"></a><span class="lineno"> 1076</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l01077"></a><span class="lineno"> 1077</span>&#160;<span class="preprocessor"></span> delay(80);</div>
<div class="line"><a name="l01078"></a><span class="lineno"> 1078</span>&#160;</div>
<div class="line"><a name="l01079"></a><span class="lineno"> 1079</span>&#160; enableIRCamera2();</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l01080"></a><span class="lineno"> 1080</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l01081"></a><span class="lineno"> 1081</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nEnable IR Camera2 Complete&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l01082"></a><span class="lineno"> 1082</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l01083"></a><span class="lineno"> 1083</span>&#160;<span class="preprocessor"></span> delay(80);</div>
<div class="line"><a name="l01084"></a><span class="lineno"> 1084</span>&#160;</div>
<div class="line"><a name="l01085"></a><span class="lineno"> 1085</span>&#160; write0x08Value();</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l01086"></a><span class="lineno"> 1086</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l01087"></a><span class="lineno"> 1087</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nWrote hex number 0x08&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l01088"></a><span class="lineno"> 1088</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l01089"></a><span class="lineno"> 1089</span>&#160;<span class="preprocessor"></span> delay(80);</div>
<div class="line"><a name="l01090"></a><span class="lineno"> 1090</span>&#160;</div>
<div class="line"><a name="l01091"></a><span class="lineno"> 1091</span>&#160; writeSensitivityBlock1();</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l01092"></a><span class="lineno"> 1092</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l01093"></a><span class="lineno"> 1093</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nWrote Sensitivity Block 1&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l01094"></a><span class="lineno"> 1094</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l01095"></a><span class="lineno"> 1095</span>&#160;<span class="preprocessor"></span> delay(80);</div>
<div class="line"><a name="l01096"></a><span class="lineno"> 1096</span>&#160;</div>
<div class="line"><a name="l01097"></a><span class="lineno"> 1097</span>&#160; writeSensitivityBlock2();</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l01098"></a><span class="lineno"> 1098</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l01099"></a><span class="lineno"> 1099</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nWrote Sensitivity Block 2&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l01100"></a><span class="lineno"> 1100</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l01101"></a><span class="lineno"> 1101</span>&#160;<span class="preprocessor"></span> delay(80);</div>
<div class="line"><a name="l01102"></a><span class="lineno"> 1102</span>&#160;</div>
<div class="line"><a name="l01103"></a><span class="lineno"> 1103</span>&#160; uint8_t mode_num = 0x03;</div>
<div class="line"><a name="l01104"></a><span class="lineno"> 1104</span>&#160; setWiiModeNumber(mode_num); <span class="comment">// Change input for whatever mode you want i.e. 0x01, 0x03, or 0x05</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l01105"></a><span class="lineno"> 1105</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l01106"></a><span class="lineno"> 1106</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSet Wii Mode Number To 0x&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l01107"></a><span class="lineno"> 1107</span>&#160; PrintHex&lt;uint8_t &gt; (mode_num, 0x80);</div>
<div class="line"><a name="l01108"></a><span class="lineno"> 1108</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l01109"></a><span class="lineno"> 1109</span>&#160;<span class="preprocessor"></span> delay(80);</div>
2013-02-05 20:02:12 +01:00
<div class="line"><a name="l01110"></a><span class="lineno"> 1110</span>&#160;</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l01111"></a><span class="lineno"> 1111</span>&#160; write0x08Value();</div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l01112"></a><span class="lineno"> 1112</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l01113"></a><span class="lineno"> 1113</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nWrote Hex Number 0x08&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l01114"></a><span class="lineno"> 1114</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l01115"></a><span class="lineno"> 1115</span>&#160;<span class="preprocessor"></span> delay(80);</div>
<div class="line"><a name="l01116"></a><span class="lineno"> 1116</span>&#160;</div>
<div class="line"><a name="l01117"></a><span class="lineno"> 1117</span>&#160; setReportMode(<span class="keyword">false</span>, 0x33);</div>
<div class="line"><a name="l01118"></a><span class="lineno"> 1118</span>&#160; <span class="comment">//setReportMode(false, 0x3f); // For full reporting mode, doesn&#39;t work yet</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l01119"></a><span class="lineno"> 1119</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l01120"></a><span class="lineno"> 1120</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nSet Report Mode to 0x33&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l01121"></a><span class="lineno"> 1121</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l01122"></a><span class="lineno"> 1122</span>&#160;<span class="preprocessor"></span> delay(80);</div>
<div class="line"><a name="l01123"></a><span class="lineno"> 1123</span>&#160;</div>
<div class="line"><a name="l01124"></a><span class="lineno"> 1124</span>&#160; <a class="code" href="class_w_i_i.html#acf275afab058a712ab84fac6c38f8f54">statusRequest</a>(); <span class="comment">// Used to update wiiState - call isIRCameraEnabled() afterwards to check if it actually worked</span></div>
2013-06-17 20:33:24 +02:00
<div class="line"><a name="l01125"></a><span class="lineno"> 1125</span>&#160;<span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
<div class="line"><a name="l01126"></a><span class="lineno"> 1126</span>&#160;<span class="preprocessor"></span> <a class="code" href="message_8h.html#a27117e124c5d66d5512fe8d494fe6338">Notify</a>(PSTR(<span class="stringliteral">&quot;\r\nIR Initialized&quot;</span>), 0x80);</div>
2013-04-01 22:52:24 +02:00
<div class="line"><a name="l01127"></a><span class="lineno"> 1127</span>&#160;<span class="preprocessor">#endif</span></div>
<div class="line"><a name="l01128"></a><span class="lineno"> 1128</span>&#160;<span class="preprocessor"></span>}</div>
<div class="line"><a name="l01129"></a><span class="lineno"> 1129</span>&#160;</div>
<div class="line"><a name="l01130"></a><span class="lineno"> 1130</span>&#160;<span class="keywordtype">void</span> WII::enableIRCamera1() {</div>
<div class="line"><a name="l01131"></a><span class="lineno"> 1131</span>&#160; uint8_t cmd_buf[3];</div>
<div class="line"><a name="l01132"></a><span class="lineno"> 1132</span>&#160; cmd_buf[0] = 0xA2; <span class="comment">// HID BT DATA_request (0xA0) | Report Type (Output 0x02)</span></div>
<div class="line"><a name="l01133"></a><span class="lineno"> 1133</span>&#160; cmd_buf[1] = 0x13; <span class="comment">// Output report 13</span></div>
<div class="line"><a name="l01134"></a><span class="lineno"> 1134</span>&#160; cmd_buf[2] = 0x04 | (HIDBuffer[2] &amp; 0x01); <span class="comment">// Keep the rumble bit and sets bit 2</span></div>
<div class="line"><a name="l01135"></a><span class="lineno"> 1135</span>&#160; HID_Command(cmd_buf, 3);</div>
<div class="line"><a name="l01136"></a><span class="lineno"> 1136</span>&#160;}</div>
<div class="line"><a name="l01137"></a><span class="lineno"> 1137</span>&#160;</div>
<div class="line"><a name="l01138"></a><span class="lineno"> 1138</span>&#160;<span class="keywordtype">void</span> WII::enableIRCamera2() {</div>
<div class="line"><a name="l01139"></a><span class="lineno"> 1139</span>&#160; uint8_t cmd_buf[3];</div>
<div class="line"><a name="l01140"></a><span class="lineno"> 1140</span>&#160; cmd_buf[0] = 0xA2; <span class="comment">// HID BT DATA_request (0xA0) | Report Type (Output 0x02)</span></div>
<div class="line"><a name="l01141"></a><span class="lineno"> 1141</span>&#160; cmd_buf[1] = 0x1A; <span class="comment">// Output report 1A</span></div>
<div class="line"><a name="l01142"></a><span class="lineno"> 1142</span>&#160; cmd_buf[2] = 0x04 | (HIDBuffer[2] &amp; 0x01); <span class="comment">// Keep the rumble bit and sets bit 2</span></div>
<div class="line"><a name="l01143"></a><span class="lineno"> 1143</span>&#160; HID_Command(cmd_buf, 3);</div>
<div class="line"><a name="l01144"></a><span class="lineno"> 1144</span>&#160;}</div>
<div class="line"><a name="l01145"></a><span class="lineno"> 1145</span>&#160;</div>
<div class="line"><a name="l01146"></a><span class="lineno"> 1146</span>&#160;<span class="keywordtype">void</span> WII::writeSensitivityBlock1() {</div>
<div class="line"><a name="l01147"></a><span class="lineno"> 1147</span>&#160; uint8_t buf[9];</div>
<div class="line"><a name="l01148"></a><span class="lineno"> 1148</span>&#160; buf[0] = 0x00;</div>
<div class="line"><a name="l01149"></a><span class="lineno"> 1149</span>&#160; buf[1] = 0x00;</div>
<div class="line"><a name="l01150"></a><span class="lineno"> 1150</span>&#160; buf[2] = 0x00;</div>
<div class="line"><a name="l01151"></a><span class="lineno"> 1151</span>&#160; buf[3] = 0x00;</div>
<div class="line"><a name="l01152"></a><span class="lineno"> 1152</span>&#160; buf[4] = 0x00;</div>
<div class="line"><a name="l01153"></a><span class="lineno"> 1153</span>&#160; buf[5] = 0x00;</div>
<div class="line"><a name="l01154"></a><span class="lineno"> 1154</span>&#160; buf[6] = 0x90;</div>
<div class="line"><a name="l01155"></a><span class="lineno"> 1155</span>&#160; buf[7] = 0x00;</div>
<div class="line"><a name="l01156"></a><span class="lineno"> 1156</span>&#160; buf[8] = 0x41;</div>
<div class="line"><a name="l01157"></a><span class="lineno"> 1157</span>&#160;</div>
<div class="line"><a name="l01158"></a><span class="lineno"> 1158</span>&#160; writeData(0xB00000, 9, buf);</div>
<div class="line"><a name="l01159"></a><span class="lineno"> 1159</span>&#160;}</div>
<div class="line"><a name="l01160"></a><span class="lineno"> 1160</span>&#160;</div>
<div class="line"><a name="l01161"></a><span class="lineno"> 1161</span>&#160;<span class="keywordtype">void</span> WII::writeSensitivityBlock2() {</div>
<div class="line"><a name="l01162"></a><span class="lineno"> 1162</span>&#160; uint8_t buf[2];</div>
<div class="line"><a name="l01163"></a><span class="lineno"> 1163</span>&#160; buf[0] = 0x40;</div>
<div class="line"><a name="l01164"></a><span class="lineno"> 1164</span>&#160; buf[1] = 0x00;</div>
<div class="line"><a name="l01165"></a><span class="lineno"> 1165</span>&#160;</div>
<div class="line"><a name="l01166"></a><span class="lineno"> 1166</span>&#160; writeData(0xB0001A, 2, buf);</div>
<div class="line"><a name="l01167"></a><span class="lineno"> 1167</span>&#160;}</div>
<div class="line"><a name="l01168"></a><span class="lineno"> 1168</span>&#160;</div>
<div class="line"><a name="l01169"></a><span class="lineno"> 1169</span>&#160;<span class="keywordtype">void</span> WII::write0x08Value() {</div>
<div class="line"><a name="l01170"></a><span class="lineno"> 1170</span>&#160; uint8_t cmd = 0x08;</div>
<div class="line"><a name="l01171"></a><span class="lineno"> 1171</span>&#160; writeData(0xb00030, 1, &amp;cmd);</div>
<div class="line"><a name="l01172"></a><span class="lineno"> 1172</span>&#160;}</div>
<div class="line"><a name="l01173"></a><span class="lineno"> 1173</span>&#160;</div>
<div class="line"><a name="l01174"></a><span class="lineno"> 1174</span>&#160;<span class="keywordtype">void</span> WII::setWiiModeNumber(uint8_t mode_number) { <span class="comment">// mode_number in hex i.e. 0x03 for extended mode</span></div>
<div class="line"><a name="l01175"></a><span class="lineno"> 1175</span>&#160; writeData(0xb00033, 1, &amp;mode_number);</div>
<div class="line"><a name="l01176"></a><span class="lineno"> 1176</span>&#160;}</div>
<div class="line"><a name="l01177"></a><span class="lineno"> 1177</span>&#160;<span class="preprocessor">#endif</span></div>
2013-02-05 20:02:12 +01:00
</div><!-- fragment --></div><!-- contents -->
<!-- start footer part -->
<hr class="footer"/><address class="footer"><small>
Generated by &#160;<a href="http://www.doxygen.org/index.html">
2013-02-05 20:02:12 +01:00
<img class="footer" src="doxygen.png" alt="doxygen"/>
2013-06-17 20:33:24 +02:00
</a> 1.8.4
2013-02-05 20:02:12 +01:00
</small></address>
</body>
</html>