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