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