mirror of
https://github.com/felis/USB_Host_Shield_2.0.git
synced 2024-03-22 11:31:26 +01:00
1238 lines
209 KiB
HTML
1238 lines
209 KiB
HTML
<!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "http://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd">
|
|
<html xmlns="http://www.w3.org/1999/xhtml">
|
|
<head>
|
|
<meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/>
|
|
<meta http-equiv="X-UA-Compatible" content="IE=9"/>
|
|
<meta name="generator" content="Doxygen 1.8.4"/>
|
|
<title>USB Host Shield 2.0: masstorage.cpp Source File</title>
|
|
<link href="tabs.css" rel="stylesheet" type="text/css"/>
|
|
<script type="text/javascript" src="jquery.js"></script>
|
|
<script type="text/javascript" src="dynsections.js"></script>
|
|
<link href="search/search.css" rel="stylesheet" type="text/css"/>
|
|
<script type="text/javascript" src="search/search.js"></script>
|
|
<script type="text/javascript">
|
|
$(document).ready(function() { searchBox.OnSelectItem(0); });
|
|
</script>
|
|
<link href="doxygen.css" rel="stylesheet" type="text/css" />
|
|
<link href="imageStyle.css" rel="stylesheet" type="text/css"/>
|
|
</head>
|
|
<body>
|
|
<div id="top"><!-- do not remove this div, it is closed by doxygen! -->
|
|
<div id="titlearea">
|
|
<table cellspacing="0" cellpadding="0">
|
|
<tbody>
|
|
<tr style="height: 56px;">
|
|
<td style="padding-left: 0.5em;">
|
|
<div id="projectname">USB Host Shield 2.0
|
|
</div>
|
|
</td>
|
|
</tr>
|
|
</tbody>
|
|
</table>
|
|
</div>
|
|
<!-- end header part -->
|
|
<!-- Generated by Doxygen 1.8.4 -->
|
|
<script type="text/javascript">
|
|
var searchBox = new SearchBox("searchBox", "search",false,'Search');
|
|
</script>
|
|
<div id="navrow1" class="tabs">
|
|
<ul class="tablist">
|
|
<li><a href="index.html"><span>Main Page</span></a></li>
|
|
<li><a href="pages.html"><span>Related Pages</span></a></li>
|
|
<li><a href="annotated.html"><span>Classes</span></a></li>
|
|
<li class="current"><a href="files.html"><span>Files</span></a></li>
|
|
<li>
|
|
<div id="MSearchBox" class="MSearchBoxInactive">
|
|
<span class="left">
|
|
<img id="MSearchSelect" src="search/mag_sel.png"
|
|
onmouseover="return searchBox.OnSearchSelectShow()"
|
|
onmouseout="return searchBox.OnSearchSelectHide()"
|
|
alt=""/>
|
|
<input type="text" id="MSearchField" value="Search" accesskey="S"
|
|
onfocus="searchBox.OnSearchFieldFocus(true)"
|
|
onblur="searchBox.OnSearchFieldFocus(false)"
|
|
onkeyup="searchBox.OnSearchFieldChange(event)"/>
|
|
</span><span class="right">
|
|
<a id="MSearchClose" href="javascript:searchBox.CloseResultsWindow()"><img id="MSearchCloseImg" border="0" src="search/close.png" alt=""/></a>
|
|
</span>
|
|
</div>
|
|
</li>
|
|
</ul>
|
|
</div>
|
|
<div id="navrow2" class="tabs2">
|
|
<ul class="tablist">
|
|
<li><a href="files.html"><span>File List</span></a></li>
|
|
<li><a href="globals.html"><span>File Members</span></a></li>
|
|
</ul>
|
|
</div>
|
|
<!-- window showing the filter options -->
|
|
<div id="MSearchSelectWindow"
|
|
onmouseover="return searchBox.OnSearchSelectShow()"
|
|
onmouseout="return searchBox.OnSearchSelectHide()"
|
|
onkeydown="return searchBox.OnSearchSelectKey(event)">
|
|
<a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(0)"><span class="SelectionMark"> </span>All</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(1)"><span class="SelectionMark"> </span>Classes</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(2)"><span class="SelectionMark"> </span>Files</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(3)"><span class="SelectionMark"> </span>Functions</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(4)"><span class="SelectionMark"> </span>Variables</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(5)"><span class="SelectionMark"> </span>Typedefs</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(6)"><span class="SelectionMark"> </span>Enumerations</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(7)"><span class="SelectionMark"> </span>Enumerator</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(8)"><span class="SelectionMark"> </span>Macros</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(9)"><span class="SelectionMark"> </span>Pages</a></div>
|
|
|
|
<!-- iframe showing the search results (closed by default) -->
|
|
<div id="MSearchResultsWindow">
|
|
<iframe src="javascript:void(0)" frameborder="0"
|
|
name="MSearchResults" id="MSearchResults">
|
|
</iframe>
|
|
</div>
|
|
|
|
<div id="nav-path" class="navpath">
|
|
<ul>
|
|
<li class="navelem"><a class="el" href="dir_e5fbe6d2783ccd4c93c7856d92d7be6e.html">GitHub</a></li><li class="navelem"><a class="el" href="dir_397a095372f04465e811d0ee219bbf8f.html">USB_Host_Shield_2.0</a></li> </ul>
|
|
</div>
|
|
</div><!-- top -->
|
|
<div class="header">
|
|
<div class="headertitle">
|
|
<div class="title">masstorage.cpp</div> </div>
|
|
</div><!--header-->
|
|
<div class="contents">
|
|
<a href="masstorage_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="preprocessor">#include "<a class="code" href="masstorage_8h.html">masstorage.h</a>"</span></div>
|
|
<div class="line"><a name="l00002"></a><span class="lineno"> 2</span> </div>
|
|
<div class="line"><a name="l00003"></a><span class="lineno"> 3</span> <span class="keyword">const</span> uint8_t <a class="code" href="class_bulk_only.html#a9e487226408578a2971570bcf7de62fe">BulkOnly::epDataInIndex</a> = 1;</div>
|
|
<div class="line"><a name="l00004"></a><span class="lineno"> 4</span> <span class="keyword">const</span> uint8_t <a class="code" href="class_bulk_only.html#a8d527bdc285870f3571481a4fd982721">BulkOnly::epDataOutIndex</a> = 2;</div>
|
|
<div class="line"><a name="l00005"></a><span class="lineno"> 5</span> <span class="keyword">const</span> uint8_t <a class="code" href="class_bulk_only.html#a03cd96b415990821bdce43b4004c85e4">BulkOnly::epInterruptInIndex</a> = 3;</div>
|
|
<div class="line"><a name="l00006"></a><span class="lineno"> 6</span> </div>
|
|
<div class="line"><a name="l00008"></a><span class="lineno"> 8</span> </div>
|
|
<div class="line"><a name="l00009"></a><span class="lineno"> 9</span> <span class="comment">// Interface code</span></div>
|
|
<div class="line"><a name="l00010"></a><span class="lineno"> 10</span> </div>
|
|
<div class="line"><a name="l00012"></a><span class="lineno"> 12</span> </div>
|
|
<div class="line"><a name="l00019"></a><span class="lineno"><a class="code" href="class_bulk_only.html#a597193e88b168e96878d383619f1377d"> 19</a></span> uint32_t <a class="code" href="class_bulk_only.html#a597193e88b168e96878d383619f1377d">BulkOnly::GetCapacity</a>(uint8_t lun) {</div>
|
|
<div class="line"><a name="l00020"></a><span class="lineno"> 20</span>  <span class="keywordflow">if</span> (<a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun])</div>
|
|
<div class="line"><a name="l00021"></a><span class="lineno"> 21</span>  <span class="keywordflow">return</span> <a class="code" href="class_bulk_only.html#a73c3f6b8f6f79ad60e5ba05e560b277d">CurrentCapacity</a>[lun];</div>
|
|
<div class="line"><a name="l00022"></a><span class="lineno"> 22</span>  <span class="keywordflow">return</span> 0LU;</div>
|
|
<div class="line"><a name="l00023"></a><span class="lineno"> 23</span> }</div>
|
|
<div class="line"><a name="l00024"></a><span class="lineno"> 24</span> </div>
|
|
<div class="line"><a name="l00031"></a><span class="lineno"><a class="code" href="class_bulk_only.html#ac97cfb7558681af4cfaa11fcccc00170"> 31</a></span> uint16_t <a class="code" href="class_bulk_only.html#ac97cfb7558681af4cfaa11fcccc00170">BulkOnly::GetSectorSize</a>(uint8_t lun) {</div>
|
|
<div class="line"><a name="l00032"></a><span class="lineno"> 32</span>  <span class="keywordflow">if</span> (<a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun])</div>
|
|
<div class="line"><a name="l00033"></a><span class="lineno"> 33</span>  <span class="keywordflow">return</span> <a class="code" href="class_bulk_only.html#aa4e2711c6279d48c63e82a63ad458421">CurrentSectorSize</a>[lun];</div>
|
|
<div class="line"><a name="l00034"></a><span class="lineno"> 34</span>  <span class="keywordflow">return</span> 0U;</div>
|
|
<div class="line"><a name="l00035"></a><span class="lineno"> 35</span> }</div>
|
|
<div class="line"><a name="l00036"></a><span class="lineno"> 36</span> </div>
|
|
<div class="line"><a name="l00043"></a><span class="lineno"><a class="code" href="class_bulk_only.html#aa6d74267dc98daeb0552fa234739ab08"> 43</a></span> <span class="keywordtype">bool</span> <a class="code" href="class_bulk_only.html#aa6d74267dc98daeb0552fa234739ab08">BulkOnly::LUNIsGood</a>(uint8_t lun) {</div>
|
|
<div class="line"><a name="l00044"></a><span class="lineno"> 44</span>  <span class="keywordflow">return</span> <a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun];</div>
|
|
<div class="line"><a name="l00045"></a><span class="lineno"> 45</span> }</div>
|
|
<div class="line"><a name="l00046"></a><span class="lineno"> 46</span> </div>
|
|
<div class="line"><a name="l00053"></a><span class="lineno"><a class="code" href="class_bulk_only.html#ab0976e6d4f5fdeff800f3769e7b287c9"> 53</a></span> <span class="keywordtype">boolean</span> <a class="code" href="class_bulk_only.html#ab0976e6d4f5fdeff800f3769e7b287c9">BulkOnly::WriteProtected</a>(uint8_t lun) {</div>
|
|
<div class="line"><a name="l00054"></a><span class="lineno"> 54</span>  <span class="keywordflow">return</span> <a class="code" href="class_bulk_only.html#af763ffffdd131949322d583fb4cd2737">WriteOk</a>[lun];</div>
|
|
<div class="line"><a name="l00055"></a><span class="lineno"> 55</span> }</div>
|
|
<div class="line"><a name="l00056"></a><span class="lineno"> 56</span> </div>
|
|
<div class="line"><a name="l00057"></a><span class="lineno"> 57</span> </div>
|
|
<div class="line"><a name="l00066"></a><span class="lineno"><a class="code" href="class_bulk_only.html#ae7561d686d0b1374b5f9937d6ec8a035"> 66</a></span> uint8_t <a class="code" href="class_bulk_only.html#ae7561d686d0b1374b5f9937d6ec8a035">BulkOnly::LockMedia</a>(uint8_t lun, uint8_t lock) {</div>
|
|
<div class="line"><a name="l00067"></a><span class="lineno"> 67</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nLockMedia\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00068"></a><span class="lineno"> 68</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"---------\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00069"></a><span class="lineno"> 69</span> </div>
|
|
<div class="line"><a name="l00070"></a><span class="lineno"> 70</span>  <a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a> cbw;</div>
|
|
<div class="line"><a name="l00071"></a><span class="lineno"> 71</span>  SetCurLUN(lun);</div>
|
|
<div class="line"><a name="l00072"></a><span class="lineno"> 72</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a133ffc8ac9be6ce284f10efece567748">dCBWSignature</a> = <a class="code" href="masstorage_8h.html#a439c9558fff25c40219c0f20244e666d">MASS_CBW_SIGNATURE</a>;</div>
|
|
<div class="line"><a name="l00073"></a><span class="lineno"> 73</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a> = ++<a class="code" href="class_bulk_only.html#a7ae682d50badd1386a06f30f35a32d1d">dCBWTag</a>;</div>
|
|
<div class="line"><a name="l00074"></a><span class="lineno"> 74</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a> = 0;</div>
|
|
<div class="line"><a name="l00075"></a><span class="lineno"> 75</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a396b36ceef993c32f28b1354727a5e9e">bmCBWFlags</a> = <a class="code" href="masstorage_8h.html#a012ee34e4ce8d644c2f75099867b26c0">MASS_CMD_DIR_IN</a>;</div>
|
|
<div class="line"><a name="l00076"></a><span class="lineno"> 76</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2a16bb9a98e3ee4eaac8fea6310b4e01">bmCBWLUN</a> = lun;</div>
|
|
<div class="line"><a name="l00077"></a><span class="lineno"> 77</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a069c89f584abbf45c13ebb85ca906494">bmCBWCBLength</a> = 6;</div>
|
|
<div class="line"><a name="l00078"></a><span class="lineno"> 78</span> </div>
|
|
<div class="line"><a name="l00079"></a><span class="lineno"> 79</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 16; i++)</div>
|
|
<div class="line"><a name="l00080"></a><span class="lineno"> 80</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[i] = 0;</div>
|
|
<div class="line"><a name="l00081"></a><span class="lineno"> 81</span> </div>
|
|
<div class="line"><a name="l00082"></a><span class="lineno"> 82</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[0] = <a class="code" href="masstorage_8h.html#ac6435ab2e468a79816db996b0a16c024">SCSI_CMD_PREVENT_REMOVAL</a>;</div>
|
|
<div class="line"><a name="l00083"></a><span class="lineno"> 83</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[4] = lock;</div>
|
|
<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>  return (HandleSCSIError(Transaction(&cbw, 0, NULL, 0)));</div>
|
|
<div class="line"><a name="l00086"></a><span class="lineno"> 86</span> </div>
|
|
<div class="line"><a name="l00087"></a><span class="lineno"> 87</span> }</div>
|
|
<div class="line"><a name="l00088"></a><span class="lineno"> 88</span> </div>
|
|
<div class="line"><a name="l00097"></a><span class="lineno"><a class="code" href="class_bulk_only.html#a2fc74b11c2ecce30e89f84cc1efe0c81"> 97</a></span> uint8_t <a class="code" href="class_bulk_only.html#a2fc74b11c2ecce30e89f84cc1efe0c81">BulkOnly::MediaCTL</a>(uint8_t lun, uint8_t ctl) {</div>
|
|
<div class="line"><a name="l00098"></a><span class="lineno"> 98</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nMediaCTL\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00099"></a><span class="lineno"> 99</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"-----------------\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00100"></a><span class="lineno"> 100</span>  SetCurLUN(lun);</div>
|
|
<div class="line"><a name="l00101"></a><span class="lineno"> 101</span>  uint8_t rcode = <a class="code" href="masstorage_8h.html#a128e4910df8d7770c6f9af7700b9ccb1">MASS_ERR_UNIT_NOT_READY</a>;</div>
|
|
<div class="line"><a name="l00102"></a><span class="lineno"> 102</span>  <span class="keywordflow">if</span> (<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>) {</div>
|
|
<div class="line"><a name="l00103"></a><span class="lineno"> 103</span>  <a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a> cbw;</div>
|
|
<div class="line"><a name="l00104"></a><span class="lineno"> 104</span> </div>
|
|
<div class="line"><a name="l00105"></a><span class="lineno"> 105</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a133ffc8ac9be6ce284f10efece567748">dCBWSignature</a> = <a class="code" href="masstorage_8h.html#a439c9558fff25c40219c0f20244e666d">MASS_CBW_SIGNATURE</a>;</div>
|
|
<div class="line"><a name="l00106"></a><span class="lineno"> 106</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a> = ++<a class="code" href="class_bulk_only.html#a7ae682d50badd1386a06f30f35a32d1d">dCBWTag</a>;</div>
|
|
<div class="line"><a name="l00107"></a><span class="lineno"> 107</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a> = 0;</div>
|
|
<div class="line"><a name="l00108"></a><span class="lineno"> 108</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a396b36ceef993c32f28b1354727a5e9e">bmCBWFlags</a> = <a class="code" href="masstorage_8h.html#ad74d783991b5eea6ad8ef2feb2ce03ea">MASS_CMD_DIR_OUT</a>;</div>
|
|
<div class="line"><a name="l00109"></a><span class="lineno"> 109</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2a16bb9a98e3ee4eaac8fea6310b4e01">bmCBWLUN</a> = lun;</div>
|
|
<div class="line"><a name="l00110"></a><span class="lineno"> 110</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a069c89f584abbf45c13ebb85ca906494">bmCBWCBLength</a> = 6;</div>
|
|
<div class="line"><a name="l00111"></a><span class="lineno"> 111</span> </div>
|
|
<div class="line"><a name="l00112"></a><span class="lineno"> 112</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 16; i++)</div>
|
|
<div class="line"><a name="l00113"></a><span class="lineno"> 113</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[i] = 0;</div>
|
|
<div class="line"><a name="l00114"></a><span class="lineno"> 114</span> </div>
|
|
<div class="line"><a name="l00115"></a><span class="lineno"> 115</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[0] = <a class="code" href="masstorage_8h.html#a17b47e6ce4b10688ac30666c16b14d86">SCSI_CMD_START_STOP_UNIT</a>;</div>
|
|
<div class="line"><a name="l00116"></a><span class="lineno"> 116</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[1] = lun << 5;</div>
|
|
<div class="line"><a name="l00117"></a><span class="lineno"> 117</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[4] = ctl & 0x03;</div>
|
|
<div class="line"><a name="l00118"></a><span class="lineno"> 118</span> </div>
|
|
<div class="line"><a name="l00119"></a><span class="lineno"> 119</span>  rcode = HandleSCSIError(Transaction(&cbw, 0, NULL, 0));</div>
|
|
<div class="line"><a name="l00120"></a><span class="lineno"> 120</span>  }</div>
|
|
<div class="line"><a name="l00121"></a><span class="lineno"> 121</span>  <span class="keywordflow">return</span> rcode;</div>
|
|
<div class="line"><a name="l00122"></a><span class="lineno"> 122</span> }</div>
|
|
<div class="line"><a name="l00123"></a><span class="lineno"> 123</span> </div>
|
|
<div class="line"><a name="l00134"></a><span class="lineno"><a class="code" href="class_bulk_only.html#a470a8f0ffd6694d9dfc834da5efa627a"> 134</a></span> uint8_t <a class="code" href="class_bulk_only.html#a470a8f0ffd6694d9dfc834da5efa627a">BulkOnly::Read</a>(uint8_t lun, uint32_t addr, uint16_t bsize, uint8_t blocks, uint8_t *buf) {</div>
|
|
<div class="line"><a name="l00135"></a><span class="lineno"> 135</span>  <span class="keywordflow">if</span> (!<a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun]) <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#aec47def0928045fdca474d78db866c39">MASS_ERR_NO_MEDIA</a>;</div>
|
|
<div class="line"><a name="l00136"></a><span class="lineno"> 136</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nRead LUN:\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00137"></a><span class="lineno"> 137</span>  D_PrintHex<uint8_t > (lun, 0x90);</div>
|
|
<div class="line"><a name="l00138"></a><span class="lineno"> 138</span>  <span class="comment">//printf("LUN=%i LBA=%8.8X BLOCKS=%i SIZE=%i\r\n", lun, addr, blocks, bsize);</span></div>
|
|
<div class="line"><a name="l00139"></a><span class="lineno"> 139</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nLBA:\t\t"</span>), 0x90);</div>
|
|
<div class="line"><a name="l00140"></a><span class="lineno"> 140</span>  D_PrintHex<uint32_t > (addr, 0x90);</div>
|
|
<div class="line"><a name="l00141"></a><span class="lineno"> 141</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nblocks:\t\t"</span>), 0x90);</div>
|
|
<div class="line"><a name="l00142"></a><span class="lineno"> 142</span>  D_PrintHex<uint8_t > (blocks, 0x90);</div>
|
|
<div class="line"><a name="l00143"></a><span class="lineno"> 143</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nblock size:\t"</span>), 0x90);</div>
|
|
<div class="line"><a name="l00144"></a><span class="lineno"> 144</span>  D_PrintHex<uint16_t > (bsize, 0x90);</div>
|
|
<div class="line"><a name="l00145"></a><span class="lineno"> 145</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\n---------\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00146"></a><span class="lineno"> 146</span>  <a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a> cbw;</div>
|
|
<div class="line"><a name="l00147"></a><span class="lineno"> 147</span> </div>
|
|
<div class="line"><a name="l00148"></a><span class="lineno"> 148</span> again:</div>
|
|
<div class="line"><a name="l00149"></a><span class="lineno"> 149</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a133ffc8ac9be6ce284f10efece567748">dCBWSignature</a> = <a class="code" href="masstorage_8h.html#a439c9558fff25c40219c0f20244e666d">MASS_CBW_SIGNATURE</a>;</div>
|
|
<div class="line"><a name="l00150"></a><span class="lineno"> 150</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a> = ((uint32_t)bsize * blocks);</div>
|
|
<div class="line"><a name="l00151"></a><span class="lineno"> 151</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a396b36ceef993c32f28b1354727a5e9e">bmCBWFlags</a> = <a class="code" href="masstorage_8h.html#a012ee34e4ce8d644c2f75099867b26c0">MASS_CMD_DIR_IN</a>;</div>
|
|
<div class="line"><a name="l00152"></a><span class="lineno"> 152</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2a16bb9a98e3ee4eaac8fea6310b4e01">bmCBWLUN</a> = lun;</div>
|
|
<div class="line"><a name="l00153"></a><span class="lineno"> 153</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a069c89f584abbf45c13ebb85ca906494">bmCBWCBLength</a> = 10;</div>
|
|
<div class="line"><a name="l00154"></a><span class="lineno"> 154</span> </div>
|
|
<div class="line"><a name="l00155"></a><span class="lineno"> 155</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 16; i++)</div>
|
|
<div class="line"><a name="l00156"></a><span class="lineno"> 156</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[i] = 0;</div>
|
|
<div class="line"><a name="l00157"></a><span class="lineno"> 157</span> </div>
|
|
<div class="line"><a name="l00158"></a><span class="lineno"> 158</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[0] = <a class="code" href="masstorage_8h.html#ad3900f141fb70afb8def054384805a2e">SCSI_CMD_READ_10</a>;</div>
|
|
<div class="line"><a name="l00159"></a><span class="lineno"> 159</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[1] = lun << 5;</div>
|
|
<div class="line"><a name="l00160"></a><span class="lineno"> 160</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[2] = ((addr >> 24) & 0xff);</div>
|
|
<div class="line"><a name="l00161"></a><span class="lineno"> 161</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[3] = ((addr >> 16) & 0xff);</div>
|
|
<div class="line"><a name="l00162"></a><span class="lineno"> 162</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[4] = ((addr >> 8) & 0xff);</div>
|
|
<div class="line"><a name="l00163"></a><span class="lineno"> 163</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[5] = (addr & 0xff);</div>
|
|
<div class="line"><a name="l00164"></a><span class="lineno"> 164</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[8] = blocks;</div>
|
|
<div class="line"><a name="l00165"></a><span class="lineno"> 165</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a> = ++<a class="code" href="class_bulk_only.html#a7ae682d50badd1386a06f30f35a32d1d">dCBWTag</a>;</div>
|
|
<div class="line"><a name="l00166"></a><span class="lineno"> 166</span>  SetCurLUN(lun);</div>
|
|
<div class="line"><a name="l00167"></a><span class="lineno"> 167</span>  uint8_t er = HandleSCSIError(Transaction(&cbw, bsize, buf, 0));</div>
|
|
<div class="line"><a name="l00168"></a><span class="lineno"> 168</span>  <span class="keywordflow">if</span> (er == <a class="code" href="masstorage_8h.html#a13aee9eab965d570a4a00463cd20ca29">MASS_ERR_STALL</a>) {</div>
|
|
<div class="line"><a name="l00169"></a><span class="lineno"> 169</span>  <a class="code" href="class_bulk_only.html#a2fc74b11c2ecce30e89f84cc1efe0c81">MediaCTL</a>(lun, 1);</div>
|
|
<div class="line"><a name="l00170"></a><span class="lineno"> 170</span>  delay(150);</div>
|
|
<div class="line"><a name="l00171"></a><span class="lineno"> 171</span>  <span class="keywordflow">if</span> (!TestUnitReady(lun)) <span class="keywordflow">goto</span> again;</div>
|
|
<div class="line"><a name="l00172"></a><span class="lineno"> 172</span>  }</div>
|
|
<div class="line"><a name="l00173"></a><span class="lineno"> 173</span>  <span class="keywordflow">return</span> er;</div>
|
|
<div class="line"><a name="l00174"></a><span class="lineno"> 174</span> }</div>
|
|
<div class="line"><a name="l00175"></a><span class="lineno"> 175</span> </div>
|
|
<div class="line"><a name="l00186"></a><span class="lineno"><a class="code" href="class_bulk_only.html#a45d327ddf87e01607c3a5b1849936053"> 186</a></span> uint8_t <a class="code" href="class_bulk_only.html#a45d327ddf87e01607c3a5b1849936053">BulkOnly::Write</a>(uint8_t lun, uint32_t addr, uint16_t bsize, uint8_t blocks, <span class="keyword">const</span> uint8_t * buf) {</div>
|
|
<div class="line"><a name="l00187"></a><span class="lineno"> 187</span>  <span class="keywordflow">if</span> (!<a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun]) <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#aec47def0928045fdca474d78db866c39">MASS_ERR_NO_MEDIA</a>;</div>
|
|
<div class="line"><a name="l00188"></a><span class="lineno"> 188</span>  <span class="keywordflow">if</span> (!<a class="code" href="class_bulk_only.html#af763ffffdd131949322d583fb4cd2737">WriteOk</a>[lun]) <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#ac8c588cb96077b615de2bd53f77d4c15">MASS_ERR_WRITE_PROTECTED</a>;</div>
|
|
<div class="line"><a name="l00189"></a><span class="lineno"> 189</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nWrite LUN:\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00190"></a><span class="lineno"> 190</span>  D_PrintHex<uint8_t > (lun, 0x90);</div>
|
|
<div class="line"><a name="l00191"></a><span class="lineno"> 191</span>  <span class="comment">//printf("LUN=%i LBA=%8.8X BLOCKS=%i SIZE=%i\r\n", lun, addr, blocks, bsize);</span></div>
|
|
<div class="line"><a name="l00192"></a><span class="lineno"> 192</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nLBA:\t\t"</span>), 0x90);</div>
|
|
<div class="line"><a name="l00193"></a><span class="lineno"> 193</span>  D_PrintHex<uint32_t > (addr, 0x90);</div>
|
|
<div class="line"><a name="l00194"></a><span class="lineno"> 194</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nblocks:\t\t"</span>), 0x90);</div>
|
|
<div class="line"><a name="l00195"></a><span class="lineno"> 195</span>  D_PrintHex<uint8_t > (blocks, 0x90);</div>
|
|
<div class="line"><a name="l00196"></a><span class="lineno"> 196</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nblock size:\t"</span>), 0x90);</div>
|
|
<div class="line"><a name="l00197"></a><span class="lineno"> 197</span>  D_PrintHex<uint16_t > (bsize, 0x90);</div>
|
|
<div class="line"><a name="l00198"></a><span class="lineno"> 198</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\n---------\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00199"></a><span class="lineno"> 199</span>  <span class="comment">//MediaCTL(lun, 0x01);</span></div>
|
|
<div class="line"><a name="l00200"></a><span class="lineno"> 200</span>  <a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a> cbw;</div>
|
|
<div class="line"><a name="l00201"></a><span class="lineno"> 201</span> </div>
|
|
<div class="line"><a name="l00202"></a><span class="lineno"> 202</span> again:</div>
|
|
<div class="line"><a name="l00203"></a><span class="lineno"> 203</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a133ffc8ac9be6ce284f10efece567748">dCBWSignature</a> = <a class="code" href="masstorage_8h.html#a439c9558fff25c40219c0f20244e666d">MASS_CBW_SIGNATURE</a>;</div>
|
|
<div class="line"><a name="l00204"></a><span class="lineno"> 204</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a> = ++<a class="code" href="class_bulk_only.html#a7ae682d50badd1386a06f30f35a32d1d">dCBWTag</a>;</div>
|
|
<div class="line"><a name="l00205"></a><span class="lineno"> 205</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a> = ((uint32_t)bsize * blocks);</div>
|
|
<div class="line"><a name="l00206"></a><span class="lineno"> 206</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a396b36ceef993c32f28b1354727a5e9e">bmCBWFlags</a> = <a class="code" href="masstorage_8h.html#ad74d783991b5eea6ad8ef2feb2ce03ea">MASS_CMD_DIR_OUT</a>;</div>
|
|
<div class="line"><a name="l00207"></a><span class="lineno"> 207</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2a16bb9a98e3ee4eaac8fea6310b4e01">bmCBWLUN</a> = lun;</div>
|
|
<div class="line"><a name="l00208"></a><span class="lineno"> 208</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a069c89f584abbf45c13ebb85ca906494">bmCBWCBLength</a> = 10;</div>
|
|
<div class="line"><a name="l00209"></a><span class="lineno"> 209</span> </div>
|
|
<div class="line"><a name="l00210"></a><span class="lineno"> 210</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 16; i++)</div>
|
|
<div class="line"><a name="l00211"></a><span class="lineno"> 211</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[i] = 0;</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>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[0] = <a class="code" href="masstorage_8h.html#ad1733ce8730cdaab39b9b868b73128a0">SCSI_CMD_WRITE_10</a>;</div>
|
|
<div class="line"><a name="l00214"></a><span class="lineno"> 214</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[1] = lun << 5;</div>
|
|
<div class="line"><a name="l00215"></a><span class="lineno"> 215</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[2] = ((addr >> 24) & 0xff);</div>
|
|
<div class="line"><a name="l00216"></a><span class="lineno"> 216</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[3] = ((addr >> 16) & 0xff);</div>
|
|
<div class="line"><a name="l00217"></a><span class="lineno"> 217</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[4] = ((addr >> 8) & 0xff);</div>
|
|
<div class="line"><a name="l00218"></a><span class="lineno"> 218</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[5] = (addr & 0xff);</div>
|
|
<div class="line"><a name="l00219"></a><span class="lineno"> 219</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[8] = 1;</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>  SetCurLUN(lun);</div>
|
|
<div class="line"><a name="l00222"></a><span class="lineno"> 222</span>  uint8_t er = HandleSCSIError(Transaction(&cbw, bsize, (<span class="keywordtype">void</span>*)buf, 0));</div>
|
|
<div class="line"><a name="l00223"></a><span class="lineno"> 223</span>  <span class="keywordflow">if</span> (er == <a class="code" href="masstorage_8h.html#a1b4efb4cfc2b0d4a912abe587a145b84">MASS_ERR_WRITE_STALL</a>) {</div>
|
|
<div class="line"><a name="l00224"></a><span class="lineno"> 224</span>  <a class="code" href="class_bulk_only.html#a2fc74b11c2ecce30e89f84cc1efe0c81">MediaCTL</a>(lun, 1);</div>
|
|
<div class="line"><a name="l00225"></a><span class="lineno"> 225</span>  delay(150);</div>
|
|
<div class="line"><a name="l00226"></a><span class="lineno"> 226</span>  <span class="keywordflow">if</span> (!TestUnitReady(lun)) <span class="keywordflow">goto</span> again;</div>
|
|
<div class="line"><a name="l00227"></a><span class="lineno"> 227</span>  }</div>
|
|
<div class="line"><a name="l00228"></a><span class="lineno"> 228</span>  <span class="keywordflow">return</span> er;</div>
|
|
<div class="line"><a name="l00229"></a><span class="lineno"> 229</span> }</div>
|
|
<div class="line"><a name="l00230"></a><span class="lineno"> 230</span> </div>
|
|
<div class="line"><a name="l00231"></a><span class="lineno"> 231</span> <span class="comment">// End of user functions, the remaining code below is driver internals.</span></div>
|
|
<div class="line"><a name="l00232"></a><span class="lineno"> 232</span> <span class="comment">// Only developer serviceable parts below!</span></div>
|
|
<div class="line"><a name="l00233"></a><span class="lineno"> 233</span> </div>
|
|
<div class="line"><a name="l00235"></a><span class="lineno"> 235</span> </div>
|
|
<div class="line"><a name="l00236"></a><span class="lineno"> 236</span> <span class="comment">// Main driver code</span></div>
|
|
<div class="line"><a name="l00237"></a><span class="lineno"> 237</span> </div>
|
|
<div class="line"><a name="l00239"></a><span class="lineno"> 239</span> </div>
|
|
<div class="line"><a name="l00240"></a><span class="lineno"> 240</span> </div>
|
|
<div class="line"><a name="l00241"></a><span class="lineno"><a class="code" href="class_bulk_only.html#a530fb250b0a0c92b48bc57e2957ace25"> 241</a></span> <a class="code" href="class_bulk_only.html#a530fb250b0a0c92b48bc57e2957ace25">BulkOnly::BulkOnly</a>(<a class="code" href="class_u_s_b.html">USB</a> *p) :</div>
|
|
<div class="line"><a name="l00242"></a><span class="lineno"> 242</span> pUsb(p),</div>
|
|
<div class="line"><a name="l00243"></a><span class="lineno"> 243</span> bAddress(0),</div>
|
|
<div class="line"><a name="l00244"></a><span class="lineno"> 244</span> bIface(0),</div>
|
|
<div class="line"><a name="l00245"></a><span class="lineno"> 245</span> bNumEP(1),</div>
|
|
<div class="line"><a name="l00246"></a><span class="lineno"> 246</span> qNextPollTime(0),</div>
|
|
<div class="line"><a name="l00247"></a><span class="lineno"> 247</span> bPollEnable(false),</div>
|
|
<div class="line"><a name="l00248"></a><span class="lineno"> 248</span> dCBWTag(0),</div>
|
|
<div class="line"><a name="l00249"></a><span class="lineno"> 249</span> bLastUsbError(0) {</div>
|
|
<div class="line"><a name="l00250"></a><span class="lineno"> 250</span>  ClearAllEP();</div>
|
|
<div class="line"><a name="l00251"></a><span class="lineno"> 251</span>  <a class="code" href="class_bulk_only.html#a7ae682d50badd1386a06f30f35a32d1d">dCBWTag</a> = 0;</div>
|
|
<div class="line"><a name="l00252"></a><span class="lineno"> 252</span>  <span class="keywordflow">if</span> (<a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>)</div>
|
|
<div class="line"><a name="l00253"></a><span class="lineno"> 253</span>  <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a3f66bf622590413ef2e1864f93a3e0d2">RegisterDeviceClass</a>(<span class="keyword">this</span>);</div>
|
|
<div class="line"><a name="l00254"></a><span class="lineno"> 254</span> }</div>
|
|
<div class="line"><a name="l00255"></a><span class="lineno"> 255</span> </div>
|
|
<div class="line"><a name="l00270"></a><span class="lineno"><a class="code" href="class_bulk_only.html#aa8fe167a7af12dce9964fa5a430c53ea"> 270</a></span> uint8_t <a class="code" href="class_bulk_only.html#aa8fe167a7af12dce9964fa5a430c53ea">BulkOnly::ConfigureDevice</a>(uint8_t parent, uint8_t port, <span class="keywordtype">bool</span> lowspeed) {</div>
|
|
<div class="line"><a name="l00271"></a><span class="lineno"> 271</span> </div>
|
|
<div class="line"><a name="l00272"></a><span class="lineno"> 272</span>  <span class="keyword">const</span> uint8_t constBufSize = <span class="keyword">sizeof</span> (<a class="code" href="struct_u_s_b___d_e_v_i_c_e___d_e_s_c_r_i_p_t_o_r.html">USB_DEVICE_DESCRIPTOR</a>);</div>
|
|
<div class="line"><a name="l00273"></a><span class="lineno"> 273</span> </div>
|
|
<div class="line"><a name="l00274"></a><span class="lineno"> 274</span>  uint8_t buf[constBufSize];</div>
|
|
<div class="line"><a name="l00275"></a><span class="lineno"> 275</span>  uint8_t rcode;</div>
|
|
<div class="line"><a name="l00276"></a><span class="lineno"> 276</span>  <a class="code" href="struct_usb_device.html">UsbDevice</a> *p = NULL;</div>
|
|
<div class="line"><a name="l00277"></a><span class="lineno"> 277</span>  <a class="code" href="struct_ep_info.html">EpInfo</a> *oldep_ptr = NULL;</div>
|
|
<div class="line"><a name="l00278"></a><span class="lineno"> 278</span>  <a class="code" href="_usb_8h.html#afc6fe7f947af35317a49a4dcfc8189fd">USBTRACE</a>(<span class="stringliteral">"MS ConfigureDevice\r\n"</span>);</div>
|
|
<div class="line"><a name="l00279"></a><span class="lineno"> 279</span>  ClearAllEP();</div>
|
|
<div class="line"><a name="l00280"></a><span class="lineno"> 280</span>  <span class="comment">//delay(2000);</span></div>
|
|
<div class="line"><a name="l00281"></a><span class="lineno"> 281</span>  <a class="code" href="class_address_pool.html">AddressPool</a> &addrPool = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a66ab8f5eda239e761d5a48741ea1f9d4">GetAddressPool</a>();</div>
|
|
<div class="line"><a name="l00282"></a><span class="lineno"> 282</span> </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>  <span class="keywordflow">if</span> (<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>)</div>
|
|
<div class="line"><a name="l00285"></a><span class="lineno"> 285</span>  <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#a44416ff64fc0e3691f98addac13d4595">USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE</a>;</div>
|
|
<div class="line"><a name="l00286"></a><span class="lineno"> 286</span> </div>
|
|
<div class="line"><a name="l00287"></a><span class="lineno"> 287</span>  <span class="comment">// <TECHNICAL></span></div>
|
|
<div class="line"><a name="l00288"></a><span class="lineno"> 288</span>  <span class="comment">// Get pointer to pseudo device with address 0 assigned</span></div>
|
|
<div class="line"><a name="l00289"></a><span class="lineno"> 289</span>  p = addrPool.<a class="code" href="class_address_pool.html#aa92d7e8f0f515340ae2dc1679b627056">GetUsbDevicePtr</a>(0);</div>
|
|
<div class="line"><a name="l00290"></a><span class="lineno"> 290</span>  <span class="keywordflow">if</span> (!p) {</div>
|
|
<div class="line"><a name="l00291"></a><span class="lineno"> 291</span>  <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#afe2fedb4b0ccc89a688c0b4b59691ce0">USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL</a>;</div>
|
|
<div class="line"><a name="l00292"></a><span class="lineno"> 292</span>  }</div>
|
|
<div class="line"><a name="l00293"></a><span class="lineno"> 293</span> </div>
|
|
<div class="line"><a name="l00294"></a><span class="lineno"> 294</span>  <span class="keywordflow">if</span> (!p-><a class="code" href="struct_usb_device.html#a410d39fb7758157f57794335e990ed02">epinfo</a>) {</div>
|
|
<div class="line"><a name="l00295"></a><span class="lineno"> 295</span>  <a class="code" href="_usb_8h.html#afc6fe7f947af35317a49a4dcfc8189fd">USBTRACE</a>(<span class="stringliteral">"epinfo\r\n"</span>);</div>
|
|
<div class="line"><a name="l00296"></a><span class="lineno"> 296</span>  <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#af192c59cafe2192ad802b22e6dbc077d">USB_ERROR_EPINFO_IS_NULL</a>;</div>
|
|
<div class="line"><a name="l00297"></a><span class="lineno"> 297</span>  }</div>
|
|
<div class="line"><a name="l00298"></a><span class="lineno"> 298</span> </div>
|
|
<div class="line"><a name="l00299"></a><span class="lineno"> 299</span>  <span class="comment">// Save old pointer to EP_RECORD of address 0</span></div>
|
|
<div class="line"><a name="l00300"></a><span class="lineno"> 300</span>  oldep_ptr = p-><a class="code" href="struct_usb_device.html#a410d39fb7758157f57794335e990ed02">epinfo</a>;</div>
|
|
<div class="line"><a name="l00301"></a><span class="lineno"> 301</span> </div>
|
|
<div class="line"><a name="l00302"></a><span class="lineno"> 302</span>  <span class="comment">// Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence</span></div>
|
|
<div class="line"><a name="l00303"></a><span class="lineno"> 303</span>  p-><a class="code" href="struct_usb_device.html#a410d39fb7758157f57794335e990ed02">epinfo</a> = <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>;</div>
|
|
<div class="line"><a name="l00304"></a><span class="lineno"> 304</span> </div>
|
|
<div class="line"><a name="l00305"></a><span class="lineno"> 305</span>  p-><a class="code" href="struct_usb_device.html#a86a815577ad7883437d3ca72b32b8e8a">lowspeed</a> = lowspeed;</div>
|
|
<div class="line"><a name="l00306"></a><span class="lineno"> 306</span>  <span class="comment">// Get device descriptor</span></div>
|
|
<div class="line"><a name="l00307"></a><span class="lineno"> 307</span>  rcode = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a193e63c149fad46adabd77ceb09b2b24" title="defined(USB_METHODS_INLINE) ">getDevDescr</a>(0, 0, constBufSize, (uint8_t*)buf);</div>
|
|
<div class="line"><a name="l00308"></a><span class="lineno"> 308</span> </div>
|
|
<div class="line"><a name="l00309"></a><span class="lineno"> 309</span>  <span class="comment">// Restore p->epinfo</span></div>
|
|
<div class="line"><a name="l00310"></a><span class="lineno"> 310</span>  p-><a class="code" href="struct_usb_device.html#a410d39fb7758157f57794335e990ed02">epinfo</a> = oldep_ptr;</div>
|
|
<div class="line"><a name="l00311"></a><span class="lineno"> 311</span> </div>
|
|
<div class="line"><a name="l00312"></a><span class="lineno"> 312</span>  <span class="keywordflow">if</span> (rcode) {</div>
|
|
<div class="line"><a name="l00313"></a><span class="lineno"> 313</span>  <span class="keywordflow">goto</span> FailGetDevDescr;</div>
|
|
<div class="line"><a name="l00314"></a><span class="lineno"> 314</span>  }</div>
|
|
<div class="line"><a name="l00315"></a><span class="lineno"> 315</span>  <span class="comment">// Allocate new address according to device class</span></div>
|
|
<div class="line"><a name="l00316"></a><span class="lineno"> 316</span>  <a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a> = addrPool.<a class="code" href="class_address_pool.html#a97df4ef42e50960ce2165f4cdb53e590">AllocAddress</a>(parent, <span class="keyword">false</span>, port);</div>
|
|
<div class="line"><a name="l00317"></a><span class="lineno"> 317</span> </div>
|
|
<div class="line"><a name="l00318"></a><span class="lineno"> 318</span>  <span class="keywordflow">if</span> (!<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>)</div>
|
|
<div class="line"><a name="l00319"></a><span class="lineno"> 319</span>  <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#a15370eb665cdded5514e69ca58d9f39d">USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL</a>;</div>
|
|
<div class="line"><a name="l00320"></a><span class="lineno"> 320</span> </div>
|
|
<div class="line"><a name="l00321"></a><span class="lineno"> 321</span>  <span class="comment">// Extract Max Packet Size from the device descriptor</span></div>
|
|
<div class="line"><a name="l00322"></a><span class="lineno"> 322</span>  <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[0].<a class="code" href="struct_ep_info.html#aa2ca775b63736df4008e88da7dd4dddb">maxPktSize</a> = (uint8_t)((<a class="code" href="struct_u_s_b___d_e_v_i_c_e___d_e_s_c_r_i_p_t_o_r.html">USB_DEVICE_DESCRIPTOR</a>*)buf)->bMaxPacketSize0;</div>
|
|
<div class="line"><a name="l00323"></a><span class="lineno"> 323</span>  <span class="comment">// Steal and abuse from epInfo structure to save on memory.</span></div>
|
|
<div class="line"><a name="l00324"></a><span class="lineno"> 324</span>  <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[1].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a> = ((<a class="code" href="struct_u_s_b___d_e_v_i_c_e___d_e_s_c_r_i_p_t_o_r.html">USB_DEVICE_DESCRIPTOR</a>*)buf)->bNumConfigurations;</div>
|
|
<div class="line"><a name="l00325"></a><span class="lineno"> 325</span>  <span class="comment">// </TECHNICAL></span></div>
|
|
<div class="line"><a name="l00326"></a><span class="lineno"> 326</span>  <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#a7cad2f024e98c4b2b1b52df76b10c01e">USB_ERROR_CONFIG_REQUIRES_ADDITIONAL_RESET</a>;</div>
|
|
<div class="line"><a name="l00327"></a><span class="lineno"> 327</span> </div>
|
|
<div class="line"><a name="l00328"></a><span class="lineno"> 328</span> FailGetDevDescr:</div>
|
|
<div class="line"><a name="l00329"></a><span class="lineno"> 329</span> <span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
|
|
<div class="line"><a name="l00330"></a><span class="lineno"> 330</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#ace40a5d826a882de0c5a25aece111d3f">NotifyFailGetDevDescr</a>(rcode);</div>
|
|
<div class="line"><a name="l00331"></a><span class="lineno"> 331</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00332"></a><span class="lineno"> 332</span> <span class="preprocessor"></span> rcode = <a class="code" href="_usb_8h.html#a96a7af8bc5ba78235312e1084a5ee229">USB_ERROR_FailGetDevDescr</a>;</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> Fail:</div>
|
|
<div class="line"><a name="l00335"></a><span class="lineno"> 335</span>  <a class="code" href="class_bulk_only.html#a8a9b213d1800db2d8e661d242b57b195">Release</a>();</div>
|
|
<div class="line"><a name="l00336"></a><span class="lineno"> 336</span>  <span class="keywordflow">return</span> rcode;</div>
|
|
<div class="line"><a name="l00337"></a><span class="lineno"> 337</span> };</div>
|
|
<div class="line"><a name="l00338"></a><span class="lineno"> 338</span> </div>
|
|
<div class="line"><a name="l00346"></a><span class="lineno"><a class="code" href="class_bulk_only.html#a51870da9badc037166b86da60bcda6ea"> 346</a></span> uint8_t <a class="code" href="class_bulk_only.html#a51870da9badc037166b86da60bcda6ea">BulkOnly::Init</a>(uint8_t parent, uint8_t port, <span class="keywordtype">bool</span> lowspeed) {</div>
|
|
<div class="line"><a name="l00347"></a><span class="lineno"> 347</span>  uint8_t rcode;</div>
|
|
<div class="line"><a name="l00348"></a><span class="lineno"> 348</span>  uint8_t num_of_conf = <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[1].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a>; <span class="comment">// number of configurations</span></div>
|
|
<div class="line"><a name="l00349"></a><span class="lineno"> 349</span>  <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[1].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a> = 0;</div>
|
|
<div class="line"><a name="l00350"></a><span class="lineno"> 350</span>  <a class="code" href="_usb_8h.html#afc6fe7f947af35317a49a4dcfc8189fd">USBTRACE</a>(<span class="stringliteral">"MS Init\r\n"</span>);</div>
|
|
<div class="line"><a name="l00351"></a><span class="lineno"> 351</span> </div>
|
|
<div class="line"><a name="l00352"></a><span class="lineno"> 352</span>  <a class="code" href="class_address_pool.html">AddressPool</a> &addrPool = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a66ab8f5eda239e761d5a48741ea1f9d4">GetAddressPool</a>();</div>
|
|
<div class="line"><a name="l00353"></a><span class="lineno"> 353</span>  <a class="code" href="struct_usb_device.html">UsbDevice</a> *p = addrPool.<a class="code" href="class_address_pool.html#aa92d7e8f0f515340ae2dc1679b627056">GetUsbDevicePtr</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>);</div>
|
|
<div class="line"><a name="l00354"></a><span class="lineno"> 354</span> </div>
|
|
<div class="line"><a name="l00355"></a><span class="lineno"> 355</span>  <span class="keywordflow">if</span> (!p)</div>
|
|
<div class="line"><a name="l00356"></a><span class="lineno"> 356</span>  <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#afe2fedb4b0ccc89a688c0b4b59691ce0">USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL</a>;</div>
|
|
<div class="line"><a name="l00357"></a><span class="lineno"> 357</span> </div>
|
|
<div class="line"><a name="l00358"></a><span class="lineno"> 358</span>  <span class="comment">// Assign new address to the device</span></div>
|
|
<div class="line"><a name="l00359"></a><span class="lineno"> 359</span>  delay(2000);</div>
|
|
<div class="line"><a name="l00360"></a><span class="lineno"> 360</span>  rcode = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a3aea534daed66b5606fa798df7ad3c47">setAddr</a>(0, 0, <a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>);</div>
|
|
<div class="line"><a name="l00361"></a><span class="lineno"> 361</span> </div>
|
|
<div class="line"><a name="l00362"></a><span class="lineno"> 362</span>  <span class="keywordflow">if</span> (rcode) {</div>
|
|
<div class="line"><a name="l00363"></a><span class="lineno"> 363</span>  p-><a class="code" href="struct_usb_device.html#a86a815577ad7883437d3ca72b32b8e8a">lowspeed</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00364"></a><span class="lineno"> 364</span>  addrPool.<a class="code" href="class_address_pool.html#a15fde13223dcb1da89305ad229763562">FreeAddress</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>);</div>
|
|
<div class="line"><a name="l00365"></a><span class="lineno"> 365</span>  <a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a> = 0;</div>
|
|
<div class="line"><a name="l00366"></a><span class="lineno"> 366</span>  <a class="code" href="_usb_8h.html#adbe3f00986df48a9254f8bf0992041d3">USBTRACE2</a>(<span class="stringliteral">"setAddr:"</span>, rcode);</div>
|
|
<div class="line"><a name="l00367"></a><span class="lineno"> 367</span>  <span class="keywordflow">return</span> rcode;</div>
|
|
<div class="line"><a name="l00368"></a><span class="lineno"> 368</span>  }</div>
|
|
<div class="line"><a name="l00369"></a><span class="lineno"> 369</span> </div>
|
|
<div class="line"><a name="l00370"></a><span class="lineno"> 370</span>  <a class="code" href="_usb_8h.html#adbe3f00986df48a9254f8bf0992041d3">USBTRACE2</a>(<span class="stringliteral">"Addr:"</span>, <a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>);</div>
|
|
<div class="line"><a name="l00371"></a><span class="lineno"> 371</span> </div>
|
|
<div class="line"><a name="l00372"></a><span class="lineno"> 372</span>  p-><a class="code" href="struct_usb_device.html#a86a815577ad7883437d3ca72b32b8e8a">lowspeed</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00373"></a><span class="lineno"> 373</span> </div>
|
|
<div class="line"><a name="l00374"></a><span class="lineno"> 374</span>  p = addrPool.<a class="code" href="class_address_pool.html#aa92d7e8f0f515340ae2dc1679b627056">GetUsbDevicePtr</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>);</div>
|
|
<div class="line"><a name="l00375"></a><span class="lineno"> 375</span> </div>
|
|
<div class="line"><a name="l00376"></a><span class="lineno"> 376</span>  <span class="keywordflow">if</span> (!p)</div>
|
|
<div class="line"><a name="l00377"></a><span class="lineno"> 377</span>  <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#afe2fedb4b0ccc89a688c0b4b59691ce0">USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL</a>;</div>
|
|
<div class="line"><a name="l00378"></a><span class="lineno"> 378</span> </div>
|
|
<div class="line"><a name="l00379"></a><span class="lineno"> 379</span>  p-><a class="code" href="struct_usb_device.html#a86a815577ad7883437d3ca72b32b8e8a">lowspeed</a> = lowspeed;</div>
|
|
<div class="line"><a name="l00380"></a><span class="lineno"> 380</span> </div>
|
|
<div class="line"><a name="l00381"></a><span class="lineno"> 381</span>  <span class="comment">// Assign epInfo to epinfo pointer</span></div>
|
|
<div class="line"><a name="l00382"></a><span class="lineno"> 382</span>  rcode = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a6c3ba3f7e6dccb450267011ce783d7ea">setEpInfoEntry</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, 1, <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>);</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="keywordflow">if</span> (rcode)</div>
|
|
<div class="line"><a name="l00385"></a><span class="lineno"> 385</span>  <span class="keywordflow">goto</span> FailSetDevTblEntry;</div>
|
|
<div class="line"><a name="l00386"></a><span class="lineno"> 386</span> </div>
|
|
<div class="line"><a name="l00387"></a><span class="lineno"> 387</span>  <a class="code" href="_usb_8h.html#adbe3f00986df48a9254f8bf0992041d3">USBTRACE2</a>(<span class="stringliteral">"NC:"</span>, num_of_conf);</div>
|
|
<div class="line"><a name="l00388"></a><span class="lineno"> 388</span> </div>
|
|
<div class="line"><a name="l00389"></a><span class="lineno"> 389</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < num_of_conf; i++) {</div>
|
|
<div class="line"><a name="l00390"></a><span class="lineno"> 390</span>  <a class="code" href="class_config_desc_parser.html">ConfigDescParser</a>< <a class="code" href="_usb_8h.html#aa99b73e335df09e6545fc44798a3c1f2">USB_CLASS_MASS_STORAGE</a>,</div>
|
|
<div class="line"><a name="l00391"></a><span class="lineno"> 391</span>  <a class="code" href="masstorage_8h.html#aaf635eb9151eb63855fe227584bb00eb">MASS_SUBCLASS_SCSI</a>,</div>
|
|
<div class="line"><a name="l00392"></a><span class="lineno"> 392</span>  <a class="code" href="masstorage_8h.html#a17a026f7d64e8daf27b45c295755fdf0">MASS_PROTO_BBB</a>,</div>
|
|
<div class="line"><a name="l00393"></a><span class="lineno"> 393</span>  <a class="code" href="confdescparser_8h.html#a97d95efc3446be55adbb1801c356c55c">CP_MASK_COMPARE_CLASS</a> |</div>
|
|
<div class="line"><a name="l00394"></a><span class="lineno"> 394</span>  <a class="code" href="confdescparser_8h.html#a640401f5d117e10f0f0fd26f74f3975e">CP_MASK_COMPARE_SUBCLASS</a> |</div>
|
|
<div class="line"><a name="l00395"></a><span class="lineno"> 395</span>  <a class="code" href="confdescparser_8h.html#a1e4d3b53bdd61abb61f20d5973e194d7">CP_MASK_COMPARE_PROTOCOL</a> > BulkOnlyParser(<span class="keyword">this</span>);</div>
|
|
<div class="line"><a name="l00396"></a><span class="lineno"> 396</span> </div>
|
|
<div class="line"><a name="l00397"></a><span class="lineno"> 397</span>  rcode = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a618eedabc161d8315be45cae0c8b6f89">getConfDescr</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, 0, i, &BulkOnlyParser);</div>
|
|
<div class="line"><a name="l00398"></a><span class="lineno"> 398</span> </div>
|
|
<div class="line"><a name="l00399"></a><span class="lineno"> 399</span>  <span class="keywordflow">if</span> (rcode)</div>
|
|
<div class="line"><a name="l00400"></a><span class="lineno"> 400</span>  <span class="keywordflow">goto</span> FailGetConfDescr;</div>
|
|
<div class="line"><a name="l00401"></a><span class="lineno"> 401</span> </div>
|
|
<div class="line"><a name="l00402"></a><span class="lineno"> 402</span>  <span class="keywordflow">if</span> (<a class="code" href="class_bulk_only.html#a6cb56ebd0307845321340919e2b35952">bNumEP</a> > 1)</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="comment">// for</span></div>
|
|
<div class="line"><a name="l00405"></a><span class="lineno"> 405</span> </div>
|
|
<div class="line"><a name="l00406"></a><span class="lineno"> 406</span>  <span class="keywordflow">if</span> (<a class="code" href="class_bulk_only.html#a6cb56ebd0307845321340919e2b35952">bNumEP</a> < 3)</div>
|
|
<div class="line"><a name="l00407"></a><span class="lineno"> 407</span>  <span class="keywordflow">return</span> <a class="code" href="_usb_8h.html#ae9e139d0fd29bb0b3e7afad2f76cd589">USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED</a>;</div>
|
|
<div class="line"><a name="l00408"></a><span class="lineno"> 408</span> </div>
|
|
<div class="line"><a name="l00409"></a><span class="lineno"> 409</span>  <span class="comment">// Assign epInfo to epinfo pointer</span></div>
|
|
<div class="line"><a name="l00410"></a><span class="lineno"> 410</span>  <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a6c3ba3f7e6dccb450267011ce783d7ea">setEpInfoEntry</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, <a class="code" href="class_bulk_only.html#a6cb56ebd0307845321340919e2b35952">bNumEP</a>, <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>);</div>
|
|
<div class="line"><a name="l00411"></a><span class="lineno"> 411</span> </div>
|
|
<div class="line"><a name="l00412"></a><span class="lineno"> 412</span>  <a class="code" href="_usb_8h.html#adbe3f00986df48a9254f8bf0992041d3">USBTRACE2</a>(<span class="stringliteral">"Conf:"</span>, <a class="code" href="class_bulk_only.html#ab54f472ec9cd39abdb9f90867943d162">bConfNum</a>);</div>
|
|
<div class="line"><a name="l00413"></a><span class="lineno"> 413</span> </div>
|
|
<div class="line"><a name="l00414"></a><span class="lineno"> 414</span>  <span class="comment">// Set Configuration Value</span></div>
|
|
<div class="line"><a name="l00415"></a><span class="lineno"> 415</span>  rcode = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a31e2c132ec32ffdde94dff72be87c378">setConf</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, 0, <a class="code" href="class_bulk_only.html#ab54f472ec9cd39abdb9f90867943d162">bConfNum</a>);</div>
|
|
<div class="line"><a name="l00416"></a><span class="lineno"> 416</span> </div>
|
|
<div class="line"><a name="l00417"></a><span class="lineno"> 417</span>  <span class="keywordflow">if</span> (rcode)</div>
|
|
<div class="line"><a name="l00418"></a><span class="lineno"> 418</span>  <span class="keywordflow">goto</span> FailSetConfDescr;</div>
|
|
<div class="line"><a name="l00419"></a><span class="lineno"> 419</span> </div>
|
|
<div class="line"><a name="l00420"></a><span class="lineno"> 420</span>  <span class="comment">//Linux does a 1sec delay after this.</span></div>
|
|
<div class="line"><a name="l00421"></a><span class="lineno"> 421</span>  delay(1000);</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>  rcode = GetMaxLUN(&<a class="code" href="class_bulk_only.html#a6bbdd41bf6efc4060f3c36da7d6ed8b2">bMaxLUN</a>);</div>
|
|
<div class="line"><a name="l00424"></a><span class="lineno"> 424</span>  <span class="keywordflow">if</span> (rcode)</div>
|
|
<div class="line"><a name="l00425"></a><span class="lineno"> 425</span>  <span class="keywordflow">goto</span> FailGetMaxLUN;</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>  <span class="keywordflow">if</span> (<a class="code" href="class_bulk_only.html#a6bbdd41bf6efc4060f3c36da7d6ed8b2">bMaxLUN</a> >= <a class="code" href="masstorage_8h.html#a68a8c3241954d2159ff8df696dd5cff6">MASS_MAX_SUPPORTED_LUN</a>) <a class="code" href="class_bulk_only.html#a6bbdd41bf6efc4060f3c36da7d6ed8b2">bMaxLUN</a> = <a class="code" href="masstorage_8h.html#a68a8c3241954d2159ff8df696dd5cff6">MASS_MAX_SUPPORTED_LUN</a> - 1;</div>
|
|
<div class="line"><a name="l00428"></a><span class="lineno"> 428</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"MaxLUN"</span>), <a class="code" href="class_bulk_only.html#a6bbdd41bf6efc4060f3c36da7d6ed8b2">bMaxLUN</a>);</div>
|
|
<div class="line"><a name="l00429"></a><span class="lineno"> 429</span> </div>
|
|
<div class="line"><a name="l00430"></a><span class="lineno"> 430</span>  delay(1000); <span class="comment">// Delay a bit for slow firmware.</span></div>
|
|
<div class="line"><a name="l00431"></a><span class="lineno"> 431</span> </div>
|
|
<div class="line"><a name="l00432"></a><span class="lineno"> 432</span>  <span class="comment">//bTheLUN = bMaxLUN;</span></div>
|
|
<div class="line"><a name="l00433"></a><span class="lineno"> 433</span> </div>
|
|
<div class="line"><a name="l00434"></a><span class="lineno"> 434</span>  <span class="keywordflow">for</span> (uint8_t lun = 0; lun <= <a class="code" href="class_bulk_only.html#a6bbdd41bf6efc4060f3c36da7d6ed8b2">bMaxLUN</a>; lun++) {</div>
|
|
<div class="line"><a name="l00435"></a><span class="lineno"> 435</span>  <a class="code" href="struct_inquiry_response.html">InquiryResponse</a> response;</div>
|
|
<div class="line"><a name="l00436"></a><span class="lineno"> 436</span>  rcode = Inquiry(lun, <span class="keyword">sizeof</span> (<a class="code" href="struct_inquiry_response.html">InquiryResponse</a>), (uint8_t*) & response);</div>
|
|
<div class="line"><a name="l00437"></a><span class="lineno"> 437</span>  <span class="keywordflow">if</span> (rcode) {</div>
|
|
<div class="line"><a name="l00438"></a><span class="lineno"> 438</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"Inquiry"</span>), rcode);</div>
|
|
<div class="line"><a name="l00439"></a><span class="lineno"> 439</span>  } <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l00440"></a><span class="lineno"> 440</span>  uint8_t tries = 0xf0;</div>
|
|
<div class="line"><a name="l00441"></a><span class="lineno"> 441</span>  <span class="keywordflow">while</span> (rcode = TestUnitReady(lun)) {</div>
|
|
<div class="line"><a name="l00442"></a><span class="lineno"> 442</span>  <span class="keywordflow">if</span> (rcode == 0x08) <span class="keywordflow">break</span>; <span class="comment">// break on no media, this is OK to do.</span></div>
|
|
<div class="line"><a name="l00443"></a><span class="lineno"> 443</span>  <span class="comment">// try to lock media and spin up</span></div>
|
|
<div class="line"><a name="l00444"></a><span class="lineno"> 444</span>  <span class="keywordflow">if</span> (tries < 14) {</div>
|
|
<div class="line"><a name="l00445"></a><span class="lineno"> 445</span>  <a class="code" href="class_bulk_only.html#ae7561d686d0b1374b5f9937d6ec8a035">LockMedia</a>(lun, 1);</div>
|
|
<div class="line"><a name="l00446"></a><span class="lineno"> 446</span>  <a class="code" href="class_bulk_only.html#a2fc74b11c2ecce30e89f84cc1efe0c81">MediaCTL</a>(lun, 1); <span class="comment">// I actually have a USB stick that needs this!</span></div>
|
|
<div class="line"><a name="l00447"></a><span class="lineno"> 447</span>  } <span class="keywordflow">else</span> delay(2 * (tries + 1));</div>
|
|
<div class="line"><a name="l00448"></a><span class="lineno"> 448</span>  tries++;</div>
|
|
<div class="line"><a name="l00449"></a><span class="lineno"> 449</span>  <span class="keywordflow">if</span> (!tries) <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00450"></a><span class="lineno"> 450</span>  }</div>
|
|
<div class="line"><a name="l00451"></a><span class="lineno"> 451</span>  <span class="keywordflow">if</span> (!rcode) {</div>
|
|
<div class="line"><a name="l00452"></a><span class="lineno"> 452</span>  delay(1000);</div>
|
|
<div class="line"><a name="l00453"></a><span class="lineno"> 453</span>  <a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun] = CheckLUN(lun);</div>
|
|
<div class="line"><a name="l00454"></a><span class="lineno"> 454</span>  <span class="keywordflow">if</span> (!<a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun]) <a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun] = CheckLUN(lun);</div>
|
|
<div class="line"><a name="l00455"></a><span class="lineno"> 455</span>  }</div>
|
|
<div class="line"><a name="l00456"></a><span class="lineno"> 456</span>  }</div>
|
|
<div class="line"><a name="l00457"></a><span class="lineno"> 457</span>  }</div>
|
|
<div class="line"><a name="l00458"></a><span class="lineno"> 458</span> </div>
|
|
<div class="line"><a name="l00459"></a><span class="lineno"> 459</span> </div>
|
|
<div class="line"><a name="l00460"></a><span class="lineno"> 460</span> <span class="preprocessor">#if 0</span></div>
|
|
<div class="line"><a name="l00461"></a><span class="lineno"> 461</span> <span class="preprocessor"></span> {</div>
|
|
<div class="line"><a name="l00462"></a><span class="lineno"> 462</span>  <span class="keywordtype">bool</span> good;</div>
|
|
<div class="line"><a name="l00463"></a><span class="lineno"> 463</span>  <span class="keywordflow">for</span> (uint8_t i = 1; i == 0; i++) {</div>
|
|
<div class="line"><a name="l00464"></a><span class="lineno"> 464</span>  good = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00465"></a><span class="lineno"> 465</span>  CheckMedia();</div>
|
|
<div class="line"><a name="l00466"></a><span class="lineno"> 466</span>  <span class="keywordflow">for</span> (uint8_t lun = 0; lun <= <a class="code" href="class_bulk_only.html#a6bbdd41bf6efc4060f3c36da7d6ed8b2">bMaxLUN</a>; lun++) good |= <a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun];</div>
|
|
<div class="line"><a name="l00467"></a><span class="lineno"> 467</span>  <span class="keywordflow">if</span> (good) <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00468"></a><span class="lineno"> 468</span>  delay(118); <span class="comment">// 255 loops =~ 30 seconds to allow for spin up, as per SCSI spec.</span></div>
|
|
<div class="line"><a name="l00469"></a><span class="lineno"> 469</span>  }</div>
|
|
<div class="line"><a name="l00470"></a><span class="lineno"> 470</span>  }</div>
|
|
<div class="line"><a name="l00471"></a><span class="lineno"> 471</span> <span class="preprocessor">#else</span></div>
|
|
<div class="line"><a name="l00472"></a><span class="lineno"> 472</span> <span class="preprocessor"></span> CheckMedia();</div>
|
|
<div class="line"><a name="l00473"></a><span class="lineno"> 473</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00474"></a><span class="lineno"> 474</span> <span class="preprocessor"></span></div>
|
|
<div class="line"><a name="l00475"></a><span class="lineno"> 475</span>  rcode = <a class="code" href="class_bulk_only.html#a3d253a0bc8f1ac5b7fe1c9e7078691e3">OnInit</a>();</div>
|
|
<div class="line"><a name="l00476"></a><span class="lineno"> 476</span> </div>
|
|
<div class="line"><a name="l00477"></a><span class="lineno"> 477</span>  <span class="keywordflow">if</span> (rcode)</div>
|
|
<div class="line"><a name="l00478"></a><span class="lineno"> 478</span>  <span class="keywordflow">goto</span> FailOnInit;</div>
|
|
<div class="line"><a name="l00479"></a><span class="lineno"> 479</span> </div>
|
|
<div class="line"><a name="l00480"></a><span class="lineno"> 480</span>  <a class="code" href="_usb_8h.html#afc6fe7f947af35317a49a4dcfc8189fd">USBTRACE</a>(<span class="stringliteral">"MS configured\r\n\r\n"</span>);</div>
|
|
<div class="line"><a name="l00481"></a><span class="lineno"> 481</span> </div>
|
|
<div class="line"><a name="l00482"></a><span class="lineno"> 482</span>  <a class="code" href="class_bulk_only.html#a21961ad1130480f534ef3e91f24c56a0">bPollEnable</a> = <span class="keyword">true</span>;</div>
|
|
<div class="line"><a name="l00483"></a><span class="lineno"> 483</span> </div>
|
|
<div class="line"><a name="l00484"></a><span class="lineno"> 484</span>  <span class="comment">//USBTRACE("Poll enabled\r\n");</span></div>
|
|
<div class="line"><a name="l00485"></a><span class="lineno"> 485</span>  <span class="keywordflow">return</span> 0;</div>
|
|
<div class="line"><a name="l00486"></a><span class="lineno"> 486</span> </div>
|
|
<div class="line"><a name="l00487"></a><span class="lineno"> 487</span> FailSetConfDescr:</div>
|
|
<div class="line"><a name="l00488"></a><span class="lineno"> 488</span> <span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
|
|
<div class="line"><a name="l00489"></a><span class="lineno"> 489</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a08b840c377ca6f8154d6924d51338d89">NotifyFailSetConfDescr</a>();</div>
|
|
<div class="line"><a name="l00490"></a><span class="lineno"> 490</span>  <span class="keywordflow">goto</span> Fail;</div>
|
|
<div class="line"><a name="l00491"></a><span class="lineno"> 491</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00492"></a><span class="lineno"> 492</span> <span class="preprocessor"></span></div>
|
|
<div class="line"><a name="l00493"></a><span class="lineno"> 493</span> FailOnInit:</div>
|
|
<div class="line"><a name="l00494"></a><span class="lineno"> 494</span> <span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
|
|
<div class="line"><a name="l00495"></a><span class="lineno"> 495</span> <span class="preprocessor"></span> <a class="code" href="_usb_8h.html#afc6fe7f947af35317a49a4dcfc8189fd">USBTRACE</a>(<span class="stringliteral">"OnInit:"</span>);</div>
|
|
<div class="line"><a name="l00496"></a><span class="lineno"> 496</span>  <span class="keywordflow">goto</span> Fail;</div>
|
|
<div class="line"><a name="l00497"></a><span class="lineno"> 497</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00498"></a><span class="lineno"> 498</span> <span class="preprocessor"></span></div>
|
|
<div class="line"><a name="l00499"></a><span class="lineno"> 499</span> FailGetMaxLUN:</div>
|
|
<div class="line"><a name="l00500"></a><span class="lineno"> 500</span> <span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
|
|
<div class="line"><a name="l00501"></a><span class="lineno"> 501</span> <span class="preprocessor"></span> <a class="code" href="_usb_8h.html#afc6fe7f947af35317a49a4dcfc8189fd">USBTRACE</a>(<span class="stringliteral">"GetMaxLUN:"</span>);</div>
|
|
<div class="line"><a name="l00502"></a><span class="lineno"> 502</span>  <span class="keywordflow">goto</span> Fail;</div>
|
|
<div class="line"><a name="l00503"></a><span class="lineno"> 503</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00504"></a><span class="lineno"> 504</span> <span class="preprocessor"></span></div>
|
|
<div class="line"><a name="l00505"></a><span class="lineno"> 505</span> FailInvalidSectorSize:</div>
|
|
<div class="line"><a name="l00506"></a><span class="lineno"> 506</span> <span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
|
|
<div class="line"><a name="l00507"></a><span class="lineno"> 507</span> <span class="preprocessor"></span> <a class="code" href="_usb_8h.html#afc6fe7f947af35317a49a4dcfc8189fd">USBTRACE</a>(<span class="stringliteral">"Sector Size is NOT VALID: "</span>);</div>
|
|
<div class="line"><a name="l00508"></a><span class="lineno"> 508</span>  <span class="keywordflow">goto</span> Fail;</div>
|
|
<div class="line"><a name="l00509"></a><span class="lineno"> 509</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00510"></a><span class="lineno"> 510</span> <span class="preprocessor"></span></div>
|
|
<div class="line"><a name="l00511"></a><span class="lineno"> 511</span> FailSetDevTblEntry:</div>
|
|
<div class="line"><a name="l00512"></a><span class="lineno"> 512</span> <span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
|
|
<div class="line"><a name="l00513"></a><span class="lineno"> 513</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#aa65008f9251787149e391f89e68b32be">NotifyFailSetDevTblEntry</a>();</div>
|
|
<div class="line"><a name="l00514"></a><span class="lineno"> 514</span>  <span class="keywordflow">goto</span> Fail;</div>
|
|
<div class="line"><a name="l00515"></a><span class="lineno"> 515</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00516"></a><span class="lineno"> 516</span> <span class="preprocessor"></span></div>
|
|
<div class="line"><a name="l00517"></a><span class="lineno"> 517</span> FailGetConfDescr:</div>
|
|
<div class="line"><a name="l00518"></a><span class="lineno"> 518</span> <span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
|
|
<div class="line"><a name="l00519"></a><span class="lineno"> 519</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a8990b7c46c3f20489c3f205fa173f110">NotifyFailGetConfDescr</a>();</div>
|
|
<div class="line"><a name="l00520"></a><span class="lineno"> 520</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00521"></a><span class="lineno"> 521</span> <span class="preprocessor"></span></div>
|
|
<div class="line"><a name="l00522"></a><span class="lineno"> 522</span> Fail:</div>
|
|
<div class="line"><a name="l00523"></a><span class="lineno"> 523</span> <span class="preprocessor">#ifdef DEBUG_USB_HOST</span></div>
|
|
<div class="line"><a name="l00524"></a><span class="lineno"> 524</span> <span class="preprocessor"></span> <a class="code" href="message_8cpp.html#a5ae2cb9bf877595104f2425f50e2057f">NotifyFail</a>(rcode);</div>
|
|
<div class="line"><a name="l00525"></a><span class="lineno"> 525</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00526"></a><span class="lineno"> 526</span> <span class="preprocessor"></span> <a class="code" href="class_bulk_only.html#a8a9b213d1800db2d8e661d242b57b195">Release</a>();</div>
|
|
<div class="line"><a name="l00527"></a><span class="lineno"> 527</span>  <span class="keywordflow">return</span> rcode;</div>
|
|
<div class="line"><a name="l00528"></a><span class="lineno"> 528</span> }</div>
|
|
<div class="line"><a name="l00529"></a><span class="lineno"> 529</span> </div>
|
|
<div class="line"><a name="l00539"></a><span class="lineno"><a class="code" href="class_bulk_only.html#a13d33906543d5d6b44620f430dc729ff"> 539</a></span> <span class="keywordtype">void</span> <a class="code" href="class_bulk_only.html#a13d33906543d5d6b44620f430dc729ff">BulkOnly::EndpointXtract</a>(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, <span class="keyword">const</span> <a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html">USB_ENDPOINT_DESCRIPTOR</a> * pep) {</div>
|
|
<div class="line"><a name="l00540"></a><span class="lineno"> 540</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"Conf.Val"</span>), conf);</div>
|
|
<div class="line"><a name="l00541"></a><span class="lineno"> 541</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"Iface Num"</span>), iface);</div>
|
|
<div class="line"><a name="l00542"></a><span class="lineno"> 542</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"Alt.Set"</span>), alt);</div>
|
|
<div class="line"><a name="l00543"></a><span class="lineno"> 543</span> </div>
|
|
<div class="line"><a name="l00544"></a><span class="lineno"> 544</span>  <a class="code" href="class_bulk_only.html#ab54f472ec9cd39abdb9f90867943d162">bConfNum</a> = conf;</div>
|
|
<div class="line"><a name="l00545"></a><span class="lineno"> 545</span> </div>
|
|
<div class="line"><a name="l00546"></a><span class="lineno"> 546</span>  uint8_t index;</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>  <span class="keywordflow">if</span> ((pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a8ee7f1bafac335258c6e742969387f57">bmAttributes</a> & 0x03) == 3 && (pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a23fbb539d72d10a6cb12efedf7d3457c">bEndpointAddress</a> & 0x80) == 0x80)</div>
|
|
<div class="line"><a name="l00549"></a><span class="lineno"> 549</span>  index = <a class="code" href="class_bulk_only.html#a03cd96b415990821bdce43b4004c85e4">epInterruptInIndex</a>;</div>
|
|
<div class="line"><a name="l00550"></a><span class="lineno"> 550</span>  <span class="keywordflow">else</span></div>
|
|
<div class="line"><a name="l00551"></a><span class="lineno"> 551</span>  <span class="keywordflow">if</span> ((pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a8ee7f1bafac335258c6e742969387f57">bmAttributes</a> & 0x02) == 2)</div>
|
|
<div class="line"><a name="l00552"></a><span class="lineno"> 552</span>  index = ((pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a23fbb539d72d10a6cb12efedf7d3457c">bEndpointAddress</a> & 0x80) == 0x80) ? <a class="code" href="class_bulk_only.html#a9e487226408578a2971570bcf7de62fe">epDataInIndex</a> : <a class="code" href="class_bulk_only.html#a8d527bdc285870f3571481a4fd982721">epDataOutIndex</a>;</div>
|
|
<div class="line"><a name="l00553"></a><span class="lineno"> 553</span>  <span class="keywordflow">else</span></div>
|
|
<div class="line"><a name="l00554"></a><span class="lineno"> 554</span>  <span class="keywordflow">return</span>;</div>
|
|
<div class="line"><a name="l00555"></a><span class="lineno"> 555</span> </div>
|
|
<div class="line"><a name="l00556"></a><span class="lineno"> 556</span>  <span class="comment">// Fill in the endpoint info structure</span></div>
|
|
<div class="line"><a name="l00557"></a><span class="lineno"> 557</span>  <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[index].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a> = (pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a23fbb539d72d10a6cb12efedf7d3457c">bEndpointAddress</a> & 0x0F);</div>
|
|
<div class="line"><a name="l00558"></a><span class="lineno"> 558</span>  <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[index].<a class="code" href="struct_ep_info.html#aa2ca775b63736df4008e88da7dd4dddb">maxPktSize</a> = (uint8_t)pep-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#af34105fa6bd0029d9c6b73d85f7853c6">wMaxPacketSize</a>;</div>
|
|
<div class="line"><a name="l00559"></a><span class="lineno"> 559</span>  <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[index].<a class="code" href="struct_ep_info.html#a1dea928517c961235eef7b0876e69f10">epAttribs</a> = 0;</div>
|
|
<div class="line"><a name="l00560"></a><span class="lineno"> 560</span> </div>
|
|
<div class="line"><a name="l00561"></a><span class="lineno"> 561</span>  <a class="code" href="class_bulk_only.html#a6cb56ebd0307845321340919e2b35952">bNumEP</a>++;</div>
|
|
<div class="line"><a name="l00562"></a><span class="lineno"> 562</span> </div>
|
|
<div class="line"><a name="l00563"></a><span class="lineno"> 563</span>  <a class="code" href="class_bulk_only.html#ac8a1d7b2ef82d9f6da44928c78039964">PrintEndpointDescriptor</a>(pep);</div>
|
|
<div class="line"><a name="l00564"></a><span class="lineno"> 564</span> }</div>
|
|
<div class="line"><a name="l00565"></a><span class="lineno"> 565</span> </div>
|
|
<div class="line"><a name="l00571"></a><span class="lineno"><a class="code" href="class_bulk_only.html#a8a9b213d1800db2d8e661d242b57b195"> 571</a></span> uint8_t <a class="code" href="class_bulk_only.html#a8a9b213d1800db2d8e661d242b57b195">BulkOnly::Release</a>() {</div>
|
|
<div class="line"><a name="l00572"></a><span class="lineno"> 572</span>  ClearAllEP();</div>
|
|
<div class="line"><a name="l00573"></a><span class="lineno"> 573</span>  <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a66ab8f5eda239e761d5a48741ea1f9d4">GetAddressPool</a>().<a class="code" href="class_address_pool.html#a15fde13223dcb1da89305ad229763562">FreeAddress</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>);</div>
|
|
<div class="line"><a name="l00574"></a><span class="lineno"> 574</span>  <span class="keywordflow">return</span> 0;</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="l00583"></a><span class="lineno"> 583</span> <span class="keywordtype">boolean</span> BulkOnly::CheckLUN(uint8_t lun) {</div>
|
|
<div class="line"><a name="l00584"></a><span class="lineno"> 584</span>  uint8_t rcode;</div>
|
|
<div class="line"><a name="l00585"></a><span class="lineno"> 585</span>  <a class="code" href="struct_capacity.html">Capacity</a> capacity;</div>
|
|
<div class="line"><a name="l00586"></a><span class="lineno"> 586</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i<<span class="keyword">sizeof</span> (<a class="code" href="struct_capacity.html">Capacity</a>); i++) capacity.<a class="code" href="struct_capacity.html#ae6dd521cd2ece3d6fa6fe58180fb9e8a">data</a>[i] = 0;</div>
|
|
<div class="line"><a name="l00587"></a><span class="lineno"> 587</span> </div>
|
|
<div class="line"><a name="l00588"></a><span class="lineno"> 588</span>  rcode = ReadCapacity(lun, <span class="keyword">sizeof</span> (<a class="code" href="struct_capacity.html">Capacity</a>), (uint8_t*) & capacity);</div>
|
|
<div class="line"><a name="l00589"></a><span class="lineno"> 589</span>  <span class="keywordflow">if</span> (rcode) {</div>
|
|
<div class="line"><a name="l00590"></a><span class="lineno"> 590</span>  <span class="comment">//printf(">>>>>>>>>>>>>>>>ReadCapacity returned %i\r\n", rcode);</span></div>
|
|
<div class="line"><a name="l00591"></a><span class="lineno"> 591</span>  <span class="keywordflow">return</span> <span class="keyword">false</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>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">">>>>>>>>>>>>>>>>CAPACITY OK ON LUN"</span>), lun);</div>
|
|
<div class="line"><a name="l00594"></a><span class="lineno"> 594</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i<<span class="keyword">sizeof</span> (<a class="code" href="struct_capacity.html">Capacity</a>); i++)</div>
|
|
<div class="line"><a name="l00595"></a><span class="lineno"> 595</span>  D_PrintHex<uint8_t > (capacity.<a class="code" href="struct_capacity.html#ae6dd521cd2ece3d6fa6fe58180fb9e8a">data</a>[i], 0x80);</div>
|
|
<div class="line"><a name="l00596"></a><span class="lineno"> 596</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\n\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00597"></a><span class="lineno"> 597</span>  <span class="comment">// Only 512/1024/2048/4096 are valid values!</span></div>
|
|
<div class="line"><a name="l00598"></a><span class="lineno"> 598</span>  uint32_t c = ((uint32_t)capacity.<a class="code" href="struct_capacity.html#ae6dd521cd2ece3d6fa6fe58180fb9e8a">data</a>[4] << 24) + ((uint32_t)capacity.<a class="code" href="struct_capacity.html#ae6dd521cd2ece3d6fa6fe58180fb9e8a">data</a>[5] << 16) + ((uint32_t)capacity.<a class="code" href="struct_capacity.html#ae6dd521cd2ece3d6fa6fe58180fb9e8a">data</a>[6] << 8) + (uint32_t)capacity.<a class="code" href="struct_capacity.html#ae6dd521cd2ece3d6fa6fe58180fb9e8a">data</a>[7];</div>
|
|
<div class="line"><a name="l00599"></a><span class="lineno"> 599</span>  if (c != 0x0200LU && c != 0x0400LU && c != 0x0800LU && c != 0x1000LU) {</div>
|
|
<div class="line"><a name="l00600"></a><span class="lineno"> 600</span>  <span class="keywordflow">return</span> <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00601"></a><span class="lineno"> 601</span>  }</div>
|
|
<div class="line"><a name="l00602"></a><span class="lineno"> 602</span>  <span class="comment">// Store capacity information.</span></div>
|
|
<div class="line"><a name="l00603"></a><span class="lineno"> 603</span>  <a class="code" href="class_bulk_only.html#aa4e2711c6279d48c63e82a63ad458421">CurrentSectorSize</a>[lun] = (uint16_t)(c & 0xFFFF);</div>
|
|
<div class="line"><a name="l00604"></a><span class="lineno"> 604</span>  <a class="code" href="class_bulk_only.html#a73c3f6b8f6f79ad60e5ba05e560b277d">CurrentCapacity</a>[lun] = ((uint32_t)capacity.<a class="code" href="struct_capacity.html#ae6dd521cd2ece3d6fa6fe58180fb9e8a">data</a>[0] << 24) + ((uint32_t)capacity.<a class="code" href="struct_capacity.html#ae6dd521cd2ece3d6fa6fe58180fb9e8a">data</a>[1] << 16) + ((uint32_t)capacity.<a class="code" href="struct_capacity.html#ae6dd521cd2ece3d6fa6fe58180fb9e8a">data</a>[2] << 8) + (uint32_t)capacity.<a class="code" href="struct_capacity.html#ae6dd521cd2ece3d6fa6fe58180fb9e8a">data</a>[3];</div>
|
|
<div class="line"><a name="l00605"></a><span class="lineno"> 605</span>  if (<a class="code" href="class_bulk_only.html#a73c3f6b8f6f79ad60e5ba05e560b277d">CurrentCapacity</a>[lun] == 0xffffffffLU || <a class="code" href="class_bulk_only.html#a73c3f6b8f6f79ad60e5ba05e560b277d">CurrentCapacity</a>[lun] == 0x00LU) {</div>
|
|
<div class="line"><a name="l00606"></a><span class="lineno"> 606</span>  <span class="comment">// Buggy firmware will report 0xffffffff or 0 for no media</span></div>
|
|
<div class="line"><a name="l00607"></a><span class="lineno"> 607</span>  <span class="keywordflow">if</span> (<a class="code" href="class_bulk_only.html#a73c3f6b8f6f79ad60e5ba05e560b277d">CurrentCapacity</a>[lun])</div>
|
|
<div class="line"><a name="l00608"></a><span class="lineno"> 608</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">">>>>>>>>>>>>>>>>BUGGY FIRMWARE. CAPACITY FAIL ON LUN"</span>), lun);</div>
|
|
<div class="line"><a name="l00609"></a><span class="lineno"> 609</span>  <span class="keywordflow">return</span> <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00610"></a><span class="lineno"> 610</span>  }</div>
|
|
<div class="line"><a name="l00611"></a><span class="lineno"> 611</span>  delay(20);</div>
|
|
<div class="line"><a name="l00612"></a><span class="lineno"> 612</span>  Page3F(lun);</div>
|
|
<div class="line"><a name="l00613"></a><span class="lineno"> 613</span>  <span class="keywordflow">if</span> (!TestUnitReady(lun)) <span class="keywordflow">return</span> <span class="keyword">true</span>;</div>
|
|
<div class="line"><a name="l00614"></a><span class="lineno"> 614</span>  <span class="keywordflow">return</span> <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00615"></a><span class="lineno"> 615</span> }</div>
|
|
<div class="line"><a name="l00616"></a><span class="lineno"> 616</span> </div>
|
|
<div class="line"><a name="l00617"></a><span class="lineno"> 617</span> </div>
|
|
<div class="line"><a name="l00623"></a><span class="lineno"> 623</span> <span class="keywordtype">void</span> BulkOnly::CheckMedia() {</div>
|
|
<div class="line"><a name="l00624"></a><span class="lineno"> 624</span>  <span class="keywordflow">for</span> (uint8_t lun = 0; lun <= <a class="code" href="class_bulk_only.html#a6bbdd41bf6efc4060f3c36da7d6ed8b2">bMaxLUN</a>; lun++) {</div>
|
|
<div class="line"><a name="l00625"></a><span class="lineno"> 625</span>  <span class="keywordflow">if</span> (TestUnitReady(lun)) {</div>
|
|
<div class="line"><a name="l00626"></a><span class="lineno"> 626</span>  <a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun] = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00627"></a><span class="lineno"> 627</span>  <span class="keywordflow">continue</span>;</div>
|
|
<div class="line"><a name="l00628"></a><span class="lineno"> 628</span>  }</div>
|
|
<div class="line"><a name="l00629"></a><span class="lineno"> 629</span>  <span class="keywordflow">if</span> (!<a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun])</div>
|
|
<div class="line"><a name="l00630"></a><span class="lineno"> 630</span>  <a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun] = CheckLUN(lun);</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="preprocessor">#if 0</span></div>
|
|
<div class="line"><a name="l00633"></a><span class="lineno"> 633</span> <span class="preprocessor"></span> printf(<span class="stringliteral">"}}}}}}}}}}}}}}}}STATUS "</span>);</div>
|
|
<div class="line"><a name="l00634"></a><span class="lineno"> 634</span>  <span class="keywordflow">for</span> (uint8_t lun = 0; lun <= <a class="code" href="class_bulk_only.html#a6bbdd41bf6efc4060f3c36da7d6ed8b2">bMaxLUN</a>; lun++) {</div>
|
|
<div class="line"><a name="l00635"></a><span class="lineno"> 635</span>  <span class="keywordflow">if</span> (<a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun])</div>
|
|
<div class="line"><a name="l00636"></a><span class="lineno"> 636</span>  printf(<span class="stringliteral">"#"</span>);</div>
|
|
<div class="line"><a name="l00637"></a><span class="lineno"> 637</span>  <span class="keywordflow">else</span> printf(<span class="stringliteral">"."</span>);</div>
|
|
<div class="line"><a name="l00638"></a><span class="lineno"> 638</span>  }</div>
|
|
<div class="line"><a name="l00639"></a><span class="lineno"> 639</span>  printf(<span class="stringliteral">"\r\n"</span>);</div>
|
|
<div class="line"><a name="l00640"></a><span class="lineno"> 640</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00641"></a><span class="lineno"> 641</span> <span class="preprocessor"></span> <a class="code" href="class_bulk_only.html#a2d422ee0745cd7c04afff905278c4233">qNextPollTime</a> = millis() + 2000;</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> </div>
|
|
<div class="line"><a name="l00649"></a><span class="lineno"><a class="code" href="class_bulk_only.html#a51b8a76f5e16697476ce2dcff2514bc6"> 649</a></span> uint8_t <a class="code" href="class_bulk_only.html#a51b8a76f5e16697476ce2dcff2514bc6">BulkOnly::Poll</a>() {</div>
|
|
<div class="line"><a name="l00650"></a><span class="lineno"> 650</span>  uint8_t rcode = 0;</div>
|
|
<div class="line"><a name="l00651"></a><span class="lineno"> 651</span> </div>
|
|
<div class="line"><a name="l00652"></a><span class="lineno"> 652</span>  <span class="keywordflow">if</span> (!<a class="code" href="class_bulk_only.html#a21961ad1130480f534ef3e91f24c56a0">bPollEnable</a>)</div>
|
|
<div class="line"><a name="l00653"></a><span class="lineno"> 653</span>  <span class="keywordflow">return</span> 0;</div>
|
|
<div class="line"><a name="l00654"></a><span class="lineno"> 654</span> </div>
|
|
<div class="line"><a name="l00655"></a><span class="lineno"> 655</span>  <span class="keywordflow">if</span> (<a class="code" href="class_bulk_only.html#a2d422ee0745cd7c04afff905278c4233">qNextPollTime</a> <= millis()) {</div>
|
|
<div class="line"><a name="l00656"></a><span class="lineno"> 656</span>  CheckMedia();</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>  rcode = 0;</div>
|
|
<div class="line"><a name="l00659"></a><span class="lineno"> 659</span> </div>
|
|
<div class="line"><a name="l00660"></a><span class="lineno"> 660</span>  <span class="keywordflow">return</span> rcode;</div>
|
|
<div class="line"><a name="l00661"></a><span class="lineno"> 661</span> }</div>
|
|
<div class="line"><a name="l00662"></a><span class="lineno"> 662</span> </div>
|
|
<div class="line"><a name="l00664"></a><span class="lineno"> 664</span> </div>
|
|
<div class="line"><a name="l00665"></a><span class="lineno"> 665</span> </div>
|
|
<div class="line"><a name="l00666"></a><span class="lineno"> 666</span> <span class="comment">// SCSI code</span></div>
|
|
<div class="line"><a name="l00667"></a><span class="lineno"> 667</span> </div>
|
|
<div class="line"><a name="l00668"></a><span class="lineno"> 668</span> </div>
|
|
<div class="line"><a name="l00670"></a><span class="lineno"> 670</span> </div>
|
|
<div class="line"><a name="l00677"></a><span class="lineno"> 677</span> uint8_t BulkOnly::GetMaxLUN(uint8_t *plun) {</div>
|
|
<div class="line"><a name="l00678"></a><span class="lineno"> 678</span>  uint8_t ret = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a636695a5c3d35cd6b9e31c54edfacd7c">ctrlReq</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, 0, <a class="code" href="masstorage_8h.html#affadc780007914e4b4de088b4df8ddf6">bmREQ_MASSIN</a>, <a class="code" href="masstorage_8h.html#a3fc37932ad8bcc25c185fb1efbc099b8">MASS_REQ_GET_MAX_LUN</a>, 0, 0, <a class="code" href="class_bulk_only.html#ac18ad598cd9a1ee99f49d51a572a50a4">bIface</a>, 1, 1, plun, NULL);</div>
|
|
<div class="line"><a name="l00679"></a><span class="lineno"> 679</span> </div>
|
|
<div class="line"><a name="l00680"></a><span class="lineno"> 680</span>  <span class="keywordflow">if</span> (ret == <a class="code" href="max3421e_8h.html#a774ac66066335e580da2b8cdab52df30">hrSTALL</a>)</div>
|
|
<div class="line"><a name="l00681"></a><span class="lineno"> 681</span>  *plun = 0;</div>
|
|
<div class="line"><a name="l00682"></a><span class="lineno"> 682</span> </div>
|
|
<div class="line"><a name="l00683"></a><span class="lineno"> 683</span>  <span class="keywordflow">return</span> 0;</div>
|
|
<div class="line"><a name="l00684"></a><span class="lineno"> 684</span> }</div>
|
|
<div class="line"><a name="l00685"></a><span class="lineno"> 685</span> </div>
|
|
<div class="line"><a name="l00686"></a><span class="lineno"> 686</span> </div>
|
|
<div class="line"><a name="l00695"></a><span class="lineno"> 695</span> uint8_t BulkOnly::Inquiry(uint8_t lun, uint16_t bsize, uint8_t *buf) {</div>
|
|
<div class="line"><a name="l00696"></a><span class="lineno"> 696</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nInquiry\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00697"></a><span class="lineno"> 697</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"---------\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00698"></a><span class="lineno"> 698</span> </div>
|
|
<div class="line"><a name="l00699"></a><span class="lineno"> 699</span>  <a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a> cbw;</div>
|
|
<div class="line"><a name="l00700"></a><span class="lineno"> 700</span>  SetCurLUN(lun);</div>
|
|
<div class="line"><a name="l00701"></a><span class="lineno"> 701</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a133ffc8ac9be6ce284f10efece567748">dCBWSignature</a> = <a class="code" href="masstorage_8h.html#a439c9558fff25c40219c0f20244e666d">MASS_CBW_SIGNATURE</a>;</div>
|
|
<div class="line"><a name="l00702"></a><span class="lineno"> 702</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a> = ++<a class="code" href="class_bulk_only.html#a7ae682d50badd1386a06f30f35a32d1d">dCBWTag</a>;</div>
|
|
<div class="line"><a name="l00703"></a><span class="lineno"> 703</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a> = bsize;</div>
|
|
<div class="line"><a name="l00704"></a><span class="lineno"> 704</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a396b36ceef993c32f28b1354727a5e9e">bmCBWFlags</a> = <a class="code" href="masstorage_8h.html#a012ee34e4ce8d644c2f75099867b26c0">MASS_CMD_DIR_IN</a>;</div>
|
|
<div class="line"><a name="l00705"></a><span class="lineno"> 705</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2a16bb9a98e3ee4eaac8fea6310b4e01">bmCBWLUN</a> = lun;</div>
|
|
<div class="line"><a name="l00706"></a><span class="lineno"> 706</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a069c89f584abbf45c13ebb85ca906494">bmCBWCBLength</a> = 6;</div>
|
|
<div class="line"><a name="l00707"></a><span class="lineno"> 707</span> </div>
|
|
<div class="line"><a name="l00708"></a><span class="lineno"> 708</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 16; i++)</div>
|
|
<div class="line"><a name="l00709"></a><span class="lineno"> 709</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[i] = 0;</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>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[0] = <a class="code" href="masstorage_8h.html#ac1f82346efef75cf197abb8e29cc5f44">SCSI_CMD_INQUIRY</a>;</div>
|
|
<div class="line"><a name="l00712"></a><span class="lineno"> 712</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[1] = lun << 5;</div>
|
|
<div class="line"><a name="l00713"></a><span class="lineno"> 713</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[4] = bsize;</div>
|
|
<div class="line"><a name="l00714"></a><span class="lineno"> 714</span> </div>
|
|
<div class="line"><a name="l00715"></a><span class="lineno"> 715</span>  uint8_t rc = HandleSCSIError(Transaction(&cbw, bsize, buf, 0));</div>
|
|
<div class="line"><a name="l00716"></a><span class="lineno"> 716</span> <span class="preprocessor">#if 0</span></div>
|
|
<div class="line"><a name="l00717"></a><span class="lineno"> 717</span> <span class="preprocessor"></span> <span class="keywordflow">if</span> (!rc) {</div>
|
|
<div class="line"><a name="l00718"></a><span class="lineno"> 718</span>  printf(<span class="stringliteral">"LUN %i `"</span>, lun);</div>
|
|
<div class="line"><a name="l00719"></a><span class="lineno"> 719</span>  <span class="keywordflow">for</span> (<span class="keywordtype">int</span> i = 8; i < 36; i++) printf(<span class="stringliteral">"%c"</span>, buf[i]);</div>
|
|
<div class="line"><a name="l00720"></a><span class="lineno"> 720</span>  printf(<span class="stringliteral">"'\r\nQualifier %1.1X "</span>, (buf[0]&0xE0) >> 5);</div>
|
|
<div class="line"><a name="l00721"></a><span class="lineno"> 721</span>  printf(<span class="stringliteral">"Device type %2.2X "</span>, buf[0]&0x1f);</div>
|
|
<div class="line"><a name="l00722"></a><span class="lineno"> 722</span>  printf(<span class="stringliteral">"RMB %1.1X "</span>, buf[1]&0x80 >> 7);</div>
|
|
<div class="line"><a name="l00723"></a><span class="lineno"> 723</span>  printf(<span class="stringliteral">"SSCS% 1.1X "</span>, buf[5]&0x80 >> 7);</div>
|
|
<div class="line"><a name="l00724"></a><span class="lineno"> 724</span>  uint8_t sv = buf[2];</div>
|
|
<div class="line"><a name="l00725"></a><span class="lineno"> 725</span>  printf(<span class="stringliteral">"SCSI version %2.2X\r\nDevice conforms to "</span>, sv);</div>
|
|
<div class="line"><a name="l00726"></a><span class="lineno"> 726</span>  <span class="keywordflow">switch</span> (sv) {</div>
|
|
<div class="line"><a name="l00727"></a><span class="lineno"> 727</span>  <span class="keywordflow">case</span> 0:</div>
|
|
<div class="line"><a name="l00728"></a><span class="lineno"> 728</span>  printf(<span class="stringliteral">"No specific"</span>);</div>
|
|
<div class="line"><a name="l00729"></a><span class="lineno"> 729</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00730"></a><span class="lineno"> 730</span>  <span class="comment">/*</span></div>
|
|
<div class="line"><a name="l00731"></a><span class="lineno"> 731</span> <span class="comment"> case 1:</span></div>
|
|
<div class="line"><a name="l00732"></a><span class="lineno"> 732</span> <span class="comment"> printf("");</span></div>
|
|
<div class="line"><a name="l00733"></a><span class="lineno"> 733</span> <span class="comment"> break;</span></div>
|
|
<div class="line"><a name="l00734"></a><span class="lineno"> 734</span> <span class="comment"> */</span></div>
|
|
<div class="line"><a name="l00735"></a><span class="lineno"> 735</span>  <span class="keywordflow">case</span> 2:</div>
|
|
<div class="line"><a name="l00736"></a><span class="lineno"> 736</span>  printf(<span class="stringliteral">"ANSI 2"</span>);</div>
|
|
<div class="line"><a name="l00737"></a><span class="lineno"> 737</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00738"></a><span class="lineno"> 738</span>  <span class="keywordflow">case</span> 3:</div>
|
|
<div class="line"><a name="l00739"></a><span class="lineno"> 739</span>  printf(<span class="stringliteral">"ANSI INCITS 301-1997 (SPC)"</span>);</div>
|
|
<div class="line"><a name="l00740"></a><span class="lineno"> 740</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00741"></a><span class="lineno"> 741</span>  <span class="keywordflow">case</span> 4:</div>
|
|
<div class="line"><a name="l00742"></a><span class="lineno"> 742</span>  printf(<span class="stringliteral">"ANSI INCITS 351-2001 (SPC-2)"</span>);</div>
|
|
<div class="line"><a name="l00743"></a><span class="lineno"> 743</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00744"></a><span class="lineno"> 744</span>  <span class="keywordflow">case</span> 5:</div>
|
|
<div class="line"><a name="l00745"></a><span class="lineno"> 745</span>  printf(<span class="stringliteral">"ANSI INCITS 408-2005 (SPC-4)"</span>);</div>
|
|
<div class="line"><a name="l00746"></a><span class="lineno"> 746</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00747"></a><span class="lineno"> 747</span>  <span class="keywordflow">case</span> 6:</div>
|
|
<div class="line"><a name="l00748"></a><span class="lineno"> 748</span>  printf(<span class="stringliteral">"T10/1731-D (SPC-4)"</span>);</div>
|
|
<div class="line"><a name="l00749"></a><span class="lineno"> 749</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l00750"></a><span class="lineno"> 750</span>  <span class="keywordflow">default</span>:</div>
|
|
<div class="line"><a name="l00751"></a><span class="lineno"> 751</span>  printf(<span class="stringliteral">"unknown"</span>);</div>
|
|
<div class="line"><a name="l00752"></a><span class="lineno"> 752</span>  }</div>
|
|
<div class="line"><a name="l00753"></a><span class="lineno"> 753</span>  printf(<span class="stringliteral">" standards.\r\n"</span>);</div>
|
|
<div class="line"><a name="l00754"></a><span class="lineno"> 754</span>  }</div>
|
|
<div class="line"><a name="l00755"></a><span class="lineno"> 755</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00756"></a><span class="lineno"> 756</span> <span class="preprocessor"></span> <span class="keywordflow">return</span> rc;</div>
|
|
<div class="line"><a name="l00757"></a><span class="lineno"> 757</span> }</div>
|
|
<div class="line"><a name="l00758"></a><span class="lineno"> 758</span> </div>
|
|
<div class="line"><a name="l00767"></a><span class="lineno"> 767</span> uint8_t BulkOnly::RequestSense(uint8_t lun, uint16_t size, uint8_t *buf) {</div>
|
|
<div class="line"><a name="l00768"></a><span class="lineno"> 768</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nRequestSense\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00769"></a><span class="lineno"> 769</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"----------------\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00770"></a><span class="lineno"> 770</span> </div>
|
|
<div class="line"><a name="l00771"></a><span class="lineno"> 771</span>  <a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a> cbw;</div>
|
|
<div class="line"><a name="l00772"></a><span class="lineno"> 772</span>  SetCurLUN(lun);</div>
|
|
<div class="line"><a name="l00773"></a><span class="lineno"> 773</span> </div>
|
|
<div class="line"><a name="l00774"></a><span class="lineno"> 774</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a133ffc8ac9be6ce284f10efece567748">dCBWSignature</a> = <a class="code" href="masstorage_8h.html#a439c9558fff25c40219c0f20244e666d">MASS_CBW_SIGNATURE</a>;</div>
|
|
<div class="line"><a name="l00775"></a><span class="lineno"> 775</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a> = ++<a class="code" href="class_bulk_only.html#a7ae682d50badd1386a06f30f35a32d1d">dCBWTag</a>;</div>
|
|
<div class="line"><a name="l00776"></a><span class="lineno"> 776</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a> = size;</div>
|
|
<div class="line"><a name="l00777"></a><span class="lineno"> 777</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a396b36ceef993c32f28b1354727a5e9e">bmCBWFlags</a> = <a class="code" href="masstorage_8h.html#a012ee34e4ce8d644c2f75099867b26c0">MASS_CMD_DIR_IN</a>;</div>
|
|
<div class="line"><a name="l00778"></a><span class="lineno"> 778</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2a16bb9a98e3ee4eaac8fea6310b4e01">bmCBWLUN</a> = lun;</div>
|
|
<div class="line"><a name="l00779"></a><span class="lineno"> 779</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a069c89f584abbf45c13ebb85ca906494">bmCBWCBLength</a> = 6;</div>
|
|
<div class="line"><a name="l00780"></a><span class="lineno"> 780</span> </div>
|
|
<div class="line"><a name="l00781"></a><span class="lineno"> 781</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 16; i++)</div>
|
|
<div class="line"><a name="l00782"></a><span class="lineno"> 782</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[i] = 0;</div>
|
|
<div class="line"><a name="l00783"></a><span class="lineno"> 783</span> </div>
|
|
<div class="line"><a name="l00784"></a><span class="lineno"> 784</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[0] = <a class="code" href="masstorage_8h.html#ad0ffafc58d70417e80425b2ee80c1769">SCSI_CMD_REQUEST_SENSE</a>;</div>
|
|
<div class="line"><a name="l00785"></a><span class="lineno"> 785</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[1] = lun << 5;</div>
|
|
<div class="line"><a name="l00786"></a><span class="lineno"> 786</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[4] = size;</div>
|
|
<div class="line"><a name="l00787"></a><span class="lineno"> 787</span> </div>
|
|
<div class="line"><a name="l00788"></a><span class="lineno"> 788</span>  <span class="keywordflow">return</span> Transaction(&cbw, size, buf, 0);</div>
|
|
<div class="line"><a name="l00789"></a><span class="lineno"> 789</span> }</div>
|
|
<div class="line"><a name="l00790"></a><span class="lineno"> 790</span> </div>
|
|
<div class="line"><a name="l00799"></a><span class="lineno"> 799</span> uint8_t BulkOnly::ReadCapacity(uint8_t lun, uint16_t bsize, uint8_t *buf) {</div>
|
|
<div class="line"><a name="l00800"></a><span class="lineno"> 800</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nReadCapacity\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00801"></a><span class="lineno"> 801</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"---------------\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00802"></a><span class="lineno"> 802</span>  <a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a> cbw;</div>
|
|
<div class="line"><a name="l00803"></a><span class="lineno"> 803</span> </div>
|
|
<div class="line"><a name="l00804"></a><span class="lineno"> 804</span>  SetCurLUN(lun);</div>
|
|
<div class="line"><a name="l00805"></a><span class="lineno"> 805</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a133ffc8ac9be6ce284f10efece567748">dCBWSignature</a> = <a class="code" href="masstorage_8h.html#a439c9558fff25c40219c0f20244e666d">MASS_CBW_SIGNATURE</a>;</div>
|
|
<div class="line"><a name="l00806"></a><span class="lineno"> 806</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a> = ++<a class="code" href="class_bulk_only.html#a7ae682d50badd1386a06f30f35a32d1d">dCBWTag</a>;</div>
|
|
<div class="line"><a name="l00807"></a><span class="lineno"> 807</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a> = bsize;</div>
|
|
<div class="line"><a name="l00808"></a><span class="lineno"> 808</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a396b36ceef993c32f28b1354727a5e9e">bmCBWFlags</a> = <a class="code" href="masstorage_8h.html#a012ee34e4ce8d644c2f75099867b26c0">MASS_CMD_DIR_IN</a>;</div>
|
|
<div class="line"><a name="l00809"></a><span class="lineno"> 809</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2a16bb9a98e3ee4eaac8fea6310b4e01">bmCBWLUN</a> = lun;</div>
|
|
<div class="line"><a name="l00810"></a><span class="lineno"> 810</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a069c89f584abbf45c13ebb85ca906494">bmCBWCBLength</a> = 10;</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">for</span> (uint8_t i = 0; i < 16; i++)</div>
|
|
<div class="line"><a name="l00813"></a><span class="lineno"> 813</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[i] = 0;</div>
|
|
<div class="line"><a name="l00814"></a><span class="lineno"> 814</span> </div>
|
|
<div class="line"><a name="l00815"></a><span class="lineno"> 815</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[0] = <a class="code" href="masstorage_8h.html#a1f08c7a277432486b2f875035df6790b">SCSI_CMD_READ_CAPACITY_10</a>;</div>
|
|
<div class="line"><a name="l00816"></a><span class="lineno"> 816</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[1] = lun << 5;</div>
|
|
<div class="line"><a name="l00817"></a><span class="lineno"> 817</span> </div>
|
|
<div class="line"><a name="l00818"></a><span class="lineno"> 818</span>  <span class="keywordflow">return</span> HandleSCSIError(Transaction(&cbw, bsize, buf, 0));</div>
|
|
<div class="line"><a name="l00819"></a><span class="lineno"> 819</span> }</div>
|
|
<div class="line"><a name="l00820"></a><span class="lineno"> 820</span> </div>
|
|
<div class="line"><a name="l00827"></a><span class="lineno"> 827</span> uint8_t BulkOnly::TestUnitReady(uint8_t lun) {</div>
|
|
<div class="line"><a name="l00828"></a><span class="lineno"> 828</span>  SetCurLUN(lun);</div>
|
|
<div class="line"><a name="l00829"></a><span class="lineno"> 829</span>  <span class="keywordflow">if</span> (!<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>)</div>
|
|
<div class="line"><a name="l00830"></a><span class="lineno"> 830</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a128e4910df8d7770c6f9af7700b9ccb1">MASS_ERR_UNIT_NOT_READY</a>;</div>
|
|
<div class="line"><a name="l00831"></a><span class="lineno"> 831</span> </div>
|
|
<div class="line"><a name="l00832"></a><span class="lineno"> 832</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nTestUnitReady\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00833"></a><span class="lineno"> 833</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"-----------------\r\n"</span>), 0x80);</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>  <a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a> cbw;</div>
|
|
<div class="line"><a name="l00836"></a><span class="lineno"> 836</span>  uint8_t rc;</div>
|
|
<div class="line"><a name="l00837"></a><span class="lineno"> 837</span> </div>
|
|
<div class="line"><a name="l00838"></a><span class="lineno"> 838</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a133ffc8ac9be6ce284f10efece567748">dCBWSignature</a> = <a class="code" href="masstorage_8h.html#a439c9558fff25c40219c0f20244e666d">MASS_CBW_SIGNATURE</a>;</div>
|
|
<div class="line"><a name="l00839"></a><span class="lineno"> 839</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a> = ++<a class="code" href="class_bulk_only.html#a7ae682d50badd1386a06f30f35a32d1d">dCBWTag</a>;</div>
|
|
<div class="line"><a name="l00840"></a><span class="lineno"> 840</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a> = 0;</div>
|
|
<div class="line"><a name="l00841"></a><span class="lineno"> 841</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a396b36ceef993c32f28b1354727a5e9e">bmCBWFlags</a> = <a class="code" href="masstorage_8h.html#ad74d783991b5eea6ad8ef2feb2ce03ea">MASS_CMD_DIR_OUT</a>;</div>
|
|
<div class="line"><a name="l00842"></a><span class="lineno"> 842</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2a16bb9a98e3ee4eaac8fea6310b4e01">bmCBWLUN</a> = lun;</div>
|
|
<div class="line"><a name="l00843"></a><span class="lineno"> 843</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a069c89f584abbf45c13ebb85ca906494">bmCBWCBLength</a> = 6;</div>
|
|
<div class="line"><a name="l00844"></a><span class="lineno"> 844</span> </div>
|
|
<div class="line"><a name="l00845"></a><span class="lineno"> 845</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 16; i++)</div>
|
|
<div class="line"><a name="l00846"></a><span class="lineno"> 846</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[i] = 0;</div>
|
|
<div class="line"><a name="l00847"></a><span class="lineno"> 847</span> </div>
|
|
<div class="line"><a name="l00848"></a><span class="lineno"> 848</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[0] = <a class="code" href="masstorage_8h.html#aa84c8ac327fad55b9d0e40fea9eda699">SCSI_CMD_TEST_UNIT_READY</a>;</div>
|
|
<div class="line"><a name="l00849"></a><span class="lineno"> 849</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[1] = lun;</div>
|
|
<div class="line"><a name="l00850"></a><span class="lineno"> 850</span>  rc = HandleSCSIError(Transaction(&cbw, 0, NULL, 0));</div>
|
|
<div class="line"><a name="l00851"></a><span class="lineno"> 851</span>  <span class="keywordflow">return</span> (rc);</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="l00862"></a><span class="lineno"> 862</span> uint8_t BulkOnly::Page3F(uint8_t lun) {</div>
|
|
<div class="line"><a name="l00863"></a><span class="lineno"> 863</span>  uint8_t buf[192];</div>
|
|
<div class="line"><a name="l00864"></a><span class="lineno"> 864</span>  <span class="keywordflow">for</span> (<span class="keywordtype">int</span> i = 0; i < 192; i++) {</div>
|
|
<div class="line"><a name="l00865"></a><span class="lineno"> 865</span>  buf[i] = 0x00;</div>
|
|
<div class="line"><a name="l00866"></a><span class="lineno"> 866</span>  }</div>
|
|
<div class="line"><a name="l00867"></a><span class="lineno"> 867</span>  <a class="code" href="class_bulk_only.html#af763ffffdd131949322d583fb4cd2737">WriteOk</a>[lun] = <span class="keyword">true</span>;</div>
|
|
<div class="line"><a name="l00868"></a><span class="lineno"> 868</span>  uint8_t rc = ModeSense(lun, 0, 0x3f, 0, 192, buf);</div>
|
|
<div class="line"><a name="l00869"></a><span class="lineno"> 869</span>  <span class="keywordflow">if</span> (!rc) {</div>
|
|
<div class="line"><a name="l00870"></a><span class="lineno"> 870</span>  <a class="code" href="class_bulk_only.html#af763ffffdd131949322d583fb4cd2737">WriteOk</a>[lun] = ((buf[2] & 0x80) == 0);</div>
|
|
<div class="line"><a name="l00871"></a><span class="lineno"> 871</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"Mode Sense: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00872"></a><span class="lineno"> 872</span>  <span class="keywordflow">for</span> (<span class="keywordtype">int</span> i = 0; i < 4; i++) {</div>
|
|
<div class="line"><a name="l00873"></a><span class="lineno"> 873</span>  D_PrintHex<uint8_t > (buf[i], 0x80);</div>
|
|
<div class="line"><a name="l00874"></a><span class="lineno"> 874</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">" "</span>), 0x80);</div>
|
|
<div class="line"><a name="l00875"></a><span class="lineno"> 875</span>  }</div>
|
|
<div class="line"><a name="l00876"></a><span class="lineno"> 876</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00877"></a><span class="lineno"> 877</span>  }</div>
|
|
<div class="line"><a name="l00878"></a><span class="lineno"> 878</span>  <span class="keywordflow">return</span> rc;</div>
|
|
<div class="line"><a name="l00879"></a><span class="lineno"> 879</span> }</div>
|
|
<div class="line"><a name="l00880"></a><span class="lineno"> 880</span> </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="l00884"></a><span class="lineno"> 884</span> </div>
|
|
<div class="line"><a name="l00885"></a><span class="lineno"> 885</span> </div>
|
|
<div class="line"><a name="l00886"></a><span class="lineno"> 886</span> <span class="comment">// USB code</span></div>
|
|
<div class="line"><a name="l00887"></a><span class="lineno"> 887</span> </div>
|
|
<div class="line"><a name="l00888"></a><span class="lineno"> 888</span> </div>
|
|
<div class="line"><a name="l00890"></a><span class="lineno"> 890</span> </div>
|
|
<div class="line"><a name="l00891"></a><span class="lineno"> 891</span> </div>
|
|
<div class="line"><a name="l00892"></a><span class="lineno"> 892</span> </div>
|
|
<div class="line"><a name="l00899"></a><span class="lineno"> 899</span> uint8_t BulkOnly::ClearEpHalt(uint8_t index) {</div>
|
|
<div class="line"><a name="l00900"></a><span class="lineno"> 900</span>  <span class="keywordflow">if</span> (index == 0)</div>
|
|
<div class="line"><a name="l00901"></a><span class="lineno"> 901</span>  <span class="keywordflow">return</span> 0;</div>
|
|
<div class="line"><a name="l00902"></a><span class="lineno"> 902</span> </div>
|
|
<div class="line"><a name="l00903"></a><span class="lineno"> 903</span>  uint8_t ret = 0;</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>  <span class="keywordflow">while</span> (ret = (<a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a636695a5c3d35cd6b9e31c54edfacd7c">ctrlReq</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, 0, <a class="code" href="usb__ch9_8h.html#a610dad02930a3061c746f84885e1e11e">USB_SETUP_HOST_TO_DEVICE</a> | <a class="code" href="usb__ch9_8h.html#a3b51a35acaa76cafbb987c07186a7868">USB_SETUP_TYPE_STANDARD</a> | <a class="code" href="usb__ch9_8h.html#ac6ef27ac78140749f3607246f21c1471">USB_SETUP_RECIPIENT_ENDPOINT</a>,</div>
|
|
<div class="line"><a name="l00906"></a><span class="lineno"> 906</span>  <a class="code" href="usb__ch9_8h.html#ab9fe860caa1f21c9410984a24bf57c7c">USB_REQUEST_CLEAR_FEATURE</a>, <a class="code" href="usb__ch9_8h.html#a0a75e9871273bf2c40d1d9aa1641c8ce">USB_FEATURE_ENDPOINT_HALT</a>, 0, ((index == <a class="code" href="class_bulk_only.html#a9e487226408578a2971570bcf7de62fe">epDataInIndex</a>) ? (0x80 | <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[index].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a>) : <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[index].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a>), 0, 0, NULL, NULL))</div>
|
|
<div class="line"><a name="l00907"></a><span class="lineno"> 907</span>  == 0x01) delay(6);</div>
|
|
<div class="line"><a name="l00908"></a><span class="lineno"> 908</span> </div>
|
|
<div class="line"><a name="l00909"></a><span class="lineno"> 909</span>  <span class="keywordflow">if</span> (ret) {</div>
|
|
<div class="line"><a name="l00910"></a><span class="lineno"> 910</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"ClearEpHalt"</span>), ret);</div>
|
|
<div class="line"><a name="l00911"></a><span class="lineno"> 911</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"EP"</span>), ((index == <a class="code" href="class_bulk_only.html#a9e487226408578a2971570bcf7de62fe">epDataInIndex</a>) ? (0x80 | <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[index].epAddr) : <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[index].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a>));</div>
|
|
<div class="line"><a name="l00912"></a><span class="lineno"> 912</span>  <span class="keywordflow">return</span> ret;</div>
|
|
<div class="line"><a name="l00913"></a><span class="lineno"> 913</span>  }</div>
|
|
<div class="line"><a name="l00914"></a><span class="lineno"> 914</span>  <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[index].<a class="code" href="struct_ep_info.html#ac85bff70ad0e5d71e50cb501f4d8caf3">bmSndToggle</a> = 0;</div>
|
|
<div class="line"><a name="l00915"></a><span class="lineno"> 915</span>  <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[index].<a class="code" href="struct_ep_info.html#a9238dd40c096baedf041c98b19386a14">bmRcvToggle</a> = 0;</div>
|
|
<div class="line"><a name="l00916"></a><span class="lineno"> 916</span>  <span class="comment">// epAttribs = 0;</span></div>
|
|
<div class="line"><a name="l00917"></a><span class="lineno"> 917</span>  <span class="keywordflow">return</span> 0;</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="l00924"></a><span class="lineno"> 924</span> <span class="keywordtype">void</span> BulkOnly::Reset() {</div>
|
|
<div class="line"><a name="l00925"></a><span class="lineno"> 925</span>  <span class="keywordflow">while</span> (<a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a636695a5c3d35cd6b9e31c54edfacd7c">ctrlReq</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, 0, <a class="code" href="masstorage_8h.html#a86a509a216410b0e356f0fa91c48cdc0">bmREQ_MASSOUT</a>, <a class="code" href="masstorage_8h.html#a172c269d960fa57ce6dfeaacc6f6197f">MASS_REQ_BOMSR</a>, 0, 0, <a class="code" href="class_bulk_only.html#ac18ad598cd9a1ee99f49d51a572a50a4">bIface</a>, 0, 0, NULL, NULL) == 0x01) delay(6);</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="l00933"></a><span class="lineno"> 933</span> uint8_t BulkOnly::ResetRecovery() {</div>
|
|
<div class="line"><a name="l00934"></a><span class="lineno"> 934</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nResetRecovery\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00935"></a><span class="lineno"> 935</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"-----------------\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00936"></a><span class="lineno"> 936</span> </div>
|
|
<div class="line"><a name="l00937"></a><span class="lineno"> 937</span>  delay(6);</div>
|
|
<div class="line"><a name="l00938"></a><span class="lineno"> 938</span>  Reset();</div>
|
|
<div class="line"><a name="l00939"></a><span class="lineno"> 939</span>  delay(6);</div>
|
|
<div class="line"><a name="l00940"></a><span class="lineno"> 940</span>  ClearEpHalt(<a class="code" href="class_bulk_only.html#a9e487226408578a2971570bcf7de62fe">epDataInIndex</a>);</div>
|
|
<div class="line"><a name="l00941"></a><span class="lineno"> 941</span>  delay(6);</div>
|
|
<div class="line"><a name="l00942"></a><span class="lineno"> 942</span>  <a class="code" href="class_bulk_only.html#a20ff3cc4bb15c557f57a8c6200b412d1">bLastUsbError</a> = ClearEpHalt(<a class="code" href="class_bulk_only.html#a8d527bdc285870f3571481a4fd982721">epDataOutIndex</a>);</div>
|
|
<div class="line"><a name="l00943"></a><span class="lineno"> 943</span>  delay(6);</div>
|
|
<div class="line"><a name="l00944"></a><span class="lineno"> 944</span>  <span class="keywordflow">return</span> <a class="code" href="class_bulk_only.html#a20ff3cc4bb15c557f57a8c6200b412d1">bLastUsbError</a>;</div>
|
|
<div class="line"><a name="l00945"></a><span class="lineno"> 945</span> }</div>
|
|
<div class="line"><a name="l00946"></a><span class="lineno"> 946</span> </div>
|
|
<div class="line"><a name="l00952"></a><span class="lineno"> 952</span> <span class="keywordtype">void</span> BulkOnly::ClearAllEP() {</div>
|
|
<div class="line"><a name="l00953"></a><span class="lineno"> 953</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < <a class="code" href="masstorage_8h.html#ab4baa1ea500923e1fc59e5991f05fe99">MASS_MAX_ENDPOINTS</a>; i++) {</div>
|
|
<div class="line"><a name="l00954"></a><span class="lineno"> 954</span>  <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[i].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a> = 0;</div>
|
|
<div class="line"><a name="l00955"></a><span class="lineno"> 955</span>  <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[i].<a class="code" href="struct_ep_info.html#aa2ca775b63736df4008e88da7dd4dddb">maxPktSize</a> = (i) ? 0 : 8;</div>
|
|
<div class="line"><a name="l00956"></a><span class="lineno"> 956</span>  <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[i].<a class="code" href="struct_ep_info.html#a1dea928517c961235eef7b0876e69f10">epAttribs</a> = 0;</div>
|
|
<div class="line"><a name="l00957"></a><span class="lineno"> 957</span> </div>
|
|
<div class="line"><a name="l00958"></a><span class="lineno"> 958</span>  <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[i].<a class="code" href="struct_ep_info.html#a3a5b1c017a034cd9e06e76729e727c46">bmNakPower</a> = <a class="code" href="address_8h.html#a622e49a2b6b99500654d24321983930e">USB_NAK_DEFAULT</a>;</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="keywordflow">for</span> (uint8_t i = 0; i < <a class="code" href="masstorage_8h.html#a68a8c3241954d2159ff8df696dd5cff6">MASS_MAX_SUPPORTED_LUN</a>; i++) <a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[i] = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00962"></a><span class="lineno"> 962</span>  <a class="code" href="class_bulk_only.html#ac18ad598cd9a1ee99f49d51a572a50a4">bIface</a> = 0;</div>
|
|
<div class="line"><a name="l00963"></a><span class="lineno"> 963</span>  <a class="code" href="class_bulk_only.html#a6cb56ebd0307845321340919e2b35952">bNumEP</a> = 1;</div>
|
|
<div class="line"><a name="l00964"></a><span class="lineno"> 964</span> </div>
|
|
<div class="line"><a name="l00965"></a><span class="lineno"> 965</span>  <a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a> = 0;</div>
|
|
<div class="line"><a name="l00966"></a><span class="lineno"> 966</span>  <a class="code" href="class_bulk_only.html#a2d422ee0745cd7c04afff905278c4233">qNextPollTime</a> = 0;</div>
|
|
<div class="line"><a name="l00967"></a><span class="lineno"> 967</span>  <a class="code" href="class_bulk_only.html#a21961ad1130480f534ef3e91f24c56a0">bPollEnable</a> = <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00968"></a><span class="lineno"> 968</span>  <a class="code" href="class_bulk_only.html#a20ff3cc4bb15c557f57a8c6200b412d1">bLastUsbError</a> = 0;</div>
|
|
<div class="line"><a name="l00969"></a><span class="lineno"> 969</span>  <a class="code" href="class_bulk_only.html#a6bbdd41bf6efc4060f3c36da7d6ed8b2">bMaxLUN</a> = 0;</div>
|
|
<div class="line"><a name="l00970"></a><span class="lineno"> 970</span>  <a class="code" href="class_bulk_only.html#a24c051d401f5f1a9ce65c1bc25ab02dd">bTheLUN</a> = 0;</div>
|
|
<div class="line"><a name="l00971"></a><span class="lineno"> 971</span> }</div>
|
|
<div class="line"><a name="l00972"></a><span class="lineno"> 972</span> </div>
|
|
<div class="line"><a name="l00973"></a><span class="lineno"> 973</span> </div>
|
|
<div class="line"><a name="l00981"></a><span class="lineno"> 981</span> <span class="keywordtype">bool</span> BulkOnly::IsValidCSW(<a class="code" href="struct_command_status_wrapper.html">CommandStatusWrapper</a> *pcsw, <a class="code" href="struct_command_block_wrapper_base.html">CommandBlockWrapperBase</a> *pcbw) {</div>
|
|
<div class="line"><a name="l00982"></a><span class="lineno"> 982</span>  <span class="keywordflow">if</span> (pcsw-><a class="code" href="struct_command_status_wrapper.html#a498a87759e737395829b6ff4b6420ad1">dCSWSignature</a> != <a class="code" href="masstorage_8h.html#af92587f54f4d56af3dd2fb3a474c0b33">MASS_CSW_SIGNATURE</a>) {</div>
|
|
<div class="line"><a name="l00983"></a><span class="lineno"> 983</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"CSW:Sig error\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00984"></a><span class="lineno"> 984</span>  <span class="comment">//printf("%lx != %lx\r\n", MASS_CSW_SIGNATURE, pcsw->dCSWSignature);</span></div>
|
|
<div class="line"><a name="l00985"></a><span class="lineno"> 985</span>  <span class="keywordflow">return</span> <span class="keyword">false</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>  <span class="keywordflow">if</span> (pcsw-><a class="code" href="struct_command_status_wrapper.html#af872c29cfee3fb74e7ad9471ee4461fb">dCSWTag</a> != pcbw-><a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a>) {</div>
|
|
<div class="line"><a name="l00988"></a><span class="lineno"> 988</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"CSW:Wrong tag\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l00989"></a><span class="lineno"> 989</span>  <span class="comment">//printf("%lx != %lx\r\n", pcsw->dCSWTag, pcbw->dCBWTag);</span></div>
|
|
<div class="line"><a name="l00990"></a><span class="lineno"> 990</span>  <span class="keywordflow">return</span> <span class="keyword">false</span>;</div>
|
|
<div class="line"><a name="l00991"></a><span class="lineno"> 991</span>  }</div>
|
|
<div class="line"><a name="l00992"></a><span class="lineno"> 992</span>  <span class="keywordflow">return</span> <span class="keyword">true</span>;</div>
|
|
<div class="line"><a name="l00993"></a><span class="lineno"> 993</span> }</div>
|
|
<div class="line"><a name="l00994"></a><span class="lineno"> 994</span> </div>
|
|
<div class="line"><a name="l01002"></a><span class="lineno"> 1002</span> uint8_t BulkOnly::HandleUsbError(uint8_t error, uint8_t index) {</div>
|
|
<div class="line"><a name="l01003"></a><span class="lineno"> 1003</span>  uint8_t count = 3;</div>
|
|
<div class="line"><a name="l01004"></a><span class="lineno"> 1004</span> </div>
|
|
<div class="line"><a name="l01005"></a><span class="lineno"> 1005</span>  <a class="code" href="class_bulk_only.html#a20ff3cc4bb15c557f57a8c6200b412d1">bLastUsbError</a> = error;</div>
|
|
<div class="line"><a name="l01006"></a><span class="lineno"> 1006</span>  <span class="comment">//if (error)</span></div>
|
|
<div class="line"><a name="l01007"></a><span class="lineno"> 1007</span>  <span class="comment">//ClearEpHalt(index);</span></div>
|
|
<div class="line"><a name="l01008"></a><span class="lineno"> 1008</span>  <span class="keywordflow">while</span> (error && count) {</div>
|
|
<div class="line"><a name="l01009"></a><span class="lineno"> 1009</span>  <span class="keywordflow">if</span> (error != <a class="code" href="max3421e_8h.html#aea69e77cdc2b4124122d0fbda7e37019">hrSUCCESS</a>) {</div>
|
|
<div class="line"><a name="l01010"></a><span class="lineno"> 1010</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"USB Error"</span>), error);</div>
|
|
<div class="line"><a name="l01011"></a><span class="lineno"> 1011</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"Index"</span>), index);</div>
|
|
<div class="line"><a name="l01012"></a><span class="lineno"> 1012</span>  }</div>
|
|
<div class="line"><a name="l01013"></a><span class="lineno"> 1013</span>  <span class="keywordflow">switch</span> (error) {</div>
|
|
<div class="line"><a name="l01014"></a><span class="lineno"> 1014</span>  <span class="comment">// case hrWRONGPID:</span></div>
|
|
<div class="line"><a name="l01015"></a><span class="lineno"> 1015</span>  <span class="keywordflow">case</span> <a class="code" href="max3421e_8h.html#aea69e77cdc2b4124122d0fbda7e37019">hrSUCCESS</a>:</div>
|
|
<div class="line"><a name="l01016"></a><span class="lineno"> 1016</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a450c2a67aa2b6a1f6593113dcb847569">MASS_ERR_SUCCESS</a>;</div>
|
|
<div class="line"><a name="l01017"></a><span class="lineno"> 1017</span>  <span class="keywordflow">case</span> <a class="code" href="max3421e_8h.html#aee07a5ab9d40160fa57eeb9df922a27b">hrBUSY</a>:</div>
|
|
<div class="line"><a name="l01018"></a><span class="lineno"> 1018</span>  <span class="comment">// SIE is busy, just hang out and try again.</span></div>
|
|
<div class="line"><a name="l01019"></a><span class="lineno"> 1019</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#ab8e02094ea448728c4229e348c90cc54">MASS_ERR_UNIT_BUSY</a>;</div>
|
|
<div class="line"><a name="l01020"></a><span class="lineno"> 1020</span>  <span class="keywordflow">case</span> <a class="code" href="max3421e_8h.html#ab4e9ff11b75e71171814fdab1ff7ce45">hrTIMEOUT</a>:</div>
|
|
<div class="line"><a name="l01021"></a><span class="lineno"> 1021</span>  <span class="keywordflow">case</span> <a class="code" href="max3421e_8h.html#aa128de549704094dadb93daa8875472b">hrJERR</a>: <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a75359f810ebeccd313e4ad9c3a88f231">MASS_ERR_DEVICE_DISCONNECTED</a>;</div>
|
|
<div class="line"><a name="l01022"></a><span class="lineno"> 1022</span>  <span class="keywordflow">case</span> <a class="code" href="max3421e_8h.html#a774ac66066335e580da2b8cdab52df30">hrSTALL</a>:</div>
|
|
<div class="line"><a name="l01023"></a><span class="lineno"> 1023</span>  <span class="keywordflow">if</span> (index == 0)</div>
|
|
<div class="line"><a name="l01024"></a><span class="lineno"> 1024</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a13aee9eab965d570a4a00463cd20ca29">MASS_ERR_STALL</a>;</div>
|
|
<div class="line"><a name="l01025"></a><span class="lineno"> 1025</span>  ClearEpHalt(index);</div>
|
|
<div class="line"><a name="l01026"></a><span class="lineno"> 1026</span>  <span class="keywordflow">if</span> (index != <a class="code" href="class_bulk_only.html#a9e487226408578a2971570bcf7de62fe">epDataInIndex</a>)</div>
|
|
<div class="line"><a name="l01027"></a><span class="lineno"> 1027</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a1b4efb4cfc2b0d4a912abe587a145b84">MASS_ERR_WRITE_STALL</a>;</div>
|
|
<div class="line"><a name="l01028"></a><span class="lineno"> 1028</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a13aee9eab965d570a4a00463cd20ca29">MASS_ERR_STALL</a>;</div>
|
|
<div class="line"><a name="l01029"></a><span class="lineno"> 1029</span> </div>
|
|
<div class="line"><a name="l01030"></a><span class="lineno"> 1030</span>  <span class="keywordflow">case</span> <a class="code" href="max3421e_8h.html#ab44a7968d08016b58d98951059c37076">hrNAK</a>:</div>
|
|
<div class="line"><a name="l01031"></a><span class="lineno"> 1031</span>  <span class="keywordflow">if</span> (index == 0)</div>
|
|
<div class="line"><a name="l01032"></a><span class="lineno"> 1032</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#ab8e02094ea448728c4229e348c90cc54">MASS_ERR_UNIT_BUSY</a>;</div>
|
|
<div class="line"><a name="l01033"></a><span class="lineno"> 1033</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#ab8e02094ea448728c4229e348c90cc54">MASS_ERR_UNIT_BUSY</a>;</div>
|
|
<div class="line"><a name="l01034"></a><span class="lineno"> 1034</span>  <span class="comment">//ClearEpHalt(index);</span></div>
|
|
<div class="line"><a name="l01035"></a><span class="lineno"> 1035</span>  <span class="comment">//ResetRecovery();</span></div>
|
|
<div class="line"><a name="l01036"></a><span class="lineno"> 1036</span>  <span class="comment">//if (index != epDataInIndex)</span></div>
|
|
<div class="line"><a name="l01037"></a><span class="lineno"> 1037</span>  <span class="comment">// return MASS_ERR_WRITE_NAKS;</span></div>
|
|
<div class="line"><a name="l01038"></a><span class="lineno"> 1038</span>  <span class="comment">//return MASS_ERR_READ_NAKS;</span></div>
|
|
<div class="line"><a name="l01039"></a><span class="lineno"> 1039</span>  <span class="keywordflow">case</span> <a class="code" href="max3421e_8h.html#a651e9347e706d3cb16357c656a7e9c8f">hrTOGERR</a>:</div>
|
|
<div class="line"><a name="l01040"></a><span class="lineno"> 1040</span>  <span class="comment">// Handle a very super rare corner case, where toggles become de-synched.</span></div>
|
|
<div class="line"><a name="l01041"></a><span class="lineno"> 1041</span>  <span class="comment">// I have only ran into one device that has this firmware bug, and this is</span></div>
|
|
<div class="line"><a name="l01042"></a><span class="lineno"> 1042</span>  <span class="comment">// the only clean way to get back into sync with the buggy device firmware.</span></div>
|
|
<div class="line"><a name="l01043"></a><span class="lineno"> 1043</span>  <span class="comment">// --AJK</span></div>
|
|
<div class="line"><a name="l01044"></a><span class="lineno"> 1044</span>  <span class="keywordflow">if</span> (<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a> && <a class="code" href="class_bulk_only.html#ab54f472ec9cd39abdb9f90867943d162">bConfNum</a>) {</div>
|
|
<div class="line"><a name="l01045"></a><span class="lineno"> 1045</span>  error = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#a31e2c132ec32ffdde94dff72be87c378">setConf</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, 0, <a class="code" href="class_bulk_only.html#ab54f472ec9cd39abdb9f90867943d162">bConfNum</a>);</div>
|
|
<div class="line"><a name="l01046"></a><span class="lineno"> 1046</span> </div>
|
|
<div class="line"><a name="l01047"></a><span class="lineno"> 1047</span>  <span class="keywordflow">if</span> (error)</div>
|
|
<div class="line"><a name="l01048"></a><span class="lineno"> 1048</span>  <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l01049"></a><span class="lineno"> 1049</span>  }</div>
|
|
<div class="line"><a name="l01050"></a><span class="lineno"> 1050</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a450c2a67aa2b6a1f6593113dcb847569">MASS_ERR_SUCCESS</a>;</div>
|
|
<div class="line"><a name="l01051"></a><span class="lineno"> 1051</span>  <span class="keywordflow">default</span>:</div>
|
|
<div class="line"><a name="l01052"></a><span class="lineno"> 1052</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"\r\nUSB"</span>), error);</div>
|
|
<div class="line"><a name="l01053"></a><span class="lineno"> 1053</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a6c2dcf2fe5e2bead7ce82793de900eaf">MASS_ERR_GENERAL_USB_ERROR</a>;</div>
|
|
<div class="line"><a name="l01054"></a><span class="lineno"> 1054</span>  }</div>
|
|
<div class="line"><a name="l01055"></a><span class="lineno"> 1055</span>  count--;</div>
|
|
<div class="line"><a name="l01056"></a><span class="lineno"> 1056</span>  } <span class="comment">// while</span></div>
|
|
<div class="line"><a name="l01057"></a><span class="lineno"> 1057</span> </div>
|
|
<div class="line"><a name="l01058"></a><span class="lineno"> 1058</span>  <span class="keywordflow">return</span> ((error && !count) ? <a class="code" href="masstorage_8h.html#a6c2dcf2fe5e2bead7ce82793de900eaf">MASS_ERR_GENERAL_USB_ERROR</a> : <a class="code" href="masstorage_8h.html#a450c2a67aa2b6a1f6593113dcb847569">MASS_ERR_SUCCESS</a>);</div>
|
|
<div class="line"><a name="l01059"></a><span class="lineno"> 1059</span> }</div>
|
|
<div class="line"><a name="l01060"></a><span class="lineno"> 1060</span> </div>
|
|
<div class="line"><a name="l01070"></a><span class="lineno"> 1070</span> uint8_t BulkOnly::Transaction(<a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a> *pcbw, uint16_t buf_size, <span class="keywordtype">void</span> *buf, uint8_t flags) {</div>
|
|
<div class="line"><a name="l01071"></a><span class="lineno"> 1071</span>  uint16_t bytes = (pcbw-><a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a> > buf_size) ? buf_size : pcbw-><a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a>;</div>
|
|
<div class="line"><a name="l01072"></a><span class="lineno"> 1072</span>  <span class="keywordtype">boolean</span> write = (pcbw-><a class="code" href="struct_command_block_wrapper_base.html#a396b36ceef993c32f28b1354727a5e9e">bmCBWFlags</a> & <a class="code" href="masstorage_8h.html#a012ee34e4ce8d644c2f75099867b26c0">MASS_CMD_DIR_IN</a>) != <a class="code" href="masstorage_8h.html#a012ee34e4ce8d644c2f75099867b26c0">MASS_CMD_DIR_IN</a>;</div>
|
|
<div class="line"><a name="l01073"></a><span class="lineno"> 1073</span>  <span class="keywordtype">boolean</span> callback = (flags & <a class="code" href="masstorage_8h.html#a597e2a0f4ee36172c260976af9805415">MASS_TRANS_FLG_CALLBACK</a>) == <a class="code" href="masstorage_8h.html#a597e2a0f4ee36172c260976af9805415">MASS_TRANS_FLG_CALLBACK</a>;</div>
|
|
<div class="line"><a name="l01074"></a><span class="lineno"> 1074</span>  uint8_t ret = 0;</div>
|
|
<div class="line"><a name="l01075"></a><span class="lineno"> 1075</span>  uint8_t usberr;</div>
|
|
<div class="line"><a name="l01076"></a><span class="lineno"> 1076</span>  <a class="code" href="struct_command_status_wrapper.html">CommandStatusWrapper</a> csw; <span class="comment">// up here, we allocate ahead to save cpu cycles.</span></div>
|
|
<div class="line"><a name="l01077"></a><span class="lineno"> 1077</span>  <span class="comment">// Fix reserved bits.</span></div>
|
|
<div class="line"><a name="l01078"></a><span class="lineno"> 1078</span>  pcbw-><a class="code" href="struct_command_block_wrapper.html#a4954eacb2cd6d0ee7be475da3b46d907">bmReserved1</a> = 0;</div>
|
|
<div class="line"><a name="l01079"></a><span class="lineno"> 1079</span>  pcbw-><a class="code" href="struct_command_block_wrapper.html#ac651509a5fc7789ba59d21fe94c55e77">bmReserved2</a> = 0;</div>
|
|
<div class="line"><a name="l01080"></a><span class="lineno"> 1080</span>  ErrorMessage<uint32_t > (PSTR(<span class="stringliteral">"CBW.dCBWTag"</span>), pcbw-><a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a>);</div>
|
|
<div class="line"><a name="l01081"></a><span class="lineno"> 1081</span> </div>
|
|
<div class="line"><a name="l01082"></a><span class="lineno"> 1082</span>  <span class="keywordflow">while</span> ((usberr = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#affbc018973a588995457d535b0ac7ee7">outTransfer</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[<a class="code" href="class_bulk_only.html#a8d527bdc285870f3571481a4fd982721">epDataOutIndex</a>].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a>, sizeof (<a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a>), (uint8_t*)pcbw)) == <a class="code" href="max3421e_8h.html#aee07a5ab9d40160fa57eeb9df922a27b">hrBUSY</a>) delay(1);</div>
|
|
<div class="line"><a name="l01083"></a><span class="lineno"> 1083</span> </div>
|
|
<div class="line"><a name="l01084"></a><span class="lineno"> 1084</span>  ret = HandleUsbError(usberr, epDataOutIndex);</div>
|
|
<div class="line"><a name="l01085"></a><span class="lineno"> 1085</span>  <span class="comment">//ret = HandleUsbError(pUsb->outTransfer(bAddress, epInfo[epDataOutIndex].epAddr, sizeof (CommandBlockWrapper), (uint8_t*)pcbw), epDataOutIndex);</span></div>
|
|
<div class="line"><a name="l01086"></a><span class="lineno"> 1086</span>  <span class="keywordflow">if</span> (ret) {</div>
|
|
<div class="line"><a name="l01087"></a><span class="lineno"> 1087</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"============================ CBW"</span>), ret);</div>
|
|
<div class="line"><a name="l01088"></a><span class="lineno"> 1088</span>  } <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l01089"></a><span class="lineno"> 1089</span>  <span class="keywordflow">if</span> (bytes) {</div>
|
|
<div class="line"><a name="l01090"></a><span class="lineno"> 1090</span>  <span class="keywordflow">if</span> (!write) {</div>
|
|
<div class="line"><a name="l01091"></a><span class="lineno"> 1091</span>  <span class="keywordflow">if</span> (callback) {</div>
|
|
<div class="line"><a name="l01092"></a><span class="lineno"> 1092</span>  uint8_t rbuf[bytes];</div>
|
|
<div class="line"><a name="l01093"></a><span class="lineno"> 1093</span>  <span class="keywordflow">while</span> ((usberr = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#ad75d64f648b102fab2bd75e53e1324a4">inTransfer</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[<a class="code" href="class_bulk_only.html#a9e487226408578a2971570bcf7de62fe">epDataInIndex</a>].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a>, &bytes, rbuf)) == <a class="code" href="max3421e_8h.html#aee07a5ab9d40160fa57eeb9df922a27b">hrBUSY</a>) delay(1);</div>
|
|
<div class="line"><a name="l01094"></a><span class="lineno"> 1094</span>  <span class="keywordflow">if</span> (usberr == <a class="code" href="max3421e_8h.html#aea69e77cdc2b4124122d0fbda7e37019">hrSUCCESS</a>) ((<a class="code" href="class_u_s_b_read_parser.html">USBReadParser</a>*)buf)->Parse(bytes, rbuf, 0);</div>
|
|
<div class="line"><a name="l01095"></a><span class="lineno"> 1095</span>  } <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l01096"></a><span class="lineno"> 1096</span>  <span class="keywordflow">while</span> ((usberr = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#ad75d64f648b102fab2bd75e53e1324a4">inTransfer</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[epDataInIndex].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a>, &bytes, (uint8_t*)buf)) == <a class="code" href="max3421e_8h.html#aee07a5ab9d40160fa57eeb9df922a27b">hrBUSY</a>) delay(1);</div>
|
|
<div class="line"><a name="l01097"></a><span class="lineno"> 1097</span>  }</div>
|
|
<div class="line"><a name="l01098"></a><span class="lineno"> 1098</span>  ret = HandleUsbError(usberr, epDataInIndex);</div>
|
|
<div class="line"><a name="l01099"></a><span class="lineno"> 1099</span>  } <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l01100"></a><span class="lineno"> 1100</span>  <span class="keywordflow">while</span> ((usberr = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#affbc018973a588995457d535b0ac7ee7">outTransfer</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[epDataOutIndex].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a>, bytes, (uint8_t*)buf)) == <a class="code" href="max3421e_8h.html#aee07a5ab9d40160fa57eeb9df922a27b">hrBUSY</a>) delay(1);</div>
|
|
<div class="line"><a name="l01101"></a><span class="lineno"> 1101</span>  ret = HandleUsbError(usberr, epDataOutIndex);</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>  <span class="keywordflow">if</span> (ret) {</div>
|
|
<div class="line"><a name="l01104"></a><span class="lineno"> 1104</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"============================ DAT"</span>), ret);</div>
|
|
<div class="line"><a name="l01105"></a><span class="lineno"> 1105</span>  }</div>
|
|
<div class="line"><a name="l01106"></a><span class="lineno"> 1106</span>  }</div>
|
|
<div class="line"><a name="l01107"></a><span class="lineno"> 1107</span>  }</div>
|
|
<div class="line"><a name="l01108"></a><span class="lineno"> 1108</span> </div>
|
|
<div class="line"><a name="l01109"></a><span class="lineno"> 1109</span>  <span class="comment">//if (!ret || ret == MASS_ERR_WRITE_STALL || ret == MASS_ERR_STALL) {</span></div>
|
|
<div class="line"><a name="l01110"></a><span class="lineno"> 1110</span>  {</div>
|
|
<div class="line"><a name="l01111"></a><span class="lineno"> 1111</span>  bytes = <span class="keyword">sizeof</span> (<a class="code" href="struct_command_status_wrapper.html">CommandStatusWrapper</a>);</div>
|
|
<div class="line"><a name="l01112"></a><span class="lineno"> 1112</span>  <span class="keywordtype">int</span> tries = 2;</div>
|
|
<div class="line"><a name="l01113"></a><span class="lineno"> 1113</span>  <span class="keywordflow">while</span> (tries--) {</div>
|
|
<div class="line"><a name="l01114"></a><span class="lineno"> 1114</span>  <span class="keywordflow">while</span> ((usberr = <a class="code" href="class_bulk_only.html#a6b4ae384eea3aacd8bf916439621973a">pUsb</a>-><a class="code" href="class_u_s_b.html#ad75d64f648b102fab2bd75e53e1324a4">inTransfer</a>(<a class="code" href="class_bulk_only.html#a9968a2119df66fa0093b020e318d8ac6">bAddress</a>, <a class="code" href="class_bulk_only.html#aee2247fd0a251e4da36e8c09bbe6917f">epInfo</a>[epDataInIndex].<a class="code" href="struct_ep_info.html#a9f92be74c75c037b39e2cae1eb49b89b">epAddr</a>, &bytes, (uint8_t*) & csw)) == <a class="code" href="max3421e_8h.html#aee07a5ab9d40160fa57eeb9df922a27b">hrBUSY</a>) delay(1);</div>
|
|
<div class="line"><a name="l01115"></a><span class="lineno"> 1115</span>  <span class="keywordflow">if</span> (!usberr) <span class="keywordflow">break</span>;</div>
|
|
<div class="line"><a name="l01116"></a><span class="lineno"> 1116</span>  ClearEpHalt(epDataInIndex);</div>
|
|
<div class="line"><a name="l01117"></a><span class="lineno"> 1117</span>  <span class="comment">//HandleUsbError(usberr, epDataInIndex);</span></div>
|
|
<div class="line"><a name="l01118"></a><span class="lineno"> 1118</span>  <span class="keywordflow">if</span> (tries) ResetRecovery();</div>
|
|
<div class="line"><a name="l01119"></a><span class="lineno"> 1119</span>  }</div>
|
|
<div class="line"><a name="l01120"></a><span class="lineno"> 1120</span>  <span class="keywordflow">if</span> (!ret) {</div>
|
|
<div class="line"><a name="l01121"></a><span class="lineno"> 1121</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"CBW:\t\tOK\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01122"></a><span class="lineno"> 1122</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"Data Stage:\tOK\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01123"></a><span class="lineno"> 1123</span>  } <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l01124"></a><span class="lineno"> 1124</span>  <span class="comment">// Throw away csw, IT IS NOT OF ANY USE.</span></div>
|
|
<div class="line"><a name="l01125"></a><span class="lineno"> 1125</span>  <span class="comment">//HandleUsbError(usberr, epDataInIndex);</span></div>
|
|
<div class="line"><a name="l01126"></a><span class="lineno"> 1126</span>  ResetRecovery();</div>
|
|
<div class="line"><a name="l01127"></a><span class="lineno"> 1127</span>  <span class="keywordflow">return</span> ret;</div>
|
|
<div class="line"><a name="l01128"></a><span class="lineno"> 1128</span>  }</div>
|
|
<div class="line"><a name="l01129"></a><span class="lineno"> 1129</span>  ret = HandleUsbError(usberr, epDataInIndex);</div>
|
|
<div class="line"><a name="l01130"></a><span class="lineno"> 1130</span>  <span class="keywordflow">if</span> (ret) {</div>
|
|
<div class="line"><a name="l01131"></a><span class="lineno"> 1131</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"============================ CSW"</span>), ret);</div>
|
|
<div class="line"><a name="l01132"></a><span class="lineno"> 1132</span>  }</div>
|
|
<div class="line"><a name="l01133"></a><span class="lineno"> 1133</span>  <span class="keywordflow">if</span> (usberr == <a class="code" href="max3421e_8h.html#aea69e77cdc2b4124122d0fbda7e37019">hrSUCCESS</a>) {</div>
|
|
<div class="line"><a name="l01134"></a><span class="lineno"> 1134</span>  <span class="keywordflow">if</span> (IsValidCSW(&csw, pcbw)) {</div>
|
|
<div class="line"><a name="l01135"></a><span class="lineno"> 1135</span>  <span class="comment">//ErrorMessage<uint32_t > (PSTR("CSW.dCBWTag"), csw.dCSWTag);</span></div>
|
|
<div class="line"><a name="l01136"></a><span class="lineno"> 1136</span>  <span class="comment">//ErrorMessage<uint8_t > (PSTR("bCSWStatus"), csw.bCSWStatus);</span></div>
|
|
<div class="line"><a name="l01137"></a><span class="lineno"> 1137</span>  <span class="comment">//ErrorMessage<uint32_t > (PSTR("dCSWDataResidue"), csw.dCSWDataResidue);</span></div>
|
|
<div class="line"><a name="l01138"></a><span class="lineno"> 1138</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"CSW:\t\tOK\r\n\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01139"></a><span class="lineno"> 1139</span>  <span class="keywordflow">return</span> csw.<a class="code" href="struct_command_status_wrapper.html#a7170ed5bc0e2bbe04758e687beef4487">bCSWStatus</a>;</div>
|
|
<div class="line"><a name="l01140"></a><span class="lineno"> 1140</span>  } <span class="keywordflow">else</span> {</div>
|
|
<div class="line"><a name="l01141"></a><span class="lineno"> 1141</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"Invalid CSW\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01142"></a><span class="lineno"> 1142</span>  ResetRecovery();</div>
|
|
<div class="line"><a name="l01143"></a><span class="lineno"> 1143</span>  <span class="comment">//return MASS_ERR_SUCCESS;</span></div>
|
|
<div class="line"><a name="l01144"></a><span class="lineno"> 1144</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a8521fd3c4b7901296d3edae0632c162d">MASS_ERR_INVALID_CSW</a>;</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>  }</div>
|
|
<div class="line"><a name="l01147"></a><span class="lineno"> 1147</span> </div>
|
|
<div class="line"><a name="l01148"></a><span class="lineno"> 1148</span>  }</div>
|
|
<div class="line"><a name="l01149"></a><span class="lineno"> 1149</span>  <span class="keywordflow">return</span> ret;</div>
|
|
<div class="line"><a name="l01150"></a><span class="lineno"> 1150</span> }</div>
|
|
<div class="line"><a name="l01151"></a><span class="lineno"> 1151</span> </div>
|
|
<div class="line"><a name="l01163"></a><span class="lineno"> 1163</span> uint8_t BulkOnly::ModeSense(uint8_t lun, uint8_t pc, uint8_t page, uint8_t subpage, uint8_t len, uint8_t * pbuf) {</div>
|
|
<div class="line"><a name="l01164"></a><span class="lineno"> 1164</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\rModeSense\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01165"></a><span class="lineno"> 1165</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"------------\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01166"></a><span class="lineno"> 1166</span> </div>
|
|
<div class="line"><a name="l01167"></a><span class="lineno"> 1167</span>  <a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a> cbw;</div>
|
|
<div class="line"><a name="l01168"></a><span class="lineno"> 1168</span>  SetCurLUN(lun);</div>
|
|
<div class="line"><a name="l01169"></a><span class="lineno"> 1169</span> </div>
|
|
<div class="line"><a name="l01170"></a><span class="lineno"> 1170</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a133ffc8ac9be6ce284f10efece567748">dCBWSignature</a> = <a class="code" href="masstorage_8h.html#a439c9558fff25c40219c0f20244e666d">MASS_CBW_SIGNATURE</a>;</div>
|
|
<div class="line"><a name="l01171"></a><span class="lineno"> 1171</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a> = ++<a class="code" href="class_bulk_only.html#a7ae682d50badd1386a06f30f35a32d1d">dCBWTag</a>;</div>
|
|
<div class="line"><a name="l01172"></a><span class="lineno"> 1172</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a> = ((uint32_t)len);</div>
|
|
<div class="line"><a name="l01173"></a><span class="lineno"> 1173</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a396b36ceef993c32f28b1354727a5e9e">bmCBWFlags</a> = <a class="code" href="masstorage_8h.html#a012ee34e4ce8d644c2f75099867b26c0">MASS_CMD_DIR_IN</a>;</div>
|
|
<div class="line"><a name="l01174"></a><span class="lineno"> 1174</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2a16bb9a98e3ee4eaac8fea6310b4e01">bmCBWLUN</a> = lun;</div>
|
|
<div class="line"><a name="l01175"></a><span class="lineno"> 1175</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a069c89f584abbf45c13ebb85ca906494">bmCBWCBLength</a> = 6;</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="keywordflow">for</span> (uint8_t i = 0; i < 16; i++)</div>
|
|
<div class="line"><a name="l01178"></a><span class="lineno"> 1178</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[i] = 0;</div>
|
|
<div class="line"><a name="l01179"></a><span class="lineno"> 1179</span> </div>
|
|
<div class="line"><a name="l01180"></a><span class="lineno"> 1180</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[0] = <a class="code" href="masstorage_8h.html#ab6164a7d5f81211ce8d98b6a731b4f69">SCSI_CMD_MODE_SENSE_6</a>;</div>
|
|
<div class="line"><a name="l01181"></a><span class="lineno"> 1181</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[2] = ((pc << 6) | page);</div>
|
|
<div class="line"><a name="l01182"></a><span class="lineno"> 1182</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[3] = subpage;</div>
|
|
<div class="line"><a name="l01183"></a><span class="lineno"> 1183</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[4] = len;</div>
|
|
<div class="line"><a name="l01184"></a><span class="lineno"> 1184</span> </div>
|
|
<div class="line"><a name="l01185"></a><span class="lineno"> 1185</span>  <span class="keywordflow">return</span> HandleSCSIError(Transaction(&cbw, 512, pbuf, 0));</div>
|
|
<div class="line"><a name="l01186"></a><span class="lineno"> 1186</span> }</div>
|
|
<div class="line"><a name="l01187"></a><span class="lineno"> 1187</span> </div>
|
|
<div class="line"><a name="l01194"></a><span class="lineno"> 1194</span> uint8_t BulkOnly::SetCurLUN(uint8_t lun) {</div>
|
|
<div class="line"><a name="l01195"></a><span class="lineno"> 1195</span>  <span class="keywordflow">if</span> (lun > <a class="code" href="class_bulk_only.html#a6bbdd41bf6efc4060f3c36da7d6ed8b2">bMaxLUN</a>)</div>
|
|
<div class="line"><a name="l01196"></a><span class="lineno"> 1196</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a5341c969f1daf8a9e8d345c0ba36fa54">MASS_ERR_INVALID_LUN</a>;</div>
|
|
<div class="line"><a name="l01197"></a><span class="lineno"> 1197</span>  <a class="code" href="class_bulk_only.html#a24c051d401f5f1a9ce65c1bc25ab02dd">bTheLUN</a> = lun;</div>
|
|
<div class="line"><a name="l01198"></a><span class="lineno"> 1198</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a450c2a67aa2b6a1f6593113dcb847569">MASS_ERR_SUCCESS</a>;</div>
|
|
<div class="line"><a name="l01199"></a><span class="lineno"> 1199</span> };</div>
|
|
<div class="line"><a name="l01200"></a><span class="lineno"> 1200</span> </div>
|
|
<div class="line"><a name="l01207"></a><span class="lineno"> 1207</span> uint8_t BulkOnly::HandleSCSIError(uint8_t status) {</div>
|
|
<div class="line"><a name="l01208"></a><span class="lineno"> 1208</span>  uint8_t ret = 0;</div>
|
|
<div class="line"><a name="l01209"></a><span class="lineno"> 1209</span> </div>
|
|
<div class="line"><a name="l01210"></a><span class="lineno"> 1210</span>  <span class="keywordflow">switch</span> (status) {</div>
|
|
<div class="line"><a name="l01211"></a><span class="lineno"> 1211</span>  <span class="keywordflow">case</span> 0: <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a450c2a67aa2b6a1f6593113dcb847569">MASS_ERR_SUCCESS</a>;</div>
|
|
<div class="line"><a name="l01212"></a><span class="lineno"> 1212</span>  <span class="comment">//case 4: return MASS_ERR_UNIT_BUSY; // Busy means retry later.</span></div>
|
|
<div class="line"><a name="l01213"></a><span class="lineno"> 1213</span>  <span class="comment">// case 0x05/0x14: we stalled out</span></div>
|
|
<div class="line"><a name="l01214"></a><span class="lineno"> 1214</span>  <span class="comment">// case 0x15/0x16: we naked out.</span></div>
|
|
<div class="line"><a name="l01215"></a><span class="lineno"> 1215</span>  <span class="keywordflow">case</span> 2:</div>
|
|
<div class="line"><a name="l01216"></a><span class="lineno"> 1216</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"Phase Error"</span>), status);</div>
|
|
<div class="line"><a name="l01217"></a><span class="lineno"> 1217</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"LUN"</span>), <a class="code" href="class_bulk_only.html#a24c051d401f5f1a9ce65c1bc25ab02dd">bTheLUN</a>);</div>
|
|
<div class="line"><a name="l01218"></a><span class="lineno"> 1218</span>  ResetRecovery();</div>
|
|
<div class="line"><a name="l01219"></a><span class="lineno"> 1219</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a2815b1980ee4f05d2712a6492b5272b3">MASS_ERR_GENERAL_SCSI_ERROR</a>;</div>
|
|
<div class="line"><a name="l01220"></a><span class="lineno"> 1220</span>  <span class="keywordflow">case</span> 1:</div>
|
|
<div class="line"><a name="l01221"></a><span class="lineno"> 1221</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"SCSI Error"</span>), status);</div>
|
|
<div class="line"><a name="l01222"></a><span class="lineno"> 1222</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"LUN"</span>), <a class="code" href="class_bulk_only.html#a24c051d401f5f1a9ce65c1bc25ab02dd">bTheLUN</a>);</div>
|
|
<div class="line"><a name="l01223"></a><span class="lineno"> 1223</span>  <a class="code" href="struct_request_sense_responce.html">RequestSenseResponce</a> rsp;</div>
|
|
<div class="line"><a name="l01224"></a><span class="lineno"> 1224</span> </div>
|
|
<div class="line"><a name="l01225"></a><span class="lineno"> 1225</span>  ret = RequestSense(<a class="code" href="class_bulk_only.html#a24c051d401f5f1a9ce65c1bc25ab02dd">bTheLUN</a>, <span class="keyword">sizeof</span> (<a class="code" href="struct_request_sense_responce.html">RequestSenseResponce</a>), (uint8_t*) & rsp);</div>
|
|
<div class="line"><a name="l01226"></a><span class="lineno"> 1226</span> </div>
|
|
<div class="line"><a name="l01227"></a><span class="lineno"> 1227</span>  <span class="keywordflow">if</span> (ret) {</div>
|
|
<div class="line"><a name="l01228"></a><span class="lineno"> 1228</span>  <span class="comment">//ResetRecovery();</span></div>
|
|
<div class="line"><a name="l01229"></a><span class="lineno"> 1229</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a2815b1980ee4f05d2712a6492b5272b3">MASS_ERR_GENERAL_SCSI_ERROR</a>;</div>
|
|
<div class="line"><a name="l01230"></a><span class="lineno"> 1230</span>  }</div>
|
|
<div class="line"><a name="l01231"></a><span class="lineno"> 1231</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"Response Code"</span>), rsp.bResponseCode);</div>
|
|
<div class="line"><a name="l01232"></a><span class="lineno"> 1232</span>  <span class="keywordflow">if</span> (rsp.bResponseCode & 0x80) {</div>
|
|
<div class="line"><a name="l01233"></a><span class="lineno"> 1233</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"Information field: "</span>), 0x80);</div>
|
|
<div class="line"><a name="l01234"></a><span class="lineno"> 1234</span>  <span class="keywordflow">for</span> (<span class="keywordtype">int</span> i = 0; i < 4; i++) {</div>
|
|
<div class="line"><a name="l01235"></a><span class="lineno"> 1235</span>  D_PrintHex<uint8_t > (rsp.CmdSpecificInformation[i], 0x80);</div>
|
|
<div class="line"><a name="l01236"></a><span class="lineno"> 1236</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">" "</span>), 0x80);</div>
|
|
<div class="line"><a name="l01237"></a><span class="lineno"> 1237</span>  }</div>
|
|
<div class="line"><a name="l01238"></a><span class="lineno"> 1238</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01239"></a><span class="lineno"> 1239</span>  }</div>
|
|
<div class="line"><a name="l01240"></a><span class="lineno"> 1240</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"Sense Key"</span>), rsp.bmSenseKey);</div>
|
|
<div class="line"><a name="l01241"></a><span class="lineno"> 1241</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"Add Sense Code"</span>), rsp.bAdditionalSenseCode);</div>
|
|
<div class="line"><a name="l01242"></a><span class="lineno"> 1242</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"Add Sense Qual"</span>), rsp.bAdditionalSenseQualifier);</div>
|
|
<div class="line"><a name="l01243"></a><span class="lineno"> 1243</span>  <span class="comment">// warning, this is not testing ASQ, only SK and ASC.</span></div>
|
|
<div class="line"><a name="l01244"></a><span class="lineno"> 1244</span>  <span class="keywordflow">switch</span> (rsp.bmSenseKey) {</div>
|
|
<div class="line"><a name="l01245"></a><span class="lineno"> 1245</span>  <span class="comment">/* bug...</span></div>
|
|
<div class="line"><a name="l01246"></a><span class="lineno"> 1246</span> <span class="comment"> case 0:</span></div>
|
|
<div class="line"><a name="l01247"></a><span class="lineno"> 1247</span> <span class="comment"> return MASS_ERR_SUCCESS;</span></div>
|
|
<div class="line"><a name="l01248"></a><span class="lineno"> 1248</span> <span class="comment"> */</span></div>
|
|
<div class="line"><a name="l01249"></a><span class="lineno"> 1249</span>  <span class="keywordflow">case</span> <a class="code" href="masstorage_8h.html#ae7ab5840b35001bba68d7adae4abcd11">SCSI_S_UNIT_ATTENTION</a>:</div>
|
|
<div class="line"><a name="l01250"></a><span class="lineno"> 1250</span>  <span class="keywordflow">switch</span> (rsp.bAdditionalSenseCode) {</div>
|
|
<div class="line"><a name="l01251"></a><span class="lineno"> 1251</span>  <span class="keywordflow">case</span> <a class="code" href="masstorage_8h.html#a9fd5f74b6bac6c95990f5f211c04894b">SCSI_ASC_MEDIA_CHANGED</a>:</div>
|
|
<div class="line"><a name="l01252"></a><span class="lineno"> 1252</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a6ddc06e45101114eb7842a7ee57f7d43">MASS_ERR_MEDIA_CHANGED</a>;</div>
|
|
<div class="line"><a name="l01253"></a><span class="lineno"> 1253</span>  <span class="keywordflow">default</span>:</div>
|
|
<div class="line"><a name="l01254"></a><span class="lineno"> 1254</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a128e4910df8d7770c6f9af7700b9ccb1">MASS_ERR_UNIT_NOT_READY</a>;</div>
|
|
<div class="line"><a name="l01255"></a><span class="lineno"> 1255</span>  }</div>
|
|
<div class="line"><a name="l01256"></a><span class="lineno"> 1256</span>  <span class="keywordflow">case</span> <a class="code" href="masstorage_8h.html#a613422ba27c89fe5d72d06d216c9f2a5">SCSI_S_NOT_READY</a>:</div>
|
|
<div class="line"><a name="l01257"></a><span class="lineno"> 1257</span>  <span class="keywordflow">switch</span> (rsp.bAdditionalSenseCode) {</div>
|
|
<div class="line"><a name="l01258"></a><span class="lineno"> 1258</span>  <span class="keywordflow">case</span> <a class="code" href="masstorage_8h.html#ac0c79fb555815317d46e9af6192d959d">SCSI_ASC_MEDIUM_NOT_PRESENT</a>:</div>
|
|
<div class="line"><a name="l01259"></a><span class="lineno"> 1259</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#aec47def0928045fdca474d78db866c39">MASS_ERR_NO_MEDIA</a>;</div>
|
|
<div class="line"><a name="l01260"></a><span class="lineno"> 1260</span>  <span class="comment">//return MASS_ERR_SUCCESS;</span></div>
|
|
<div class="line"><a name="l01261"></a><span class="lineno"> 1261</span>  <span class="keywordflow">default</span>:</div>
|
|
<div class="line"><a name="l01262"></a><span class="lineno"> 1262</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a128e4910df8d7770c6f9af7700b9ccb1">MASS_ERR_UNIT_NOT_READY</a>;</div>
|
|
<div class="line"><a name="l01263"></a><span class="lineno"> 1263</span>  }</div>
|
|
<div class="line"><a name="l01264"></a><span class="lineno"> 1264</span>  <span class="keywordflow">case</span> <a class="code" href="masstorage_8h.html#a3f36c4b24d404a7bde02e6bf3f87a0cd">SCSI_S_ILLEGAL_REQUEST</a>:</div>
|
|
<div class="line"><a name="l01265"></a><span class="lineno"> 1265</span>  <span class="keywordflow">switch</span> (rsp.bAdditionalSenseCode) {</div>
|
|
<div class="line"><a name="l01266"></a><span class="lineno"> 1266</span>  <span class="keywordflow">case</span> <a class="code" href="masstorage_8h.html#ac6d64023e2b8137eed90917f362ab262">SCSI_ASC_LBA_OUT_OF_RANGE</a>:</div>
|
|
<div class="line"><a name="l01267"></a><span class="lineno"> 1267</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a57edffb4395696374818f80202aedca4">MASS_ERR_BAD_LBA</a>;</div>
|
|
<div class="line"><a name="l01268"></a><span class="lineno"> 1268</span>  <span class="keywordflow">default</span>:</div>
|
|
<div class="line"><a name="l01269"></a><span class="lineno"> 1269</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#ac3364cf841936aa8c3107e14c06ff65f">MASS_ERR_CMD_NOT_SUPPORTED</a>;</div>
|
|
<div class="line"><a name="l01270"></a><span class="lineno"> 1270</span>  }</div>
|
|
<div class="line"><a name="l01271"></a><span class="lineno"> 1271</span>  <span class="keywordflow">default</span>:</div>
|
|
<div class="line"><a name="l01272"></a><span class="lineno"> 1272</span>  <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#a2815b1980ee4f05d2712a6492b5272b3">MASS_ERR_GENERAL_SCSI_ERROR</a>;</div>
|
|
<div class="line"><a name="l01273"></a><span class="lineno"> 1273</span>  }</div>
|
|
<div class="line"><a name="l01274"></a><span class="lineno"> 1274</span> </div>
|
|
<div class="line"><a name="l01275"></a><span class="lineno"> 1275</span>  <span class="keywordflow">default</span>:</div>
|
|
<div class="line"><a name="l01276"></a><span class="lineno"> 1276</span>  <span class="comment">// Should have been handled already in HandleUsbError.</span></div>
|
|
<div class="line"><a name="l01277"></a><span class="lineno"> 1277</span>  <span class="comment">// ResetRecovery();</span></div>
|
|
<div class="line"><a name="l01278"></a><span class="lineno"> 1278</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"Gen SCSI Err"</span>), status);</div>
|
|
<div class="line"><a name="l01279"></a><span class="lineno"> 1279</span>  ErrorMessage<uint8_t > (PSTR(<span class="stringliteral">"LUN"</span>), <a class="code" href="class_bulk_only.html#a24c051d401f5f1a9ce65c1bc25ab02dd">bTheLUN</a>);</div>
|
|
<div class="line"><a name="l01280"></a><span class="lineno"> 1280</span>  <span class="keywordflow">return</span> status; <span class="comment">//MASS_ERR_GENERAL_SCSI_ERROR;</span></div>
|
|
<div class="line"><a name="l01281"></a><span class="lineno"> 1281</span>  } <span class="comment">// switch</span></div>
|
|
<div class="line"><a name="l01282"></a><span class="lineno"> 1282</span> }</div>
|
|
<div class="line"><a name="l01283"></a><span class="lineno"> 1283</span> </div>
|
|
<div class="line"><a name="l01284"></a><span class="lineno"> 1284</span> </div>
|
|
<div class="line"><a name="l01286"></a><span class="lineno"> 1286</span> </div>
|
|
<div class="line"><a name="l01287"></a><span class="lineno"> 1287</span> </div>
|
|
<div class="line"><a name="l01288"></a><span class="lineno"> 1288</span> <span class="comment">// Debugging code</span></div>
|
|
<div class="line"><a name="l01289"></a><span class="lineno"> 1289</span> </div>
|
|
<div class="line"><a name="l01290"></a><span class="lineno"> 1290</span> </div>
|
|
<div class="line"><a name="l01292"></a><span class="lineno"> 1292</span> </div>
|
|
<div class="line"><a name="l01293"></a><span class="lineno"> 1293</span> </div>
|
|
<div class="line"><a name="l01298"></a><span class="lineno"><a class="code" href="class_bulk_only.html#ac8a1d7b2ef82d9f6da44928c78039964"> 1298</a></span> <span class="keywordtype">void</span> <a class="code" href="class_bulk_only.html#ac8a1d7b2ef82d9f6da44928c78039964">BulkOnly::PrintEndpointDescriptor</a>(<span class="keyword">const</span> <a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html">USB_ENDPOINT_DESCRIPTOR</a> * ep_ptr) {</div>
|
|
<div class="line"><a name="l01299"></a><span class="lineno"> 1299</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"Endpoint descriptor:"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01300"></a><span class="lineno"> 1300</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nLength:\t\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01301"></a><span class="lineno"> 1301</span>  D_PrintHex<uint8_t > (ep_ptr-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a55263a9cc9dc17abc37226ac8a471ad0">bLength</a>, 0x80);</div>
|
|
<div class="line"><a name="l01302"></a><span class="lineno"> 1302</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nType:\t\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01303"></a><span class="lineno"> 1303</span>  D_PrintHex<uint8_t > (ep_ptr-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#af39d036ab903a96b9d4d56b879555d6c">bDescriptorType</a>, 0x80);</div>
|
|
<div class="line"><a name="l01304"></a><span class="lineno"> 1304</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nAddress:\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01305"></a><span class="lineno"> 1305</span>  D_PrintHex<uint8_t > (ep_ptr-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a23fbb539d72d10a6cb12efedf7d3457c">bEndpointAddress</a>, 0x80);</div>
|
|
<div class="line"><a name="l01306"></a><span class="lineno"> 1306</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nAttributes:\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01307"></a><span class="lineno"> 1307</span>  D_PrintHex<uint8_t > (ep_ptr-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a8ee7f1bafac335258c6e742969387f57">bmAttributes</a>, 0x80);</div>
|
|
<div class="line"><a name="l01308"></a><span class="lineno"> 1308</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nMaxPktSize:\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01309"></a><span class="lineno"> 1309</span>  D_PrintHex<uint16_t > (ep_ptr-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#af34105fa6bd0029d9c6b73d85f7853c6">wMaxPacketSize</a>, 0x80);</div>
|
|
<div class="line"><a name="l01310"></a><span class="lineno"> 1310</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nPoll Intrv:\t"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01311"></a><span class="lineno"> 1311</span>  D_PrintHex<uint8_t > (ep_ptr-><a class="code" href="struct_u_s_b___e_n_d_p_o_i_n_t___d_e_s_c_r_i_p_t_o_r.html#a95cd9669dee9cab375a7c5e62284a01b">bInterval</a>, 0x80);</div>
|
|
<div class="line"><a name="l01312"></a><span class="lineno"> 1312</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01313"></a><span class="lineno"> 1313</span> }</div>
|
|
<div class="line"><a name="l01314"></a><span class="lineno"> 1314</span> </div>
|
|
<div class="line"><a name="l01315"></a><span class="lineno"> 1315</span> </div>
|
|
<div class="line"><a name="l01317"></a><span class="lineno"> 1317</span> </div>
|
|
<div class="line"><a name="l01318"></a><span class="lineno"> 1318</span> </div>
|
|
<div class="line"><a name="l01319"></a><span class="lineno"> 1319</span> <span class="comment">// misc/to kill/to-do</span></div>
|
|
<div class="line"><a name="l01320"></a><span class="lineno"> 1320</span> </div>
|
|
<div class="line"><a name="l01321"></a><span class="lineno"> 1321</span> </div>
|
|
<div class="line"><a name="l01323"></a><span class="lineno"> 1323</span> </div>
|
|
<div class="line"><a name="l01324"></a><span class="lineno"> 1324</span> </div>
|
|
<div class="line"><a name="l01325"></a><span class="lineno"> 1325</span> <span class="comment">/* We won't be needing this... */</span></div>
|
|
<div class="line"><a name="l01326"></a><span class="lineno"><a class="code" href="class_bulk_only.html#a52f54376dcd7f5baf17718105e8f085d"> 1326</a></span> uint8_t <a class="code" href="class_bulk_only.html#a470a8f0ffd6694d9dfc834da5efa627a">BulkOnly::Read</a>(uint8_t lun, uint32_t addr, uint16_t bsize, uint8_t blocks, <a class="code" href="class_u_s_b_read_parser.html">USBReadParser</a> * prs) {</div>
|
|
<div class="line"><a name="l01327"></a><span class="lineno"> 1327</span>  <span class="keywordflow">if</span> (!<a class="code" href="class_bulk_only.html#a9f9d9b0925a2cb6b2fb8b10e4d581d28">LUNOk</a>[lun]) <span class="keywordflow">return</span> <a class="code" href="masstorage_8h.html#aec47def0928045fdca474d78db866c39">MASS_ERR_NO_MEDIA</a>;</div>
|
|
<div class="line"><a name="l01328"></a><span class="lineno"> 1328</span> <span class="preprocessor">#if 0</span></div>
|
|
<div class="line"><a name="l01329"></a><span class="lineno"> 1329</span> <span class="preprocessor"></span> <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"\r\nRead (With parser)\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01330"></a><span class="lineno"> 1330</span>  <a class="code" href="message_8h.html#a747819b0aa34f5c3ba0332c2db28c846">Notify</a>(PSTR(<span class="stringliteral">"---------\r\n"</span>), 0x80);</div>
|
|
<div class="line"><a name="l01331"></a><span class="lineno"> 1331</span> </div>
|
|
<div class="line"><a name="l01332"></a><span class="lineno"> 1332</span>  <a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a> cbw;</div>
|
|
<div class="line"><a name="l01333"></a><span class="lineno"> 1333</span> </div>
|
|
<div class="line"><a name="l01334"></a><span class="lineno"> 1334</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a133ffc8ac9be6ce284f10efece567748">dCBWSignature</a> = <a class="code" href="masstorage_8h.html#a439c9558fff25c40219c0f20244e666d">MASS_CBW_SIGNATURE</a>;</div>
|
|
<div class="line"><a name="l01335"></a><span class="lineno"> 1335</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a> = ++<a class="code" href="class_bulk_only.html#a7ae682d50badd1386a06f30f35a32d1d">dCBWTag</a>;</div>
|
|
<div class="line"><a name="l01336"></a><span class="lineno"> 1336</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a> = ((uint32_t)bsize * blocks);</div>
|
|
<div class="line"><a name="l01337"></a><span class="lineno"> 1337</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a396b36ceef993c32f28b1354727a5e9e">bmCBWFlags</a> = <a class="code" href="masstorage_8h.html#a012ee34e4ce8d644c2f75099867b26c0">MASS_CMD_DIR_IN</a>,</div>
|
|
<div class="line"><a name="l01338"></a><span class="lineno"> 1338</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2a16bb9a98e3ee4eaac8fea6310b4e01">bmCBWLUN</a> = lun;</div>
|
|
<div class="line"><a name="l01339"></a><span class="lineno"> 1339</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a069c89f584abbf45c13ebb85ca906494">bmCBWCBLength</a> = 10;</div>
|
|
<div class="line"><a name="l01340"></a><span class="lineno"> 1340</span> </div>
|
|
<div class="line"><a name="l01341"></a><span class="lineno"> 1341</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 16; i++)</div>
|
|
<div class="line"><a name="l01342"></a><span class="lineno"> 1342</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[i] = 0;</div>
|
|
<div class="line"><a name="l01343"></a><span class="lineno"> 1343</span> </div>
|
|
<div class="line"><a name="l01344"></a><span class="lineno"> 1344</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[0] = <a class="code" href="masstorage_8h.html#ad3900f141fb70afb8def054384805a2e">SCSI_CMD_READ_10</a>;</div>
|
|
<div class="line"><a name="l01345"></a><span class="lineno"> 1345</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[8] = blocks;</div>
|
|
<div class="line"><a name="l01346"></a><span class="lineno"> 1346</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[2] = ((addr >> 24) & 0xff);</div>
|
|
<div class="line"><a name="l01347"></a><span class="lineno"> 1347</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[3] = ((addr >> 16) & 0xff);</div>
|
|
<div class="line"><a name="l01348"></a><span class="lineno"> 1348</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[4] = ((addr >> 8) & 0xff);</div>
|
|
<div class="line"><a name="l01349"></a><span class="lineno"> 1349</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[5] = (addr & 0xff);</div>
|
|
<div class="line"><a name="l01350"></a><span class="lineno"> 1350</span> </div>
|
|
<div class="line"><a name="l01351"></a><span class="lineno"> 1351</span>  <span class="keywordflow">return</span> HandleSCSIError(Transaction(&cbw, bsize, prs, 1));</div>
|
|
<div class="line"><a name="l01352"></a><span class="lineno"> 1352</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l01353"></a><span class="lineno"> 1353</span> <span class="preprocessor"></span>}</div>
|
|
<div class="line"><a name="l01354"></a><span class="lineno"> 1354</span> </div>
|
|
<div class="line"><a name="l01355"></a><span class="lineno"> 1355</span> <span class="preprocessor">#if 0</span></div>
|
|
<div class="line"><a name="l01356"></a><span class="lineno"> 1356</span> <span class="preprocessor"></span><span class="comment">// TO-DO: Unify CBW creation as much as possible.</span></div>
|
|
<div class="line"><a name="l01357"></a><span class="lineno"> 1357</span> <span class="comment">// Make and submit CBW.</span></div>
|
|
<div class="line"><a name="l01358"></a><span class="lineno"> 1358</span> <span class="comment">// if stalled, delay retry</span></div>
|
|
<div class="line"><a name="l01359"></a><span class="lineno"> 1359</span> <span class="comment">// exit on 100 retries, or anything except stall.</span></div>
|
|
<div class="line"><a name="l01360"></a><span class="lineno"> 1360</span> </div>
|
|
<div class="line"><a name="l01361"></a><span class="lineno"> 1361</span> uint8_t SubmitCBW(uint8_t cmd, uint8_t cmdsz, uint8_t lun, uint16_t bsize, uint8_t *buf, uint8_t flags) {</div>
|
|
<div class="line"><a name="l01362"></a><span class="lineno"> 1362</span>  <a class="code" href="struct_command_block_wrapper.html">CommandBlockWrapper</a> cbw;</div>
|
|
<div class="line"><a name="l01363"></a><span class="lineno"> 1363</span>  SetCurLUN(lun);</div>
|
|
<div class="line"><a name="l01364"></a><span class="lineno"> 1364</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a133ffc8ac9be6ce284f10efece567748">dCBWSignature</a> = <a class="code" href="masstorage_8h.html#a439c9558fff25c40219c0f20244e666d">MASS_CBW_SIGNATURE</a>;</div>
|
|
<div class="line"><a name="l01365"></a><span class="lineno"> 1365</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a0898a332eec2d598b80a896ff66d5549">dCBWTag</a> = ++dCBWTag;</div>
|
|
<div class="line"><a name="l01366"></a><span class="lineno"> 1366</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a62c537797107ada830b86e1f2d629164">dCBWDataTransferLength</a> = bsize;</div>
|
|
<div class="line"><a name="l01367"></a><span class="lineno"> 1367</span>  cbw.<a class="code" href="struct_command_block_wrapper_base.html#a396b36ceef993c32f28b1354727a5e9e">bmCBWFlags</a> = flags;</div>
|
|
<div class="line"><a name="l01368"></a><span class="lineno"> 1368</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2a16bb9a98e3ee4eaac8fea6310b4e01">bmCBWLUN</a> = lun;</div>
|
|
<div class="line"><a name="l01369"></a><span class="lineno"> 1369</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a069c89f584abbf45c13ebb85ca906494">bmCBWCBLength</a> = cmdsz;</div>
|
|
<div class="line"><a name="l01370"></a><span class="lineno"> 1370</span>  <span class="keywordflow">for</span> (uint8_t i = 0; i < 16; i++) cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[i] = 0;</div>
|
|
<div class="line"><a name="l01371"></a><span class="lineno"> 1371</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[0] = cmd;</div>
|
|
<div class="line"><a name="l01372"></a><span class="lineno"> 1372</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[1] = lun << 5;</div>
|
|
<div class="line"><a name="l01373"></a><span class="lineno"> 1373</span>  cbw.<a class="code" href="struct_command_block_wrapper.html#a2f5feafb5e1c993454c1ccd14a17965a">CBWCB</a>[4] = bsize;</div>
|
|
<div class="line"><a name="l01374"></a><span class="lineno"> 1374</span> }</div>
|
|
<div class="line"><a name="l01375"></a><span class="lineno"> 1375</span> <span class="preprocessor">#endif</span></div>
|
|
</div><!-- fragment --></div><!-- contents -->
|
|
<!-- start footer part -->
|
|
<hr class="footer"/><address class="footer"><small>
|
|
Generated by  <a href="http://www.doxygen.org/index.html">
|
|
<img class="footer" src="doxygen.png" alt="doxygen"/>
|
|
</a> 1.8.4
|
|
</small></address>
|
|
</body>
|
|
</html>
|