ZealOS/docs/Kernel/BlkDev/DiskATA.CC.html

517 lines
63 KiB
HTML
Raw Normal View History

2021-07-03 05:07:57 +01:00
<!DOCTYPE HTML>
<html>
<head>
<meta http-equiv="Content-Type" content="text/html;charset=US-ASCII">
<meta name="generator" content="ZealOS V0.12">
2021-07-03 05:07:57 +01:00
<style type="text/css">
body {background-color:#fef1f0;}
.cF0{color:#000000;background-color:#fef1f0;}
.cF1{color:#0148a4;background-color:#fef1f0;}
.cF2{color:#3b7901;background-color:#fef1f0;}
.cF3{color:#057c7e;background-color:#fef1f0;}
.cF4{color:#bb2020;background-color:#fef1f0;}
.cF5{color:#9e42ae;background-color:#fef1f0;}
.cF6{color:#b57901;background-color:#fef1f0;}
.cF7{color:#b2b6af;background-color:#fef1f0;}
.cF8{color:#555753;background-color:#fef1f0;}
.cF9{color:#678fbb;background-color:#fef1f0;}
.cFA{color:#82bc49;background-color:#fef1f0;}
.cFB{color:#0097a2;background-color:#fef1f0;}
.cFC{color:#e26a6a;background-color:#fef1f0;}
.cFD{color:#c671bc;background-color:#fef1f0;}
.cFE{color:#c7ab00;background-color:#fef1f0;}
.cFF{color:#fef1f0;background-color:#fef1f0;}
2021-07-03 05:07:57 +01:00
</style>
</head>
<body>
<pre style="font-family:monospace;font-size:12pt">
2021-07-03 05:07:57 +01:00
<a name="l1"></a><span class=cF0>
<a name="l2"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cFD>IDEATABlkSel</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF9>I64</span><span class=cF0> blk, </span><span class=cF9>I64</span><span class=cF0> count)
<a name="l3"></a>{
<a name="l4"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;type != </span><span class=cF3>BDT_ATAPI</span><span class=cF0> &amp;&amp; bd-&gt;base1)
<a name="l5"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base1 + </span><span class=cF3>ATAR1_CTRL</span><span class=cF0>, </span><span class=cFE>0x8</span><span class=cF0>);
<a name="l6"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l7"></a> </span><span class=cF7>{</span><span class=cF0> </span><span class=cF2>//48 Bit LBA?</span><span class=cF0>
<a name="l8"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_NSECT</span><span class=cF0>, count.u8[</span><span class=cFE>1</span><span class=cF0>]);
<a name="l9"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SECT</span><span class=cF0>, blk.u8[</span><span class=cFE>3</span><span class=cF0>]);
<a name="l10"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>, blk.u8[</span><span class=cFE>4</span><span class=cF0>]);
<a name="l11"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>, blk.u8[</span><span class=cFE>5</span><span class=cF0>]);
<a name="l12"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_NSECT</span><span class=cF0>, count);
<a name="l13"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SECT</span><span class=cF0>, blk);
<a name="l14"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>, blk.u8[</span><span class=cFE>1</span><span class=cF0>]);
<a name="l15"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>, blk.u8[</span><span class=cFE>2</span><span class=cF0>]);
<a name="l16"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l17"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l18"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l19"></a> </span><span class=cF7>{</span><span class=cF0> </span><span class=cF2>//28 Bit LBA</span><span class=cF0>
<a name="l20"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_NSECT</span><span class=cF0>, count);
<a name="l21"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SECT</span><span class=cF0>, blk);
<a name="l22"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>, blk.u8[</span><span class=cFE>1</span><span class=cF0>]);
<a name="l23"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>, blk.u8[</span><span class=cFE>2</span><span class=cF0>]);
<a name="l24"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0> | blk.u8[</span><span class=cFE>3</span><span class=cF0>]);
<a name="l25"></a> </span><span class=cF7>}</span><span class=cF0>
2021-07-03 05:07:57 +01:00
<a name="l26"></a>}
<a name="l27"></a>
<a name="l28"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF1>F64</span><span class=cF0> timeout)
<a name="l29"></a>{
<a name="l30"></a> </span><span class=cF9>I64</span><span class=cF0> i;
2021-07-03 05:07:57 +01:00
<a name="l31"></a>
<a name="l32"></a> </span><span class=cF1>do</span><span class=cF0>
<a name="l33"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l34"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i &lt; </span><span class=cFE>3</span><span class=cF0>; i++)
<a name="l35"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cF7>(</span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_STAT</span><span class=cF0>) &amp; </span><span class=cF3>ATAS_BSY</span><span class=cF7>)</span><span class=cF0>)
<a name="l36"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
<a name="l37"></a> </span><span class=cF5>Yield</span><span class=cF0>;
<a name="l38"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l39"></a> </span><span class=cF1>while</span><span class=cF0> (!</span><span class=cF7>(</span><span class=cFE>0</span><span class=cF0> &lt; timeout &lt; </span><span class=cF5>tS</span><span class=cF7>)</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l40"></a>
<a name="l41"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l42"></a>}
<a name="l43"></a>
<a name="l44"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>IDEATAWaitDRQ</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF1>F64</span><span class=cF0> timeout)
<a name="l45"></a>{
<a name="l46"></a> </span><span class=cF9>I64</span><span class=cF0> i;
2021-07-03 05:07:57 +01:00
<a name="l47"></a>
<a name="l48"></a> </span><span class=cF1>do</span><span class=cF0>
<a name="l49"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l50"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i &lt; </span><span class=cFE>3</span><span class=cF0>; i++)
<a name="l51"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>InU8</span><span class=cF7>(</span><span class=cF0>bd-&gt;base0 + </span><span class=cF3>ATAR0_STAT</span><span class=cF7>)</span><span class=cF0> &amp; </span><span class=cF3>ATAS_DRQ</span><span class=cF0>)
<a name="l52"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
<a name="l53"></a> </span><span class=cF5>Yield</span><span class=cF0>;
<a name="l54"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l55"></a> </span><span class=cF1>while</span><span class=cF0> (!</span><span class=cF7>(</span><span class=cFE>0</span><span class=cF0> &lt; timeout &lt; </span><span class=cF5>tS</span><span class=cF7>)</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l56"></a>
<a name="l57"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l58"></a>}
<a name="l59"></a>
<a name="l60"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>IDEATANop</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF1>F64</span><span class=cF0> timeout)
<a name="l61"></a>{
<a name="l62"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l63"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l64"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l65"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l66"></a>
<a name="l67"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_FEAT</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l68"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_CMD</span><span class=cF0>, </span><span class=cF3>ATA_NOP</span><span class=cF0>);
<a name="l69"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF0>(bd, timeout);
2021-07-03 05:07:57 +01:00
<a name="l70"></a>}
<a name="l71"></a>
<a name="l72"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cFD>IDEATACmd</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF1>U8</span><span class=cF0> cmd)
<a name="l73"></a>{
<a name="l74"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_FEAT</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l75"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_CMD</span><span class=cF0>, cmd);
<a name="l76"></a> bd-&gt;last_time = </span><span class=cF5>tS</span><span class=cF0>;
<a name="l77"></a> </span><span class=cF5>PortNop</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l78"></a>}
<a name="l79"></a>
<a name="l80"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>IDEATAGetRes</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF1>F64</span><span class=cF0> timeout, </span><span class=cF1>U8</span><span class=cF0> *buf, </span><span class=cF9>I64</span><span class=cF0> count, </span><span class=cF9>I64</span><span class=cF0> _avail, </span><span class=cF1>Bool</span><span class=cF0> one_read)
<a name="l81"></a>{
<a name="l82"></a> </span><span class=cF9>I64</span><span class=cF0> avail, overflow;
2021-07-03 05:07:57 +01:00
<a name="l83"></a>
<a name="l84"></a> bd-&gt;flags &amp;= ~</span><span class=cF3>BDF_LAST_WAS_WRITE</span><span class=cF0>;
<a name="l85"></a> </span><span class=cF5>MemSet</span><span class=cF0>(buf, </span><span class=cFE>0</span><span class=cF0>, count);
<a name="l86"></a> </span><span class=cF1>while</span><span class=cF0> (count &gt; </span><span class=cFE>0</span><span class=cF0>)
<a name="l87"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l88"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cFD>IDEATAWaitDRQ</span><span class=cF7>(</span><span class=cF0>bd, timeout</span><span class=cF7>)</span><span class=cF0>)
<a name="l89"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
<a name="l90"></a> </span><span class=cF1>if</span><span class=cF0> (_avail)
<a name="l91"></a> avail = _avail;
<a name="l92"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l93"></a> avail = </span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>) &lt;&lt; </span><span class=cFE>8</span><span class=cF0> + </span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>);
<a name="l94"></a> </span><span class=cF1>if</span><span class=cF0> (avail)
<a name="l95"></a> {
<a name="l96"></a> </span><span class=cF1>if</span><span class=cF0> (avail &gt; count)
<a name="l97"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l98"></a> overflow = avail - count;
<a name="l99"></a> avail = count;
<a name="l100"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l101"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l102"></a> overflow = </span><span class=cFE>0</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l103"></a>
<a name="l104"></a> </span><span class=cF1>if</span><span class=cF0> (avail &amp; </span><span class=cFE>2</span><span class=cF0>)
<a name="l105"></a> </span><span class=cF5>RepInU16</span><span class=cF0>(buf, avail &gt;&gt; </span><span class=cFE>1</span><span class=cF0>, bd-&gt;base0 + </span><span class=cF3>ATAR0_DATA</span><span class=cF0>);
<a name="l106"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l107"></a> </span><span class=cF5>RepInU32</span><span class=cF0>(buf, avail &gt;&gt; </span><span class=cFE>2</span><span class=cF0>, bd-&gt;base0 + </span><span class=cF3>ATAR0_DATA</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l108"></a>
<a name="l109"></a> count -= avail;
<a name="l110"></a> buf += avail;
<a name="l111"></a> </span><span class=cF1>while</span><span class=cF0> (overflow &gt; </span><span class=cFE>0</span><span class=cF0>)
<a name="l112"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l113"></a> </span><span class=cF5>InU16</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_DATA</span><span class=cF0>);
<a name="l114"></a> overflow -= </span><span class=cFE>2</span><span class=cF0>;
<a name="l115"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cFE>0</span><span class=cF0> &lt; timeout &lt; </span><span class=cF5>tS</span><span class=cF0>)
<a name="l116"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
<a name="l117"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l118"></a> </span><span class=cF1>if</span><span class=cF0> (one_read)
<a name="l119"></a> </span><span class=cF1>break</span><span class=cF0>;
<a name="l120"></a> }
<a name="l121"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l122"></a> </span><span class=cF5>Yield</span><span class=cF0>;
<a name="l123"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l124"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF0>(bd, timeout);
2021-07-03 05:07:57 +01:00
<a name="l125"></a>}
<a name="l126"></a>
<a name="l127"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>IDEATAPIWritePacketWord</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF1>F64</span><span class=cF0> timeout, ...)
<a name="l128"></a>{
<a name="l129"></a> </span><span class=cF9>I64</span><span class=cF0> i;
2021-07-03 05:07:57 +01:00
<a name="l130"></a>
<a name="l131"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i &lt; argc; i++)
<a name="l132"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l133"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cFD>IDEATAWaitDRQ</span><span class=cF7>(</span><span class=cF0>bd, timeout</span><span class=cF7>)</span><span class=cF0>)
<a name="l134"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l135"></a>
<a name="l136"></a> </span><span class=cF5>OutU16</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_DATA</span><span class=cF0>, </span><span class=cF5>EndianU16</span><span class=cF7>(</span><span class=cF0>argv[i]</span><span class=cF7>)</span><span class=cF0>);
<a name="l137"></a> bd-&gt;last_time = </span><span class=cF5>tS</span><span class=cF0>;
<a name="l138"></a> </span><span class=cF7>}</span><span class=cF0>
2021-07-03 05:07:57 +01:00
<a name="l139"></a>
<a name="l140"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l141"></a>}
<a name="l142"></a>
<a name="l143"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>IDEATAPISetMaxSpeed</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd)
<a name="l144"></a>{
<a name="l145"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l146"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l147"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l148"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l149"></a>
<a name="l150"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l151"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l152"></a> </span><span class=cFD>IDEATACmd</span><span class=cF0>(bd, </span><span class=cF3>ATA_PACKET</span><span class=cF0>);
<a name="l153"></a> </span><span class=cFD>IDEATAPIWritePacketWord</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF3>ATAPI_SET_CD_SPEED</span><span class=cF0>, </span><span class=cFE>0xFFFF</span><span class=cF0>, </span><span class=cFE>0xFFFF</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l154"></a>
<a name="l155"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l156"></a>}
<a name="l157"></a>
<a name="l158"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>IDEATAPISeek</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF9>I64</span><span class=cF0> native_blk)
<a name="l159"></a>{
<a name="l160"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l161"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l162"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l163"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l164"></a>
<a name="l165"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l166"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l167"></a> </span><span class=cFD>IDEATACmd</span><span class=cF0>(bd, </span><span class=cF3>ATA_PACKET</span><span class=cF0>);
<a name="l168"></a> </span><span class=cFD>IDEATAPIWritePacketWord</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF3>ATAPI_SEEK</span><span class=cF0>, native_blk &gt;&gt; </span><span class=cFE>16</span><span class=cF0>, native_blk, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l169"></a>
<a name="l170"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l171"></a>}
<a name="l172"></a>
<a name="l173"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cF5>IDEATAPIStartStop</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF1>F64</span><span class=cF0> timeout, </span><span class=cF1>Bool</span><span class=cF0> </span><span class=cF1>start</span><span class=cF0>)
<a name="l174"></a>{
<a name="l175"></a> </span><span class=cF9>I64</span><span class=cF0> i;
2021-07-03 05:07:57 +01:00
<a name="l176"></a>
<a name="l177"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF1>start</span><span class=cF0>)
<a name="l178"></a> i = </span><span class=cFE>0x100</span><span class=cF0>;
<a name="l179"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l180"></a> i = </span><span class=cFE>0</span><span class=cF0>;
<a name="l181"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l182"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l183"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l184"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l185"></a>
<a name="l186"></a> </span><span class=cFD>IDEATACmd</span><span class=cF0>(bd, </span><span class=cF3>ATA_PACKET</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l187"></a></span><span class=cF2>//Start/Stop</span><span class=cF0>
<a name="l188"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cFD>IDEATAPIWritePacketWord</span><span class=cF7>(</span><span class=cF0>bd, timeout, </span><span class=cF3>ATAPI_START_STOP_UNIT</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, i, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF7>)</span><span class=cF0>)
<a name="l189"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF0>(bd, timeout);
<a name="l190"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l191"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l192"></a>}
<a name="l193"></a>
<a name="l194"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cFD>IDEATAGetDevId</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF1>F64</span><span class=cF0> timeout, </span><span class=cF1>Bool</span><span class=cF0> keep_id_record)
<a name="l195"></a>{
<a name="l196"></a> </span><span class=cF9>I64</span><span class=cF0> res = </span><span class=cF3>BDT_NULL</span><span class=cF0>;
<a name="l197"></a> </span><span class=cF9>U16</span><span class=cF0> *id_record = </span><span class=cF3>NULL</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l198"></a>
<a name="l199"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;type != </span><span class=cF3>BDT_ATAPI</span><span class=cF0> &amp;&amp; bd-&gt;base1)
<a name="l200"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base1 + </span><span class=cF3>ATAR1_CTRL</span><span class=cF0>, </span><span class=cFE>0x8</span><span class=cF0>);
<a name="l201"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l202"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l203"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l204"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l205"></a>
<a name="l206"></a> </span><span class=cFD>IDEATACmd</span><span class=cF0>(bd, </span><span class=cF3>ATA_IDENTIFY</span><span class=cF0>);
<a name="l207"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF7>(</span><span class=cF0>bd, timeout</span><span class=cF7>)</span><span class=cF0>)
<a name="l208"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l209"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>InU8</span><span class=cF7>(</span><span class=cF0>bd-&gt;base0 + </span><span class=cF3>ATAR0_STAT</span><span class=cF7>)</span><span class=cF0> &amp; </span><span class=cF3>ATAS_ERR</span><span class=cF0>)
<a name="l210"></a> res = </span><span class=cF3>BDT_ATAPI</span><span class=cF0>;
<a name="l211"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l212"></a> {
<a name="l213"></a> id_record = </span><span class=cF5>SysCAlloc</span><span class=cF0>(</span><span class=cFE>512</span><span class=cF0>);
<a name="l214"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cFD>IDEATAGetRes</span><span class=cF7>(</span><span class=cF0>bd, timeout, id_record, </span><span class=cFE>512</span><span class=cF0>, </span><span class=cFE>512</span><span class=cF0>, </span><span class=cF3>FALSE</span><span class=cF7>)</span><span class=cF0>)
<a name="l215"></a> res = </span><span class=cF3>BDT_ATA</span><span class=cF0>;
<a name="l216"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l217"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l218"></a> </span><span class=cF5>Free</span><span class=cF0>(id_record);
<a name="l219"></a> id_record = </span><span class=cF3>NULL</span><span class=cF0>;
<a name="l220"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l221"></a> }
<a name="l222"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l223"></a> </span><span class=cF1>if</span><span class=cF0> (keep_id_record)
<a name="l224"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l225"></a> </span><span class=cF5>Free</span><span class=cF0>(bd-&gt;dev_id_record);
<a name="l226"></a> bd-&gt;dev_id_record = id_record;
<a name="l227"></a> </span><span class=cF7>}</span><span class=cF0>
2021-07-03 05:07:57 +01:00
<a name="l228"></a>
<a name="l229"></a> </span><span class=cF1>return</span><span class=cF0> res;
2021-07-03 05:07:57 +01:00
<a name="l230"></a>}
<a name="l231"></a>
<a name="l232"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cFD>IDEATAReadNativeMax</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF1>F64</span><span class=cF0> timeout)
<a name="l233"></a>{</span><span class=cF2>//Returns zero on error</span><span class=cF0>
<a name="l234"></a> </span><span class=cF9>I64</span><span class=cF0> res = </span><span class=cFE>0</span><span class=cF0>;
<a name="l235"></a> </span><span class=cF1>Bool</span><span class=cF0> okay = </span><span class=cF3>TRUE</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l236"></a>
<a name="l237"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;type == </span><span class=cF3>BDT_ATAPI</span><span class=cF0>)
<a name="l238"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l239"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l240"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l241"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l242"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l243"></a>
<a name="l244"></a> </span><span class=cFD>IDEATACmd</span><span class=cF0>(bd, </span><span class=cF3>ATA_DEV_RST</span><span class=cF0>);
<a name="l245"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF7>(</span><span class=cF0>bd, </span><span class=cFE>0</span><span class=cF7>)</span><span class=cF0>)
<a name="l246"></a> okay = </span><span class=cF3>FALSE</span><span class=cF0>;
<a name="l247"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l248"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l249"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l250"></a> </span><span class=cF1>while</span><span class=cF0> (</span><span class=cF5>InU8</span><span class=cF7>(</span><span class=cF0>bd-&gt;base0 + </span><span class=cF3>ATAR0_STAT</span><span class=cF7>)</span><span class=cF0> &amp; </span><span class=cF3>ATAS_BSY</span><span class=cF0>)
<a name="l251"></a> {
<a name="l252"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_LAST_WAS_WRITE</span><span class=cF0>)
<a name="l253"></a> </span><span class=cF5>OutU16</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_DATA</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l254"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l255"></a> </span><span class=cF5>InU16</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_DATA</span><span class=cF0>);
<a name="l256"></a> </span><span class=cF5>Yield</span><span class=cF0>;
<a name="l257"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cFE>0</span><span class=cF0> &lt; timeout &lt; </span><span class=cF5>tS</span><span class=cF0>)
<a name="l258"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
<a name="l259"></a> }
<a name="l260"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cFD>IDEATAGetDevId</span><span class=cF7>(</span><span class=cF0>bd, timeout, </span><span class=cF3>TRUE</span><span class=cF7>)</span><span class=cF0> == </span><span class=cF3>BDT_NULL</span><span class=cF0>)
<a name="l261"></a> okay = </span><span class=cF3>FALSE</span><span class=cF0>;
<a name="l262"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l263"></a> </span><span class=cF5>BEqual</span><span class=cF0>(&amp;bd-&gt;flags, </span><span class=cF3>BDf_EXT_SIZE</span><span class=cF0>, </span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&amp;bd-&gt;dev_id_record[</span><span class=cFE>86</span><span class=cF0>], </span><span class=cFE>10</span><span class=cF7>)</span><span class=cF0>);
<a name="l264"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l265"></a> </span><span class=cF1>if</span><span class=cF0> (okay)
<a name="l266"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l267"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0> &amp;&amp; bd-&gt;base1)
<a name="l268"></a> {
<a name="l269"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base1 + </span><span class=cF3>ATAR1_CTRL</span><span class=cF0>, </span><span class=cFE>0x8</span><span class=cF0>);
<a name="l270"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l271"></a>
<a name="l272"></a> </span><span class=cFD>IDEATACmd</span><span class=cF0>(bd, </span><span class=cF3>ATA_READ_NATIVE_MAX_EXT</span><span class=cF0>);
<a name="l273"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF7>(</span><span class=cF0>bd, timeout</span><span class=cF7>)</span><span class=cF0>)
<a name="l274"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l275"></a> res.u8[</span><span class=cFE>0</span><span class=cF0>] = </span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SECT</span><span class=cF0>);
<a name="l276"></a> res.u8[</span><span class=cFE>1</span><span class=cF0>] = </span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>);
<a name="l277"></a> res.u8[</span><span class=cFE>2</span><span class=cF0>] = </span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l278"></a>
<a name="l279"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base1+</span><span class=cF3>ATAR1_CTRL</span><span class=cF0>, </span><span class=cFE>0x80</span><span class=cF0>);
<a name="l280"></a> res.u8[</span><span class=cFE>3</span><span class=cF0>] = </span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SECT</span><span class=cF0>);
<a name="l281"></a> res.u8[</span><span class=cFE>4</span><span class=cF0>] = </span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>);
<a name="l282"></a> res.u8[</span><span class=cFE>5</span><span class=cF0>] = </span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l283"></a>
<a name="l284"></a> </span><span class=cF1>if</span><span class=cF0> (res &gt;&gt; </span><span class=cFE>24</span><span class=cF0> == res &amp; </span><span class=cFE>0xFFFFFF</span><span class=cF0>)
<a name="l285"></a> {</span><span class=cF2>//Kludge to make QEMU work</span><span class=cF0>
<a name="l286"></a> bd-&gt;flags &amp;= ~</span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>;
<a name="l287"></a> res &amp;= </span><span class=cFE>0xFFFFFF</span><span class=cF0>;
<a name="l288"></a> }
<a name="l289"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l290"></a> }
<a name="l291"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l292"></a> {
<a name="l293"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;type != </span><span class=cF3>BDT_ATAPI</span><span class=cF0> &amp;&amp; bd-&gt;base1)
<a name="l294"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base1 + </span><span class=cF3>ATAR1_CTRL</span><span class=cF0>, </span><span class=cFE>0x8</span><span class=cF0>);
<a name="l295"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l296"></a> </span><span class=cFD>IDEATACmd</span><span class=cF0>(bd, </span><span class=cF3>ATA_READ_NATIVE_MAX</span><span class=cF0>);
<a name="l297"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF7>(</span><span class=cF0>bd, timeout</span><span class=cF7>)</span><span class=cF0>)
<a name="l298"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l299"></a> res.u8[</span><span class=cFE>0</span><span class=cF0>] = </span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SECT</span><span class=cF0>);
<a name="l300"></a> res.u8[</span><span class=cFE>1</span><span class=cF0>] = </span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>);
<a name="l301"></a> res.u8[</span><span class=cFE>2</span><span class=cF0>] = </span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>);
<a name="l302"></a> res.u8[</span><span class=cFE>3</span><span class=cF0>] = </span><span class=cF5>InU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>) &amp; </span><span class=cFE>0xF</span><span class=cF0>;
<a name="l303"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l304"></a> }
<a name="l305"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l306"></a> </span><span class=cF1>return</span><span class=cF0> bd-&gt;max_blk = res;
2021-07-03 05:07:57 +01:00
<a name="l307"></a>}
<a name="l308"></a>
<a name="l309"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cFD>IDEATAPIReadCapacity</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF9>I64</span><span class=cF0> *_blk_size=</span><span class=cF3>NULL</span><span class=cF0>)
<a name="l310"></a>{</span><span class=cF2>//Supposedly this can return a res +/- 75 sects.</span><span class=cF0>
<a name="l311"></a></span><span class=cF2>//Error might just be for music.</span><span class=cF0>
<a name="l312"></a> </span><span class=cF1>Bool</span><span class=cF0> unlock = </span><span class=cF5>BlkDevLock</span><span class=cF0>(bd);
<a name="l313"></a> </span><span class=cF9>U32</span><span class=cF0> buf[</span><span class=cFE>2</span><span class=cF0>];
2021-07-03 05:07:57 +01:00
<a name="l314"></a>
<a name="l315"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF7>(</span><span class=cF0>bd, </span><span class=cFE>0</span><span class=cF7>)</span><span class=cF0>)
<a name="l316"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l317"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l318"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l319"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l320"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l321"></a>
<a name="l322"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>, </span><span class=cFE>8</span><span class=cF0>);
<a name="l323"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l324"></a> </span><span class=cFD>IDEATACmd</span><span class=cF0>(bd, </span><span class=cF3>ATA_PACKET</span><span class=cF0>);
<a name="l325"></a> </span><span class=cFD>IDEATAPIWritePacketWord</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF3>ATAPI_READ_CAPACITY</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l326"></a>
<a name="l327"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cFD>IDEATAGetRes</span><span class=cF7>(</span><span class=cF0>bd, </span><span class=cFE>0</span><span class=cF0>, buf, </span><span class=cFE>8</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF3>TRUE</span><span class=cF7>)</span><span class=cF0>)
<a name="l328"></a> buf[</span><span class=cFE>0</span><span class=cF0>] = buf[</span><span class=cFE>1</span><span class=cF0>] = </span><span class=cFE>0</span><span class=cF0>;
<a name="l329"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l330"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l331"></a> buf[</span><span class=cFE>0</span><span class=cF0>] = buf[</span><span class=cFE>1</span><span class=cF0>] = </span><span class=cFE>0</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l332"></a>
<a name="l333"></a> </span><span class=cF1>if</span><span class=cF0> (unlock)
<a name="l334"></a> </span><span class=cF5>BlkDevUnlock</span><span class=cF0>(bd);
<a name="l335"></a> </span><span class=cF1>if</span><span class=cF0> (_blk_size)
<a name="l336"></a> *_blk_size = </span><span class=cF5>EndianU32</span><span class=cF0>(buf[</span><span class=cFE>1</span><span class=cF0>]);
2021-07-03 05:07:57 +01:00
<a name="l337"></a>
<a name="l338"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF5>EndianU32</span><span class=cF0>(buf[</span><span class=cFE>0</span><span class=cF0>]);
2021-07-03 05:07:57 +01:00
<a name="l339"></a>}
<a name="l340"></a>
<a name="l341"></a></span><span class=cF9>CATAPITrack</span><span class=cF0> *</span><span class=cFD>IDEATAPIReadTrackInfo</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF9>I64</span><span class=cF0> blk)
<a name="l342"></a>{
<a name="l343"></a> </span><span class=cF9>CATAPITrack</span><span class=cF0> *res = </span><span class=cF5>CAlloc</span><span class=cF0>(</span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CATAPITrack</span><span class=cF7>)</span><span class=cF0>);
<a name="l344"></a> </span><span class=cF1>Bool</span><span class=cF0> unlock = </span><span class=cF5>BlkDevLock</span><span class=cF0>(bd);
2021-07-03 05:07:57 +01:00
<a name="l345"></a>
<a name="l346"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF7>(</span><span class=cF0>bd, </span><span class=cFE>0</span><span class=cF7>)</span><span class=cF0>)
<a name="l347"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l348"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l349"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l350"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l351"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l352"></a>
<a name="l353"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CATAPITrack</span><span class=cF7>)</span><span class=cF0> &amp; </span><span class=cFE>0xFF</span><span class=cF0>);
<a name="l354"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CATAPITrack</span><span class=cF7>)</span><span class=cF0> &gt;&gt; </span><span class=cFE>8</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l355"></a>
<a name="l356"></a> </span><span class=cFD>IDEATACmd</span><span class=cF0>(bd, </span><span class=cF3>ATA_PACKET</span><span class=cF0>);
<a name="l357"></a> </span><span class=cFD>IDEATAPIWritePacketWord</span><span class=cF0>(bd,
<a name="l358"></a> </span><span class=cFE>0</span><span class=cF0>,
<a name="l359"></a> </span><span class=cF3>ATAPI_READ_TRACK_INFO</span><span class=cF0>,
<a name="l360"></a> blk.u16[</span><span class=cFE>1</span><span class=cF0>],
<a name="l361"></a> blk.u16[</span><span class=cFE>0</span><span class=cF0>],
<a name="l362"></a> </span><span class=cF7>(</span><span class=cF1>sizeof</span><span class=cF0>(</span><span class=cF9>CATAPITrack</span><span class=cF0>) &amp; </span><span class=cFE>0xFF00</span><span class=cF7>)</span><span class=cF0> &gt;&gt; </span><span class=cFE>8</span><span class=cF0>,
<a name="l363"></a> </span><span class=cF7>(</span><span class=cF1>sizeof</span><span class=cF0>(</span><span class=cF9>CATAPITrack</span><span class=cF0>) &amp; </span><span class=cFE>0x00FF</span><span class=cF7>)</span><span class=cF0> &lt;&lt; </span><span class=cFE>8</span><span class=cF0>,
<a name="l364"></a> </span><span class=cFE>0</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l365"></a>
<a name="l366"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cFD>IDEATAGetRes</span><span class=cF7>(</span><span class=cF0>bd, </span><span class=cFE>0</span><span class=cF0>, res, </span><span class=cF1>sizeof</span><span class=cF0>(</span><span class=cF9>CATAPITrack</span><span class=cF0>), </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF3>TRUE</span><span class=cF7>)</span><span class=cF0>)
<a name="l367"></a> {
<a name="l368"></a> </span><span class=cF5>Free</span><span class=cF0>(res);
<a name="l369"></a> res = </span><span class=cF3>NULL</span><span class=cF0>;
<a name="l370"></a> }
<a name="l371"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l372"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l373"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l374"></a> </span><span class=cF5>Free</span><span class=cF0>(res);
<a name="l375"></a> res = </span><span class=cF3>NULL</span><span class=cF0>;
<a name="l376"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l377"></a> </span><span class=cF1>if</span><span class=cF0> (unlock)
<a name="l378"></a> </span><span class=cF5>BlkDevUnlock</span><span class=cF0>(bd);
<a name="l379"></a> </span><span class=cF1>return</span><span class=cF0> res;
2021-07-03 05:07:57 +01:00
<a name="l380"></a>}
<a name="l381"></a>
<a name="l382"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cF5>IDEATAProbe</span><span class=cF0>(</span><span class=cF9>I64</span><span class=cF0> base0, </span><span class=cF9>I64</span><span class=cF0> base1, </span><span class=cF9>I64</span><span class=cF0> unit)
<a name="l383"></a>{
<a name="l384"></a> </span><span class=cF9>CBlkDev</span><span class=cF0> bd;
2021-07-03 05:07:57 +01:00
<a name="l385"></a>
<a name="l386"></a> </span><span class=cF5>MemSet</span><span class=cF0>(&amp;bd, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CBlkDev</span><span class=cF7>)</span><span class=cF0>);
<a name="l387"></a> bd.type = </span><span class=cF3>BDT_ATAPI</span><span class=cF0>;
<a name="l388"></a> bd.base0 = base0;
<a name="l389"></a> bd.base1 = base1;
<a name="l390"></a> bd.unit = unit;
<a name="l391"></a> bd.blk_size = </span><span class=cF3>DVD_BLK_SIZE</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l392"></a>
<a name="l393"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFD>IDEATAGetDevId</span><span class=cF0>(&amp;bd, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>0</span><span class=cF0>.</span><span class=cFE>1</span><span class=cF0>, </span><span class=cF3>FALSE</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l394"></a>}
<a name="l395"></a>
<a name="l396"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>IDEATAPISync</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd)
<a name="l397"></a>{
<a name="l398"></a> </span><span class=cF1>Bool</span><span class=cF0> okay = </span><span class=cF3>TRUE</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l399"></a>
<a name="l400"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF7>(</span><span class=cF0>bd, </span><span class=cFE>0</span><span class=cF7>)</span><span class=cF0>)
<a name="l401"></a> okay = </span><span class=cF3>FALSE</span><span class=cF0>;
<a name="l402"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l403"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l404"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l405"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l406"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l407"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l408"></a>
<a name="l409"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l410"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l411"></a> </span><span class=cFD>IDEATACmd</span><span class=cF0>(bd, </span><span class=cF3>ATA_PACKET</span><span class=cF0>);
<a name="l412"></a> </span><span class=cFD>IDEATAPIWritePacketWord</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF3>ATAPI_SYNC_CACHE</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l413"></a>
<a name="l414"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF7>(</span><span class=cF0>bd, </span><span class=cFE>0</span><span class=cF7>)</span><span class=cF0>)
<a name="l415"></a> okay = </span><span class=cF3>FALSE</span><span class=cF0>;
<a name="l416"></a> </span><span class=cF7>}</span><span class=cF0>
2021-07-03 05:07:57 +01:00
<a name="l417"></a>
<a name="l418"></a> </span><span class=cF1>return</span><span class=cF0> okay;
2021-07-03 05:07:57 +01:00
<a name="l419"></a>}
<a name="l420"></a>
<a name="l421"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cFD>IDEATAPIClose</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF9>I64</span><span class=cF0> close_field=</span><span class=cFE>0x200</span><span class=cF0>, </span><span class=cF9>I64</span><span class=cF0> track=</span><span class=cFE>0</span><span class=cF0>)
<a name="l422"></a>{</span><span class=cF2>//0x200 CD/DVD part 1</span><span class=cF0>
<a name="l423"></a></span><span class=cF2>// 0x300</span><span class=cF0> </span><span class=cF2>DVD part 2</span><span class=cF0>
<a name="l424"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l425"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l426"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l427"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l428"></a>
<a name="l429"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l430"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l431"></a> </span><span class=cFD>IDEATACmd</span><span class=cF0>(bd, </span><span class=cF3>ATA_PACKET</span><span class=cF0>);
<a name="l432"></a> </span><span class=cFD>IDEATAPIWritePacketWord</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF3>ATAPI_CLOSE_TRACK_SESSION</span><span class=cF0>, close_field, track, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l433"></a>
<a name="l434"></a> </span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l435"></a>}
<a name="l436"></a>
<a name="l437"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cFD>IDEATAPIWriteBlks</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF1>U8</span><span class=cF0> *buf, </span><span class=cF9>I64</span><span class=cF0> native_blk, </span><span class=cF9>I64</span><span class=cF0> count)
<a name="l438"></a>{
<a name="l439"></a> </span><span class=cF9>I64</span><span class=cF0> U32s_avail;
<a name="l440"></a> </span><span class=cF1>U8</span><span class=cF0> *buf2;
2021-07-03 05:07:57 +01:00
<a name="l441"></a>
<a name="l442"></a> </span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>);
<a name="l443"></a> </span><span class=cFD>IDEATAPISeek</span><span class=cF0>(bd, native_blk);
2021-07-03 05:07:57 +01:00
<a name="l444"></a>
<a name="l445"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_FEAT</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l446"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>, bd-&gt;blk_size);
<a name="l447"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>, bd-&gt;blk_size.u8[</span><span class=cFE>1</span><span class=cF0>]);
2021-07-03 05:07:57 +01:00
<a name="l448"></a>
<a name="l449"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l450"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l451"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l452"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l453"></a>
<a name="l454"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_CMD</span><span class=cF0>, </span><span class=cF3>ATA_PACKET</span><span class=cF0>);
<a name="l455"></a> </span><span class=cFD>IDEATAPIWritePacketWord</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF3>ATAPI_FORMAT_UNIT</span><span class=cF0>, native_blk.u16[</span><span class=cFE>1</span><span class=cF0>], native_blk, count.u16[</span><span class=cFE>1</span><span class=cF0>], count, </span><span class=cFE>0</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l456"></a>
<a name="l457"></a> bd-&gt;flags |= </span><span class=cF3>BDF_LAST_WAS_WRITE</span><span class=cF0>;
2021-07-03 05:07:57 +01:00
<a name="l458"></a>
<a name="l459"></a> </span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>);
<a name="l460"></a> </span><span class=cFD>IDEATAPISeek</span><span class=cF0>(bd, native_blk);
2021-07-03 05:07:57 +01:00
<a name="l461"></a>
<a name="l462"></a> </span><span class=cF1>if</span><span class=cF0> (bd-&gt;flags &amp; </span><span class=cF3>BDF_EXT_SIZE</span><span class=cF0>)
<a name="l463"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xEF</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
<a name="l464"></a> </span><span class=cF1>else</span><span class=cF0>
<a name="l465"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_SEL</span><span class=cF0>, </span><span class=cFE>0xE0</span><span class=cF0> | bd-&gt;unit &lt;&lt; </span><span class=cFE>4</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l466"></a>
<a name="l467"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF0>, bd-&gt;blk_size);
<a name="l468"></a> </span><span class=cF5>OutU8</span><span class=cF0>(bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF0>, bd-&gt;blk_size.u8[</span><span class=cFE>1</span><span class=cF0>]);
<a name="l469"></a> </span><span class=cFD>IDEATACmd</span><span class=cF0>(bd, </span><span class=cF3>ATA_PACKET</span><span class=cF0>);
<a name="l470"></a> </span><span class=cFD>IDEATAPIWritePacketWord</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF3>ATAPI_WRITE</span><span class=cF0>, native_blk.u16[</span><span class=cFE>1</span><span class=cF0>], native_blk, count.u16[</span><span class=cFE>1</span><span class=cF0>], count, </span><span class=cFE>0</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l471"></a>
<a name="l472"></a> buf2 = buf + bd-&gt;blk_size * count;
<a name="l473"></a> </span><span class=cF1>while</span><span class=cF0> (buf &lt; buf2)
<a name="l474"></a> </span><span class=cF7>{</span><span class=cF0>
<a name="l475"></a> </span><span class=cFD>IDEATAWaitDRQ</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>);
<a name="l476"></a> U32s_avail = (</span><span class=cF5>InU8</span><span class=cF7>(</span><span class=cF0>bd-&gt;base0 + </span><span class=cF3>ATAR0_HCYL</span><span class=cF7>)</span><span class=cF0> &lt;&lt; </span><span class=cFE>8</span><span class=cF0> + </span><span class=cF5>InU8</span><span class=cF7>(</span><span class=cF0>bd-&gt;base0 + </span><span class=cF3>ATAR0_LCYL</span><span class=cF7>)</span><span class=cF0>) &gt;&gt; </span><span class=cFE>2</span><span class=cF0>;
<a name="l477"></a> </span><span class=cF1>if</span><span class=cF0> (buf + U32s_avail &lt;&lt; </span><span class=cFE>2</span><span class=cF0> &gt; buf2)
<a name="l478"></a> U32s_avail = (buf2-buf) &gt;&gt; </span><span class=cFE>2</span><span class=cF0>;
<a name="l479"></a> </span><span class=cF1>if</span><span class=cF0> (U32s_avail)
<a name="l480"></a> {
<a name="l481"></a> </span><span class=cF5>RepOutU32</span><span class=cF0>(buf, U32s_avail, bd-&gt;base0 + </span><span class=cF3>ATAR0_DATA</span><span class=cF0>);
<a name="l482"></a> buf += U32s_avail &lt;&lt; </span><span class=cFE>2</span><span class=cF0>;
<a name="l483"></a> </span><span class=cFB>blkdev</span><span class=cF0>.write_count += U32s_avail &gt;&gt; (</span><span class=cF3>BLK_SIZE_BITS</span><span class=cF0> - </span><span class=cFE>2</span><span class=cF0>);
<a name="l484"></a> }
<a name="l485"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l486"></a> </span><span class=cFD>IDEATAWaitNotBUSY</span><span class=cF0>(bd, </span><span class=cFE>0</span><span class=cF0>);
2021-07-03 05:07:57 +01:00
<a name="l487"></a>}
</span></pre></body>
</html>